/*********************************************************************
*
* _Write
*
* Function description
* Writes to a device on I2C.
*/
static U8 _Write(U8 Addr, U8 * pData, U16 NumBytesToWrite, U8 PartOfWriteRead) {
U8 r;
U16 i;
r = _I2C_Start(); // Generate Start condition
if(r == I2C_CODE_OK) {
r = _I2C_WriteWithWait(Addr); // Write address (SLA+W)
if (r == I2C_CODE_OK) {
//
// Write data
//
for (i = 0; i < NumBytesToWrite; i++) {
r = _I2C_WriteWithWait(*pData);
if (r != I2C_CODE_OK) {
PartOfWriteRead = 0; // Override to generate stop condition on error
break;
}
pData++;
}
}
}
if (PartOfWriteRead == 0) {
_I2C_Stop(); // Generate Stop condition
}
return r;
}
/*********************************************************************
*
* I2C_PCA9532_WriteRead()
*/
unsigned char I2CPCA9532_WriteRead(unsigned char * pData, unsigned short NumBytesToWrite, unsigned char * pBuf, unsigned short NumBytesToRead) {
unsigned char r = 0;
unsigned char Status = 0;
unsigned short i = 0;
r = _I2C_Start(); // Generate Start condition
if(r != I2C_CODE_OK) {
goto STOPWRITE;
}
r = _I2C_WriteWithWait(0xC0); // Write PCA9532 address
if (r != I2C_CODE_OK) {
goto STOPWRITE;
}
//
// Write data
//
for (i = 0; i < NumBytesToWrite; i++) {
r = _I2C_WriteWithWait(*pData);
if (r != I2C_CODE_OK) {
goto STOPWRITE;
}
pData++;
}
STOPWRITE:
if (NumBytesToRead > 0) {
r = _I2C_RepeatStart(); // Generate Start condition
//
// Transmit device address
//
if (r == I2C_CODE_OK) {
r = _I2C_PutChar(0xc0 + 0x01); // Write SLA+R
while(r == I2C_CODE_BUSY) {
r = _I2C_PutChar(0xc0 + 0x01);
}
}
//
// Wait until SLA+R transmitted
//
while (1) {
Status = _I2C_CheckStatus();
if (Status == 0x40) { // Data transmitted and ACK received
break;
} else if (Status != 0xF8) { // Error
r = I2C_CODE_ERROR;
break;
}
}
if (r == I2C_CODE_OK) {
//
// Wait until address transmitted and receive data
//
for (i = 1; i <= NumBytesToRead; i++) {
//
// Wait until data transmitted
//
while (1) {
Status = _I2C_CheckStatus();
if ((Status == 0x40) || (Status == 0x48) || (Status == 0x50 )) { // Data received
//
// Set generate NACK
//
if (i == NumBytesToRead) {
r = _I2C_GetChar(I2C_MODE_ACK1, pBuf);
} else {
r = _I2C_GetChar(I2C_MODE_ACK0, pBuf);
}
r = _I2C_GetChar(I2C_MODE_READ, pBuf); // Read data
while (r == I2C_CODE_EMPTY) {
r = _I2C_GetChar(I2C_MODE_READ, pBuf);
}
pBuf++;
break;
} else if (Status != 0xF8) { // Error
i = NumBytesToRead;
r = I2C_CODE_ERROR;
break;
}
}
}
}
}
_I2C_Stop(); // Generate Stop condition
return r;
}
