Training courses

Kernel and Embedded Linux

Bootlin training courses

Embedded Linux, kernel,
Yocto Project, Buildroot, real-time,
graphics, boot time, debugging...

Bootlin logo

Elixir Cross Referencer

/* $NetBSD: ibmhawk.c,v 1.9 2020/05/15 19:28:09 maxv Exp $ */

/*-
 * Copyright (c) 2011 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Juergen Hannken-Illjes.
 *
 * 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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``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 FOUNDATION OR CONTRIBUTORS
 * 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/systm.h>
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/bswap.h>

#include <dev/sysmon/sysmonvar.h>
#include <dev/i2c/i2cvar.h>
#include <dev/i2c/ibmhawkreg.h>
#include <dev/i2c/ibmhawkvar.h>

#if !defined(IBMHAWK_DEBUG)	/* Set to 2 for verbose debug. */
#if defined(DEBUG)
#define IBMHAWK_DEBUG	1
#else
#define IBMHAWK_DEBUG	0
#endif
#endif

/*
 * Known sensors.
 */
static struct ibmhawk_sensordesc {
	const char *desc;
	uint32_t units;
	int offset;
} ibmhawk_sensors[] = {
	{ "Ambient temperature", ENVSYS_STEMP,     IBMHAWK_T_AMBIENT   },
	{ "CPU 1 temperature",   ENVSYS_STEMP,     IBMHAWK_T_CPU       },
	{ "CPU 2 temperature",   ENVSYS_STEMP,     IBMHAWK_T_CPU+1     },
	{ "12 Voltage sensor",   ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE   },
	{ "5 Voltage sensor",    ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE+1 },
	{ "3.3 Voltage sensor",  ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE+2 },
	{ "2.5 Voltage sensor",  ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE+3 },
	{ "1.5 Voltage sensor",  ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE+4 },
	{ "1.25 Voltage sensor", ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE+5 },
	{ "VRM 1",               ENVSYS_SVOLTS_DC, IBMHAWK_V_VOLTAGE+6 },
	{ "Fan 1",               ENVSYS_SFANRPM,   IBMHAWK_F_FAN       },
	{ "Fan 2",               ENVSYS_SFANRPM,   IBMHAWK_F_FAN+1     },
	{ "Fan 3",               ENVSYS_SFANRPM,   IBMHAWK_F_FAN+2     },
	{ "Fan 4",               ENVSYS_SFANRPM,   IBMHAWK_F_FAN+3     },
	{ "Fan 5",               ENVSYS_SFANRPM,   IBMHAWK_F_FAN+4     },
	{ "Fan 6",               ENVSYS_SFANRPM,   IBMHAWK_F_FAN+5     },
};
static const int ibmhawk_num_sensors =
    (sizeof(ibmhawk_sensors)/sizeof(ibmhawk_sensors[0]));

static int ibmhawk_match(device_t, cfdata_t, void *);
static void ibmhawk_attach(device_t, device_t, void *);
static int ibmhawk_detach(device_t, int);
static uint8_t ibmhawk_cksum(uint8_t *);
static int ibmhawk_request(struct ibmhawk_softc *,
    uint8_t, ibmhawk_response_t *);
static uint32_t ibmhawk_normalize(int, uint32_t);
static void ibmhawk_set(struct ibmhawk_softc *, int, int, bool, bool);
static void ibmhawk_refreshall(struct ibmhawk_softc *, bool);
static void ibmhawk_refresh(struct sysmon_envsys *, envsys_data_t *);
static void ibmhawk_get_limits(struct sysmon_envsys *, envsys_data_t *,
    sysmon_envsys_lim_t *, uint32_t *);

CFATTACH_DECL_NEW(ibmhawk, sizeof(struct ibmhawk_softc),
    ibmhawk_match, ibmhawk_attach, ibmhawk_detach, NULL);

static int
ibmhawk_match(device_t parent, cfdata_t match, void *aux)
{
	struct i2c_attach_args *ia = aux;
	ibmhawk_response_t resp;
	static struct ibmhawk_softc sc;

	/* There is an expected address for this device: */
	if (ia->ia_addr != 0x37)
		return 0;

	/* XXX Probe is potentially destructive. */

	sc.sc_tag = ia->ia_tag;
	sc.sc_addr = ia->ia_addr;
	if (ibmhawk_request(&sc, IHR_EQUIP, &resp))
		return 0;

	return I2C_MATCH_ADDRESS_AND_PROBE;
}

