Revert the S5L870X I2C driver to busy waiting because of some issues with interrupts, and increase the bus speed from 24kHz to 390kHz.

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@23074 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Michael Sparmann 2009-10-10 16:36:55 +00:00
parent 72271af7df
commit 6be1d8b8a8

View file

@ -40,20 +40,10 @@
*/ */
static struct mutex i2c_mtx; static struct mutex i2c_mtx;
static struct wakeup i2c_wakeup;
void INT_IIC(void)
{
/* disable interrupt (but don't clear it yet) */
IICCON &= ~((1 << 4) | (1 << 5));
wakeup_signal(&i2c_wakeup);
}
void i2c_init(void) void i2c_init(void)
{ {
mutex_init(&i2c_mtx); mutex_init(&i2c_mtx);
wakeup_init(&i2c_wakeup);
/* enable I2C pins */ /* enable I2C pins */
PCON10 = (2 << 2) | PCON10 = (2 << 2) |
@ -65,10 +55,10 @@ void i2c_init(void)
/* initial config */ /* initial config */
IICADD = 0; IICADD = 0;
IICCON = (1 << 7) | /* ACK_GEN */ IICCON = (1 << 7) | /* ACK_GEN */
(1 << 6) | /* CLKSEL = PCLK/512 */ (0 << 6) | /* CLKSEL = PCLK/16 */
(1 << 5) | /* INT_EN */ (1 << 5) | /* INT_EN */
(1 << 4) | /* IRQ clear */ (1 << 4) | /* IRQ clear */
(3 << 0); /* CK_REG */ (7 << 0); /* CK_REG */
/* serial output on */ /* serial output on */
IICSTAT = (1 << 4); IICSTAT = (1 << 4);
@ -84,26 +74,26 @@ int i2c_write(unsigned char slave, int address, int len, const unsigned char *da
/* START */ /* START */
IICDS = slave & ~1; IICDS = slave & ~1;
IICSTAT = 0xF0; IICSTAT = 0xF0;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
if (address >= 0) { if (address >= 0) {
/* write address */ /* write address */
IICDS = address; IICDS = address;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
} }
/* write data */ /* write data */
while (len--) { while (len--) {
IICDS = *data++; IICDS = *data++;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
} }
/* STOP */ /* STOP */
IICSTAT = 0xD0; IICSTAT = 0xD0;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICSTAT & (1 << 5)) != 0); while ((IICSTAT & (1 << 5)) != 0);
mutex_unlock(&i2c_mtx); mutex_unlock(&i2c_mtx);
@ -118,30 +108,30 @@ int i2c_read(unsigned char slave, int address, int len, unsigned char *data)
/* START */ /* START */
IICDS = slave & ~1; IICDS = slave & ~1;
IICSTAT = 0xF0; IICSTAT = 0xF0;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
/* write address */ /* write address */
IICDS = address; IICDS = address;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
} }
/* (repeated) START */ /* (repeated) START */
IICDS = slave | 1; IICDS = slave | 1;
IICSTAT = 0xB0; IICSTAT = 0xB0;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
while (len--) { while (len--) {
IICCON = (len == 0) ? 0x73 : 0xF3; /* NACK or ACK */ IICCON = (len == 0) ? 0x37 : 0xB7; /* NACK or ACK */
while ((IICCON & 0x10) == 0) wakeup_wait(&i2c_wakeup, 1); while ((IICCON & 0x10) == 0);
*data++ = IICDS; *data++ = IICDS;
} }
/* STOP */ /* STOP */
IICSTAT = 0x90; IICSTAT = 0x90;
IICCON = 0xF3; IICCON = 0xB7;
while ((IICSTAT & (1 << 5)) != 0); while ((IICSTAT & (1 << 5)) != 0);
mutex_unlock(&i2c_mtx); mutex_unlock(&i2c_mtx);