/* ------------------------------------------------------------------------ *
* *
* _I2C_read( i2c_addr, data, len ) *
* *
* I2C read in Master mode *
* *
* i2c_addr <- I2C slave address *
* data <- I2C data ptr *
* len <- # of bytes to write *
* *
* Returns: 0: PASS *
* -1: FAIL Timeout *
* *
* ------------------------------------------------------------------------ */
Int16 USBSTK5505_I2C_read( Uint16 i2c_addr, Uint8* data, Uint16 len )
{
Int32 timeout, i;
I2C_CNT = len; // Set length
I2C_SAR = i2c_addr; // Set I2C slave address
I2C_MDR = MDR_STT // Set for Master Read
| MDR_MST
| MDR_IRS
| MDR_FREE;
USBSTK5505_wait( 10 ); // Short delay
for ( i = 0 ; i < len ; i++ )
{
timeout = i2c_timeout;
//Wait for Rx Ready
do
{
if ( timeout-- < 0 )
{
USBSTK5505_I2C_reset( );
return -1;
}
} while ( ( I2C_STR & STR_RRDY ) == 0 );// Wait for Rx Ready
data[i] = I2C_DRR; // Read
}
I2C_MDR |= MDR_STP; // Generate STOP
USBSTK5505_waitusec(10);
return 0;
}
/*
*
* AIC3204_rset( regnum, regval )
*
* Set codec register regnum to value regval
*
*/
Int16 AIC3204_rset( Uint16 regnum, Uint16 regval )
{
Uint16 cmd[2];
cmd[0] = regnum & 0x007F; // 7-bit Device Register
cmd[1] = regval; // 8-bit Register Data
USBSTK5505_waitusec( 300 );
return USBSTK5505_I2C_write( AIC3204_I2C_ADDR, cmd, 2 );
}
/* ------------------------------------------------------------------------ *
* *
* _I2C_write( i2c_addr, data, len ) *
* *
* I2C write in Master mode *
* *
* i2c_addr <- I2C slave address *
* data <- I2C data ptr *
* len <- # of bytes to write *
* *
* ------------------------------------------------------------------------ */
Int16 USBSTK5505_I2C_write( Uint16 i2c_addr, Uint8* data, Uint16 len )
{
Int32 timeout, i;
//I2C_IER = 0x0000;
I2C_CNT = len; // Set length
I2C_SAR = i2c_addr; // Set I2C slave address
I2C_MDR = MDR_STT // Set for Master Write
| MDR_TRX
| MDR_MST
| MDR_IRS
| MDR_FREE;
USBSTK5505_wait(10); // Short delay
for ( i = 0 ; i < len ; i++ )
{
I2C_DXR = data[i]; // Write
timeout = i2c_timeout;
do
{
if ( timeout-- < 0 )
{
USBSTK5505_I2C_reset( );
return -1;
}
} while ( ( I2C_STR & STR_XRDY ) == 0 );// Wait for Tx Ready
}
I2C_MDR |= MDR_STP; // Generate STOP
USBSTK5505_waitusec(100);
return 0;
}