Home | History | Annotate | Line # | Download | only in dev
battery.c revision 1.5
      1  1.5   xtraeme /*	$NetBSD: battery.c,v 1.5 2007/07/16 18:24:29 xtraeme Exp $ */
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.1  macallan  * Copyright (c) 2007 Michael Lorenz
      5  1.1  macallan  * All rights reserved.
      6  1.1  macallan  *
      7  1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8  1.1  macallan  * modification, are permitted provided that the following conditions
      9  1.1  macallan  * are met:
     10  1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11  1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12  1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15  1.1  macallan  * 3. Neither the name of The NetBSD Foundation nor the names of its
     16  1.1  macallan  *    contributors may be used to endorse or promote products derived
     17  1.1  macallan  *    from this software without specific prior written permission.
     18  1.1  macallan  *
     19  1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1  macallan  */
     31  1.1  macallan 
     32  1.1  macallan #include <sys/cdefs.h>
     33  1.5   xtraeme __KERNEL_RCSID(0, "$NetBSD: battery.c,v 1.5 2007/07/16 18:24:29 xtraeme Exp $");
     34  1.1  macallan 
     35  1.1  macallan #include <sys/param.h>
     36  1.1  macallan #include <sys/systm.h>
     37  1.1  macallan #include <sys/kernel.h>
     38  1.1  macallan #include <sys/device.h>
     39  1.1  macallan #include <sys/proc.h>
     40  1.1  macallan 
     41  1.1  macallan #include <dev/sysmon/sysmonvar.h>
     42  1.1  macallan #include <dev/sysmon/sysmon_taskq.h>
     43  1.1  macallan 
     44  1.1  macallan #include <macppc/dev/pmuvar.h>
     45  1.1  macallan #include <macppc/dev/batteryvar.h>
     46  1.1  macallan #include <machine/bus.h>
     47  1.1  macallan #include "opt_battery.h"
     48  1.1  macallan 
     49  1.1  macallan #ifdef BATTERY_DEBUG
     50  1.1  macallan #define DPRINTF printf
     51  1.1  macallan #else
     52  1.1  macallan #define DPRINTF while (0) printf
     53  1.1  macallan #endif
     54  1.1  macallan 
     55  1.1  macallan #define BTYPE_COMET	1
     56  1.1  macallan #define BTYPE_HOOPER	2
     57  1.1  macallan 
     58  1.1  macallan #define BAT_CPU_TEMPERATURE	0
     59  1.1  macallan #define BAT_AC_PRESENT		1
     60  1.1  macallan #define BAT_PRESENT		2
     61  1.1  macallan #define BAT_VOLTAGE		3
     62  1.1  macallan #define BAT_CURRENT		4
     63  1.1  macallan #define BAT_MAX_CHARGE		5
     64  1.1  macallan #define BAT_CHARGE		6
     65  1.1  macallan #define BAT_CHARGING		7
     66  1.4   xtraeme #define BAT_FULL		8
     67  1.4   xtraeme #define BAT_TEMPERATURE		9
     68  1.4   xtraeme #define BAT_NSENSORS		10  /* number of sensors */
     69  1.1  macallan 
     70  1.1  macallan struct battery_softc {
     71  1.1  macallan 	struct device sc_dev;
     72  1.1  macallan 	struct pmu_ops *sc_pmu_ops;
     73  1.1  macallan 	int sc_type;
     74  1.1  macallan 
     75  1.1  macallan 	/* envsys stuff */
     76  1.1  macallan 	struct sysmon_envsys sc_sysmon;
     77  1.4   xtraeme 	envsys_data_t sc_sensor[BAT_NSENSORS];
     78  1.3  macallan 	struct sysmon_pswitch sc_sm_acpower;
     79  1.1  macallan 
     80  1.1  macallan 	/* battery status */
     81  1.1  macallan 	int sc_flags;
     82  1.3  macallan 	int sc_oflags;
     83  1.1  macallan 	int sc_voltage;
     84  1.1  macallan 	int sc_charge;
     85  1.1  macallan 	int sc_current;
     86  1.1  macallan 	int sc_time;
     87  1.1  macallan 	int sc_cpu_temp;
     88  1.1  macallan 	int sc_bat_temp;
     89  1.1  macallan 	int sc_vmax_charged;
     90  1.1  macallan 	int sc_vmax_charging;
     91  1.3  macallan 	uint32_t sc_timestamp;
     92  1.1  macallan };
     93  1.1  macallan 
     94  1.1  macallan static void battery_attach(struct device *, struct device *, void *);
     95  1.1  macallan static int battery_match(struct device *, struct cfdata *, void *);
     96  1.1  macallan static int battery_update(struct battery_softc *, int);
     97  1.1  macallan static void battery_setup_envsys(struct battery_softc *);
     98  1.4   xtraeme static int battery_gtredata(struct sysmon_envsys *, envsys_data_t *);
     99  1.3  macallan static void battery_poll(void *);
    100  1.1  macallan 
    101  1.1  macallan CFATTACH_DECL(battery, sizeof(struct battery_softc),
    102  1.1  macallan     battery_match, battery_attach, NULL, NULL);
    103  1.1  macallan 
    104  1.1  macallan static int
    105  1.1  macallan battery_match(struct device *parent, struct cfdata *cf, void *aux)
    106  1.1  macallan {
    107  1.1  macallan 	struct battery_attach_args *baa = aux;
    108  1.1  macallan 
    109  1.1  macallan 	if (baa->baa_type == BATTERY_TYPE_LEGACY)
    110  1.1  macallan 		return 1;
    111  1.1  macallan 
    112  1.1  macallan 	return 0;
    113  1.1  macallan }
    114  1.1  macallan 
    115  1.1  macallan static void
    116  1.1  macallan battery_attach(struct device *parent, struct device *self, void *aux)
    117  1.1  macallan {
    118  1.1  macallan 	struct battery_attach_args *baa = aux;
    119  1.1  macallan 	struct battery_softc *sc = (struct battery_softc *)self;
    120  1.1  macallan 	uint32_t reg;
    121  1.1  macallan 
    122  1.1  macallan 	sc->sc_pmu_ops = baa->baa_pmu_ops;
    123  1.1  macallan 	printf(": legacy battery ");
    124  1.1  macallan 
    125  1.1  macallan 	reg = in32rb(0xf3000034);
    126  1.1  macallan 	DPRINTF("reg: %08x\n", reg);
    127  1.1  macallan 	if (reg & 0x20000000) {
    128  1.1  macallan 		sc->sc_type = BTYPE_HOOPER;
    129  1.1  macallan 		sc->sc_vmax_charged = 330;
    130  1.1  macallan 		sc->sc_vmax_charging = 365;
    131  1.1  macallan 		printf("[hooper]\n");
    132  1.1  macallan 	} else {
    133  1.1  macallan 		sc->sc_type = BTYPE_COMET;
    134  1.1  macallan 		sc->sc_vmax_charged = 189;
    135  1.1  macallan 		sc->sc_vmax_charging = 213;
    136  1.1  macallan 		printf("[comet]\n");
    137  1.1  macallan 	}
    138  1.1  macallan 	battery_update(sc, 1);
    139  1.3  macallan 	/* trigger a status update */
    140  1.3  macallan 	sc->sc_oflags = ~sc->sc_flags;
    141  1.3  macallan 
    142  1.1  macallan 	battery_setup_envsys(sc);
    143  1.3  macallan 	sc->sc_pmu_ops->register_callback(sc->sc_pmu_ops->cookie, battery_poll,
    144  1.3  macallan 	    sc);
    145  1.3  macallan 
    146  1.3  macallan 	memset(&sc->sc_sm_acpower, 0, sizeof(struct sysmon_pswitch));
    147  1.3  macallan 	sc->sc_sm_acpower.smpsw_name = "AC Power";
    148  1.3  macallan 	sc->sc_sm_acpower.smpsw_type = PSWITCH_TYPE_ACADAPTER;
    149  1.3  macallan 	if (sysmon_pswitch_register(&sc->sc_sm_acpower) != 0)
    150  1.3  macallan 		printf("%s: unable to register AC power status with sysmon\n",
    151  1.3  macallan 		    sc->sc_dev.dv_xname);
    152  1.4   xtraeme 
    153  1.1  macallan }
    154  1.1  macallan 
    155  1.1  macallan static int
    156  1.1  macallan battery_update(struct battery_softc *sc, int out)
    157  1.1  macallan {
    158  1.1  macallan 	int len, vmax, pcharge, vb;
    159  1.1  macallan 	uint8_t buf[16];
    160  1.1  macallan 
    161  1.3  macallan 	if (sc->sc_timestamp == time_second)
    162  1.3  macallan 		return 0;
    163  1.3  macallan 	sc->sc_timestamp = time_second;
    164  1.3  macallan 
    165  1.1  macallan 	len = sc->sc_pmu_ops->do_command(sc->sc_pmu_ops->cookie,
    166  1.2  macallan 	    PMU_BATTERY_STATE, 0, NULL, 16, buf);
    167  1.1  macallan 	if (len != 9)
    168  1.1  macallan 		return -1;
    169  1.1  macallan 
    170  1.1  macallan 	sc->sc_flags = buf[1];
    171  1.1  macallan 
    172  1.1  macallan 	if (out) {
    173  1.1  macallan 		if (buf[1] & PMU_PWR_AC_PRESENT)
    174  1.1  macallan 			printf(" AC");
    175  1.1  macallan 		if (buf[1] & PMU_PWR_BATT_CHARGING)
    176  1.1  macallan 			printf(" charging");
    177  1.1  macallan 		if (buf[1] & PMU_PWR_BATT_PRESENT)
    178  1.1  macallan 			printf(" present");
    179  1.1  macallan 		if (buf[1] & PMU_PWR_BATT_FULL)
    180  1.1  macallan 			printf(" full");
    181  1.1  macallan 		printf("\n");
    182  1.1  macallan 	}
    183  1.1  macallan 
    184  1.1  macallan 	sc->sc_cpu_temp = buf[4];
    185  1.1  macallan 
    186  1.1  macallan 	if ((sc->sc_flags & PMU_PWR_BATT_PRESENT) == 0) {
    187  1.1  macallan 		sc->sc_voltage = 0;
    188  1.1  macallan 		sc->sc_current = 0;
    189  1.1  macallan 		sc->sc_bat_temp = 0;
    190  1.1  macallan 		sc->sc_charge = 0;
    191  1.1  macallan 		sc->sc_time = 0;
    192  1.1  macallan 		return 0;
    193  1.1  macallan 	}
    194  1.1  macallan 
    195  1.1  macallan 	vmax = sc->sc_vmax_charged;
    196  1.1  macallan 	vb = (buf[2] << 8) | buf[3];
    197  1.1  macallan 	sc->sc_voltage = (vb * 265 + 72665) / 10;
    198  1.1  macallan 	sc->sc_current = buf[6];
    199  1.1  macallan 	if ((sc->sc_flags & PMU_PWR_AC_PRESENT) == 0) {
    200  1.1  macallan 	    	if (sc->sc_current > 200)
    201  1.1  macallan 			vb += ((sc->sc_current - 200) * 15) / 100;
    202  1.1  macallan 	} else {
    203  1.1  macallan 		vmax = sc->sc_vmax_charging;
    204  1.1  macallan 	}
    205  1.1  macallan 	sc->sc_charge = (100 * vb) / vmax;
    206  1.1  macallan 	if (sc->sc_flags & PMU_PWR_PCHARGE_RESET) {
    207  1.1  macallan 		pcharge = (buf[7] << 8) | buf[8];
    208  1.1  macallan 		if (pcharge > 6500)
    209  1.1  macallan 			pcharge = 6500;
    210  1.1  macallan 		pcharge = 100 - pcharge * 100 / 6500;
    211  1.1  macallan 		if (pcharge < sc->sc_charge)
    212  1.1  macallan 			sc->sc_charge = pcharge;
    213  1.1  macallan 	}
    214  1.1  macallan 	if (sc->sc_current > 0) {
    215  1.1  macallan 		sc->sc_time = (sc->sc_charge * 16440) / sc->sc_current;
    216  1.1  macallan 	} else
    217  1.1  macallan 		sc->sc_time = 0;
    218  1.1  macallan 
    219  1.1  macallan 	sc->sc_bat_temp = buf[5];
    220  1.1  macallan 
    221  1.1  macallan 	if (out) {
    222  1.1  macallan 		printf("voltage: %d.%03d\n", sc->sc_voltage / 1000,
    223  1.1  macallan 		    sc->sc_voltage % 1000);
    224  1.1  macallan 		printf("charge:  %d%%\n", sc->sc_charge);
    225  1.1  macallan 		if (sc->sc_time > 0)
    226  1.1  macallan 			printf("time:    %d:%02d\n", sc->sc_time / 60,
    227  1.1  macallan 			    sc->sc_time % 60);
    228  1.1  macallan 	}
    229  1.1  macallan 
    230  1.1  macallan 	return 0;
    231  1.1  macallan }
    232  1.1  macallan 
    233  1.4   xtraeme #define INITDATA(index, unit, string)					\
    234  1.4   xtraeme 	sc->sc_sensor[index].sensor = index;				\
    235  1.4   xtraeme 	sc->sc_sensor[index].units = unit;     				\
    236  1.4   xtraeme 	sc->sc_sensor[index].state = ENVSYS_SVALID;			\
    237  1.4   xtraeme 	snprintf(sc->sc_sensor[index].desc,				\
    238  1.4   xtraeme 	    sizeof(sc->sc_sensor[index].desc), "%s", string);
    239  1.1  macallan 
    240  1.1  macallan static void
    241  1.1  macallan battery_setup_envsys(struct battery_softc *sc)
    242  1.1  macallan {
    243  1.1  macallan 
    244  1.1  macallan 	INITDATA(BAT_CPU_TEMPERATURE, ENVSYS_STEMP, "CPU temperature");
    245  1.1  macallan 	INITDATA(BAT_AC_PRESENT, ENVSYS_INDICATOR, "AC present");
    246  1.1  macallan 	INITDATA(BAT_PRESENT, ENVSYS_INDICATOR, "Battery present");
    247  1.1  macallan 	INITDATA(BAT_VOLTAGE, ENVSYS_SVOLTS_DC, "Battery voltage");
    248  1.1  macallan 	INITDATA(BAT_CHARGE, ENVSYS_INTEGER, "Battery charge");
    249  1.1  macallan 	INITDATA(BAT_MAX_CHARGE, ENVSYS_INTEGER, "Battery design cap");
    250  1.1  macallan 	INITDATA(BAT_CURRENT, ENVSYS_SAMPS, "Battery current");
    251  1.1  macallan 	INITDATA(BAT_TEMPERATURE, ENVSYS_STEMP, "Battery temperature");
    252  1.1  macallan 	INITDATA(BAT_CHARGING, ENVSYS_INDICATOR, "Battery charging");
    253  1.1  macallan 	INITDATA(BAT_FULL, ENVSYS_INDICATOR, "Battery full");
    254  1.1  macallan #undef INITDATA
    255  1.1  macallan 
    256  1.4   xtraeme 	sc->sc_sysmon.sme_name = sc->sc_dev.dv_xname;
    257  1.4   xtraeme 	sc->sc_sysmon.sme_sensor_data = sc->sc_sensor;
    258  1.1  macallan 	sc->sc_sysmon.sme_cookie = sc;
    259  1.1  macallan 	sc->sc_sysmon.sme_gtredata = battery_gtredata;
    260  1.1  macallan 	sc->sc_sysmon.sme_nsensors = BAT_NSENSORS;
    261  1.1  macallan 
    262  1.1  macallan 	if (sysmon_envsys_register(&sc->sc_sysmon))
    263  1.4   xtraeme 		aprint_error("%s: unable to register with sysmon\n",
    264  1.1  macallan 		    sc->sc_dev.dv_xname);
    265  1.1  macallan }
    266  1.1  macallan 
    267  1.1  macallan static int
    268  1.4   xtraeme battery_gtredata(struct sysmon_envsys *sme, envsys_data_t *edata)
    269  1.1  macallan {
    270  1.1  macallan 	struct battery_softc *sc = sme->sme_cookie;
    271  1.4   xtraeme 	int which = edata->sensor;
    272  1.1  macallan 
    273  1.1  macallan 	battery_update(sc, 0);
    274  1.1  macallan 
    275  1.4   xtraeme 	switch (which) {
    276  1.4   xtraeme 	case BAT_CPU_TEMPERATURE:
    277  1.4   xtraeme 		edata->value_cur = sc->sc_cpu_temp * 1000000 + 273150000;
    278  1.4   xtraeme 		break;
    279  1.4   xtraeme 	case BAT_AC_PRESENT:
    280  1.4   xtraeme 		edata->value_cur = (sc->sc_flags & PMU_PWR_AC_PRESENT);
    281  1.4   xtraeme 		break;
    282  1.4   xtraeme 	case BAT_VOLTAGE:
    283  1.4   xtraeme 		edata->value_cur = sc->sc_voltage * 1000;
    284  1.4   xtraeme 		break;
    285  1.4   xtraeme 	case BAT_CURRENT:
    286  1.4   xtraeme 		edata->value_cur = sc->sc_current * 1000;
    287  1.4   xtraeme 		break;
    288  1.4   xtraeme 	case BAT_CHARGE:
    289  1.4   xtraeme 		edata->value_cur = sc->sc_charge;
    290  1.4   xtraeme 		break;
    291  1.4   xtraeme 	case BAT_MAX_CHARGE:
    292  1.4   xtraeme 		edata->value_cur = 100;
    293  1.4   xtraeme 		break;
    294  1.4   xtraeme 	case BAT_TEMPERATURE:
    295  1.4   xtraeme 		edata->value_cur = sc->sc_bat_temp * 1000000 + 273150000;
    296  1.4   xtraeme 		break;
    297  1.4   xtraeme 	case BAT_CHARGING:
    298  1.4   xtraeme 		if ((sc->sc_flags & PMU_PWR_BATT_CHARGING) &&
    299  1.4   xtraeme 		    (sc->sc_flags & PMU_PWR_AC_PRESENT))
    300  1.4   xtraeme 			edata->value_cur = 1;
    301  1.4   xtraeme 		else
    302  1.4   xtraeme 			edata->value_cur = 0;
    303  1.4   xtraeme 
    304  1.4   xtraeme 		break;
    305  1.4   xtraeme 	case BAT_FULL:
    306  1.4   xtraeme 		edata->value_cur = (sc->sc_flags & PMU_PWR_BATT_FULL);
    307  1.4   xtraeme 		break;
    308  1.4   xtraeme 	}
    309  1.1  macallan 
    310  1.5   xtraeme 	edata->state = ENVSYS_SVALID;
    311  1.1  macallan 	return 0;
    312  1.1  macallan }
    313  1.3  macallan 
    314  1.3  macallan static void
    315  1.3  macallan battery_poll(void *cookie)
    316  1.3  macallan {
    317  1.3  macallan 	struct battery_softc *sc = cookie;
    318  1.3  macallan 
    319  1.3  macallan 	battery_update(sc, 0);
    320  1.3  macallan 	if ((sc->sc_flags & PMU_PWR_AC_PRESENT) == sc->sc_oflags)
    321  1.3  macallan 		return;
    322  1.3  macallan 
    323  1.3  macallan 	sc->sc_oflags = sc->sc_flags & PMU_PWR_AC_PRESENT;
    324  1.3  macallan 
    325  1.3  macallan 	sysmon_pswitch_event(&sc->sc_sm_acpower,
    326  1.3  macallan 	    sc->sc_oflags ? PSWITCH_EVENT_PRESSED :
    327  1.3  macallan 	    PSWITCH_EVENT_RELEASED);
    328  1.3  macallan }
    329