6f8905baf6
Mainly focus on files that use BSD 2-Clause license, however the tool I was using misidentified many licenses so this was mostly a manual - error prone - task. The Software Package Data Exchange (SPDX) group provides a specification to make it easier for automated tools to detect and summarize well known opensource licenses. We are gradually adopting the specification, noting that the tags are considered only advisory and do not, in any way, superceed or replace the license texts.
296 lines
7.1 KiB
C
296 lines
7.1 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
|
|
*
|
|
* Copyright (c) 2010 Nathan Whitehorn
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/module.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/cpu.h>
|
|
#include <sys/ctype.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/sysctl.h>
|
|
|
|
#include <dev/iicbus/iicbus.h>
|
|
#include <dev/iicbus/iiconf.h>
|
|
#include <dev/ofw/ofw_bus.h>
|
|
#include <dev/ofw/openfirm.h>
|
|
|
|
#include <powerpc/powermac/powermac_thermal.h>
|
|
|
|
struct smu_sensor {
|
|
struct pmac_therm therm;
|
|
device_t dev;
|
|
|
|
cell_t reg;
|
|
enum {
|
|
SMU_CURRENT_SENSOR,
|
|
SMU_VOLTAGE_SENSOR,
|
|
SMU_POWER_SENSOR,
|
|
SMU_TEMP_SENSOR
|
|
} type;
|
|
};
|
|
|
|
static int smusat_probe(device_t);
|
|
static int smusat_attach(device_t);
|
|
static int smusat_sensor_sysctl(SYSCTL_HANDLER_ARGS);
|
|
static int smusat_sensor_read(struct smu_sensor *sens);
|
|
|
|
static MALLOC_DEFINE(M_SMUSAT, "smusat", "SMU Sattelite Sensors");
|
|
|
|
static device_method_t smusat_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, smusat_probe),
|
|
DEVMETHOD(device_attach, smusat_attach),
|
|
{ 0, 0 },
|
|
};
|
|
|
|
struct smusat_softc {
|
|
struct smu_sensor *sc_sensors;
|
|
int sc_nsensors;
|
|
|
|
uint8_t sc_cache[16];
|
|
time_t sc_last_update;
|
|
};
|
|
|
|
static driver_t smusat_driver = {
|
|
"smusat",
|
|
smusat_methods,
|
|
sizeof(struct smusat_softc)
|
|
};
|
|
|
|
static devclass_t smusat_devclass;
|
|
|
|
DRIVER_MODULE(smusat, iicbus, smusat_driver, smusat_devclass, 0, 0);
|
|
|
|
static int
|
|
smusat_probe(device_t dev)
|
|
{
|
|
const char *compat = ofw_bus_get_compat(dev);
|
|
|
|
if (compat == NULL || strcmp(compat, "smu-sat") != 0)
|
|
return (ENXIO);
|
|
|
|
device_set_desc(dev, "SMU Satellite Sensors");
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
smusat_attach(device_t dev)
|
|
{
|
|
phandle_t child;
|
|
struct smu_sensor *sens;
|
|
struct smusat_softc *sc;
|
|
struct sysctl_oid *sensroot_oid;
|
|
struct sysctl_ctx_list *ctx;
|
|
char type[32];
|
|
int i;
|
|
|
|
sc = device_get_softc(dev);
|
|
sc->sc_nsensors = 0;
|
|
sc->sc_last_update = 0;
|
|
|
|
for (child = OF_child(ofw_bus_get_node(dev)); child != 0;
|
|
child = OF_peer(child))
|
|
sc->sc_nsensors++;
|
|
|
|
if (sc->sc_nsensors == 0) {
|
|
device_printf(dev, "WARNING: No sensors detected!\n");
|
|
return (-1);
|
|
}
|
|
|
|
sc->sc_sensors = malloc(sc->sc_nsensors * sizeof(struct smu_sensor),
|
|
M_SMUSAT, M_WAITOK | M_ZERO);
|
|
|
|
sens = sc->sc_sensors;
|
|
sc->sc_nsensors = 0;
|
|
|
|
ctx = device_get_sysctl_ctx(dev);
|
|
sensroot_oid = device_get_sysctl_tree(dev);
|
|
|
|
for (child = OF_child(ofw_bus_get_node(dev)); child != 0;
|
|
child = OF_peer(child)) {
|
|
char sysctl_name[40], sysctl_desc[40];
|
|
const char *units;
|
|
|
|
sens->dev = dev;
|
|
sens->reg = 0;
|
|
OF_getprop(child, "reg", &sens->reg, sizeof(sens->reg));
|
|
if (sens->reg < 0x30)
|
|
continue;
|
|
sens->reg -= 0x30;
|
|
|
|
OF_getprop(child, "zone", &sens->therm.zone, sizeof(int));
|
|
OF_getprop(child, "location", sens->therm.name,
|
|
sizeof(sens->therm.name));
|
|
|
|
OF_getprop(child, "device_type", type, sizeof(type));
|
|
|
|
if (strcmp(type, "current-sensor") == 0) {
|
|
sens->type = SMU_CURRENT_SENSOR;
|
|
units = "mA";
|
|
} else if (strcmp(type, "temp-sensor") == 0) {
|
|
sens->type = SMU_TEMP_SENSOR;
|
|
units = "C";
|
|
} else if (strcmp(type, "voltage-sensor") == 0) {
|
|
sens->type = SMU_VOLTAGE_SENSOR;
|
|
units = "mV";
|
|
} else if (strcmp(type, "power-sensor") == 0) {
|
|
sens->type = SMU_POWER_SENSOR;
|
|
units = "mW";
|
|
} else {
|
|
continue;
|
|
}
|
|
|
|
for (i = 0; i < strlen(sens->therm.name); i++) {
|
|
sysctl_name[i] = tolower(sens->therm.name[i]);
|
|
if (isspace(sysctl_name[i]))
|
|
sysctl_name[i] = '_';
|
|
}
|
|
sysctl_name[i] = 0;
|
|
|
|
sprintf(sysctl_desc,"%s (%s)", sens->therm.name, units);
|
|
SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(sensroot_oid), OID_AUTO,
|
|
sysctl_name, CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, dev,
|
|
sc->sc_nsensors, smusat_sensor_sysctl,
|
|
(sens->type == SMU_TEMP_SENSOR) ? "IK" : "I", sysctl_desc);
|
|
|
|
if (sens->type == SMU_TEMP_SENSOR) {
|
|
/* Make up some numbers */
|
|
sens->therm.target_temp = 500 + 2731; /* 50 C */
|
|
sens->therm.max_temp = 900 + 2731; /* 90 C */
|
|
sens->therm.read =
|
|
(int (*)(struct pmac_therm *))smusat_sensor_read;
|
|
pmac_thermal_sensor_register(&sens->therm);
|
|
}
|
|
|
|
sens++;
|
|
sc->sc_nsensors++;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
smusat_updatecache(device_t dev)
|
|
{
|
|
uint8_t reg = 0x3f;
|
|
uint8_t value[16];
|
|
struct smusat_softc *sc = device_get_softc(dev);
|
|
int error;
|
|
struct iic_msg msgs[2] = {
|
|
{0, IIC_M_WR | IIC_M_NOSTOP, 1, ®},
|
|
{0, IIC_M_RD, 16, value},
|
|
};
|
|
|
|
msgs[0].slave = msgs[1].slave = iicbus_get_addr(dev);
|
|
error = iicbus_transfer(dev, msgs, 2);
|
|
if (error)
|
|
return (error);
|
|
|
|
sc->sc_last_update = time_uptime;
|
|
memcpy(sc->sc_cache, value, sizeof(value));
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
smusat_sensor_read(struct smu_sensor *sens)
|
|
{
|
|
int value, error;
|
|
device_t dev;
|
|
struct smusat_softc *sc;
|
|
|
|
dev = sens->dev;
|
|
sc = device_get_softc(dev);
|
|
error = 0;
|
|
|
|
if (time_uptime - sc->sc_last_update > 1)
|
|
error = smusat_updatecache(dev);
|
|
if (error)
|
|
return (-error);
|
|
|
|
value = (sc->sc_cache[sens->reg*2] << 8) +
|
|
sc->sc_cache[sens->reg*2 + 1];
|
|
if (value == 0xffff) {
|
|
sc->sc_last_update = 0; /* Result was bad, don't cache */
|
|
return (-EINVAL);
|
|
}
|
|
|
|
switch (sens->type) {
|
|
case SMU_TEMP_SENSOR:
|
|
/* 16.16 */
|
|
value <<= 10;
|
|
/* From 16.16 to 0.1 C */
|
|
value = 10*(value >> 16) + ((10*(value & 0xffff)) >> 16) + 2731;
|
|
break;
|
|
case SMU_VOLTAGE_SENSOR:
|
|
/* 16.16 */
|
|
value <<= 4;
|
|
/* Kill the .16 */
|
|
value >>= 16;
|
|
break;
|
|
case SMU_CURRENT_SENSOR:
|
|
/* 16.16 */
|
|
value <<= 8;
|
|
/* Kill the .16 */
|
|
value >>= 16;
|
|
break;
|
|
case SMU_POWER_SENSOR:
|
|
/* Doesn't exist */
|
|
break;
|
|
}
|
|
|
|
return (value);
|
|
}
|
|
|
|
static int
|
|
smusat_sensor_sysctl(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
device_t dev;
|
|
struct smusat_softc *sc;
|
|
struct smu_sensor *sens;
|
|
int value, error;
|
|
|
|
dev = arg1;
|
|
sc = device_get_softc(dev);
|
|
sens = &sc->sc_sensors[arg2];
|
|
|
|
value = smusat_sensor_read(sens);
|
|
if (value < 0)
|
|
return (EBUSY);
|
|
|
|
error = sysctl_handle_int(oidp, &value, 0, req);
|
|
|
|
return (error);
|
|
}
|
|
|