uthum.c revision 1.11
1 /* $NetBSD: uthum.c,v 1.11 2016/04/23 10:15:32 skrll Exp $ */ 2 /* $OpenBSD: uthum.c,v 1.6 2010/01/03 18:43:02 deraadt Exp $ */ 3 4 /* 5 * Copyright (c) 2009 Yojiro UO <yuo (at) nui.org> 6 * 7 * Permission to use, copy, modify, and distribute this software for any 8 * purpose with or without fee is hereby granted, provided that the above 9 * copyright notice and this permission notice appear in all copies. 10 * 11 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCAIMS ALL WARRANTIES 12 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 13 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 14 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 15 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 16 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 17 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 18 */ 19 20 /* 21 * Driver for TEMPer and TEMPerHUM HID 22 */ 23 24 #include <sys/cdefs.h> 25 __KERNEL_RCSID(0, "$NetBSD: uthum.c,v 1.11 2016/04/23 10:15:32 skrll Exp $"); 26 27 #include <sys/param.h> 28 #include <sys/proc.h> 29 #include <sys/systm.h> 30 #include <sys/kernel.h> 31 #include <sys/device.h> 32 #include <sys/conf.h> 33 34 #include <dev/sysmon/sysmonvar.h> 35 36 #include <dev/usb/usb.h> 37 #include <dev/usb/usbhid.h> 38 #include <dev/usb/usbdi.h> 39 #include <dev/usb/usbdi_util.h> 40 #include <dev/usb/usbdevs.h> 41 #include <dev/usb/uhidev.h> 42 #include <dev/usb/hid.h> 43 44 #ifdef UTHUM_DEBUG 45 int uthumdebug = 0; 46 #define DPRINTFN(n, x) do { if (uthumdebug > (n)) printf x; } while (0) 47 #else 48 #define DPRINTFN(n, x) 49 #endif 50 51 #define DPRINTF(x) DPRINTFN(0, x) 52 53 54 /* TEMPerHUM */ 55 #define CMD_DEVTYPE 0x52 /* XXX */ 56 #define CMD_GETDATA 0x48 /* XXX */ 57 #define CMD_GETTEMP 0x54 /* XXX */ 58 static uint8_t cmd_start[8] = 59 { 0x0a, 0x0b, 0x0c, 0x0d, 0x00, 0x00, 0x02, 0x00 }; 60 static uint8_t cmd_end[8] = 61 { 0x0a, 0x0b, 0x0c, 0x0d, 0x00, 0x00, 0x01, 0x00 }; 62 63 /* sensors */ 64 #define UTHUM_TEMP 0 65 #define UTHUM_HUMIDITY 1 66 #define UTHUM_MAX_SENSORS 2 67 68 #define UTHUM_TYPE_UNKNOWN 0 69 #define UTHUM_TYPE_SHT1x 1 70 #define UTHUM_TYPE_TEMPER 2 71 72 struct uthum_softc { 73 struct uhidev sc_hdev; 74 struct usbd_device * sc_udev; 75 u_char sc_dying; 76 uint16_t sc_flag; 77 int sc_sensortype; 78 79 /* uhidev parameters */ 80 size_t sc_flen; /* feature report length */ 81 size_t sc_ilen; /* input report length */ 82 size_t sc_olen; /* output report length */ 83 84 /* sensor framework */ 85 struct sysmon_envsys *sc_sme; 86 envsys_data_t sc_sensor[UTHUM_MAX_SENSORS]; 87 88 uint8_t sc_num_sensors; 89 }; 90 91 92 const struct usb_devno uthum_devs[] = { 93 /* XXX: various TEMPer variants using same VID/PID */ 94 { USB_VENDOR_TENX, USB_PRODUCT_TENX_TEMPER}, 95 }; 96 #define uthum_lookup(v, p) usb_lookup(uthum_devs, v, p) 97 98 int uthum_match(device_t, cfdata_t, void *); 99 void uthum_attach(device_t, device_t, void *); 100 void uthum_childdet(device_t, device_t); 101 int uthum_detach(device_t, int); 102 int uthum_activate(device_t, enum devact); 103 104 int uthum_read_data(struct uthum_softc *, uint8_t, uint8_t *, size_t, int); 105 int uthum_check_sensortype(struct uthum_softc *); 106 int uthum_temper_temp(uint8_t, uint8_t); 107 int uthum_sht1x_temp(uint8_t, uint8_t); 108 int uthum_sht1x_rh(unsigned int, int); 109 110 void uthum_intr(struct uhidev *, void *, u_int); 111 static void uthum_refresh(struct sysmon_envsys *, envsys_data_t *); 112 113 extern struct cfdriver uthum_cd; 114 CFATTACH_DECL_NEW(uthum, sizeof(struct uthum_softc), uthum_match, uthum_attach, 115 uthum_detach, uthum_activate); 116 117 int 118 uthum_match(device_t parent, cfdata_t match, void *aux) 119 { 120 struct uhidev_attach_arg *uha = aux; 121 122 return uthum_lookup(uha->uiaa->uiaa_vendor, uha->uiaa->uiaa_product) != NULL ? 123 UMATCH_VENDOR_PRODUCT : UMATCH_NONE; 124 } 125 126 void 127 uthum_attach(device_t parent, device_t self, void *aux) 128 { 129 struct uthum_softc *sc = device_private(self); 130 struct uhidev_attach_arg *uha = aux; 131 struct usbd_device *dev = uha->parent->sc_udev; 132 int size, repid; 133 void *desc; 134 135 sc->sc_udev = dev; 136 sc->sc_hdev.sc_dev = self; 137 sc->sc_hdev.sc_intr = uthum_intr; 138 sc->sc_hdev.sc_parent = uha->parent; 139 sc->sc_hdev.sc_report_id = uha->reportid; 140 sc->sc_num_sensors = 0; 141 142 aprint_normal("\n"); 143 aprint_naive("\n"); 144 145 uhidev_get_report_desc(uha->parent, &desc, &size); 146 repid = uha->reportid; 147 sc->sc_ilen = hid_report_size(desc, size, hid_input, repid); 148 sc->sc_olen = hid_report_size(desc, size, hid_output, repid); 149 sc->sc_flen = hid_report_size(desc, size, hid_feature, repid); 150 151 usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, 152 sc->sc_hdev.sc_dev); 153 154 if (sc->sc_flen < 32) { 155 /* not sensor interface, just attach */ 156 return; 157 } 158 159 sc->sc_sensortype = uthum_check_sensortype(sc); 160 161 /* attach sensor */ 162 sc->sc_sme = sysmon_envsys_create(); 163 sc->sc_sme->sme_name = device_xname(self); 164 165 switch (sc->sc_sensortype) { 166 case UTHUM_TYPE_SHT1x: 167 (void)strlcpy(sc->sc_sensor[UTHUM_TEMP].desc, "temp", 168 sizeof(sc->sc_sensor[UTHUM_TEMP].desc)); 169 sc->sc_sensor[UTHUM_TEMP].units = ENVSYS_STEMP; 170 sc->sc_sensor[UTHUM_TEMP].state = ENVSYS_SINVALID; 171 172 (void)strlcpy(sc->sc_sensor[UTHUM_HUMIDITY].desc, 173 "relative humidity", 174 sizeof(sc->sc_sensor[UTHUM_HUMIDITY].desc)); 175 sc->sc_sensor[UTHUM_HUMIDITY].units = ENVSYS_INTEGER; 176 sc->sc_sensor[UTHUM_HUMIDITY].value_cur = 0; 177 sc->sc_sensor[UTHUM_HUMIDITY].state = ENVSYS_SINVALID; 178 179 sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor[UTHUM_TEMP]); 180 sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor[UTHUM_HUMIDITY]); 181 sc->sc_num_sensors = 2; 182 DPRINTF(("sensor type: SHT1x\n")); 183 break; 184 case UTHUM_TYPE_TEMPER: 185 (void)strlcpy(sc->sc_sensor[UTHUM_TEMP].desc, "temp", 186 sizeof(sc->sc_sensor[UTHUM_TEMP].desc)); 187 sc->sc_sensor[UTHUM_TEMP].units = ENVSYS_STEMP; 188 sc->sc_sensor[UTHUM_TEMP].state = ENVSYS_SINVALID; 189 190 sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensor[UTHUM_TEMP]); 191 sc->sc_num_sensors = 1; 192 DPRINTF(("sensor type: TEMPer\n")); 193 break; 194 case UTHUM_TYPE_UNKNOWN: 195 DPRINTF(("sensor type: unknown, give up to attach sensors\n")); 196 default: 197 break; 198 } 199 200 if (sc->sc_num_sensors > 0) { 201 sc->sc_sme->sme_cookie = sc; 202 sc->sc_sme->sme_refresh = uthum_refresh; 203 204 if (sysmon_envsys_register(sc->sc_sme)) { 205 aprint_error_dev(self, "unable to register with sysmon\n"); 206 sysmon_envsys_destroy(sc->sc_sme); 207 } 208 } else { 209 sysmon_envsys_destroy(sc->sc_sme); 210 } 211 212 DPRINTF(("uthum_attach: complete\n")); 213 } 214 215 int 216 uthum_detach(device_t self, int flags) 217 { 218 struct uthum_softc *sc = device_private(self); 219 int rv = 0; 220 221 sc->sc_dying = 1; 222 223 if (sc->sc_num_sensors > 0) { 224 sysmon_envsys_unregister(sc->sc_sme); 225 } 226 227 usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, 228 sc->sc_hdev.sc_dev); 229 230 return rv; 231 } 232 233 int 234 uthum_activate(device_t self, enum devact act) 235 { 236 struct uthum_softc *sc = device_private(self); 237 238 switch (act) { 239 case DVACT_DEACTIVATE: 240 sc->sc_dying = 1; 241 break; 242 } 243 return 0; 244 } 245 246 void 247 uthum_intr(struct uhidev *addr, void *ibuf, u_int len) 248 { 249 /* do nothing */ 250 } 251 252 int 253 uthum_read_data(struct uthum_softc *sc, uint8_t target_cmd, uint8_t *buf, 254 size_t len, int need_delay) 255 { 256 int i; 257 uint8_t cmdbuf[32], report[256]; 258 259 /* if return buffer is null, do nothing */ 260 if ((buf == NULL) || len == 0) 261 return 0; 262 263 /* issue query */ 264 memset(cmdbuf, 0, sizeof(cmdbuf)); 265 memcpy(cmdbuf, cmd_start, sizeof(cmd_start)); 266 if (uhidev_set_report(&sc->sc_hdev, UHID_OUTPUT_REPORT, 267 cmdbuf, sc->sc_olen)) 268 return EIO; 269 270 memset(cmdbuf, 0, sizeof(cmdbuf)); 271 cmdbuf[0] = target_cmd; 272 if (uhidev_set_report(&sc->sc_hdev, UHID_OUTPUT_REPORT, 273 cmdbuf, sc->sc_olen)) 274 return EIO; 275 276 memset(cmdbuf, 0, sizeof(cmdbuf)); 277 for (i = 0; i < 7; i++) { 278 if (uhidev_set_report(&sc->sc_hdev, UHID_OUTPUT_REPORT, 279 cmdbuf, sc->sc_olen)) 280 return EIO; 281 } 282 memcpy(cmdbuf, cmd_end, sizeof(cmd_end)); 283 if (uhidev_set_report(&sc->sc_hdev, UHID_OUTPUT_REPORT, 284 cmdbuf, sc->sc_olen)) 285 return EIO; 286 287 /* wait if required */ 288 if (need_delay > 1) 289 tsleep(&sc->sc_sme, 0, "uthum", (need_delay*hz+999)/1000 + 1); 290 291 /* get answer */ 292 if (uhidev_get_report(&sc->sc_hdev, UHID_FEATURE_REPORT, 293 report, sc->sc_flen)) 294 return EIO; 295 memcpy(buf, report, len); 296 return 0; 297 } 298 299 int 300 uthum_check_sensortype(struct uthum_softc *sc) 301 { 302 uint8_t buf[8]; 303 static uint8_t sht1x_sig0[] = 304 { 0x57, 0x5a, 0x13, 0x00, 0x14, 0x00, 0x53, 0x00 }; 305 static uint8_t sht1x_sig1[] = 306 { 0x57, 0x5a, 0x14, 0x00, 0x14, 0x00, 0x53, 0x00 }; 307 static uint8_t temper_sig[] = 308 { 0x57, 0x58, 0x14, 0x00, 0x14, 0x00, 0x53, 0x00 }; 309 310 if (uthum_read_data(sc, CMD_DEVTYPE, buf, sizeof(buf), 0) != 0) { 311 DPRINTF(("uthum: read fail\n")); 312 return UTHUM_TYPE_UNKNOWN; 313 } 314 315 /* 316 * currently we have not enough information about the return value, 317 * therefore, compare full bytes. 318 * TEMPerHUM HID (SHT1x version) will return: 319 * { 0x57, 0x5a, 0x13, 0x00, 0x14, 0x00, 0x53, 0x00 } 320 * { 0x57, 0x5a, 0x14, 0x00, 0x14, 0x00, 0x53, 0x00 } 321 * TEMPer HID (TEMPer version) will return: 322 * { 0x57, 0x58, 0x14, 0x00, 0x14, 0x00, 0x53, 0x00 } 323 */ 324 DPRINTF(("uthum: device signature: " 325 "0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x\n", 326 buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7])); 327 if (0 == memcmp(buf, sht1x_sig0, sizeof(sht1x_sig0))) 328 return UTHUM_TYPE_SHT1x; 329 if (0 == memcmp(buf, sht1x_sig1, sizeof(sht1x_sig1))) 330 return UTHUM_TYPE_SHT1x; 331 if (0 == memcmp(buf, temper_sig, sizeof(temper_sig))) 332 return UTHUM_TYPE_TEMPER; 333 334 return UTHUM_TYPE_UNKNOWN; 335 } 336 337 338 static void 339 uthum_refresh(struct sysmon_envsys *sme, envsys_data_t *edata) 340 { 341 struct uthum_softc *sc = sme->sme_cookie; 342 uint8_t buf[8]; 343 unsigned int humidity_tick; 344 int temp, rh; 345 346 switch (sc->sc_sensortype) { 347 case UTHUM_TYPE_SHT1x: 348 if (uthum_read_data(sc, CMD_GETDATA, buf, sizeof(buf), 1000) != 0) { 349 DPRINTF(("uthum: data read fail\n")); 350 sc->sc_sensor[UTHUM_TEMP].state = ENVSYS_SINVALID; 351 sc->sc_sensor[UTHUM_HUMIDITY].state = ENVSYS_SINVALID; 352 return; 353 } 354 DPRINTF(("%s: read SHT1x data " 355 "0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x\n", 356 sc->sc_sme->sme_name, buf[0], buf[1], buf[2], buf[3], 357 buf[4], buf[5], buf[6], buf[7])); 358 359 humidity_tick = (buf[2] * 256 + buf[3]) & 0x0fff; 360 361 temp = uthum_sht1x_temp(buf[0], buf[1]); 362 rh = uthum_sht1x_rh(humidity_tick, temp); 363 364 sc->sc_sensor[UTHUM_HUMIDITY].value_cur = rh / 1000; 365 sc->sc_sensor[UTHUM_HUMIDITY].state = ENVSYS_SVALID; 366 break; 367 case UTHUM_TYPE_TEMPER: 368 if (uthum_read_data(sc, CMD_GETTEMP, buf, sizeof(buf), 0) != 0) { 369 DPRINTF(("uthum: data read fail\n")); 370 sc->sc_sensor[UTHUM_TEMP].state = ENVSYS_SINVALID; 371 return; 372 } 373 DPRINTF(("%s: read TEMPER data " 374 "0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x 0x%0x\n", 375 sc->sc_sme->sme_name, buf[0], buf[1], buf[2], buf[3], 376 buf[4], buf[5], buf[6], buf[7])); 377 temp = uthum_temper_temp(buf[0], buf[1]); 378 break; 379 default: 380 /* do nothing */ 381 return; 382 } 383 384 sc->sc_sensor[UTHUM_TEMP].value_cur = (temp * 10000) + 273150000; 385 sc->sc_sensor[UTHUM_TEMP].state = ENVSYS_SVALID; 386 } 387 388 /* return C-degree * 100 value */ 389 int 390 uthum_temper_temp(uint8_t msb, uint8_t lsb) 391 { 392 int val; 393 394 val = (msb << 8) | lsb; 395 if (val >= 32768) { 396 val = val - 65536; 397 } 398 val = (val * 100) >> 8; 399 return val; 400 } 401 402 /* return C-degree * 100 value */ 403 int 404 uthum_sht1x_temp(uint8_t msb, uint8_t lsb) 405 { 406 int val; 407 408 val = ((msb << 8) + lsb) - 4096; 409 return val; 410 } 411 412 /* return %RH * 1000 */ 413 int 414 uthum_sht1x_rh(unsigned int ticks, int temp) 415 { 416 int rh_l, rh; 417 418 rh_l = (-40000 + 405 * ticks) - ((7 * ticks * ticks) / 250); 419 rh = ((temp - 2500) * (1 + (ticks >> 7)) + rh_l) / 10; 420 return rh; 421 } 422
Indexes created Thu Sep 25 08:09:54 GMT 2025