/* * CDDL HEADER START * * The contents of this file are subject to the terms of the * Common Development and Distribution License (the "License"). * You may not use this file except in compliance with the License. * * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE * or http://www.opensolaris.org/os/licensing. * See the License for the specific language governing permissions * and limitations under the License. * * When distributing Covered Code, include this CDDL HEADER in each * file and include the License file at usr/src/OPENSOLARIS.LICENSE. * If applicable, add the following below this CDDL HEADER, with the * fields enclosed by brackets "[]" replaced with your own identifying * information: Portions Copyright [yyyy] [name of copyright owner] * * CDDL HEADER END */ /* * Copyright 2008 Sun Microsystems, Inc. All rights reserved. * Use is subject to license terms. */ #include /* ddi_create_minor_node S_IFCHR */ #include /* for modldrv */ #include /* for open params. */ #include #include #include /* req. by dev_ops flags MTSAFE etc. */ #include #include #include #include #include #define SSC050_NUM_PORTS 5 #define SSC050_DATADIRECTION_REG(port) (0x10 | (port)) #define SSC050_COUNT_REG(port) (0x32 | ((port) << 2)) #define SSC050_GP_REG(port) (port) #define SSC050_BIT_REG(port, bit) (SSC050_PORT_BIT_REG(port) | (bit)) #define SSC050_FAN_SPEED(div, count) (1200000 / ((count) * (1<<(div)))) #define SSC050_FAN_CONTROL_ENABLE 0x80 #define SSC050_FAN_CONTROL_DIVISOR 0x03 #define SSC050_DATADIRECTION_BIT 0x02 struct ssc050_unit { kmutex_t mutex; int oflag; i2c_client_hdl_t hdl; char name[12]; }; #ifdef DEBUG static int ssc050debug = 0; #define D1CMN_ERR(ARGS) if (ssc050debug & 0x01) cmn_err ARGS; #define D2CMN_ERR(ARGS) if (ssc050debug & 0x02) cmn_err ARGS; #define D3CMN_ERR(ARGS) if (ssc050debug & 0x04) cmn_err ARGS; #else #define D1CMN_ERR(ARGS) #define D2CMN_ERR(ARGS) #define D3CMN_ERR(ARGS) #endif static void *ssc050soft_statep; static int ssc050_do_attach(dev_info_t *); static int ssc050_do_detach(dev_info_t *); static int ssc050_set(struct ssc050_unit *, int, uchar_t); static int ssc050_get(struct ssc050_unit *, int, uchar_t *, int); /* * cb ops */ static int ssc050_open(dev_t *, int, int, cred_t *); static int ssc050_close(dev_t, int, int, cred_t *); static int ssc050_ioctl(dev_t, int, intptr_t, int, cred_t *, int *); static struct cb_ops ssc050_cbops = { ssc050_open, /* open */ ssc050_close, /* close */ nodev, /* strategy */ nodev, /* print */ nodev, /* dump */ nodev, /* read */ nodev, /* write */ ssc050_ioctl, /* ioctl */ nodev, /* devmap */ nodev, /* mmap */ nodev, /* segmap */ nochpoll, /* poll */ ddi_prop_op, /* cb_prop_op */ NULL, /* streamtab */ D_NEW | D_MP | D_HOTPLUG, /* Driver compatibility flag */ CB_REV, /* rev */ nodev, /* int (*cb_aread)() */ nodev /* int (*cb_awrite)() */ }; /* * dev ops */ static int ssc050_info(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result); static int ssc050_attach(dev_info_t *dip, ddi_attach_cmd_t cmd); static int ssc050_detach(dev_info_t *dip, ddi_detach_cmd_t cmd); static struct dev_ops ssc050_ops = { DEVO_REV, 0, ssc050_info, nulldev, nulldev, ssc050_attach, ssc050_detach, nodev, &ssc050_cbops, NULL, NULL, ddi_quiesce_not_needed, /* quiesce */ }; extern struct mod_ops mod_driverops; static struct modldrv ssc050_modldrv = { &mod_driverops, /* type of module - driver */ "SSC050 i2c device driver", &ssc050_ops }; static struct modlinkage ssc050_modlinkage = { MODREV_1, &ssc050_modldrv, 0 }; int _init(void) { int error; error = mod_install(&ssc050_modlinkage); if (!error) (void) ddi_soft_state_init(&ssc050soft_statep, sizeof (struct ssc050_unit), 1); return (error); } int _fini(void) { int error; error = mod_remove(&ssc050_modlinkage); if (!error) ddi_soft_state_fini(&ssc050soft_statep); return (error); } int _info(struct modinfo *modinfop) { return (mod_info(&ssc050_modlinkage, modinfop)); } static int ssc050_open(dev_t *devp, int flags, int otyp, cred_t *credp) { _NOTE(ARGUNUSED(credp)) struct ssc050_unit *unitp; int instance; int error = 0; instance = MINOR_TO_INST(getminor(*devp)); if (instance < 0) { return (ENXIO); } unitp = (struct ssc050_unit *) ddi_get_soft_state(ssc050soft_statep, instance); if (unitp == NULL) { return (ENXIO); } if (otyp != OTYP_CHR) { return (EINVAL); } mutex_enter(&unitp->mutex); if (flags & FEXCL) { if (unitp->oflag != 0) { error = EBUSY; } else { unitp->oflag = FEXCL; } } else { if (unitp->oflag == FEXCL) { error = EBUSY; } else { unitp->oflag = FOPEN; } } mutex_exit(&unitp->mutex); return (error); } static int ssc050_close(dev_t dev, int flags, int otyp, cred_t *credp) { _NOTE(ARGUNUSED(flags, otyp, credp)) struct ssc050_unit *unitp; int instance; instance = MINOR_TO_INST(getminor(dev)); if (instance < 0) { return (ENXIO); } unitp = (struct ssc050_unit *) ddi_get_soft_state(ssc050soft_statep, instance); if (unitp == NULL) { return (ENXIO); } mutex_enter(&unitp->mutex); unitp->oflag = 0; mutex_exit(&unitp->mutex); return (DDI_SUCCESS); } static int ssc050_get(struct ssc050_unit *unitp, int reg, uchar_t *byte, int flags) { i2c_transfer_t *i2c_tran_pointer; int err; (void) i2c_transfer_alloc(unitp->hdl, &i2c_tran_pointer, 1, 1, flags); 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->hdl, i2c_tran_pointer); if (err) { D2CMN_ERR((CE_WARN, "%s: ssc050_get failed reg=%x", unitp->name, reg)); } else { *byte = i2c_tran_pointer->i2c_rbuf[0]; } i2c_transfer_free(unitp->hdl, i2c_tran_pointer); return (err); } static int ssc050_set(struct ssc050_unit *unitp, int reg, uchar_t byte) { i2c_transfer_t *i2c_tran_pointer; int err; (void) i2c_transfer_alloc(unitp->hdl, &i2c_tran_pointer, 2, 0, I2C_SLEEP); if (i2c_tran_pointer == NULL) { D2CMN_ERR((CE_WARN, "%s: Failed in ssc050_set " "i2c_tran_pointer not allocated", unitp->name)); return (ENOMEM); } i2c_tran_pointer->i2c_flags = I2C_WR; i2c_tran_pointer->i2c_wbuf[0] = (uchar_t)reg; i2c_tran_pointer->i2c_wbuf[1] = byte; D1CMN_ERR((CE_NOTE, "%s: set reg %x to %x", unitp->name, reg, byte)); err = i2c_transfer(unitp->hdl, i2c_tran_pointer); if (err) { D2CMN_ERR((CE_WARN, "%s: Failed in the ssc050_set" " i2c_transfer routine", unitp->name)); } i2c_transfer_free(unitp->hdl, i2c_tran_pointer); return (err); } static int ssc050_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *credp, int *rvalp) { _NOTE(ARGUNUSED(credp, rvalp)) struct ssc050_unit *unitp; int err = 0; i2c_bit_t ioctl_bit; i2c_port_t ioctl_port; i2c_reg_t ioctl_reg; int port = MINOR_TO_PORT(getminor(dev)); int instance = MINOR_TO_INST(getminor(dev)); uchar_t reg, val8; uchar_t control; uchar_t fan_count; int divisor; int32_t fan_speed; uint8_t inverted_mask; if (arg == (intptr_t)NULL) { D2CMN_ERR((CE_WARN, "SSC050: ioctl: arg passed in to ioctl " "= NULL")); return (EINVAL); } unitp = (struct ssc050_unit *) ddi_get_soft_state(ssc050soft_statep, instance); if (unitp == NULL) { return (ENXIO); } mutex_enter(&unitp->mutex); D3CMN_ERR((CE_NOTE, "%s: ioctl: port = %d", unitp->name, port)); switch (cmd) { case I2C_GET_PORT: if (ddi_copyin((caddr_t)arg, (caddr_t)&ioctl_port, sizeof (i2c_port_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } if (ioctl_port.direction == DIR_INPUT) { reg = SSC050_DATADIRECTION_REG(port); err = ssc050_get(unitp, reg, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } if (val8 != ioctl_port.dir_mask) { D2CMN_ERR((CE_NOTE, "GET_PORT sleeping! " "wanted %x, had %x", ioctl_port.dir_mask, val8)); err = ssc050_set(unitp, reg, ioctl_port.dir_mask); if (err != I2C_SUCCESS) { break; } delay(10); } } err = ssc050_get(unitp, port, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } ioctl_port.value = val8; if (ddi_copyout((caddr_t)&ioctl_port, (caddr_t)arg, sizeof (i2c_port_t), mode) != DDI_SUCCESS) { err = EFAULT; } break; case I2C_SET_PORT: if (ddi_copyin((caddr_t)arg, (caddr_t)&ioctl_port, sizeof (i2c_port_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } reg = SSC050_DATADIRECTION_REG(port); err = ssc050_get(unitp, reg, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } D1CMN_ERR((CE_NOTE, "%s: ioctl: Data Direction Register " "contains %x", unitp->name, val8)); inverted_mask = ioctl_port.dir_mask ^ 0xff; val8 = val8 & inverted_mask; D1CMN_ERR((CE_NOTE, "%s: ioctl: Data Direction Register " "NOW contains %x", unitp->name, val8)); err = ssc050_set(unitp, reg, val8); if (err != I2C_SUCCESS) { break; } err = ssc050_get(unitp, port, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } D1CMN_ERR((CE_NOTE, "%s: ioctl: GP Register " "contains %x", unitp->name, val8)); val8 = val8 & inverted_mask; val8 = val8 | ioctl_port.value; D1CMN_ERR((CE_NOTE, "%s: ioctl: GP Register " "NOW contains %x", unitp->name, val8)); err = ssc050_set(unitp, SSC050_GP_REG(port), val8); break; case I2C_GET_FAN_SPEED: err = ssc050_get(unitp, SSC050_FAN_CONTROL_REG(port), &control, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } D1CMN_ERR((CE_NOTE, "%s: port %d: control = %x", unitp->name, port, control)); if (!(control & SSC050_FAN_CONTROL_ENABLE)) { err = EIO; break; } err = ssc050_get(unitp, SSC050_COUNT_REG(port), &fan_count, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } if (fan_count == 0) { D2CMN_ERR((CE_WARN, "%s: Failed in I2C_GET_FAN_SPEED " "i2c_rbuf = 0", unitp->name)); err = EIO; break; } if (fan_count == 0xff) { fan_speed = 0; if (ddi_copyout((caddr_t)&fan_speed, (caddr_t)arg, sizeof (int32_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } break; } divisor = control & SSC050_FAN_CONTROL_DIVISOR; fan_speed = SSC050_FAN_SPEED(divisor, fan_count); if (ddi_copyout((caddr_t)&fan_speed, (caddr_t)arg, sizeof (int32_t), mode) != DDI_SUCCESS) { err = EFAULT; } break; case I2C_GET_BIT: if (ddi_copyin((caddr_t)arg, (caddr_t)&ioctl_bit, sizeof (i2c_bit_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } if (ioctl_bit.bit_num > 7) { err = EINVAL; break; } reg = (uchar_t)SSC050_BIT_REG(port, ioctl_bit.bit_num); D3CMN_ERR((CE_NOTE, "%s: reg = %x", unitp->name, reg)); if (ioctl_bit.direction == DIR_INPUT) { err = ssc050_get(unitp, reg, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } if (!(val8 & SSC050_DATADIRECTION_BIT)) { D2CMN_ERR((CE_NOTE, "GET_PORT sleeping! " "wanted %x, had %x", val8 | SSC050_DATADIRECTION_BIT, val8)); err = ssc050_set(unitp, reg, val8 | SSC050_DATADIRECTION_BIT); if (err != I2C_SUCCESS) { break; } delay(10); } } err = ssc050_get(unitp, reg, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } D3CMN_ERR((CE_NOTE, "byte back from device = %x", val8)); val8 = val8 & 0x01; ioctl_bit.bit_value = (boolean_t)val8; if (ddi_copyout((caddr_t)&ioctl_bit, (caddr_t)arg, sizeof (i2c_bit_t), mode) != DDI_SUCCESS) { err = EFAULT; } break; case I2C_SET_BIT: if (ddi_copyin((caddr_t)arg, (caddr_t)&ioctl_bit, sizeof (i2c_bit_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } if (ioctl_bit.bit_num > 7) { err = EINVAL; break; } reg = (uchar_t)SSC050_BIT_REG(port, ioctl_bit.bit_num); D3CMN_ERR((CE_NOTE, "%s: reg = %x", unitp->name, reg)); val8 = (uchar_t)ioctl_bit.bit_value; err = ssc050_set(unitp, reg, val8); break; case I2C_GET_REG: if (ddi_copyin((caddr_t)arg, (caddr_t)&ioctl_reg, sizeof (i2c_reg_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } err = ssc050_get(unitp, ioctl_reg.reg_num, &val8, I2C_SLEEP); if (err != I2C_SUCCESS) { break; } ioctl_reg.reg_value = val8; if (ddi_copyout((caddr_t)&ioctl_reg, (caddr_t)arg, sizeof (i2c_reg_t), mode) != DDI_SUCCESS) { err = EFAULT; } break; case I2C_SET_REG: if (ddi_copyin((caddr_t)arg, (caddr_t)&ioctl_reg, sizeof (i2c_reg_t), mode) != DDI_SUCCESS) { err = EFAULT; break; } err = ssc050_set(unitp, ioctl_reg.reg_num, ioctl_reg.reg_value); break; default: D2CMN_ERR((CE_WARN, "%s: Invalid IOCTL cmd: %x", unitp->name, cmd)); err = EINVAL; } mutex_exit(&unitp->mutex); return (err); } /* ARGSUSED */ static int ssc050_info(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result) { dev_t dev; int instance; if (infocmd == DDI_INFO_DEVT2INSTANCE) { dev = (dev_t)arg; instance = MINOR_TO_INST(getminor(dev)); *result = (void *)(uintptr_t)instance; return (DDI_SUCCESS); } return (DDI_FAILURE); } static int ssc050_attach(dev_info_t *dip, ddi_attach_cmd_t cmd) { switch (cmd) { case DDI_ATTACH: return (ssc050_do_attach(dip)); case DDI_RESUME: return (DDI_SUCCESS); default: return (DDI_FAILURE); } } static int ssc050_detach(dev_info_t *dip, ddi_detach_cmd_t cmd) { switch (cmd) { case DDI_DETACH: return (ssc050_do_detach(dip)); case DDI_SUSPEND: return (DDI_SUCCESS); default: return (DDI_FAILURE); } } static int ssc050_do_attach(dev_info_t *dip) { struct ssc050_unit *unitp; int instance; char name[MAXNAMELEN]; minor_t minor_number; int i; instance = ddi_get_instance(dip); if (ddi_soft_state_zalloc(ssc050soft_statep, instance) != 0) { return (DDI_FAILURE); } unitp = ddi_get_soft_state(ssc050soft_statep, instance); (void) snprintf(unitp->name, sizeof (unitp->name), "%s%d", ddi_node_name(dip), instance); for (i = 0; i < SSC050_NUM_PORTS; i++) { (void) sprintf(name, "port_%d", i); minor_number = INST_TO_MINOR(instance) | PORT_TO_MINOR(I2C_PORT(i)); if (ddi_create_minor_node(dip, name, S_IFCHR, minor_number, "ddi_i2c:ioexp", 0) == DDI_FAILURE) { cmn_err(CE_WARN, "%s: failed to create node for %s", unitp->name, name); ddi_soft_state_free(ssc050soft_statep, instance); return (DDI_FAILURE); } } if (i2c_client_register(dip, &unitp->hdl) != I2C_SUCCESS) { ddi_remove_minor_node(dip, NULL); ddi_soft_state_free(ssc050soft_statep, instance); return (DDI_FAILURE); } mutex_init(&unitp->mutex, NULL, MUTEX_DRIVER, NULL); return (DDI_SUCCESS); } static int ssc050_do_detach(dev_info_t *dip) { struct ssc050_unit *unitp; int instance; instance = ddi_get_instance(dip); unitp = ddi_get_soft_state(ssc050soft_statep, instance); i2c_client_unregister(unitp->hdl); ddi_remove_minor_node(dip, NULL); mutex_destroy(&unitp->mutex); ddi_soft_state_free(ssc050soft_statep, instance); return (DDI_SUCCESS); } int ssc050_get_port_bit(dev_info_t *dip, int port, int bit, uchar_t *rval, int flags) { struct ssc050_unit *unitp; int instance; int reg = (uchar_t)SSC050_BIT_REG(port, bit); if (rval == NULL || dip == NULL) return (EINVAL); instance = ddi_get_instance(dip); unitp = ddi_get_soft_state(ssc050soft_statep, instance); if (unitp == NULL) { return (ENXIO); } return (ssc050_get(unitp, reg, rval, flags)); }