diff options
-rw-r--r-- | src/southbridge/intel/common/smbus.c | 11 | ||||
-rw-r--r-- | src/southbridge/intel/common/smbus.h | 2 |
2 files changed, 8 insertions, 5 deletions
diff --git a/src/southbridge/intel/common/smbus.c b/src/southbridge/intel/common/smbus.c index ee58aab995..43d7d1901f 100644 --- a/src/southbridge/intel/common/smbus.c +++ b/src/southbridge/intel/common/smbus.c @@ -47,6 +47,7 @@ #define SMBHSTSTS_HOST_BUSY (1 << 0) #define SMBUS_TIMEOUT (10 * 1000 * 100) +#define SMBUS_BLOCK_MAXLEN 32 static void smbus_delay(void) { @@ -203,7 +204,7 @@ int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd, if (smbus_wait_until_ready(smbus_base) < 0) return SMBUS_WAIT_UNTIL_READY_TIMEOUT; - max_bytes = MIN(32, max_bytes); + max_bytes = MIN(SMBUS_BLOCK_MAXLEN, max_bytes); /* Set up transaction */ /* Disable interrupts */ @@ -243,8 +244,7 @@ int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd, if (status & SMBHSTSTS_BYTE_DONE) { /* Byte done */ if (bytes_read < max_bytes) { - *buf = inb(smbus_base + SMBBLKDAT); - buf++; + *buf++ = inb(smbus_base + SMBBLKDAT); bytes_read++; } @@ -271,7 +271,7 @@ int do_smbus_block_write(unsigned int smbus_base, u8 device, u8 cmd, int bytes_sent = 0; unsigned int loops = SMBUS_TIMEOUT; - if (bytes > 32) + if (bytes > SMBUS_BLOCK_MAXLEN) return SMBUS_ERROR; if (smbus_wait_until_ready(smbus_base) < 0) @@ -329,6 +329,9 @@ int do_smbus_block_write(unsigned int smbus_base, u8 device, u8 cmd, } } while ((status & SMBHSTSTS_HOST_BUSY) && loops); + if (bytes_sent < bytes) + return SMBUS_ERROR; + return bytes_sent; } diff --git a/src/southbridge/intel/common/smbus.h b/src/southbridge/intel/common/smbus.h index f2e903c82b..3016a1726f 100644 --- a/src/southbridge/intel/common/smbus.h +++ b/src/southbridge/intel/common/smbus.h @@ -37,7 +37,7 @@ int do_smbus_read_byte(unsigned int smbus_base, u8 device, int do_smbus_write_byte(unsigned int smbus_base, u8 device, unsigned int address, unsigned int data); int do_smbus_block_read(unsigned int smbus_base, u8 device, - u8 cmd, unsigned int bytes, u8 *buf); + u8 cmd, unsigned int max_bytes, u8 *buf); int do_smbus_block_write(unsigned int smbus_base, u8 device, u8 cmd, unsigned int bytes, const u8 *buf); /* Only since ICH5 */ |