|
@@ -1033,17 +1033,18 @@ static void sm501_i2c_write(void *opaque, hwaddr addr, uint64_t value,
|
|
case SM501_I2C_CONTROL:
|
|
case SM501_I2C_CONTROL:
|
|
if (value & SM501_I2C_CONTROL_ENABLE) {
|
|
if (value & SM501_I2C_CONTROL_ENABLE) {
|
|
if (value & SM501_I2C_CONTROL_START) {
|
|
if (value & SM501_I2C_CONTROL_START) {
|
|
|
|
+ bool is_recv = s->i2c_addr & 1;
|
|
int res = i2c_start_transfer(s->i2c_bus,
|
|
int res = i2c_start_transfer(s->i2c_bus,
|
|
s->i2c_addr >> 1,
|
|
s->i2c_addr >> 1,
|
|
- s->i2c_addr & 1);
|
|
|
|
|
|
+ is_recv);
|
|
if (res) {
|
|
if (res) {
|
|
s->i2c_status |= SM501_I2C_STATUS_ERROR;
|
|
s->i2c_status |= SM501_I2C_STATUS_ERROR;
|
|
} else {
|
|
} else {
|
|
int i;
|
|
int i;
|
|
for (i = 0; i <= s->i2c_byte_count; i++) {
|
|
for (i = 0; i <= s->i2c_byte_count; i++) {
|
|
- res = i2c_send_recv(s->i2c_bus, &s->i2c_data[i],
|
|
|
|
- !(s->i2c_addr & 1));
|
|
|
|
- if (res) {
|
|
|
|
|
|
+ if (is_recv) {
|
|
|
|
+ s->i2c_data[i] = i2c_recv(s->i2c_bus);
|
|
|
|
+ } else if (i2c_send(s->i2c_bus, s->i2c_data[i]) < 0) {
|
|
s->i2c_status |= SM501_I2C_STATUS_ERROR;
|
|
s->i2c_status |= SM501_I2C_STATUS_ERROR;
|
|
return;
|
|
return;
|
|
}
|
|
}
|