557 lines
15 KiB
C
557 lines
15 KiB
C
/* $NetBSD: piixpm.c,v 1.40 2012/02/14 15:08:07 pgoyette Exp $ */
|
|
/* $OpenBSD: piixpm.c,v 1.20 2006/02/27 08:25:02 grange Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 2005, 2006 Alexander Yurchenko <grange@openbsd.org>
|
|
*
|
|
* Permission to use, copy, modify, and distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
/*
|
|
* Intel PIIX and compatible Power Management controller driver.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: piixpm.c,v 1.40 2012/02/14 15:08:07 pgoyette Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/proc.h>
|
|
|
|
#include <sys/bus.h>
|
|
|
|
#include <dev/pci/pcidevs.h>
|
|
#include <dev/pci/pcireg.h>
|
|
#include <dev/pci/pcivar.h>
|
|
|
|
#include <dev/pci/piixpmreg.h>
|
|
|
|
#include <dev/i2c/i2cvar.h>
|
|
|
|
#include <dev/ic/acpipmtimer.h>
|
|
|
|
#ifdef PIIXPM_DEBUG
|
|
#define DPRINTF(x) printf x
|
|
#else
|
|
#define DPRINTF(x)
|
|
#endif
|
|
|
|
#define PIIXPM_IS_CSB5(id) \
|
|
(PCI_VENDOR((id)) == PCI_VENDOR_SERVERWORKS && \
|
|
PCI_PRODUCT((id)) == PCI_PRODUCT_SERVERWORKS_CSB5)
|
|
#define PIIXPM_DELAY 200
|
|
#define PIIXPM_TIMEOUT 1
|
|
|
|
#define PIIXPM_INDIRECTIO_BASE 0xcd6
|
|
#define PIIXPM_INDIRECTIO_SIZE 2
|
|
#define PIIXPM_INDIRECTIO_INDEX 0
|
|
#define PIIXPM_INDIRECTIO_DATA 1
|
|
|
|
#define SB800_PM_SMBUS0EN_LO 0x2c
|
|
#define SB800_PM_SMBUS0EN_HI 0x2d
|
|
|
|
#define SB800_PM_SMBUS0EN_ENABLE 0x0001
|
|
#define SB800_PM_SMBUS0EN_BADDR 0xffe0
|
|
|
|
struct piixpm_softc {
|
|
device_t sc_dev;
|
|
|
|
bus_space_tag_t sc_smb_iot;
|
|
bus_space_handle_t sc_smb_ioh;
|
|
void * sc_smb_ih;
|
|
int sc_poll;
|
|
|
|
bus_space_tag_t sc_pm_iot;
|
|
bus_space_handle_t sc_pm_ioh;
|
|
|
|
pci_chipset_tag_t sc_pc;
|
|
pcitag_t sc_pcitag;
|
|
pcireg_t sc_id;
|
|
|
|
struct i2c_controller sc_i2c_tag;
|
|
kmutex_t sc_i2c_mutex;
|
|
struct {
|
|
i2c_op_t op;
|
|
void * buf;
|
|
size_t len;
|
|
int flags;
|
|
volatile int error;
|
|
} sc_i2c_xfer;
|
|
|
|
pcireg_t sc_devact[2];
|
|
};
|
|
|
|
static int piixpm_match(device_t, cfdata_t, void *);
|
|
static void piixpm_attach(device_t, device_t, void *);
|
|
|
|
static bool piixpm_suspend(device_t, const pmf_qual_t *);
|
|
static bool piixpm_resume(device_t, const pmf_qual_t *);
|
|
|
|
static int piixpm_sb800_init(struct piixpm_softc *,
|
|
struct pci_attach_args *);
|
|
static void piixpm_csb5_reset(void *);
|
|
static int piixpm_i2c_acquire_bus(void *, int);
|
|
static void piixpm_i2c_release_bus(void *, int);
|
|
static int piixpm_i2c_exec(void *, i2c_op_t, i2c_addr_t, const void *,
|
|
size_t, void *, size_t, int);
|
|
|
|
static int piixpm_intr(void *);
|
|
|
|
CFATTACH_DECL_NEW(piixpm, sizeof(struct piixpm_softc),
|
|
piixpm_match, piixpm_attach, NULL, NULL);
|
|
|
|
static int
|
|
piixpm_match(device_t parent, cfdata_t match, void *aux)
|
|
{
|
|
struct pci_attach_args *pa;
|
|
|
|
pa = (struct pci_attach_args *)aux;
|
|
switch (PCI_VENDOR(pa->pa_id)) {
|
|
case PCI_VENDOR_INTEL:
|
|
switch (PCI_PRODUCT(pa->pa_id)) {
|
|
case PCI_PRODUCT_INTEL_82371AB_PMC:
|
|
case PCI_PRODUCT_INTEL_82440MX_PMC:
|
|
return 1;
|
|
}
|
|
break;
|
|
case PCI_VENDOR_ATI:
|
|
switch (PCI_PRODUCT(pa->pa_id)) {
|
|
case PCI_PRODUCT_ATI_SB200_SMB:
|
|
case PCI_PRODUCT_ATI_SB300_SMB:
|
|
case PCI_PRODUCT_ATI_SB400_SMB:
|
|
case PCI_PRODUCT_ATI_SB600_SMB: /* matches SB600/SB700/SB800 */
|
|
return 1;
|
|
}
|
|
break;
|
|
case PCI_VENDOR_SERVERWORKS:
|
|
switch (PCI_PRODUCT(pa->pa_id)) {
|
|
case PCI_PRODUCT_SERVERWORKS_OSB4:
|
|
case PCI_PRODUCT_SERVERWORKS_CSB5:
|
|
case PCI_PRODUCT_SERVERWORKS_CSB6:
|
|
case PCI_PRODUCT_SERVERWORKS_HT1000SB:
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
piixpm_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct piixpm_softc *sc = device_private(self);
|
|
struct pci_attach_args *pa = aux;
|
|
struct i2cbus_attach_args iba;
|
|
pcireg_t base, conf;
|
|
pcireg_t pmmisc;
|
|
pci_intr_handle_t ih;
|
|
const char *intrstr = NULL;
|
|
|
|
sc->sc_dev = self;
|
|
sc->sc_id = pa->pa_id;
|
|
sc->sc_pc = pa->pa_pc;
|
|
sc->sc_pcitag = pa->pa_tag;
|
|
|
|
pci_aprint_devinfo(pa, NULL);
|
|
|
|
if (!pmf_device_register(self, piixpm_suspend, piixpm_resume))
|
|
aprint_error_dev(self, "couldn't establish power handler\n");
|
|
|
|
/* Read configuration */
|
|
conf = pci_conf_read(pa->pa_pc, pa->pa_tag, PIIX_SMB_HOSTC);
|
|
DPRINTF(("%s: conf 0x%x\n", device_xname(self), conf));
|
|
|
|
if ((PCI_VENDOR(pa->pa_id) != PCI_VENDOR_INTEL) ||
|
|
(PCI_PRODUCT(pa->pa_id) != PCI_PRODUCT_INTEL_82371AB_PMC))
|
|
goto nopowermanagement;
|
|
|
|
/* check whether I/O access to PM regs is enabled */
|
|
pmmisc = pci_conf_read(pa->pa_pc, pa->pa_tag, PIIX_PMREGMISC);
|
|
if (!(pmmisc & 1))
|
|
goto nopowermanagement;
|
|
|
|
sc->sc_pm_iot = pa->pa_iot;
|
|
/* Map I/O space */
|
|
base = pci_conf_read(pa->pa_pc, pa->pa_tag, PIIX_PM_BASE);
|
|
if (bus_space_map(sc->sc_pm_iot, PCI_MAPREG_IO_ADDR(base),
|
|
PIIX_PM_SIZE, 0, &sc->sc_pm_ioh)) {
|
|
aprint_error_dev(self, "can't map power management I/O space\n");
|
|
goto nopowermanagement;
|
|
}
|
|
|
|
/*
|
|
* Revision 0 and 1 are PIIX4, 2 is PIIX4E, 3 is PIIX4M.
|
|
* PIIX4 and PIIX4E have a bug in the timer latch, see Errata #20
|
|
* in the "Specification update" (document #297738).
|
|
*/
|
|
acpipmtimer_attach(self, sc->sc_pm_iot, sc->sc_pm_ioh,
|
|
PIIX_PM_PMTMR,
|
|
(PCI_REVISION(pa->pa_class) < 3) ? ACPIPMT_BADLATCH : 0 );
|
|
|
|
nopowermanagement:
|
|
|
|
/* SB800 rev 0x40+ needs special initialization */
|
|
if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_ATI &&
|
|
PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_SB600_SMB &&
|
|
PCI_REVISION(pa->pa_class) >= 0x40) {
|
|
if (piixpm_sb800_init(sc, pa) == 0)
|
|
goto attach_i2c;
|
|
aprint_normal_dev(self, "SMBus disabled\n");
|
|
return;
|
|
}
|
|
|
|
if ((conf & PIIX_SMB_HOSTC_HSTEN) == 0) {
|
|
aprint_normal_dev(self, "SMBus disabled\n");
|
|
return;
|
|
}
|
|
|
|
/* Map I/O space */
|
|
sc->sc_smb_iot = pa->pa_iot;
|
|
base = pci_conf_read(pa->pa_pc, pa->pa_tag, PIIX_SMB_BASE) & 0xffff;
|
|
if (bus_space_map(sc->sc_smb_iot, PCI_MAPREG_IO_ADDR(base),
|
|
PIIX_SMB_SIZE, 0, &sc->sc_smb_ioh)) {
|
|
aprint_error_dev(self, "can't map smbus I/O space\n");
|
|
return;
|
|
}
|
|
|
|
sc->sc_poll = 1;
|
|
aprint_normal_dev(self, "");
|
|
if ((conf & PIIX_SMB_HOSTC_INTMASK) == PIIX_SMB_HOSTC_SMI) {
|
|
/* No PCI IRQ */
|
|
aprint_normal("interrupting at SMI, ");
|
|
} else if ((conf & PIIX_SMB_HOSTC_INTMASK) == PIIX_SMB_HOSTC_IRQ) {
|
|
/* Install interrupt handler */
|
|
if (pci_intr_map(pa, &ih) == 0) {
|
|
intrstr = pci_intr_string(pa->pa_pc, ih);
|
|
sc->sc_smb_ih = pci_intr_establish(pa->pa_pc, ih, IPL_BIO,
|
|
piixpm_intr, sc);
|
|
if (sc->sc_smb_ih != NULL) {
|
|
aprint_normal("interrupting at %s", intrstr);
|
|
sc->sc_poll = 0;
|
|
}
|
|
}
|
|
}
|
|
if (sc->sc_poll)
|
|
aprint_normal("polling");
|
|
|
|
aprint_normal("\n");
|
|
|
|
attach_i2c:
|
|
/* Attach I2C bus */
|
|
mutex_init(&sc->sc_i2c_mutex, MUTEX_DEFAULT, IPL_NONE);
|
|
sc->sc_i2c_tag.ic_cookie = sc;
|
|
sc->sc_i2c_tag.ic_acquire_bus = piixpm_i2c_acquire_bus;
|
|
sc->sc_i2c_tag.ic_release_bus = piixpm_i2c_release_bus;
|
|
sc->sc_i2c_tag.ic_exec = piixpm_i2c_exec;
|
|
|
|
memset(&iba, 0, sizeof(iba));
|
|
iba.iba_type = I2C_TYPE_SMBUS;
|
|
iba.iba_tag = &sc->sc_i2c_tag;
|
|
config_found_ia(self, "i2cbus", &iba, iicbus_print);
|
|
|
|
return;
|
|
}
|
|
|
|
static bool
|
|
piixpm_suspend(device_t dv, const pmf_qual_t *qual)
|
|
{
|
|
struct piixpm_softc *sc = device_private(dv);
|
|
|
|
sc->sc_devact[0] = pci_conf_read(sc->sc_pc, sc->sc_pcitag,
|
|
PIIX_DEVACTA);
|
|
sc->sc_devact[1] = pci_conf_read(sc->sc_pc, sc->sc_pcitag,
|
|
PIIX_DEVACTB);
|
|
|
|
return true;
|
|
}
|
|
|
|
static bool
|
|
piixpm_resume(device_t dv, const pmf_qual_t *qual)
|
|
{
|
|
struct piixpm_softc *sc = device_private(dv);
|
|
|
|
pci_conf_write(sc->sc_pc, sc->sc_pcitag, PIIX_DEVACTA,
|
|
sc->sc_devact[0]);
|
|
pci_conf_write(sc->sc_pc, sc->sc_pcitag, PIIX_DEVACTB,
|
|
sc->sc_devact[1]);
|
|
|
|
return true;
|
|
}
|
|
|
|
/*
|
|
* Extract SMBus base address from SB800 Power Management (PM) registers.
|
|
* The PM registers can be accessed either through indirect I/O (CD6/CD7) or
|
|
* direct mapping if AcpiMMioDecodeEn is enabled. Since this function is only
|
|
* called once it uses indirect I/O for simplicity.
|
|
*/
|
|
static int
|
|
piixpm_sb800_init(struct piixpm_softc *sc, struct pci_attach_args *pa)
|
|
{
|
|
bus_space_tag_t iot = pa->pa_iot;
|
|
bus_space_handle_t ioh; /* indirect I/O handle */
|
|
uint16_t val, base_addr;
|
|
|
|
/* Fetch SMB base address */
|
|
if (bus_space_map(iot,
|
|
PIIXPM_INDIRECTIO_BASE, PIIXPM_INDIRECTIO_SIZE, 0, &ioh)) {
|
|
device_printf(sc->sc_dev, "couldn't map indirect I/O space\n");
|
|
return EBUSY;
|
|
}
|
|
bus_space_write_1(iot, ioh, PIIXPM_INDIRECTIO_INDEX,
|
|
SB800_PM_SMBUS0EN_LO);
|
|
val = bus_space_read_1(iot, ioh, PIIXPM_INDIRECTIO_DATA);
|
|
bus_space_write_1(iot, ioh, PIIXPM_INDIRECTIO_INDEX,
|
|
SB800_PM_SMBUS0EN_HI);
|
|
val |= bus_space_read_1(iot, ioh, PIIXPM_INDIRECTIO_DATA) << 8;
|
|
bus_space_unmap(iot, ioh, 2);
|
|
|
|
if ((val & SB800_PM_SMBUS0EN_ENABLE) == 0)
|
|
return ENOENT;
|
|
|
|
base_addr = val & SB800_PM_SMBUS0EN_BADDR;
|
|
|
|
aprint_debug_dev(sc->sc_dev, "SMBus @ 0x%04x\n", base_addr);
|
|
|
|
sc->sc_smb_iot = iot;
|
|
if (bus_space_map(sc->sc_smb_iot, PCI_MAPREG_IO_ADDR(base_addr),
|
|
PIIX_SMB_SIZE, 0, &sc->sc_smb_ioh)) {
|
|
aprint_error_dev(sc->sc_dev, "can't map smbus I/O space\n");
|
|
return EBUSY;
|
|
}
|
|
aprint_normal_dev(sc->sc_dev, "polling (SB800)\n");
|
|
sc->sc_poll = 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
piixpm_csb5_reset(void *arg)
|
|
{
|
|
struct piixpm_softc *sc = arg;
|
|
pcireg_t base, hostc, pmbase;
|
|
|
|
base = pci_conf_read(sc->sc_pc, sc->sc_pcitag, PIIX_SMB_BASE);
|
|
hostc = pci_conf_read(sc->sc_pc, sc->sc_pcitag, PIIX_SMB_HOSTC);
|
|
|
|
pmbase = pci_conf_read(sc->sc_pc, sc->sc_pcitag, PIIX_PM_BASE);
|
|
pmbase |= PIIX_PM_BASE_CSB5_RESET;
|
|
pci_conf_write(sc->sc_pc, sc->sc_pcitag, PIIX_PM_BASE, pmbase);
|
|
pmbase &= ~PIIX_PM_BASE_CSB5_RESET;
|
|
pci_conf_write(sc->sc_pc, sc->sc_pcitag, PIIX_PM_BASE, pmbase);
|
|
|
|
pci_conf_write(sc->sc_pc, sc->sc_pcitag, PIIX_SMB_BASE, base);
|
|
pci_conf_write(sc->sc_pc, sc->sc_pcitag, PIIX_SMB_HOSTC, hostc);
|
|
|
|
(void) tsleep(&sc, PRIBIO, "csb5reset", hz/2);
|
|
}
|
|
|
|
static int
|
|
piixpm_i2c_acquire_bus(void *cookie, int flags)
|
|
{
|
|
struct piixpm_softc *sc = cookie;
|
|
|
|
if (!cold)
|
|
mutex_enter(&sc->sc_i2c_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
piixpm_i2c_release_bus(void *cookie, int flags)
|
|
{
|
|
struct piixpm_softc *sc = cookie;
|
|
|
|
if (!cold)
|
|
mutex_exit(&sc->sc_i2c_mutex);
|
|
}
|
|
|
|
static int
|
|
piixpm_i2c_exec(void *cookie, i2c_op_t op, i2c_addr_t addr,
|
|
const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
|
|
{
|
|
struct piixpm_softc *sc = cookie;
|
|
const u_int8_t *b;
|
|
u_int8_t ctl = 0, st;
|
|
int retries;
|
|
|
|
DPRINTF(("%s: exec: op %d, addr 0x%x, cmdlen %zu, len %zu, flags 0x%x\n",
|
|
device_xname(sc->sc_dev), op, addr, cmdlen, len, flags));
|
|
|
|
/* Wait for bus to be idle */
|
|
for (retries = 100; retries > 0; retries--) {
|
|
st = bus_space_read_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HS);
|
|
if (!(st & PIIX_SMB_HS_BUSY))
|
|
break;
|
|
DELAY(PIIXPM_DELAY);
|
|
}
|
|
DPRINTF(("%s: exec: st 0x%d\n", device_xname(sc->sc_dev), st & 0xff));
|
|
if (st & PIIX_SMB_HS_BUSY)
|
|
return (1);
|
|
|
|
if (cold || sc->sc_poll)
|
|
flags |= I2C_F_POLL;
|
|
|
|
if (!I2C_OP_STOP_P(op) || cmdlen > 1 || len > 2 ||
|
|
(cmdlen == 0 && len > 1))
|
|
return (1);
|
|
|
|
/* Setup transfer */
|
|
sc->sc_i2c_xfer.op = op;
|
|
sc->sc_i2c_xfer.buf = buf;
|
|
sc->sc_i2c_xfer.len = len;
|
|
sc->sc_i2c_xfer.flags = flags;
|
|
sc->sc_i2c_xfer.error = 0;
|
|
|
|
/* Set slave address and transfer direction */
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_TXSLVA,
|
|
PIIX_SMB_TXSLVA_ADDR(addr) |
|
|
(I2C_OP_READ_P(op) ? PIIX_SMB_TXSLVA_READ : 0));
|
|
|
|
b = cmdbuf;
|
|
if (cmdlen > 0)
|
|
/* Set command byte */
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HCMD, b[0]);
|
|
|
|
if (I2C_OP_WRITE_P(op)) {
|
|
/* Write data */
|
|
b = buf;
|
|
if (cmdlen == 0 && len == 1)
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HCMD, b[0]);
|
|
else if (len > 0)
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HD0, b[0]);
|
|
if (len > 1)
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HD1, b[1]);
|
|
}
|
|
|
|
/* Set SMBus command */
|
|
if (cmdlen == 0) {
|
|
if (len == 0)
|
|
ctl = PIIX_SMB_HC_CMD_QUICK;
|
|
else
|
|
ctl = PIIX_SMB_HC_CMD_BYTE;
|
|
} else if (len == 1)
|
|
ctl = PIIX_SMB_HC_CMD_BDATA;
|
|
else if (len == 2)
|
|
ctl = PIIX_SMB_HC_CMD_WDATA;
|
|
|
|
if ((flags & I2C_F_POLL) == 0)
|
|
ctl |= PIIX_SMB_HC_INTREN;
|
|
|
|
/* Start transaction */
|
|
ctl |= PIIX_SMB_HC_START;
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_HC, ctl);
|
|
|
|
if (flags & I2C_F_POLL) {
|
|
/* Poll for completion */
|
|
if (PIIXPM_IS_CSB5(sc->sc_id))
|
|
DELAY(2*PIIXPM_DELAY);
|
|
else
|
|
DELAY(PIIXPM_DELAY);
|
|
for (retries = 1000; retries > 0; retries--) {
|
|
st = bus_space_read_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HS);
|
|
if ((st & PIIX_SMB_HS_BUSY) == 0)
|
|
break;
|
|
DELAY(PIIXPM_DELAY);
|
|
}
|
|
if (st & PIIX_SMB_HS_BUSY)
|
|
goto timeout;
|
|
piixpm_intr(sc);
|
|
} else {
|
|
/* Wait for interrupt */
|
|
if (tsleep(sc, PRIBIO, "iicexec", PIIXPM_TIMEOUT * hz))
|
|
goto timeout;
|
|
}
|
|
|
|
if (sc->sc_i2c_xfer.error)
|
|
return (1);
|
|
|
|
return (0);
|
|
|
|
timeout:
|
|
/*
|
|
* Transfer timeout. Kill the transaction and clear status bits.
|
|
*/
|
|
aprint_error_dev(sc->sc_dev, "timeout, status 0x%x\n", st);
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_HC,
|
|
PIIX_SMB_HC_KILL);
|
|
DELAY(PIIXPM_DELAY);
|
|
st = bus_space_read_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_HS);
|
|
if ((st & PIIX_SMB_HS_FAILED) == 0)
|
|
aprint_error_dev(sc->sc_dev, "transaction abort failed, status 0x%x\n", st);
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_HS, st);
|
|
/*
|
|
* CSB5 needs hard reset to unlock the smbus after timeout.
|
|
*/
|
|
if (PIIXPM_IS_CSB5(sc->sc_id))
|
|
piixpm_csb5_reset(sc);
|
|
return (1);
|
|
}
|
|
|
|
static int
|
|
piixpm_intr(void *arg)
|
|
{
|
|
struct piixpm_softc *sc = arg;
|
|
u_int8_t st;
|
|
u_int8_t *b;
|
|
size_t len;
|
|
|
|
/* Read status */
|
|
st = bus_space_read_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_HS);
|
|
if ((st & PIIX_SMB_HS_BUSY) != 0 || (st & (PIIX_SMB_HS_INTR |
|
|
PIIX_SMB_HS_DEVERR | PIIX_SMB_HS_BUSERR |
|
|
PIIX_SMB_HS_FAILED)) == 0)
|
|
/* Interrupt was not for us */
|
|
return (0);
|
|
|
|
DPRINTF(("%s: intr st 0x%d\n", device_xname(sc->sc_dev), st & 0xff));
|
|
|
|
/* Clear status bits */
|
|
bus_space_write_1(sc->sc_smb_iot, sc->sc_smb_ioh, PIIX_SMB_HS, st);
|
|
|
|
/* Check for errors */
|
|
if (st & (PIIX_SMB_HS_DEVERR | PIIX_SMB_HS_BUSERR |
|
|
PIIX_SMB_HS_FAILED)) {
|
|
sc->sc_i2c_xfer.error = 1;
|
|
goto done;
|
|
}
|
|
|
|
if (st & PIIX_SMB_HS_INTR) {
|
|
if (I2C_OP_WRITE_P(sc->sc_i2c_xfer.op))
|
|
goto done;
|
|
|
|
/* Read data */
|
|
b = sc->sc_i2c_xfer.buf;
|
|
len = sc->sc_i2c_xfer.len;
|
|
if (len > 0)
|
|
b[0] = bus_space_read_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HD0);
|
|
if (len > 1)
|
|
b[1] = bus_space_read_1(sc->sc_smb_iot, sc->sc_smb_ioh,
|
|
PIIX_SMB_HD1);
|
|
}
|
|
|
|
done:
|
|
if ((sc->sc_i2c_xfer.flags & I2C_F_POLL) == 0)
|
|
wakeup(sc);
|
|
return (1);
|
|
}
|