1208842Snwhitehorn/*- 2208842Snwhitehorn * Copyright (c) 2010 Nathan Whitehorn 3208842Snwhitehorn * All rights reserved. 4208842Snwhitehorn * 5208842Snwhitehorn * Redistribution and use in source and binary forms, with or without 6208842Snwhitehorn * modification, are permitted provided that the following conditions 7208842Snwhitehorn * are met: 8208842Snwhitehorn * 1. Redistributions of source code must retain the above copyright 9208842Snwhitehorn * notice, this list of conditions and the following disclaimer. 10208842Snwhitehorn * 2. Redistributions in binary form must reproduce the above copyright 11208842Snwhitehorn * notice, this list of conditions and the following disclaimer in the 12208842Snwhitehorn * documentation and/or other materials provided with the distribution. 13208842Snwhitehorn * 14208842Snwhitehorn * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15208842Snwhitehorn * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16208842Snwhitehorn * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17208842Snwhitehorn * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18208842Snwhitehorn * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 19208842Snwhitehorn * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 20208842Snwhitehorn * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 21208842Snwhitehorn * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 22208842Snwhitehorn * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23208842Snwhitehorn * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24208842Snwhitehorn * SUCH DAMAGE. 25208842Snwhitehorn * 26208842Snwhitehorn */ 27208842Snwhitehorn 28208842Snwhitehorn#include <sys/cdefs.h> 29208842Snwhitehorn__FBSDID("$FreeBSD: releng/10.3/sys/powerpc/powermac/smusat.c 231770 2012-02-15 16:59:24Z nwhitehorn $"); 30208842Snwhitehorn 31208842Snwhitehorn#include <sys/param.h> 32208842Snwhitehorn#include <sys/systm.h> 33208842Snwhitehorn#include <sys/module.h> 34208842Snwhitehorn#include <sys/bus.h> 35208842Snwhitehorn#include <sys/conf.h> 36208842Snwhitehorn#include <sys/cpu.h> 37208842Snwhitehorn#include <sys/ctype.h> 38208842Snwhitehorn#include <sys/kernel.h> 39208842Snwhitehorn#include <sys/sysctl.h> 40208842Snwhitehorn 41208842Snwhitehorn#include <dev/iicbus/iicbus.h> 42208842Snwhitehorn#include <dev/iicbus/iiconf.h> 43208842Snwhitehorn#include <dev/ofw/ofw_bus.h> 44208842Snwhitehorn#include <dev/ofw/openfirm.h> 45208842Snwhitehorn 46222431Snwhitehorn#include <powerpc/powermac/powermac_thermal.h> 47222431Snwhitehorn 48208842Snwhitehornstruct smu_sensor { 49222431Snwhitehorn struct pmac_therm therm; 50222431Snwhitehorn device_t dev; 51222431Snwhitehorn 52208842Snwhitehorn cell_t reg; 53208842Snwhitehorn enum { 54208842Snwhitehorn SMU_CURRENT_SENSOR, 55208842Snwhitehorn SMU_VOLTAGE_SENSOR, 56208842Snwhitehorn SMU_POWER_SENSOR, 57208842Snwhitehorn SMU_TEMP_SENSOR 58208842Snwhitehorn } type; 59208842Snwhitehorn}; 60208842Snwhitehorn 61208842Snwhitehornstatic int smusat_probe(device_t); 62208842Snwhitehornstatic int smusat_attach(device_t); 63208842Snwhitehornstatic int smusat_sensor_sysctl(SYSCTL_HANDLER_ARGS); 64222431Snwhitehornstatic int smusat_sensor_read(struct smu_sensor *sens); 65208842Snwhitehorn 66227293Sedstatic MALLOC_DEFINE(M_SMUSAT, "smusat", "SMU Sattelite Sensors"); 67208842Snwhitehorn 68208842Snwhitehornstatic device_method_t smusat_methods[] = { 69208842Snwhitehorn /* Device interface */ 70208842Snwhitehorn DEVMETHOD(device_probe, smusat_probe), 71208842Snwhitehorn DEVMETHOD(device_attach, smusat_attach), 72208842Snwhitehorn { 0, 0 }, 73208842Snwhitehorn}; 74208842Snwhitehorn 75208842Snwhitehornstruct smusat_softc { 76208842Snwhitehorn struct smu_sensor *sc_sensors; 77208842Snwhitehorn int sc_nsensors; 78208842Snwhitehorn 79208842Snwhitehorn uint8_t sc_cache[16]; 80208842Snwhitehorn time_t sc_last_update; 81208842Snwhitehorn}; 82208842Snwhitehorn 83208842Snwhitehornstatic driver_t smusat_driver = { 84208842Snwhitehorn "smusat", 85208842Snwhitehorn smusat_methods, 86208842Snwhitehorn sizeof(struct smusat_softc) 87208842Snwhitehorn}; 88208842Snwhitehorn 89208842Snwhitehornstatic devclass_t smusat_devclass; 90208842Snwhitehorn 91208842SnwhitehornDRIVER_MODULE(smusat, iicbus, smusat_driver, smusat_devclass, 0, 0); 92208842Snwhitehorn 93208842Snwhitehornstatic int 94208842Snwhitehornsmusat_probe(device_t dev) 95208842Snwhitehorn{ 96208842Snwhitehorn const char *compat = ofw_bus_get_compat(dev); 97208842Snwhitehorn 98208842Snwhitehorn if (compat == NULL || strcmp(compat, "smu-sat") != 0) 99208842Snwhitehorn return (ENXIO); 100208842Snwhitehorn 101208842Snwhitehorn device_set_desc(dev, "SMU Satellite Sensors"); 102208842Snwhitehorn return (0); 103208842Snwhitehorn} 104208842Snwhitehorn 105208842Snwhitehornstatic int 106208842Snwhitehornsmusat_attach(device_t dev) 107208842Snwhitehorn{ 108208842Snwhitehorn phandle_t child; 109208842Snwhitehorn struct smu_sensor *sens; 110208842Snwhitehorn struct smusat_softc *sc; 111208842Snwhitehorn struct sysctl_oid *sensroot_oid; 112208842Snwhitehorn struct sysctl_ctx_list *ctx; 113208842Snwhitehorn char type[32]; 114208842Snwhitehorn int i; 115208842Snwhitehorn 116208842Snwhitehorn sc = device_get_softc(dev); 117208842Snwhitehorn sc->sc_nsensors = 0; 118208842Snwhitehorn sc->sc_last_update = 0; 119208842Snwhitehorn 120208842Snwhitehorn for (child = OF_child(ofw_bus_get_node(dev)); child != 0; 121208842Snwhitehorn child = OF_peer(child)) 122208842Snwhitehorn sc->sc_nsensors++; 123208842Snwhitehorn 124208842Snwhitehorn if (sc->sc_nsensors == 0) { 125208842Snwhitehorn device_printf(dev, "WARNING: No sensors detected!\n"); 126208842Snwhitehorn return (-1); 127208842Snwhitehorn } 128208842Snwhitehorn 129208842Snwhitehorn sc->sc_sensors = malloc(sc->sc_nsensors * sizeof(struct smu_sensor), 130208842Snwhitehorn M_SMUSAT, M_WAITOK | M_ZERO); 131208842Snwhitehorn 132208842Snwhitehorn sens = sc->sc_sensors; 133208842Snwhitehorn sc->sc_nsensors = 0; 134208842Snwhitehorn 135208842Snwhitehorn ctx = device_get_sysctl_ctx(dev); 136208842Snwhitehorn sensroot_oid = device_get_sysctl_tree(dev); 137208842Snwhitehorn 138208842Snwhitehorn for (child = OF_child(ofw_bus_get_node(dev)); child != 0; 139208842Snwhitehorn child = OF_peer(child)) { 140208842Snwhitehorn char sysctl_name[40], sysctl_desc[40]; 141208842Snwhitehorn const char *units; 142208842Snwhitehorn 143222431Snwhitehorn sens->dev = dev; 144208842Snwhitehorn sens->reg = 0; 145208842Snwhitehorn OF_getprop(child, "reg", &sens->reg, sizeof(sens->reg)); 146208842Snwhitehorn if (sens->reg < 0x30) 147208842Snwhitehorn continue; 148208842Snwhitehorn sens->reg -= 0x30; 149208842Snwhitehorn 150222431Snwhitehorn OF_getprop(child, "zone", &sens->therm.zone, sizeof(int)); 151222431Snwhitehorn OF_getprop(child, "location", sens->therm.name, 152222431Snwhitehorn sizeof(sens->therm.name)); 153222431Snwhitehorn 154208842Snwhitehorn OF_getprop(child, "device_type", type, sizeof(type)); 155208842Snwhitehorn 156208842Snwhitehorn if (strcmp(type, "current-sensor") == 0) { 157208842Snwhitehorn sens->type = SMU_CURRENT_SENSOR; 158208842Snwhitehorn units = "mA"; 159208842Snwhitehorn } else if (strcmp(type, "temp-sensor") == 0) { 160208842Snwhitehorn sens->type = SMU_TEMP_SENSOR; 161208842Snwhitehorn units = "C"; 162208842Snwhitehorn } else if (strcmp(type, "voltage-sensor") == 0) { 163208842Snwhitehorn sens->type = SMU_VOLTAGE_SENSOR; 164208842Snwhitehorn units = "mV"; 165208842Snwhitehorn } else if (strcmp(type, "power-sensor") == 0) { 166208842Snwhitehorn sens->type = SMU_POWER_SENSOR; 167208842Snwhitehorn units = "mW"; 168208842Snwhitehorn } else { 169208842Snwhitehorn continue; 170208842Snwhitehorn } 171208842Snwhitehorn 172222431Snwhitehorn for (i = 0; i < strlen(sens->therm.name); i++) { 173222431Snwhitehorn sysctl_name[i] = tolower(sens->therm.name[i]); 174208842Snwhitehorn if (isspace(sysctl_name[i])) 175208842Snwhitehorn sysctl_name[i] = '_'; 176208842Snwhitehorn } 177208842Snwhitehorn sysctl_name[i] = 0; 178208842Snwhitehorn 179222431Snwhitehorn sprintf(sysctl_desc,"%s (%s)", sens->therm.name, units); 180208842Snwhitehorn SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(sensroot_oid), OID_AUTO, 181208842Snwhitehorn sysctl_name, CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, dev, 182222431Snwhitehorn sc->sc_nsensors, smusat_sensor_sysctl, 183222431Snwhitehorn (sens->type == SMU_TEMP_SENSOR) ? "IK" : "I", sysctl_desc); 184208842Snwhitehorn 185222431Snwhitehorn if (sens->type == SMU_TEMP_SENSOR) { 186222431Snwhitehorn /* Make up some numbers */ 187222431Snwhitehorn sens->therm.target_temp = 500 + 2732; /* 50 C */ 188222431Snwhitehorn sens->therm.max_temp = 900 + 2732; /* 90 C */ 189222431Snwhitehorn sens->therm.read = 190222431Snwhitehorn (int (*)(struct pmac_therm *))smusat_sensor_read; 191222431Snwhitehorn pmac_thermal_sensor_register(&sens->therm); 192222431Snwhitehorn } 193222431Snwhitehorn 194208842Snwhitehorn sens++; 195208842Snwhitehorn sc->sc_nsensors++; 196208842Snwhitehorn } 197208842Snwhitehorn 198208842Snwhitehorn return (0); 199208842Snwhitehorn} 200208842Snwhitehorn 201208842Snwhitehornstatic int 202208842Snwhitehornsmusat_updatecache(device_t dev) 203208842Snwhitehorn{ 204208842Snwhitehorn uint8_t reg = 0x3f; 205231770Snwhitehorn uint8_t value[16]; 206208842Snwhitehorn struct smusat_softc *sc = device_get_softc(dev); 207231770Snwhitehorn int error; 208208842Snwhitehorn struct iic_msg msgs[2] = { 209208842Snwhitehorn {0, IIC_M_WR | IIC_M_NOSTOP, 1, ®}, 210231770Snwhitehorn {0, IIC_M_RD, 16, value}, 211208842Snwhitehorn }; 212208842Snwhitehorn 213208842Snwhitehorn msgs[0].slave = msgs[1].slave = iicbus_get_addr(dev); 214231770Snwhitehorn error = iicbus_transfer(dev, msgs, 2); 215231770Snwhitehorn if (error) 216231770Snwhitehorn return (error); 217231770Snwhitehorn 218208842Snwhitehorn sc->sc_last_update = time_uptime; 219231770Snwhitehorn memcpy(sc->sc_cache, value, sizeof(value)); 220231770Snwhitehorn return (0); 221208842Snwhitehorn} 222208842Snwhitehorn 223208842Snwhitehornstatic int 224222431Snwhitehornsmusat_sensor_read(struct smu_sensor *sens) 225208842Snwhitehorn{ 226231770Snwhitehorn int value, error; 227222431Snwhitehorn device_t dev; 228208842Snwhitehorn struct smusat_softc *sc; 229208842Snwhitehorn 230222431Snwhitehorn dev = sens->dev; 231208842Snwhitehorn sc = device_get_softc(dev); 232231770Snwhitehorn error = 0; 233208842Snwhitehorn 234208842Snwhitehorn if (time_uptime - sc->sc_last_update > 1) 235231770Snwhitehorn error = smusat_updatecache(dev); 236231770Snwhitehorn if (error) 237231770Snwhitehorn return (-error); 238208842Snwhitehorn 239208842Snwhitehorn value = (sc->sc_cache[sens->reg*2] << 8) + 240208842Snwhitehorn sc->sc_cache[sens->reg*2 + 1]; 241231770Snwhitehorn if (value == 0xffff) { 242231770Snwhitehorn sc->sc_last_update = 0; /* Result was bad, don't cache */ 243231770Snwhitehorn return (-EINVAL); 244231770Snwhitehorn } 245208842Snwhitehorn 246208842Snwhitehorn switch (sens->type) { 247208842Snwhitehorn case SMU_TEMP_SENSOR: 248208842Snwhitehorn /* 16.16 */ 249208842Snwhitehorn value <<= 10; 250222431Snwhitehorn /* From 16.16 to 0.1 C */ 251222462Snwhitehorn value = 10*(value >> 16) + ((10*(value & 0xffff)) >> 16) + 2732; 252208842Snwhitehorn break; 253208842Snwhitehorn case SMU_VOLTAGE_SENSOR: 254208842Snwhitehorn /* 16.16 */ 255208842Snwhitehorn value <<= 4; 256208842Snwhitehorn /* Kill the .16 */ 257208842Snwhitehorn value >>= 16; 258208842Snwhitehorn break; 259208842Snwhitehorn case SMU_CURRENT_SENSOR: 260208842Snwhitehorn /* 16.16 */ 261208842Snwhitehorn value <<= 8; 262208842Snwhitehorn /* Kill the .16 */ 263208842Snwhitehorn value >>= 16; 264208842Snwhitehorn break; 265208842Snwhitehorn case SMU_POWER_SENSOR: 266208842Snwhitehorn /* Doesn't exist */ 267208842Snwhitehorn break; 268208842Snwhitehorn } 269208842Snwhitehorn 270222431Snwhitehorn return (value); 271208842Snwhitehorn} 272208842Snwhitehorn 273208842Snwhitehornstatic int 274208842Snwhitehornsmusat_sensor_sysctl(SYSCTL_HANDLER_ARGS) 275208842Snwhitehorn{ 276208842Snwhitehorn device_t dev; 277208842Snwhitehorn struct smusat_softc *sc; 278208842Snwhitehorn struct smu_sensor *sens; 279208842Snwhitehorn int value, error; 280208842Snwhitehorn 281208842Snwhitehorn dev = arg1; 282208842Snwhitehorn sc = device_get_softc(dev); 283208842Snwhitehorn sens = &sc->sc_sensors[arg2]; 284208842Snwhitehorn 285222431Snwhitehorn value = smusat_sensor_read(sens); 286222431Snwhitehorn if (value < 0) 287222431Snwhitehorn return (EBUSY); 288208842Snwhitehorn 289208842Snwhitehorn error = sysctl_handle_int(oidp, &value, 0, req); 290208842Snwhitehorn 291208842Snwhitehorn return (error); 292208842Snwhitehorn} 293208842Snwhitehorn 294