static void
ibmhawk_attach(device_t parent, device_t self, void *aux)
{
	struct ibmhawk_softc *sc = device_private(self);
	struct i2c_attach_args *ia = aux;
	ibmhawk_response_t resp;
	int i;

	sc->sc_dev = self;
	sc->sc_tag = ia->ia_tag;
	sc->sc_addr = ia->ia_addr;

	if (!pmf_device_register(self, NULL, NULL))
		aprint_error_dev(self, "couldn't establish power handler\n");
	if (ibmhawk_request(sc, IHR_NAME, &resp)) {
		aprint_error_dev(self, "communication failed\n");
		return;
	}
	aprint_normal(": IBM Hawk \"%.16s\"\n", resp.ihr_name);
	if (ibmhawk_request(sc, IHR_EQUIP, &resp)) {
		aprint_error_dev(sc->sc_dev, "equip query failed\n");
		return;
	}
	sc->sc_numcpus = uimin(resp.ihr_numcpus, IBMHAWK_MAX_CPU);
	sc->sc_numfans = uimin(resp.ihr_numfans, IBMHAWK_MAX_FAN);
#if IBMHAWK_DEBUG > 0
	aprint_normal_dev(sc->sc_dev, "monitoring %d/%d cpu(s) %d/%d fan(s)\n",
	    sc->sc_numcpus, resp.ihr_numcpus, sc->sc_numfans, resp.ihr_numfans);
#endif
	/* Request and set sensor thresholds. */
	if (ibmhawk_request(sc, IHR_TEMP_THR, &resp)) {
		aprint_error_dev(sc->sc_dev, "temp threshold query failed\n");
		return;
	}
	for (i = 0; i < sc->sc_numcpus; i++)
		sc->sc_sensordata[IBMHAWK_T_CPU+i].ihs_warnmax =
		    resp.ihr_t_warn_thr;
	if (ibmhawk_request(sc, IHR_VOLT_THR, &resp)) {
		aprint_error_dev(sc->sc_dev, "volt threshold query failed\n");
		return;
	}
	for (i = 0; i < IBMHAWK_MAX_VOLTAGE; i++) {
		sc->sc_sensordata[IBMHAWK_V_VOLTAGE+i].ihs_warnmax =
		    bswap16(resp.ihr_v_voltage_thr[i*2]);
		sc->sc_sensordata[IBMHAWK_V_VOLTAGE+i].ihs_warnmin =
		    bswap16(resp.ihr_v_voltage_thr[i*2+1]);
	}
	if ((sc->sc_sme = sysmon_envsys_create()) == NULL) {
		aprint_error_dev(sc->sc_dev, "sysmon_envsys_create failed\n");
		return;
	}
	ibmhawk_refreshall(sc, true);
	sc->sc_sme->sme_name = device_xname(sc->sc_dev);
	sc->sc_sme->sme_cookie = sc;
	sc->sc_sme->sme_refresh = ibmhawk_refresh;
	sc->sc_sme->sme_get_limits = ibmhawk_get_limits;
	if (sysmon_envsys_register(sc->sc_sme)) {
		aprint_error_dev(sc->sc_dev, "sysmon_envsys_register failed\n");
		sysmon_envsys_destroy(sc->sc_sme);
		sc->sc_sme = NULL;
		return;
	}
}

static int
ibmhawk_detach(device_t self, int flags)
{
	struct ibmhawk_softc *sc = device_private(self);

	if (sc->sc_sme)
		sysmon_envsys_destroy(sc->sc_sme);
	return 0;
}


/*
 * Compute the message checksum.
 */
static uint8_t
ibmhawk_cksum(uint8_t *buf)
{
	int len = *buf++;
	int s = 0;

	while (--len > 0)
		s += *buf++;
	return -s;
}

/*
 * Request information from the management processor.
 * The response will be zeroed on error.
 * Request and response have the form <n> <data 0:n-2> <checksum>.
 */
static int
ibmhawk_request(struct ibmhawk_softc *sc, uint8_t request,
    ibmhawk_response_t *response)
{
	int i, error, retries;
	uint8_t buf[sizeof(ibmhawk_response_t)+3], dummy;

	error = EIO;	/* Fail until we have a valid response. */
	retries = 0;

	if (iic_acquire_bus(sc->sc_tag, 0))
		return error;

again:
	memset(response, 0, sizeof(*response));

	/* Build and send the request. */
	buf[0] = 2;
	buf[1] = request;
	buf[2] = ibmhawk_cksum(buf);
#if IBMHAWK_DEBUG > 1
	printf("[");
	for (i = 0; i < 3; i++)
		printf(" %02x", buf[i]);
	printf(" ]");
#endif
	for (i = 0; i < 3; i++)
		if (iic_smbus_send_byte(sc->sc_tag, sc->sc_addr, buf[i], 0))
			goto bad;

	/* Receive and check the response. */
#if IBMHAWK_DEBUG > 1
	printf(" => [");
#endif
	if (iic_smbus_receive_byte(sc->sc_tag, sc->sc_addr, &buf[0], 0))
		goto bad;
	if (buf[0] == 0 || buf[0] == 255)
		goto bad;
	for (i = 1; i < buf[0]+1; i++)
		if (iic_smbus_receive_byte(sc->sc_tag, sc->sc_addr,
		    (i < sizeof buf ? &buf[i] : &dummy), 0))
			goto bad;
	if (buf[0] >= sizeof(buf) || buf[1] != request ||
	    ibmhawk_cksum(buf) != buf[buf[0]])
		goto bad;
	if (buf[0] > 2)
		memcpy(response, buf+2, buf[0]-2);
	error = 0;

bad:
#if IBMHAWK_DEBUG > 1
	for (i = 0; i < uimin(buf[0]+1, sizeof buf); i++)
		printf(" %02x", buf[i]);
	printf(" ] => %d\n", error);
#endif
	if (error != 0 && retries++ < 3)
		goto again;

	iic_release_bus(sc->sc_tag, 0);
	return error;
}

