diff options
Diffstat (limited to 'cpu/mpc824x/drivers/i2c/i2c1.c')
| -rw-r--r-- | cpu/mpc824x/drivers/i2c/i2c1.c | 11 |
1 files changed, 7 insertions, 4 deletions
diff --git a/cpu/mpc824x/drivers/i2c/i2c1.c b/cpu/mpc824x/drivers/i2c/i2c1.c index dc1c97ca0f6..94c671e5672 100644 --- a/cpu/mpc824x/drivers/i2c/i2c1.c +++ b/cpu/mpc824x/drivers/i2c/i2c1.c @@ -1197,13 +1197,16 @@ int i2c_write (uchar chip, uint addr, int alen, uchar * buffer, int len) uchar *p; int i; - p = dummy_buffer; /* fill in address in big endian order */ - for (i=0; i<alen; ++i) - *p++ = (addr >> (i * 8)) & 0xFF; + for (i=alen-1; i>=0; --i) { + buffer[i] = addr & 0xFF; + addr >>= 8; + } /* fill in data */ + p = dummy_buffer + alen; + for (i=0; i<len; ++i) - *p++ = *buffer; + *p++ = *buffer++; status = I2C_do_buffer (0, I2C_MASTER_XMIT, chip, alen + len, dummy_buffer, I2C_STOP, 1, I2C_NO_RESTART); |