diff options
Diffstat (limited to 'drivers')
-rwxr-xr-x | drivers/avr/i2c_master.c | 89 | ||||
-rwxr-xr-x | drivers/avr/i2c_master.h | 2 | ||||
-rw-r--r-- | drivers/avr/is31fl3731.c | 56 | ||||
-rw-r--r-- | drivers/avr/is31fl3731.h | 10 |
4 files changed, 115 insertions, 42 deletions
diff --git a/drivers/avr/i2c_master.c b/drivers/avr/i2c_master.c index cd3c2e1c81..97f6900436 100755 --- a/drivers/avr/i2c_master.c +++ b/drivers/avr/i2c_master.c @@ -6,6 +6,7 @@ #include <util/twi.h> #include "i2c_master.h" +#include "timer.h" #define F_SCL 400000UL // SCL frequency #define Prescaler 1 @@ -24,8 +25,18 @@ uint8_t i2c_start(uint8_t address) TWCR = 0; // transmit START condition TWCR = (1<<TWINT) | (1<<TWSTA) | (1<<TWEN); - // wait for end of transmission - while( !(TWCR & (1<<TWINT)) ); + + #ifdef I2C_TIMEOUT + uint16_t timeout_timer = timer_read(); + while( !(TWCR & (1<<TWINT)) ) { + if ((timer_read() - timeout_timer) > I2C_TIMEOUT) { + return 2; // should make these codes standard + } + } + #else + // wait for end of transmission + while( !(TWCR & (1<<TWINT)) ); + #endif // check if the start condition was successfully transmitted if(((TW_STATUS & 0xF8) != TW_START) && ((TW_STATUS & 0xF8) != TW_REP_START)){ return 1; } @@ -34,8 +45,18 @@ uint8_t i2c_start(uint8_t address) TWDR = address; // start transmission of address TWCR = (1<<TWINT) | (1<<TWEN); - // wait for end of transmission - while( !(TWCR & (1<<TWINT)) ); + + #ifdef I2C_TIMEOUT + timeout_timer = timer_read(); + while( !(TWCR & (1<<TWINT)) ) { + if ((timer_read() - timeout_timer) > I2C_TIMEOUT) { + return 2; // should make these codes standard + } + } + #else + // wait for end of transmission + while( !(TWCR & (1<<TWINT)) ); + #endif // check if the device has acknowledged the READ / WRITE mode uint8_t twst = TW_STATUS & 0xF8; @@ -50,8 +71,18 @@ uint8_t i2c_write(uint8_t data) TWDR = data; // start transmission of data TWCR = (1<<TWINT) | (1<<TWEN); + + #ifdef I2C_TIMEOUT + uint16_t timeout_timer = timer_read(); + while( !(TWCR & (1<<TWINT)) ) { + if ((timer_read() - timeout_timer) > I2C_TIMEOUT) { + return 2; // should make these codes standard + } + } + #else // wait for end of transmission - while( !(TWCR & (1<<TWINT)) ); + while( !(TWCR & (1<<TWINT)) ); + #endif if( (TW_STATUS & 0xF8) != TW_MT_DATA_ACK ){ return 1; } @@ -63,8 +94,19 @@ uint8_t i2c_read_ack(void) // start TWI module and acknowledge data after reception TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWEA); - // wait for end of transmission - while( !(TWCR & (1<<TWINT)) ); + + #ifdef I2C_TIMEOUT + uint16_t timeout_timer = timer_read(); + while( !(TWCR & (1<<TWINT)) ) { + if ((timer_read() - timeout_timer) > I2C_TIMEOUT) { + return 2; // should make these codes standard + } + } + #else + // wait for end of transmission + while( !(TWCR & (1<<TWINT)) ); + #endif + // return received data from TWDR return TWDR; } @@ -74,8 +116,19 @@ uint8_t i2c_read_nack(void) // start receiving without acknowledging reception TWCR = (1<<TWINT) | (1<<TWEN); - // wait for end of transmission - while( !(TWCR & (1<<TWINT)) ); + + #ifdef I2C_TIMEOUT + uint16_t timeout_timer = timer_read(); + while( !(TWCR & (1<<TWINT)) ) { + if ((timer_read() - timeout_timer) > I2C_TIMEOUT) { + return 2; // should make these codes standard + } + } + #else + // wait for end of transmission + while( !(TWCR & (1<<TWINT)) ); + #endif + // return received data from TWDR return TWDR; } @@ -144,10 +197,22 @@ uint8_t i2c_readReg(uint8_t devaddr, uint8_t regaddr, uint8_t* data, uint16_t le return 0; } -void i2c_stop(void) +uint8_t i2c_stop(void) { // transmit STOP condition TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWSTO); - // wait until stop condition is executed and bus released - while(TWCR & (1<<TWSTO)); + + #ifdef I2C_TIMEOUT + uint16_t timeout_timer = timer_read(); + while(TWCR & (1<<TWSTO)) { + if ((timer_read() - timeout_timer) > I2C_TIMEOUT) { + return 2; // should make these codes standard + } + } + #else + // wait for end of transmission + while(TWCR & (1<<TWSTO)); + #endif + + return 0; } diff --git a/drivers/avr/i2c_master.h b/drivers/avr/i2c_master.h index 2479d28d52..8686807146 100755 --- a/drivers/avr/i2c_master.h +++ b/drivers/avr/i2c_master.h @@ -17,6 +17,6 @@ uint8_t i2c_transmit(uint8_t address, uint8_t* data, uint16_t length); uint8_t i2c_receive(uint8_t address, uint8_t* data, uint16_t length); uint8_t i2c_writeReg(uint8_t devaddr, uint8_t regaddr, uint8_t* data, uint16_t length); uint8_t i2c_readReg(uint8_t devaddr, uint8_t regaddr, uint8_t* data, uint16_t length); -void i2c_stop(void); +uint8_t i2c_stop(void); #endif // I2C_MASTER_H diff --git a/drivers/avr/is31fl3731.c b/drivers/avr/is31fl3731.c index 13dfe6eaf6..158b77b7b1 100644 --- a/drivers/avr/is31fl3731.c +++ b/drivers/avr/is31fl3731.c @@ -78,18 +78,19 @@ bool g_led_control_registers_update_required = false; // 0x10 - R16,R15,R14,R13,R12,R11,R10,R09 -void IS31FL3731_write_register( uint8_t addr, uint8_t reg, uint8_t data ) +uint8_t IS31FL3731_write_register( uint8_t addr, uint8_t reg, uint8_t data ) { g_twi_transfer_buffer[0] = reg; g_twi_transfer_buffer[1] = data; //Transmit data until succesful //while(i2c_transmit(addr << 1, g_twi_transfer_buffer,2) != 0); - i2c_transmit(addr << 1, g_twi_transfer_buffer,2); + return i2c_transmit(addr << 1, g_twi_transfer_buffer,2); } -void IS31FL3731_write_pwm_buffer( uint8_t addr, uint8_t *pwm_buffer ) +uint8_t IS31FL3731_write_pwm_buffer( uint8_t addr, uint8_t *pwm_buffer ) { + uint8_t ret = 0; // assumes bank is already selected // transmit PWM registers in 9 transfers of 16 bytes @@ -110,64 +111,67 @@ void IS31FL3731_write_pwm_buffer( uint8_t addr, uint8_t *pwm_buffer ) //Transmit buffer until succesful //while(i2c_transmit(addr << 1, g_twi_transfer_buffer,17) != 0); - i2c_transmit(addr << 1, g_twi_transfer_buffer,17); - + ret |= i2c_transmit(addr << 1, g_twi_transfer_buffer, 17); } + return ret; } -void IS31FL3731_init( uint8_t addr ) +uint8_t IS31FL3731_init( uint8_t addr ) { + uint8_t ret = 0; // In order to avoid the LEDs being driven with garbage data // in the LED driver's PWM registers, first enable software shutdown, // then set up the mode and other settings, clear the PWM registers, // then disable software shutdown. // select "function register" bank - IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, ISSI_BANK_FUNCTIONREG ); + ret |= IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, ISSI_BANK_FUNCTIONREG ); // enable software shutdown - IS31FL3731_write_register( addr, ISSI_REG_SHUTDOWN, 0x00 ); + ret |= IS31FL3731_write_register( addr, ISSI_REG_SHUTDOWN, 0x00 ); // this delay was copied from other drivers, might not be needed _delay_ms( 10 ); // picture mode - IS31FL3731_write_register( addr, ISSI_REG_CONFIG, ISSI_REG_CONFIG_PICTUREMODE ); + ret |= IS31FL3731_write_register( addr, ISSI_REG_CONFIG, ISSI_REG_CONFIG_PICTUREMODE ); // display frame 0 - IS31FL3731_write_register( addr, ISSI_REG_PICTUREFRAME, 0x00 ); + ret |= IS31FL3731_write_register( addr, ISSI_REG_PICTUREFRAME, 0x00 ); // audio sync off - IS31FL3731_write_register( addr, ISSI_REG_AUDIOSYNC, 0x00 ); + ret |= IS31FL3731_write_register( addr, ISSI_REG_AUDIOSYNC, 0x00 ); // select bank 0 - IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, 0 ); + ret |= IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, 0 ); // turn off all LEDs in the LED control register for ( int i = 0x00; i <= 0x11; i++ ) { - IS31FL3731_write_register( addr, i, 0x00 ); + ret |= IS31FL3731_write_register( addr, i, 0x00 ); } // turn off all LEDs in the blink control register (not really needed) for ( int i = 0x12; i <= 0x23; i++ ) { - IS31FL3731_write_register( addr, i, 0x00 ); + ret |= IS31FL3731_write_register( addr, i, 0x00 ); } // set PWM on all LEDs to 0 for ( int i = 0x24; i <= 0xB3; i++ ) { - IS31FL3731_write_register( addr, i, 0x00 ); + ret |= IS31FL3731_write_register( addr, i, 0x00 ); } // select "function register" bank - IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, ISSI_BANK_FUNCTIONREG ); + ret |= IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, ISSI_BANK_FUNCTIONREG ); // disable software shutdown - IS31FL3731_write_register( addr, ISSI_REG_SHUTDOWN, 0x01 ); + ret |= IS31FL3731_write_register( addr, ISSI_REG_SHUTDOWN, 0x01 ); // select bank 0 and leave it selected. // most usage after initialization is just writing PWM buffers in bank 0 // as there's not much point in double-buffering - IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, 0 ); + ret |= IS31FL3731_write_register( addr, ISSI_COMMANDREGISTER, 0 ); + + return ret; } void IS31FL3731_set_color( int index, uint8_t red, uint8_t green, uint8_t blue ) @@ -223,25 +227,29 @@ void IS31FL3731_set_led_control_register( uint8_t index, bool red, bool green, b } -void IS31FL3731_update_pwm_buffers( uint8_t addr1, uint8_t addr2 ) +uint8_t IS31FL3731_update_pwm_buffers( uint8_t addr1, uint8_t addr2 ) { + uint8_t ret = 0; if ( g_pwm_buffer_update_required ) { - IS31FL3731_write_pwm_buffer( addr1, g_pwm_buffer[0] ); - IS31FL3731_write_pwm_buffer( addr2, g_pwm_buffer[1] ); + ret |= IS31FL3731_write_pwm_buffer( addr1, g_pwm_buffer[0] ); + ret |= IS31FL3731_write_pwm_buffer( addr2, g_pwm_buffer[1] ); } g_pwm_buffer_update_required = false; + return ret; } -void IS31FL3731_update_led_control_registers( uint8_t addr1, uint8_t addr2 ) +uint8_t IS31FL3731_update_led_control_registers( uint8_t addr1, uint8_t addr2 ) { + uint8_t ret = 0; if ( g_led_control_registers_update_required ) { for ( int i=0; i<18; i++ ) { - IS31FL3731_write_register(addr1, i, g_led_control_registers[0][i] ); - IS31FL3731_write_register(addr2, i, g_led_control_registers[1][i] ); + ret |= IS31FL3731_write_register(addr1, i, g_led_control_registers[0][i] ); + ret |= IS31FL3731_write_register(addr2, i, g_led_control_registers[1][i] ); } } + return ret; } diff --git a/drivers/avr/is31fl3731.h b/drivers/avr/is31fl3731.h index 3d30fc67b7..62632e276a 100644 --- a/drivers/avr/is31fl3731.h +++ b/drivers/avr/is31fl3731.h @@ -31,9 +31,9 @@ typedef struct is31_led { extern const is31_led g_is31_leds[DRIVER_LED_TOTAL]; -void IS31FL3731_init( uint8_t addr ); -void IS31FL3731_write_register( uint8_t addr, uint8_t reg, uint8_t data ); -void IS31FL3731_write_pwm_buffer( uint8_t addr, uint8_t *pwm_buffer ); +uint8_t IS31FL3731_init( uint8_t addr ); +uint8_t IS31FL3731_write_register( uint8_t addr, uint8_t reg, uint8_t data ); +uint8_t IS31FL3731_write_pwm_buffer( uint8_t addr, uint8_t *pwm_buffer ); void IS31FL3731_set_color( int index, uint8_t red, uint8_t green, uint8_t blue ); void IS31FL3731_set_color_all( uint8_t red, uint8_t green, uint8_t blue ); @@ -44,8 +44,8 @@ void IS31FL3731_set_led_control_register( uint8_t index, bool red, bool green, b // (eg. from a timer interrupt). // Call this while idle (in between matrix scans). // If the buffer is dirty, it will update the driver with the buffer. -void IS31FL3731_update_pwm_buffers( uint8_t addr1, uint8_t addr2 ); -void IS31FL3731_update_led_control_registers( uint8_t addr1, uint8_t addr2 ); +uint8_t IS31FL3731_update_pwm_buffers( uint8_t addr1, uint8_t addr2 ); +uint8_t IS31FL3731_update_led_control_registers( uint8_t addr1, uint8_t addr2 ); #define C1_1 0x24 #define C1_2 0x25 |