static uint32_t
ibmhawk_normalize(int value, uint32_t units)
{

	if (value == 0)
		return 0;

	switch (units) {
	case ENVSYS_STEMP:
		return 273150000+1000000*value;
	case ENVSYS_SVOLTS_DC:
		return 10000*value;
	default:
		return value;
	}
}

static void
ibmhawk_set(struct ibmhawk_softc *sc,
    int offset, int value, bool valid, bool create)
{
	int i;
	struct ibmhawk_sensordesc *sp;
	struct ibmhawk_sensordata *sd;
	envsys_data_t *dp;

	sd = &sc->sc_sensordata[offset];
	dp = &sd->ihs_edata;
	sp = NULL;
	if (create) {
		for (i = 0; i < ibmhawk_num_sensors; i++)
			if (ibmhawk_sensors[i].offset == offset) {
				sp = ibmhawk_sensors+i;
				break;
			}
		if (sp == NULL) {
#if IBMHAWK_DEBUG > 0
			aprint_error_dev(sc->sc_dev,
			    "offset %d: no sensor found\n", offset);
#endif
			return;
		}
		strlcpy(dp->desc, sp->desc, sizeof(dp->desc));
		dp->units = sp->units;
		if (sd->ihs_warnmin != 0 || sd->ihs_warnmax != 0) {
			sd->ihs_warnmin =
			    ibmhawk_normalize(sd->ihs_warnmin, dp->units);
			sd->ihs_warnmax =
			    ibmhawk_normalize(sd->ihs_warnmax, dp->units);
			dp->flags |= ENVSYS_FMONLIMITS;
		}
	}

	if (valid) {
		dp->value_cur = ibmhawk_normalize(value, dp->units);
		dp->state = ENVSYS_SVALID;
	} else
		dp->state = ENVSYS_SINVALID;

	if (create) {
		if (sysmon_envsys_sensor_attach(sc->sc_sme, dp))
			aprint_error_dev(sc->sc_dev,
			    "failed to attach \"%s\"\n", dp->desc);
	}
}

static void
ibmhawk_refreshall(struct ibmhawk_softc *sc, bool create)
{
	int i;
	bool valid;
	ibmhawk_response_t resp;

	valid = (ibmhawk_request(sc, IHR_TEMP, &resp) == 0);
	ibmhawk_set(sc, IBMHAWK_T_AMBIENT, resp.ihr_t_ambient, valid, create);
	for (i = 0; i < sc->sc_numcpus; i++)
		ibmhawk_set(sc, IBMHAWK_T_CPU+i,
		    resp.ihr_t_cpu[i], valid, create);

	valid = (ibmhawk_request(sc, IHR_FANRPM, &resp) == 0);
	for (i = 0; i < sc->sc_numfans; i++)
		ibmhawk_set(sc, IBMHAWK_F_FAN+i,
		    bswap16(resp.ihr_fanrpm[i]), valid, create);

	valid = (ibmhawk_request(sc, IHR_VOLT, &resp) == 0);
	for (i = 0; i < IBMHAWK_MAX_VOLTAGE; i++)
		ibmhawk_set(sc, IBMHAWK_V_VOLTAGE+i,
		    bswap16(resp.ihr_v_voltage[i]), valid, create);
}

static void
ibmhawk_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
{
	struct ibmhawk_softc *sc = sme->sme_cookie;

	/* No more than two refreshes per second. */
	if (getticks() - sc->sc_refresh < hz/2)
		return;
#if IBMHAWK_DEBUG > 1
	aprint_normal_dev(sc->sc_dev, "refresh \"%s\" delta %d\n",
	    edata->desc, getticks() - sc->sc_refresh);
#endif
	sc->sc_refresh = getticks();
	ibmhawk_refreshall(sc, false);
}

static void
ibmhawk_get_limits(struct sysmon_envsys *sme, envsys_data_t *edata,
    sysmon_envsys_lim_t *limits, uint32_t *props)
{
	struct ibmhawk_sensordata *sd = (struct ibmhawk_sensordata *)edata;

	if (sd->ihs_warnmin != 0) {
		limits->sel_warnmin = sd->ihs_warnmin;
		*props |= PROP_WARNMIN;
	}
	if (sd->ihs_warnmax != 0) {
		limits->sel_warnmax = sd->ihs_warnmax;
		*props |= PROP_WARNMAX;
	}
}