#include <sys/param.h>
#include <sys/systm.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <sys/thread2.h>
#include "smbconf.h"
#include "smbus.h"
#include "smbus_if.h"
void
smbus_intr(device_t bus, u_char devaddr, char low, char high, int error)
{
struct smbus_softc *sc = (struct smbus_softc *)device_get_softc(bus);
if (sc->owner)
SMBUS_INTR(sc->owner, devaddr, low, high, error);
}
int
smbus_error(int smb_error)
{
int error = 0;
if (smb_error == SMB_ENOERR)
return (0);
if (smb_error & (SMB_ENOTSUPP))
error = ENODEV;
else if (smb_error & (SMB_ENOACK))
error = ENXIO;
else if (smb_error & (SMB_ETIMEOUT))
error = EWOULDBLOCK;
else if (smb_error & (SMB_EBUSY))
error = EBUSY;
else if (smb_error & (SMB_EABORT | SMB_EBUSERR | SMB_ECOLLI))
error = EIO;
else
error = EINVAL;
return (error);
}
static int
smbus_poll(struct smbus_softc *sc, int how)
{
int error;
switch (how) {
case (SMB_WAIT | SMB_INTR):
error = tsleep(sc, PCATCH, "smbreq", 0);
break;
case (SMB_WAIT | SMB_NOINTR):
error = tsleep(sc, 0, "smbreq", 0);
break;
default:
error = EWOULDBLOCK;
break;
}
return (error);
}
int
smbus_request_bus(device_t bus, device_t dev, int how)
{
struct smbus_softc *sc = device_get_softc(bus);
device_t parent;
int error;
parent = device_get_parent(bus);
do {
error = SMBUS_CALLBACK(parent, SMB_REQUEST_BUS, &how);
if (error)
error = smbus_poll(sc, how);
} while (error == EWOULDBLOCK);
while (error == 0) {
crit_enter();
if (sc->owner && sc->owner != dev) {
crit_exit();
error = smbus_poll(sc, how);
if (error == EWOULDBLOCK)
error = 0;
} else {
sc->owner = dev;
crit_exit();
}
if (error == 0)
break;
SMBUS_CALLBACK(parent, SMB_RELEASE_BUS, &how);
}
return (error);
}
int
smbus_release_bus(device_t bus, device_t dev)
{
struct smbus_softc *sc = (struct smbus_softc *)device_get_softc(bus);
device_t parent;
int error;
parent = device_get_parent(bus);
error = SMBUS_CALLBACK(parent, SMB_RELEASE_BUS, NULL);
if (error)
return (error);
crit_enter();
if (sc->owner == dev) {
sc->owner = NULL;
wakeup(sc);
} else {
error = EACCES;
}
crit_exit();
wakeup(sc);
return (error);
}