I2C driver cleanup (#21273)
* remove i2c_start and i2c_stop from i2c drivers * remove static i2c_address variable from chibios i2c driver
This commit is contained in:
		
							parent
							
								
									2b0965944d
								
							
						
					
					
						commit
						e9bd7d7ad3
					
				
					 49 changed files with 280 additions and 603 deletions
				
			
		| 
						 | 
				
			
			@ -43,23 +43,17 @@ uint8_t init_mcp23018(void) {
 | 
			
		|||
    // - unused  : input  : 1
 | 
			
		||||
    // - input   : input  : 1
 | 
			
		||||
    // - driving : output : 0
 | 
			
		||||
    mcp23018_status = i2c_start(I2C_ADDR_WRITE, I2C_TIMEOUT);    if (mcp23018_status) goto out;
 | 
			
		||||
    mcp23018_status = i2c_write(IODIRA, I2C_TIMEOUT);            if (mcp23018_status) goto out;
 | 
			
		||||
    mcp23018_status = i2c_write(0b10000000, I2C_TIMEOUT);        if (mcp23018_status) goto out;
 | 
			
		||||
    mcp23018_status = i2c_write(0b11111111, I2C_TIMEOUT);        if (mcp23018_status) goto out;
 | 
			
		||||
    i2c_stop();
 | 
			
		||||
    uint8_t data[] = {0b10000000, 0b11111111};
 | 
			
		||||
    mcp23018_status = i2c_writeReg(I2C_ADDR, IODIRA, data, sizeof(data), I2C_TIMEOUT);
 | 
			
		||||
 | 
			
		||||
    // set pull-up
 | 
			
		||||
    // - unused  : on  : 1
 | 
			
		||||
    // - input   : on  : 1
 | 
			
		||||
    // - driving : off : 0
 | 
			
		||||
    mcp23018_status = i2c_start(I2C_ADDR_WRITE, I2C_TIMEOUT);    if (mcp23018_status) goto out;
 | 
			
		||||
    mcp23018_status = i2c_write(GPPUA, I2C_TIMEOUT);             if (mcp23018_status) goto out;
 | 
			
		||||
    mcp23018_status = i2c_write(0b10000000, I2C_TIMEOUT);        if (mcp23018_status) goto out;
 | 
			
		||||
    mcp23018_status = i2c_write(0b11111111, I2C_TIMEOUT);        if (mcp23018_status) goto out;
 | 
			
		||||
    if (!mcp23018_status) {
 | 
			
		||||
        // set pull-up
 | 
			
		||||
        // - unused  : on  : 1
 | 
			
		||||
        // - input   : on  : 1
 | 
			
		||||
        // - driving : off : 0
 | 
			
		||||
        mcp23018_status = i2c_writeReg(I2C_ADDR, GPPUA, data, sizeof(data), I2C_TIMEOUT);
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
out:
 | 
			
		||||
    i2c_stop();
 | 
			
		||||
    // SREG=sreg_prev;
 | 
			
		||||
    //uprintf("Init %x\n", mcp23018_status);
 | 
			
		||||
    return mcp23018_status;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -11,10 +11,7 @@ extern i2c_status_t mcp23018_status;
 | 
			
		|||
#define I2C_TIMEOUT 1000
 | 
			
		||||
 | 
			
		||||
// I2C aliases and register addresses (see "mcp23018.md")
 | 
			
		||||
//#define I2C_ADDR        0b0100000
 | 
			
		||||
#define I2C_ADDR        0x20
 | 
			
		||||
#define I2C_ADDR_WRITE  ( (I2C_ADDR<<1) | I2C_WRITE )
 | 
			
		||||
#define I2C_ADDR_READ   ( (I2C_ADDR<<1) | I2C_READ  )
 | 
			
		||||
#define I2C_ADDR        (0x20<<1)
 | 
			
		||||
#define IODIRA          0x00            // i/o direction register
 | 
			
		||||
#define IODIRB          0x01
 | 
			
		||||
#define GPPUA           0x0C            // GPIO pull-up resistor register
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -297,19 +297,12 @@ static matrix_row_t read_cols(uint8_t row) {
 | 
			
		|||
            return 0;
 | 
			
		||||
        } else {
 | 
			
		||||
            uint8_t data = 0;
 | 
			
		||||
            mcp23018_status = i2c_start(I2C_ADDR_WRITE, I2C_TIMEOUT);    if (mcp23018_status) goto out;
 | 
			
		||||
            mcp23018_status = i2c_write(GPIOB, I2C_TIMEOUT);             if (mcp23018_status) goto out;
 | 
			
		||||
            mcp23018_status = i2c_start(I2C_ADDR_READ, I2C_TIMEOUT);     if (mcp23018_status) goto out;
 | 
			
		||||
            mcp23018_status = i2c_read_nack(I2C_TIMEOUT);                if (mcp23018_status < 0) goto out;
 | 
			
		||||
            data = ~((uint8_t)mcp23018_status);
 | 
			
		||||
            mcp23018_status = I2C_STATUS_SUCCESS;
 | 
			
		||||
        out:
 | 
			
		||||
            i2c_stop();
 | 
			
		||||
            mcp23018_status = i2c_readReg(I2C_ADDR, GPIOB, &data, 1, I2C_TIMEOUT);
 | 
			
		||||
 | 
			
		||||
#ifdef DEBUG_MATRIX
 | 
			
		||||
            if (data != 0x00) xprintf("I2C: %d\n", data);
 | 
			
		||||
            if (~data != 0x00) xprintf("I2C: %d\n", ~data);
 | 
			
		||||
#endif
 | 
			
		||||
            return data;
 | 
			
		||||
            return ~data;
 | 
			
		||||
        }
 | 
			
		||||
    } else {
 | 
			
		||||
         /* read from teensy
 | 
			
		||||
| 
						 | 
				
			
			@ -350,11 +343,8 @@ static void select_row(uint8_t row)
 | 
			
		|||
        // select on mcp23018
 | 
			
		||||
        if (mcp23018_status) { // do nothing on error
 | 
			
		||||
        } else { // set active row low  : 0 // set other rows hi-Z : 1
 | 
			
		||||
            mcp23018_status = i2c_start(I2C_ADDR_WRITE, I2C_TIMEOUT);        if (mcp23018_status) goto out;
 | 
			
		||||
            mcp23018_status = i2c_write(GPIOA, I2C_TIMEOUT);                 if (mcp23018_status) goto out;
 | 
			
		||||
            mcp23018_status = i2c_write(0xFF & ~(1<<row), I2C_TIMEOUT);      if (mcp23018_status) goto out;
 | 
			
		||||
        out:
 | 
			
		||||
            i2c_stop();
 | 
			
		||||
            uint8_t data = 0xFF & ~(1<<row);
 | 
			
		||||
            mcp23018_status = i2c_writeReg(I2C_ADDR, GPIOA, &data, 1, I2C_TIMEOUT);
 | 
			
		||||
        }
 | 
			
		||||
    } else {
 | 
			
		||||
        // Output low(DDR:1, PORT:0) to select
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue