sb/intel/common: SMBus complete_command()

Adds helper to test for SMBHSTSTAT flags for
hardware having finished or failed a transaction.

Change-Id: Idea15e03edde7aeedf198c1529f09c24a5bc0b06
Signed-off-by: Kyösti Mälkki <kyosti.malkki@gmail.com>
Reviewed-on: https://review.coreboot.org/c/21120
Tested-by: build bot (Jenkins) <no-reply@coreboot.org>
Reviewed-by: Arthur Heymans <arthur@aheymans.xyz>
This commit is contained in:
Kyösti Mälkki 2017-08-20 21:36:18 +03:00 committed by Patrick Georgi
parent a2dcf735e4
commit c38d543feb
1 changed files with 65 additions and 54 deletions

View File

@ -65,6 +65,14 @@ static void smbus_delay(void)
inb(0x80); inb(0x80);
} }
static int host_completed(u8 status)
{
if (status & SMBHSTSTS_HOST_BUSY)
return 0;
status &= ~(SMBHSTSTS_SMBALERT_STS | SMBHSTSTS_INUSE_STS);
return status != 0;
}
static int recover_master(int smbus_base, int ret) static int recover_master(int smbus_base, int ret)
{ {
/* TODO: Depending of the failure, drive KILL transaction /* TODO: Depending of the failure, drive KILL transaction
@ -74,6 +82,17 @@ static int recover_master(int smbus_base, int ret)
return ret; return ret;
} }
static int cb_err_from_stat(u8 status)
{
/* Ignore the "In Use" status... */
status &= ~(SMBHSTSTS_SMBALERT_STS | SMBHSTSTS_INUSE_STS);
if (status == SMBHSTSTS_INTR)
return 0;
return SMBUS_ERROR;
}
static int setup_command(unsigned int smbus_base, u8 ctrl, u8 xmitadd) static int setup_command(unsigned int smbus_base, u8 ctrl, u8 xmitadd)
{ {
unsigned int loops = SMBUS_TIMEOUT; unsigned int loops = SMBUS_TIMEOUT;
@ -128,26 +147,28 @@ static int execute_command(unsigned int smbus_base)
return 0; return 0;
} }
static int smbus_wait_until_done(u16 smbus_base) static int complete_command(unsigned int smbus_base)
{ {
unsigned int loops = SMBUS_TIMEOUT; unsigned int loops = SMBUS_TIMEOUT;
unsigned char byte; u8 status;
do { do {
smbus_delay(); smbus_delay();
if (--loops == 0) status = inb(smbus_base + SMBHSTSTAT);
break; } while (--loops && !host_completed(status));
byte = inb(smbus_base + SMBHSTSTAT);
} while ((byte & SMBHSTSTS_HOST_BUSY) if (loops == 0)
|| (byte & ~(SMBHSTSTS_INUSE_STS | SMBHSTSTS_HOST_BUSY)) == 0); return recover_master(smbus_base,
return loops ? 0 : -1; SMBUS_WAIT_UNTIL_DONE_TIMEOUT);
return cb_err_from_stat(status);
} }
int do_smbus_read_byte(unsigned int smbus_base, u8 device, int do_smbus_read_byte(unsigned int smbus_base, u8 device,
unsigned int address) unsigned int address)
{ {
int ret; int ret;
unsigned char status; u8 byte;
unsigned char byte;
/* Set up for a byte data read. */ /* Set up for a byte data read. */
ret = setup_command(smbus_base, I801_BYTE_DATA, XMIT_READ(device)); ret = setup_command(smbus_base, I801_BYTE_DATA, XMIT_READ(device));
@ -166,25 +187,18 @@ int do_smbus_read_byte(unsigned int smbus_base, u8 device,
return ret; return ret;
/* Poll for transaction completion */ /* Poll for transaction completion */
if (smbus_wait_until_done(smbus_base) < 0) ret = complete_command(smbus_base);
return SMBUS_WAIT_UNTIL_DONE_TIMEOUT; if (ret < 0)
return ret;
status = inb(smbus_base + SMBHSTSTAT);
/* Ignore the "In Use" status... */
status &= ~(SMBHSTSTS_SMBALERT_STS | SMBHSTSTS_INUSE_STS);
/* Read results of transaction */ /* Read results of transaction */
byte = inb(smbus_base + SMBHSTDAT0); byte = inb(smbus_base + SMBHSTDAT0);
if (status != SMBHSTSTS_INTR)
return SMBUS_ERROR;
return byte; return byte;
} }
int do_smbus_write_byte(unsigned int smbus_base, u8 device, int do_smbus_write_byte(unsigned int smbus_base, u8 device,
unsigned int address, unsigned int data) unsigned int address, unsigned int data)
{ {
unsigned char status;
int ret; int ret;
/* Set up for a byte data write. */ /* Set up for a byte data write. */
@ -204,19 +218,7 @@ int do_smbus_write_byte(unsigned int smbus_base, u8 device,
return ret; return ret;
/* Poll for transaction completion */ /* Poll for transaction completion */
if (smbus_wait_until_done(smbus_base) < 0) return complete_command(smbus_base);
return SMBUS_WAIT_UNTIL_DONE_TIMEOUT;
status = inb(smbus_base + SMBHSTSTAT);
/* Ignore the "In Use" status... */
status &= ~(SMBHSTSTS_SMBALERT_STS | SMBHSTSTS_INUSE_STS);
/* Read results of transaction */
if (status != SMBHSTSTS_INTR)
return SMBUS_ERROR;
return 0;
} }
int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd, int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd,
@ -248,12 +250,7 @@ int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd,
/* Poll for transaction completion */ /* Poll for transaction completion */
do { do {
loops--;
status = inb(smbus_base + SMBHSTSTAT); status = inb(smbus_base + SMBHSTSTAT);
if (status & (SMBHSTSTS_FAILED | /* FAILED */
SMBHSTSTS_BUS_ERR | /* BUS ERR */
SMBHSTSTS_DEV_ERR)) /* DEV ERR */
return SMBUS_ERROR;
if (status & SMBHSTSTS_BYTE_DONE) { /* Byte done */ if (status & SMBHSTSTS_BYTE_DONE) { /* Byte done */
@ -266,9 +263,9 @@ int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd,
* and clears HOST_BUSY flag once the byte count * and clears HOST_BUSY flag once the byte count
* from slave is reached. * from slave is reached.
*/ */
outb(status, smbus_base + SMBHSTSTAT); outb(SMBHSTSTS_BYTE_DONE, smbus_base + SMBHSTSTAT);
} }
} while ((status & SMBHSTSTS_HOST_BUSY) && loops); } while (--loops && !host_completed(status));
/* Post-check we received complete message. */ /* Post-check we received complete message. */
slave_bytes = inb(smbus_base + SMBHSTDAT0); slave_bytes = inb(smbus_base + SMBHSTDAT0);
@ -276,6 +273,14 @@ int do_smbus_block_read(unsigned int smbus_base, u8 device, u8 cmd,
dprintk("%s: status = %02x, len = %d / %d, loops = %d\n", dprintk("%s: status = %02x, len = %d / %d, loops = %d\n",
__func__, status, bytes_read, slave_bytes, loops); __func__, status, bytes_read, slave_bytes, loops);
if (loops == 0)
return recover_master(smbus_base,
SMBUS_WAIT_UNTIL_DONE_TIMEOUT);
ret = cb_err_from_stat(status);
if (ret < 0)
return ret;
if (bytes_read < slave_bytes) if (bytes_read < slave_bytes)
return SMBUS_ERROR; return SMBUS_ERROR;
@ -315,12 +320,7 @@ int do_smbus_block_write(unsigned int smbus_base, u8 device, u8 cmd,
/* Poll for transaction completion */ /* Poll for transaction completion */
do { do {
loops--;
status = inb(smbus_base + SMBHSTSTAT); status = inb(smbus_base + SMBHSTSTAT);
if (status & (SMBHSTSTS_FAILED | /* FAILED */
SMBHSTSTS_BUS_ERR | /* BUS ERR */
SMBHSTSTS_DEV_ERR)) /* DEV ERR */
return SMBUS_ERROR;
if (status & SMBHSTSTS_BYTE_DONE) { if (status & SMBHSTSTS_BYTE_DONE) {
bytes_sent++; bytes_sent++;
@ -331,13 +331,21 @@ int do_smbus_block_write(unsigned int smbus_base, u8 device, u8 cmd,
* and clears HOST_BUSY flag once the byte count * and clears HOST_BUSY flag once the byte count
* has been reached. * has been reached.
*/ */
outb(status, smbus_base + SMBHSTSTAT); outb(SMBHSTSTS_BYTE_DONE, smbus_base + SMBHSTSTAT);
} }
} while ((status & SMBHSTSTS_HOST_BUSY) && loops); } while (--loops && !host_completed(status));
dprintk("%s: status = %02x, len = %d / %d, loops = %d\n", dprintk("%s: status = %02x, len = %d / %d, loops = %d\n",
__func__, status, bytes_sent, bytes, loops); __func__, status, bytes_sent, bytes, loops);
if (loops == 0)
return recover_master(smbus_base,
SMBUS_WAIT_UNTIL_DONE_TIMEOUT);
ret = cb_err_from_stat(status);
if (ret < 0)
return ret;
if (bytes_sent < bytes) if (bytes_sent < bytes)
return SMBUS_ERROR; return SMBUS_ERROR;
@ -373,12 +381,7 @@ int do_i2c_block_read(unsigned int smbus_base, u8 device,
/* Poll for transaction completion */ /* Poll for transaction completion */
do { do {
loops--;
status = inb(smbus_base + SMBHSTSTAT); status = inb(smbus_base + SMBHSTSTAT);
if (status & (SMBHSTSTS_FAILED | /* FAILED */
SMBHSTSTS_BUS_ERR | /* BUS ERR */
SMBHSTSTS_DEV_ERR)) /* DEV ERR */
return SMBUS_ERROR;
if (status & SMBHSTSTS_BYTE_DONE) { if (status & SMBHSTSTS_BYTE_DONE) {
@ -394,13 +397,21 @@ int do_i2c_block_read(unsigned int smbus_base, u8 device,
smbus_base + SMBHSTCTL); smbus_base + SMBHSTCTL);
} }
outb(status, smbus_base + SMBHSTSTAT); outb(SMBHSTSTS_BYTE_DONE, smbus_base + SMBHSTSTAT);
} }
} while ((status & SMBHSTSTS_HOST_BUSY) && loops); } while (--loops && !host_completed(status));
dprintk("%s: status = %02x, len = %d / %d, loops = %d\n", dprintk("%s: status = %02x, len = %d / %d, loops = %d\n",
__func__, status, bytes_read, bytes, loops); __func__, status, bytes_read, bytes, loops);
if (loops == 0)
return recover_master(smbus_base,
SMBUS_WAIT_UNTIL_DONE_TIMEOUT);
ret = cb_err_from_stat(status);
if (ret < 0)
return ret;
if (bytes_read < bytes) if (bytes_read < bytes)
return SMBUS_ERROR; return SMBUS_ERROR;