forked from len0rd/rockbox
Slightly better error handling in the iRiver I2C driver
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@6607 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
parent
a9ac3d12ea
commit
ead61c1d18
1 changed files with 17 additions and 9 deletions
|
|
@ -70,19 +70,22 @@ void i2c_close(void)
|
|||
int i2c_write(int device, unsigned char *buf, int count)
|
||||
{
|
||||
int i;
|
||||
int rc;
|
||||
|
||||
if (i2c_gen_start(device) == -1)
|
||||
rc = i2c_gen_start(device);
|
||||
if (rc < 0)
|
||||
{
|
||||
DEBUGF("i2c: gen_start failed (d=%d)", device);
|
||||
return -1;
|
||||
return rc*10 - 1;
|
||||
}
|
||||
|
||||
for (i=0; i<count; i++)
|
||||
{
|
||||
if (i2c_write_byte(device, buf[i]) == -1)
|
||||
rc = i2c_write_byte(device, buf[i]);
|
||||
if (rc < 0)
|
||||
{
|
||||
DEBUGF("i2c: write failed at (d=%d,i=%d)", device, i);
|
||||
return i-1;
|
||||
return rc*10 - 2;
|
||||
}
|
||||
}
|
||||
|
||||
|
|
@ -110,6 +113,8 @@ int i2c_write_byte(int device, unsigned char data)
|
|||
if (count >= MAX_LOOP)
|
||||
return -1;
|
||||
|
||||
count = 0;
|
||||
|
||||
/* Wait for interrupt flag */
|
||||
while (!(regs[O_MBSR] & IFF) && count < MAX_LOOP)
|
||||
{
|
||||
|
|
@ -118,15 +123,15 @@ int i2c_write_byte(int device, unsigned char data)
|
|||
}
|
||||
|
||||
if (count >= MAX_LOOP)
|
||||
return -1;
|
||||
return -2;
|
||||
|
||||
regs[O_MBSR] &= ~IFF; /* Clear interrupt flag */
|
||||
|
||||
if (!(regs[O_MBSR] & ICF)) /* Check that transfer is complete */
|
||||
return -1;
|
||||
return -3;
|
||||
|
||||
if (regs[O_MBSR] & RXAK) /* Check that the byte has been ACKed */
|
||||
return -1;
|
||||
return -4;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -140,7 +145,10 @@ int i2c_gen_start(int device)
|
|||
|
||||
/* Wait for bus to become free */
|
||||
while ((regs[O_MBSR] & IBB) && (count < MAX_LOOP))
|
||||
{
|
||||
yield();
|
||||
count++;
|
||||
}
|
||||
|
||||
if (count >= MAX_LOOP)
|
||||
return -1;
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue