[BACK]Return to tsl2560.c CVS log [TXT][DIR] Up to [local] / sys / dev / i2c

Annotation of sys/dev/i2c/tsl2560.c, Revision 1.1.1.1

1.1       nbrk        1: /*     $OpenBSD: tsl2560.c,v 1.6 2007/06/24 05:34:35 dlg Exp $ */
                      2:
                      3: /*
                      4:  * Copyright (c) 2005 Mark Kettenis
                      5:  *
                      6:  * Permission to use, copy, modify, and distribute this software for any
                      7:  * purpose with or without fee is hereby granted, provided that the above
                      8:  * copyright notice and this permission notice appear in all copies.
                      9:  *
                     10:  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
                     11:  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
                     12:  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
                     13:  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
                     14:  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
                     15:  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
                     16:  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
                     17:  */
                     18:
                     19: #include <sys/param.h>
                     20: #include <sys/systm.h>
                     21: #include <sys/device.h>
                     22: #include <sys/sensors.h>
                     23:
                     24: #include <dev/i2c/i2cvar.h>
                     25:
                     26: /* TSL2560/61 registers */
                     27: #define TSL2560_REG_CONTROL    0x80
                     28: #define  TSL2560_CONTROL_POWER 0x03
                     29: #define TSL2560_REG_TIMING     0x81
                     30: #define  TSL2560_TIMING_GAIN   0x10 /* high gain (16x) */
                     31: #define  TSL2560_TIMING_INTEG0 0x00 /* 13.7ms */
                     32: #define  TSL2560_TIMING_INTEG1 0x01 /* 101ms */
                     33: #define  TSL2560_TIMING_INTEG2 0x02 /* 402ms */
                     34: #define TSL2560_REG_ID         0x8a
                     35: #define TSL2560_REG_DATA0      0xac
                     36: #define TSL2560_REG_DATA1      0xae
                     37:
                     38: struct tsl_softc {
                     39:        struct device sc_dev;
                     40:        i2c_tag_t sc_tag;
                     41:        i2c_addr_t sc_addr;
                     42:
                     43:        struct ksensor sc_sensor;
                     44:        struct ksensordev sc_sensordev;
                     45: };
                     46:
                     47: int    tsl_match(struct device *, void *, void *);
                     48: void   tsl_attach(struct device *, struct device *, void *);
                     49:
                     50: void   tsl_refresh(void *);
                     51: u_int64_t tsl_lux(u_int32_t, u_int32_t);
                     52:
                     53: struct cfattach tsl_ca = {
                     54:        sizeof(struct tsl_softc), tsl_match, tsl_attach
                     55: };
                     56:
                     57: struct cfdriver tsl_cd = {
                     58:        NULL, "tsl", DV_DULL
                     59: };
                     60:
                     61: int
                     62: tsl_match(struct device *parent, void *match, void *aux)
                     63: {
                     64:        struct i2c_attach_args *ia = aux;
                     65:
                     66:        if (strcmp(ia->ia_name, "tsl2560") == 0)
                     67:                return (1);
                     68:        return (0);
                     69: }
                     70:
                     71: void
                     72: tsl_attach(struct device *parent, struct device *self, void *aux)
                     73: {
                     74:        struct tsl_softc *sc = (struct tsl_softc *)self;
                     75:        struct i2c_attach_args *ia = aux;
                     76:        u_int8_t cmd, data;
                     77:
                     78:        sc->sc_tag = ia->ia_tag;
                     79:        sc->sc_addr = ia->ia_addr;
                     80:
                     81:        iic_acquire_bus(sc->sc_tag, 0);
                     82:        cmd = TSL2560_REG_CONTROL; data = TSL2560_CONTROL_POWER;
                     83:        if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
                     84:                     sc->sc_addr, &cmd, 1, &data, 1, 0)) {
                     85:                iic_release_bus(sc->sc_tag, 0);
                     86:                printf(": power up failed\n");
                     87:                return;
                     88:        }
                     89:        cmd = TSL2560_REG_TIMING;
                     90:        data = TSL2560_TIMING_GAIN | TSL2560_TIMING_INTEG2;
                     91:        if (iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
                     92:                     sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0)) {
                     93:                iic_release_bus(sc->sc_tag, 0);
                     94:                printf(": cannot write timing register\n");
                     95:                return;
                     96:        }
                     97:        cmd = TSL2560_REG_ID;
                     98:        if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
                     99:                     sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0)) {
                    100:                iic_release_bus(sc->sc_tag, 0);
                    101:                printf(": cannot read ID register\n");
                    102:                return;
                    103:        }
                    104:        iic_release_bus(sc->sc_tag, 0);
                    105:
                    106:        switch (data >> 4) {
                    107:        case 0:
                    108:                printf(": TSL2560 rev %x", data & 0x0f);
                    109:                break;
                    110:        case 1:
                    111:                printf(": TSL2561 rev %x", data & 0x0f);
                    112:                break;
                    113:        default:
                    114:                printf(": unknown part number %x", data >> 4);
                    115:                break;
                    116:        }
                    117:
                    118:        /* Initialize sensor data. */
                    119:        strlcpy(sc->sc_sensordev.xname, sc->sc_dev.dv_xname,
                    120:            sizeof(sc->sc_sensordev.xname));
                    121:        sc->sc_sensor.type = SENSOR_LUX;
                    122:
                    123:        if (sensor_task_register(sc, tsl_refresh, 5) == NULL) {
                    124:                printf(": unable to register update task\n");
                    125:                return;
                    126:        }
                    127:
                    128:        sensor_attach(&sc->sc_sensordev, &sc->sc_sensor);
                    129:        sensordev_install(&sc->sc_sensordev);
                    130:
                    131:        printf("\n");
                    132: }
                    133:
                    134: void
                    135: tsl_refresh(void *arg)
                    136: {
                    137:        struct tsl_softc *sc = arg;
                    138:        u_int8_t cmd, data[2];
                    139:        u_int16_t chan0, chan1;
                    140:
                    141:        iic_acquire_bus(sc->sc_tag, 0);
                    142:        cmd = TSL2560_REG_DATA0;
                    143:        if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
                    144:                     sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0)) {
                    145:                iic_release_bus(sc->sc_tag, 0);
                    146:                sc->sc_sensor.flags |= SENSOR_FINVALID;
                    147:                return;
                    148:        }
                    149:        chan0 = data[1] << 8 | data[0];
                    150:        cmd = TSL2560_REG_DATA1;
                    151:        if (iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
                    152:                     sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0)) {
                    153:                iic_release_bus(sc->sc_tag, 0);
                    154:                sc->sc_sensor.flags |= SENSOR_FINVALID;
                    155:                return;
                    156:        }
                    157:        chan1 = data[1] << 8 | data[0];
                    158:        iic_release_bus(sc->sc_tag, 0);
                    159:
                    160:        sc->sc_sensor.value = tsl_lux(chan0, chan1);
                    161:        sc->sc_sensor.flags &= ~SENSOR_FINVALID;
                    162: }
                    163:
                    164: /* Precision for fixed-point math. */
                    165: #define TSL2560_RATIO_SCALE    9
                    166: #define TSL2560_LUX_SCALE      14
                    167:
                    168: /*
                    169:  * The TSL2560/2561 comes in a ChipScale or TMB-6 package and the
                    170:  * calibration is slightly different for each package.  The constants
                    171:  * below are for the TMB-6 package.
                    172:  */
                    173:
                    174: #define TSL2560_K1T    0x0040  /* 0.125 * (1 << TSL2560_RATIO_SCALE) */
                    175: #define TSL2560_B1T    0x01f2  /* 0.0304 * (1 << TSL2560_LUX_SCALE) */
                    176: #define TSL2560_M1T    0x01be  /* 0.0272 * (1 << TSL2560_LUX_SCALE) */
                    177:
                    178: #define TSL2560_K2T    0x0080  /* 0.250 * (1 << TSL2560_RATIO_SCALE) */
                    179: #define TSL2560_B2T    0x0214  /* 0.0324 * (1 << TSL2560_LUX_SCALE) */
                    180: #define TSL2560_M2T    0x02d1  /* 0.0440 * (1 << TSL2560_LUX_SCALE) */
                    181:
                    182: #define TSL2560_K3T    0x00c0  /* 0.375 * (1 << TSL2560_RATIO_SCALE) */
                    183: #define TSL2560_B3T    0x023f  /* 0.0351 * (1 << TSL2560_LUX_SCALE) */
                    184: #define TSL2560_M3T    0x037b  /* 0.0544 * (1 << TSL2560_LUX_SCALE) */
                    185:
                    186: #define TSL2560_K4T    0x0080  /* 0.50 * (1 << TSL2560_RATIO_SCALE) */
                    187: #define TSL2560_B4T    0x0214  /* 0.0381 * (1 << TSL2560_LUX_SCALE) */
                    188: #define TSL2560_M4T    0x02d1  /* 0.0624 * (1 << TSL2560_LUX_SCALE) */
                    189:
                    190: #define TSL2560_K5T    0x0138  /* 0.61 * (1 << TSL2560_RATIO_SCALE) */
                    191: #define TSL2560_B5T    0x016f  /* 0.0224 * (1 << TSL2560_LUX_SCALE) */
                    192: #define TSL2560_M5T    0x01fc  /* 0.0310 * (1 << TSL2560_LUX_SCALE) */
                    193:
                    194: #define TSL2560_K6T    0x0100  /* 0.80 * (1 << TSL2560_RATIO_SCALE) */
                    195: #define TSL2560_B6T    0x0270  /* 0.0128 * (1 << TSL2560_LUX_SCALE) */
                    196: #define TSL2560_M6T    0x03fe  /* 0.0153 * (1 << TSL2560_LUX_SCALE) */
                    197:
                    198: #define TSL2560_K7T    0x019a  /* 1.3 * (1 << TSL2560_RATIO_SCALE) */
                    199: #define TSL2560_B7T    0x0018  /* 0.00146 * (1 << TSL2560_LUX_SCALE) */
                    200: #define TSL2560_M7T    0x0012  /* 0.00112 * (1 << TSL2560_LUX_SCALE) */
                    201:
                    202: u_int64_t
                    203: tsl_lux(u_int32_t chan0, u_int32_t chan1)
                    204: {
                    205:        u_int32_t ratio, ratio1;
                    206:        u_int32_t b, m;
                    207:        int64_t lux;
                    208:
                    209:        ratio1 = 0;
                    210:        if (chan0 != 0)
                    211:                ratio1 = (chan1 << (TSL2560_RATIO_SCALE + 1)) / chan0;
                    212:        ratio = (ratio1 + 1) >> 1;
                    213:
                    214:        b = 0, m = 0;
                    215:        if (ratio <= TSL2560_K1T)
                    216:                b = TSL2560_B1T, m = TSL2560_M1T;
                    217:        else if (ratio <= TSL2560_K2T)
                    218:                b = TSL2560_B2T, m = TSL2560_M2T;
                    219:        else if (ratio <= TSL2560_K3T)
                    220:                b = TSL2560_B3T, m = TSL2560_M3T;
                    221:        else if (ratio <= TSL2560_K4T)
                    222:                b = TSL2560_B4T, m = TSL2560_M4T;
                    223:        else if (ratio <= TSL2560_K5T)
                    224:                b = TSL2560_B5T, m = TSL2560_M5T;
                    225:        else if (ratio <= TSL2560_K6T)
                    226:                b = TSL2560_B6T, m = TSL2560_M6T;
                    227:        else if (ratio <= TSL2560_K7T)
                    228:                b = TSL2560_B7T, m = TSL2560_M7T;
                    229:
                    230:        lux = b * chan0 - m * chan1;
                    231:        if (lux < 0)
                    232:                lux = 0;
                    233:        return ((lux * 1000000) >> TSL2560_LUX_SCALE);
                    234: }

CVSweb