#include <sys/stat.h>
#include <sys/modctl.h>
#include <sys/open.h>
#include <sys/types.h>
#include <sys/kmem.h>
#include <sys/sunddi.h>
#include <sys/conf.h>
#include <sys/ddi.h>
#include <sys/file.h>
#include <sys/note.h>
#include <sys/i2c/clients/i2c_gpio.h>
#include <sys/i2c/clients/adm1026_impl.h>
static void *adm1026soft_statep;
static int adm1026_do_attach(dev_info_t *);
static int adm1026_do_detach(dev_info_t *);
static int adm1026_do_resume(void);
static int adm1026_do_suspend(void);
static int adm1026_get8(adm1026_unit_t *unitp, uint8_t reg, uint8_t *val);
static int adm1026_put8(adm1026_unit_t *unitp, uint8_t reg, uint8_t val);
static int adm1026_open(dev_t *, int, int, cred_t *);
static int adm1026_close(dev_t, int, int, cred_t *);
static int adm1026_ioctl(dev_t, int, intptr_t, int, cred_t *, int *);
static struct cb_ops adm1026_cbops = {
adm1026_open,
adm1026_close,
nodev,
nodev,
nodev,
nodev,
nodev,
adm1026_ioctl,
nodev,
nodev,
nodev,
nochpoll,
ddi_prop_op,
NULL,
D_NEW | D_MP | D_HOTPLUG,
CB_REV,
nodev,
nodev
};
static int adm1026_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
static int adm1026_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
static struct dev_ops adm1026_ops = {
DEVO_REV,
0,
ddi_getinfo_1to1,
nulldev,
nulldev,
adm1026_attach,
adm1026_detach,
nodev,
&adm1026_cbops,
NULL,
NULL,
ddi_quiesce_not_needed,
};
extern struct mod_ops mod_driverops;
static struct modldrv adm1026_modldrv = {
&mod_driverops,
"ADM1026 i2c device driver",
&adm1026_ops
};
static struct modlinkage adm1026_modlinkage = {
MODREV_1,
&adm1026_modldrv,
0
};
int
_init(void)
{
int error;
error = mod_install(&adm1026_modlinkage);
if (!error)
(void) ddi_soft_state_init(&adm1026soft_statep,
sizeof (struct adm1026_unit), 1);
return (error);
}
int
_fini(void)
{
int error;
error = mod_remove(&adm1026_modlinkage);
if (!error)
ddi_soft_state_fini(&adm1026soft_statep);
return (error);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&adm1026_modlinkage, modinfop));
}
static int
adm1026_open(dev_t *devp, int flags, int otyp, cred_t *credp)
{
_NOTE(ARGUNUSED(credp))
adm1026_unit_t *unitp;
int instance;
int error = 0;
instance = getminor(*devp);
D2CMN_ERR((CE_WARN, "adm1026_open: instance=%d\n", instance));
if (instance < 0) {
return (ENXIO);
}
unitp = (struct adm1026_unit *)
ddi_get_soft_state(adm1026soft_statep, instance);
if (unitp == NULL) {
return (ENXIO);
}
if (otyp != OTYP_CHR) {
return (EINVAL);
}
mutex_enter(&unitp->adm1026_mutex);
if (flags & FEXCL) {
if (unitp->adm1026_oflag != 0) {
error = EBUSY;
} else {
unitp->adm1026_oflag = FEXCL;
}
} else {
if (unitp->adm1026_oflag == FEXCL) {
error = EBUSY;
} else {
unitp->adm1026_oflag = FOPEN;
}
}
mutex_exit(&unitp->adm1026_mutex);
return (error);
}
static int
adm1026_close(dev_t dev, int flags, int otyp, cred_t *credp)
{
_NOTE(ARGUNUSED(flags, otyp, credp))
adm1026_unit_t *unitp;
int instance;
instance = getminor(dev);
D2CMN_ERR((CE_WARN, "adm1026_close: instance=%d\n", instance));
if (instance < 0) {
return (ENXIO);
}
unitp = (struct adm1026_unit *)
ddi_get_soft_state(adm1026soft_statep, instance);
if (unitp == NULL) {
return (ENXIO);
}
mutex_enter(&unitp->adm1026_mutex);
unitp->adm1026_oflag = 0;
mutex_exit(&unitp->adm1026_mutex);
return (DDI_SUCCESS);
}
static int
adm1026_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
D2CMN_ERR((CE_WARN, "adm1026_attach: cmd=%x\n", cmd));
switch (cmd) {
case DDI_ATTACH:
return (adm1026_do_attach(dip));
case DDI_RESUME:
return (adm1026_do_resume());
default:
return (DDI_FAILURE);
}
}
static int
adm1026_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
D2CMN_ERR((CE_WARN, "adm1026_detach: cmd=%x\n", cmd));
switch (cmd) {
case DDI_DETACH:
return (adm1026_do_detach(dip));
case DDI_SUSPEND:
return (adm1026_do_suspend());
default:
return (DDI_FAILURE);
}
}
static int
adm1026_do_attach(dev_info_t *dip)
{
adm1026_unit_t *unitp;
int instance;
instance = ddi_get_instance(dip);
D2CMN_ERR((CE_WARN, "adm1026_do_attach: instance=%d, dip=%p",
instance, (void *)dip));
if (ddi_soft_state_zalloc(adm1026soft_statep, instance) != 0) {
cmn_err(CE_WARN, "%s%d: ddi_soft_state_zalloc() failed",
ddi_get_name(dip), instance);
return (DDI_FAILURE);
}
unitp = ddi_get_soft_state(adm1026soft_statep, instance);
if (unitp == NULL) {
cmn_err(CE_WARN, "%s%d: ddi_get_soft_state(), no memory",
ddi_get_name(dip), instance);
return (ENOMEM);
}
D2CMN_ERR((CE_WARN, "adm1026_do_attach: ddi_create_minor_node"));
if (ddi_create_minor_node(dip, "adm1026", S_IFCHR, instance,
"ddi_i2c:led_control", 0) == DDI_FAILURE) {
cmn_err(CE_WARN,
"adm1026_do_attach: ddi_create_minor_node failed");
ddi_soft_state_free(adm1026soft_statep, instance);
return (DDI_FAILURE);
}
D2CMN_ERR((CE_WARN, "adm1026_do_attach: i2c_client_register"));
if (i2c_client_register(dip, &unitp->adm1026_hdl) != I2C_SUCCESS) {
ddi_remove_minor_node(dip, NULL);
ddi_soft_state_free(adm1026soft_statep, instance);
cmn_err(CE_WARN,
"adm1026_do_attach: i2c_client_register failed");
return (DDI_FAILURE);
}
mutex_init(&unitp->adm1026_mutex, NULL, MUTEX_DRIVER, NULL);
D2CMN_ERR((CE_WARN, "adm1026_do_attach: DDI_SUCCESS"));
return (DDI_SUCCESS);
}
static int
adm1026_do_resume(void)
{
int ret = DDI_SUCCESS;
return (ret);
}
static int
adm1026_do_suspend()
{
int ret = DDI_SUCCESS;
return (ret);
}
static int
adm1026_do_detach(dev_info_t *dip)
{
adm1026_unit_t *unitp;
int instance;
instance = ddi_get_instance(dip);
unitp = ddi_get_soft_state(adm1026soft_statep, instance);
if (unitp == NULL) {
cmn_err(CE_WARN,
"adm1026_do_detach: ddi_get_soft_state failed");
return (ENOMEM);
}
i2c_client_unregister(unitp->adm1026_hdl);
ddi_remove_minor_node(dip, NULL);
mutex_destroy(&unitp->adm1026_mutex);
ddi_soft_state_free(adm1026soft_statep, instance);
return (DDI_SUCCESS);
}
static int
adm1026_get8(adm1026_unit_t *unitp, uint8_t reg, uint8_t *val)
{
i2c_transfer_t *i2c_tran_pointer = NULL;
int err = DDI_SUCCESS;
(void) i2c_transfer_alloc(unitp->adm1026_hdl, &i2c_tran_pointer,
1, 1, I2C_SLEEP);
if (i2c_tran_pointer == NULL)
return (ENOMEM);
i2c_tran_pointer->i2c_flags = I2C_WR_RD;
i2c_tran_pointer->i2c_wbuf[0] = (uchar_t)reg;
err = i2c_transfer(unitp->adm1026_hdl, i2c_tran_pointer);
if (err) {
D1CMN_ERR((CE_WARN,
"adm1026_get8: I2C_WR_RD reg=0x%x failed", reg));
} else {
*val = i2c_tran_pointer->i2c_rbuf[0];
D1CMN_ERR((CE_WARN, "adm1026_get8: reg=%02x, val=%02x",
reg, *val));
}
i2c_transfer_free(unitp->adm1026_hdl, i2c_tran_pointer);
return (err);
}
static int
adm1026_put8(adm1026_unit_t *unitp, uint8_t reg, uint8_t val)
{
i2c_transfer_t *i2c_tran_pointer = NULL;
int err = DDI_SUCCESS;
D1CMN_ERR((CE_WARN, "adm1026_put8: reg=%02x, val=%02x\n", reg, val));
(void) i2c_transfer_alloc(unitp->adm1026_hdl, &i2c_tran_pointer,
2, 0, I2C_SLEEP);
if (i2c_tran_pointer == NULL)
return (ENOMEM);
i2c_tran_pointer->i2c_flags = I2C_WR;
i2c_tran_pointer->i2c_wbuf[0] = reg;
i2c_tran_pointer->i2c_wbuf[1] = val;
err = i2c_transfer(unitp->adm1026_hdl, i2c_tran_pointer);
if (err)
D2CMN_ERR((CE_WARN, "adm1026_put8: return=%x", err));
i2c_transfer_free(unitp->adm1026_hdl, i2c_tran_pointer);
return (err);
}
static int
adm1026_send8(adm1026_unit_t *unitp, uint8_t reg, uint8_t reg_val,
uint8_t reg_mask)
{
uint8_t val = 0;
int err;
if ((err = adm1026_get8(unitp, reg, &val)) != I2C_SUCCESS)
return (err);
val &= ~reg_mask;
val |= (reg_val & reg_mask);
return (adm1026_put8(unitp, reg, val));
}
static int
adm1026_set_output(adm1026_unit_t *unitp, uint32_t val, uint32_t mask)
{
int err = I2C_SUCCESS;
if (mask & 0xff)
err = adm1026_send8(unitp, ADM1026_STS_REG5, (uint8_t)val,
(uint8_t)mask);
if ((err == I2C_SUCCESS) && (mask & 0xff00))
err = adm1026_send8(unitp, ADM1026_STS_REG6,
(uint8_t)(val >> OUTPUT_SHIFT),
(uint8_t)(mask >> OUTPUT_SHIFT));
return (err);
}
static int
adm1026_get_output(adm1026_unit_t *unitp, uint32_t mask, uint32_t *val)
{
uint8_t reg_val = 0;
int err = I2C_SUCCESS;
if (mask & 0xff) {
err = adm1026_get8(unitp, ADM1026_STS_REG5, ®_val);
if (err != I2C_SUCCESS)
return (err);
*val = reg_val;
}
if (mask & 0xff00) {
err = adm1026_get8(unitp, ADM1026_STS_REG6, ®_val);
if (err != I2C_SUCCESS)
return (err);
*val |= ((reg_val << OUTPUT_SHIFT) & (mask & 0xff00));
}
return (err);
}
static int
adm1026_set_config(adm1026_unit_t *unitp, int cmd, uint32_t val, uint32_t mask)
{
int i;
uint8_t r;
uint32_t m = mask, v = val;
int err = I2C_SUCCESS;
for (i = 0, r = ADM1026_GPIO_CFG1; i < BYTES_PER_CONFIG; i++, r++) {
if (m & GPIO_CFG_MASK) {
int j;
uint8_t mm = 0, vv = 0;
uint8_t bit = (cmd == GPIO_SET_CONFIG) ?
DIR_BIT : POLARITY_BIT;
for (j = 0; j < GPIOS_PER_CFG_BYTE; j++) {
if (m & (1 << j)) {
mm |= (bit << (j * BITSPERCFG));
}
if (v & (1 << j)) {
vv |= (bit << (j * BITSPERCFG));
}
}
D2CMN_ERR((CE_WARN, "adm1026_set_config: r=%02x, "
"vv=%02x, mm=%02x, m=%02x", r, vv, mm, m));
err = adm1026_send8(unitp, r, vv, mm);
if (err != I2C_SUCCESS)
return (err);
}
m >>= GPIOS_PER_CFG_BYTE;
v >>= GPIOS_PER_CFG_BYTE;
}
return (err);
}
static int
adm1026_get_config(adm1026_unit_t *unitp, int cmd, uint32_t mask, uint32_t *val)
{
int i, j;
uint8_t r;
int err = I2C_SUCCESS;
*val = 0;
for (i = 0, r = ADM1026_GPIO_CFG1; i < BYTES_PER_CONFIG; i++, r++) {
if (mask & GPIO_CFG_MASK) {
uint8_t newval = 0, x;
uint8_t bit = (cmd == GPIO_GET_CONFIG) ?
DIR_BIT : POLARITY_BIT;
err = adm1026_get8(unitp, r, &x);
if (err != I2C_SUCCESS)
return (err);
for (j = 0; j < GPIOS_PER_CFG_BYTE; j++) {
if (mask & (1 << j)) {
if (x & (bit << (j * BITSPERCFG)))
newval |= (1 << j);
}
}
*val |= (newval << (i * GPIOS_PER_CFG_BYTE));
} else
*val <<= GPIOS_PER_CFG_BYTE;
mask >>= GPIOS_PER_CFG_BYTE;
}
return (err);
}
static int
adm1026_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *credp,
int *rvalp)
{
_NOTE(ARGUNUSED(credp, rvalp))
adm1026_unit_t *unitp;
int instance;
int err = DDI_SUCCESS;
i2c_gpio_t g_buf;
instance = getminor(dev);
D2CMN_ERR((CE_WARN, "adm1026_ioctl: instance=%d, cmd=%x\n",
instance, cmd));
unitp = (struct adm1026_unit *)
ddi_get_soft_state(adm1026soft_statep, instance);
if (unitp == NULL) {
cmn_err(CE_WARN, "adm1026_ioctl: ddi_get_soft_state failed");
err = ENOMEM;
return (err);
}
mutex_enter(&unitp->adm1026_mutex);
if (ddi_copyin((caddr_t)arg, &g_buf,
sizeof (i2c_gpio_t), mode) != DDI_SUCCESS) {
mutex_exit(&unitp->adm1026_mutex);
return (EFAULT);
}
if (g_buf.reg_mask & 0xffff0000) {
cmn_err(CE_WARN,
"adm1026_ioctl: reg_mask too large. "
"Only bits 15-0 supported");
mutex_exit(&unitp->adm1026_mutex);
return (EINVAL);
}
switch (cmd) {
case GPIO_SET_OUTPUT:
err = adm1026_set_output(unitp, g_buf.reg_val, g_buf.reg_mask);
break;
case GPIO_GET_OUTPUT:
err = adm1026_get_output(unitp, g_buf.reg_mask, &g_buf.reg_val);
if (err == DDI_SUCCESS)
err = ddi_copyout(&g_buf, (caddr_t)arg,
sizeof (i2c_gpio_t), mode);
break;
case GPIO_SET_CONFIG:
case GPIO_SET_POLARITY:
err = adm1026_set_config(unitp, cmd, g_buf.reg_val,
g_buf.reg_mask);
break;
case GPIO_GET_CONFIG:
case GPIO_GET_POLARITY:
err = adm1026_get_config(unitp, cmd, g_buf.reg_mask,
&g_buf.reg_val);
if (err == DDI_SUCCESS)
err = ddi_copyout(&g_buf, (caddr_t)arg,
sizeof (i2c_gpio_t), mode);
break;
default:
D2CMN_ERR((CE_WARN,
"adm1026_ioctl: Invalid ioctl cmd %x\n", cmd));
err = EINVAL;
}
mutex_exit(&unitp->adm1026_mutex);
if (err) {
D2CMN_ERR((CE_WARN,
"adm1026_ioctl: failed, err=%x\n", err));
if (err == DDI_FAILURE)
err = EIO;
}
return (err);
}