2006-07-24 06:25:47 +02:00
|
|
|
#include <device/smbus_def.h>
|
2010-12-07 20:16:07 +01:00
|
|
|
#include "i82371eb.h"
|
2006-07-24 06:25:47 +02:00
|
|
|
|
2006-07-30 02:23:20 +02:00
|
|
|
#define SMBHST_STATUS 0x0
|
|
|
|
#define SMBHST_CTL 0x2
|
|
|
|
#define SMBHST_CMD 0x3
|
|
|
|
#define SMBHST_ADDR 0x4
|
|
|
|
#define SMBHST_DAT 0x5
|
2006-07-24 06:25:47 +02:00
|
|
|
|
|
|
|
#define SMBUS_TIMEOUT (100*1000*10)
|
|
|
|
#define SMBUS_STATUS_MASK 0x1e
|
2006-07-30 02:23:20 +02:00
|
|
|
#define SMBUS_ERROR_FLAG (1<<2)
|
2006-07-24 06:25:47 +02:00
|
|
|
|
2010-10-09 19:00:18 +02:00
|
|
|
int do_smbus_read_byte(unsigned smbus_io_base, unsigned device, unsigned address);
|
|
|
|
|
2006-07-24 06:25:47 +02:00
|
|
|
static inline void smbus_delay(void)
|
|
|
|
{
|
|
|
|
outb(0x80, 0x80);
|
|
|
|
outb(0x80, 0x80);
|
|
|
|
outb(0x80, 0x80);
|
|
|
|
outb(0x80, 0x80);
|
|
|
|
outb(0x80, 0x80);
|
|
|
|
outb(0x80, 0x80);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int smbus_wait_until_ready(unsigned smbus_io_base)
|
|
|
|
{
|
|
|
|
unsigned long loops;
|
|
|
|
loops = SMBUS_TIMEOUT;
|
|
|
|
do {
|
|
|
|
unsigned char val;
|
|
|
|
smbus_delay();
|
2006-07-30 02:23:20 +02:00
|
|
|
val = inb(smbus_io_base + SMBHST_STATUS);
|
2006-07-24 06:25:47 +02:00
|
|
|
if ((val & 0x1) == 0) {
|
|
|
|
break;
|
|
|
|
}
|
2010-04-27 08:56:47 +02:00
|
|
|
#if 0
|
2006-07-24 06:25:47 +02:00
|
|
|
if(loops == (SMBUS_TIMEOUT / 2)) {
|
2010-04-27 08:56:47 +02:00
|
|
|
outw(inw(smbus_io_base + SMBHST_STATUS),
|
2006-07-30 02:23:20 +02:00
|
|
|
smbus_io_base + SMBHST_STATUS);
|
2006-07-24 06:25:47 +02:00
|
|
|
}
|
2006-07-30 02:23:20 +02:00
|
|
|
#endif
|
2006-07-24 06:25:47 +02:00
|
|
|
} while(--loops);
|
|
|
|
return loops?0:SMBUS_WAIT_UNTIL_READY_TIMEOUT;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int smbus_wait_until_done(unsigned smbus_io_base)
|
|
|
|
{
|
|
|
|
unsigned long loops;
|
|
|
|
loops = SMBUS_TIMEOUT;
|
|
|
|
do {
|
|
|
|
unsigned short val;
|
|
|
|
smbus_delay();
|
2010-04-27 08:56:47 +02:00
|
|
|
|
2006-07-30 02:23:20 +02:00
|
|
|
val = inb(smbus_io_base + SMBHST_STATUS);
|
2006-07-24 06:25:47 +02:00
|
|
|
// Make sure the command is done
|
2010-04-27 08:56:47 +02:00
|
|
|
if ((val & 0x1) != 0) {
|
2006-07-24 06:25:47 +02:00
|
|
|
continue;
|
|
|
|
}
|
|
|
|
// Don't break out until one of the interrupt
|
|
|
|
// flags is set.
|
|
|
|
if (val & 0xfe) {
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
} while(--loops);
|
|
|
|
return loops?0:SMBUS_WAIT_UNTIL_DONE_TIMEOUT;
|
|
|
|
}
|
|
|
|
|
2010-10-09 19:00:18 +02:00
|
|
|
int do_smbus_read_byte(unsigned smbus_io_base, unsigned device, unsigned address)
|
2006-07-24 06:25:47 +02:00
|
|
|
{
|
2006-07-30 02:23:20 +02:00
|
|
|
unsigned status_register;
|
2006-07-24 06:25:47 +02:00
|
|
|
unsigned byte;
|
|
|
|
|
|
|
|
if (smbus_wait_until_ready(smbus_io_base) < 0) {
|
|
|
|
return SMBUS_WAIT_UNTIL_READY_TIMEOUT;
|
|
|
|
}
|
2010-04-27 08:56:47 +02:00
|
|
|
|
2006-07-24 06:25:47 +02:00
|
|
|
/* setup transaction */
|
|
|
|
|
|
|
|
/* clear any lingering errors, so the transaction will run */
|
2006-07-30 02:23:20 +02:00
|
|
|
outb(0x1e, smbus_io_base + SMBHST_STATUS);
|
2006-07-24 06:25:47 +02:00
|
|
|
|
|
|
|
/* set the device I'm talking too */
|
2006-07-30 02:23:20 +02:00
|
|
|
outb(((device & 0x7f) << 1) | 1, smbus_io_base + SMBHST_ADDR);
|
|
|
|
|
2006-07-24 06:25:47 +02:00
|
|
|
/* set the command/address... */
|
2006-07-30 02:23:20 +02:00
|
|
|
outb(address & 0xff, smbus_io_base + SMBHST_CMD);
|
2006-07-24 06:25:47 +02:00
|
|
|
|
|
|
|
/* clear the data word...*/
|
2006-07-30 02:23:20 +02:00
|
|
|
outb(0, smbus_io_base + SMBHST_DAT);
|
2006-07-24 06:25:47 +02:00
|
|
|
|
|
|
|
/* start a byte read with interrupts disabled */
|
2006-07-30 02:23:20 +02:00
|
|
|
outb( (0x02 << 2)|(1<<6), smbus_io_base + SMBHST_CTL);
|
2006-07-24 06:25:47 +02:00
|
|
|
|
|
|
|
/* poll for transaction completion */
|
|
|
|
if (smbus_wait_until_done(smbus_io_base) < 0) {
|
|
|
|
return SMBUS_WAIT_UNTIL_DONE_TIMEOUT;
|
|
|
|
}
|
|
|
|
|
2006-07-30 02:23:20 +02:00
|
|
|
status_register = inw(smbus_io_base + SMBHST_STATUS);
|
2006-07-24 06:25:47 +02:00
|
|
|
|
|
|
|
/* read results of transaction */
|
2006-07-30 02:23:20 +02:00
|
|
|
byte = inw(smbus_io_base + SMBHST_DAT) & 0xff;
|
|
|
|
|
|
|
|
if (status_register & 0x04) {
|
|
|
|
#if 0
|
|
|
|
print_debug("Read fail ");
|
|
|
|
print_debug_hex16(status_register);
|
2010-03-31 16:47:43 +02:00
|
|
|
print_debug("\n");
|
2006-07-30 02:23:20 +02:00
|
|
|
#endif
|
2006-07-24 06:25:47 +02:00
|
|
|
return SMBUS_ERROR;
|
|
|
|
}
|
|
|
|
return byte;
|
|
|
|
}
|
|
|
|
|