Home | History | Annotate | Line # | Download | only in dev
tadpmu.c revision 1.4
      1  1.4  macallan /*/* $NetBSD: tadpmu.c,v 1.4 2018/10/14 05:08:39 macallan Exp $ */
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.1  macallan  * Copyright (c) 2018 Michael Lorenz <macallan (at) netbsd.org>
      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  *
     16  1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  macallan  */
     28  1.1  macallan 
     29  1.1  macallan /* a driver for the PMU found in Tadpole Wiper and possibly SPARCle laptops */
     30  1.1  macallan 
     31  1.3  macallan #include "opt_tadpmu.h"
     32  1.3  macallan #ifdef HAVE_TADPMU
     33  1.1  macallan #include <sys/param.h>
     34  1.1  macallan #include <sys/systm.h>
     35  1.1  macallan #include <sys/kernel.h>
     36  1.1  macallan #include <sys/device.h>
     37  1.1  macallan #include <sys/malloc.h>
     38  1.2  macallan #include <sys/proc.h>
     39  1.1  macallan #include <sys/bus.h>
     40  1.1  macallan #include <sys/intr.h>
     41  1.4  macallan #include <sys/kthread.h>
     42  1.4  macallan #include <sys/mutex.h>
     43  1.1  macallan 
     44  1.1  macallan #include <dev/sysmon/sysmonvar.h>
     45  1.2  macallan #include <dev/sysmon/sysmon_taskq.h>
     46  1.1  macallan 
     47  1.1  macallan #include <sparc64/dev/tadpmureg.h>
     48  1.1  macallan #include <sparc64/dev/tadpmuvar.h>
     49  1.1  macallan 
     50  1.2  macallan #ifdef TADPMU_DEBUG
     51  1.2  macallan #define DPRINTF printf
     52  1.2  macallan #else
     53  1.2  macallan #define DPRINTF while (0) printf
     54  1.2  macallan #endif
     55  1.2  macallan 
     56  1.1  macallan static bus_space_tag_t tadpmu_iot;
     57  1.1  macallan static bus_space_handle_t tadpmu_hcmd;
     58  1.1  macallan static bus_space_handle_t tadpmu_hdata;
     59  1.1  macallan static struct sysmon_envsys *tadpmu_sme;
     60  1.1  macallan static envsys_data_t tadpmu_sensors[5];
     61  1.2  macallan static uint8_t idata = 0xff;
     62  1.2  macallan static uint8_t ivalid = 0;
     63  1.4  macallan static wchan_t tadpmu, tadpmuev;
     64  1.4  macallan static struct sysmon_pswitch tadpmu_pbutton, tadpmu_lidswitch;
     65  1.4  macallan static kmutex_t tadpmu_lock;
     66  1.4  macallan static lwp_t *tadpmu_thread;
     67  1.4  macallan static int tadpmu_dying = 0;
     68  1.1  macallan 
     69  1.1  macallan static inline void
     70  1.1  macallan tadpmu_cmd(uint8_t d)
     71  1.1  macallan {
     72  1.1  macallan 	bus_space_write_1(tadpmu_iot, tadpmu_hcmd, 0, d);
     73  1.1  macallan }
     74  1.1  macallan 
     75  1.1  macallan static inline void
     76  1.1  macallan tadpmu_wdata(uint8_t d)
     77  1.1  macallan {
     78  1.1  macallan 	bus_space_write_1(tadpmu_iot, tadpmu_hdata, 0, d);
     79  1.1  macallan }
     80  1.1  macallan 
     81  1.1  macallan static inline uint8_t
     82  1.1  macallan tadpmu_status(void)
     83  1.1  macallan {
     84  1.1  macallan 	return bus_space_read_1(tadpmu_iot, tadpmu_hcmd, 0);
     85  1.1  macallan }
     86  1.1  macallan 
     87  1.1  macallan static inline uint8_t
     88  1.1  macallan tadpmu_data(void)
     89  1.1  macallan {
     90  1.1  macallan 	return bus_space_read_1(tadpmu_iot, tadpmu_hdata, 0);
     91  1.1  macallan }
     92  1.1  macallan 
     93  1.1  macallan static void
     94  1.1  macallan tadpmu_flush(void)
     95  1.1  macallan {
     96  1.1  macallan 	volatile uint8_t junk, d;
     97  1.1  macallan 	int bail = 0;
     98  1.1  macallan 
     99  1.1  macallan 	d = tadpmu_status();
    100  1.1  macallan 	while (d & STATUS_HAVE_DATA) {
    101  1.1  macallan 		junk = tadpmu_data();
    102  1.1  macallan 		__USE(junk);
    103  1.1  macallan 		delay(10);
    104  1.1  macallan 		bail++;
    105  1.1  macallan 		if (bail > 100) {
    106  1.1  macallan 			printf("%s: timeout waiting for data out to clear %2x\n",
    107  1.1  macallan 			    __func__, d);
    108  1.1  macallan 			break;
    109  1.1  macallan 		}
    110  1.1  macallan 		d = tadpmu_status();
    111  1.1  macallan 	}
    112  1.1  macallan 	bail = 0;
    113  1.1  macallan 	d = tadpmu_status();
    114  1.1  macallan 	while (d & STATUS_SEND_DATA) {
    115  1.1  macallan 		bus_space_write_1(tadpmu_iot, tadpmu_hdata, 0, 0);
    116  1.1  macallan 		delay(10);
    117  1.1  macallan 		bail++;
    118  1.1  macallan 		if (bail > 100) {
    119  1.1  macallan 			printf("%s: timeout waiting for data in to clear %02x\n",
    120  1.1  macallan 			    __func__, d);
    121  1.1  macallan 			break;
    122  1.1  macallan 		}
    123  1.1  macallan 		d = tadpmu_status();
    124  1.1  macallan 	}
    125  1.1  macallan }
    126  1.1  macallan 
    127  1.1  macallan static void
    128  1.1  macallan tadpmu_send_cmd(uint8_t cmd)
    129  1.1  macallan {
    130  1.1  macallan 	int bail = 0;
    131  1.1  macallan 	uint8_t d;
    132  1.1  macallan 
    133  1.2  macallan 	ivalid = 0;
    134  1.1  macallan 	tadpmu_cmd(cmd);
    135  1.1  macallan 
    136  1.1  macallan 	d = tadpmu_status();
    137  1.1  macallan 	while ((d & STATUS_CMD_IN_PROGRESS) == 0) {
    138  1.1  macallan 		delay(10);
    139  1.1  macallan 		bail++;
    140  1.1  macallan 		if (bail > 100) {
    141  1.1  macallan 			printf("%s: timeout waiting for command to start\n",
    142  1.1  macallan 			    __func__);
    143  1.1  macallan 			break;
    144  1.1  macallan 		}
    145  1.1  macallan 		d = tadpmu_status();
    146  1.1  macallan 	}
    147  1.1  macallan }
    148  1.1  macallan 
    149  1.1  macallan static uint8_t
    150  1.1  macallan tadpmu_recv(void)
    151  1.1  macallan {
    152  1.1  macallan 	int bail = 0;
    153  1.1  macallan 	uint8_t d;
    154  1.1  macallan 
    155  1.2  macallan 	if (cold) {
    156  1.2  macallan 		d = tadpmu_status();
    157  1.2  macallan 		while ((d & STATUS_HAVE_DATA) == 0) {
    158  1.2  macallan 			delay(10);
    159  1.2  macallan 			bail++;
    160  1.2  macallan 			if (bail > 1000) {
    161  1.2  macallan 				printf("%s: timeout waiting for data %02x\n",
    162  1.2  macallan 				    __func__, d);
    163  1.2  macallan 				break;
    164  1.2  macallan 			}
    165  1.2  macallan 			d = tadpmu_status();
    166  1.1  macallan 		}
    167  1.2  macallan 		return bus_space_read_1(tadpmu_iot, tadpmu_hdata, 0);
    168  1.2  macallan 	} else {
    169  1.2  macallan 		while (ivalid == 0)
    170  1.2  macallan 			tsleep(tadpmu, 0, "pmucmd", 1);
    171  1.2  macallan 		return idata;
    172  1.1  macallan 	}
    173  1.1  macallan }
    174  1.1  macallan 
    175  1.1  macallan static void
    176  1.1  macallan tadpmu_send(uint8_t v)
    177  1.1  macallan {
    178  1.1  macallan 	int bail = 0;
    179  1.1  macallan 	uint8_t d;
    180  1.1  macallan 
    181  1.1  macallan 	d = tadpmu_status();
    182  1.1  macallan 	while ((d & STATUS_SEND_DATA) == 0) {
    183  1.1  macallan 		delay(10);
    184  1.1  macallan 		bail++;
    185  1.1  macallan 		if (bail > 1000) {
    186  1.1  macallan 			printf("%s: timeout waiting for PMU ready %02x\n", __func__, d);
    187  1.1  macallan 			break;
    188  1.1  macallan 		}
    189  1.1  macallan 		d = tadpmu_status();
    190  1.1  macallan 	}
    191  1.1  macallan 
    192  1.1  macallan 	tadpmu_wdata(v);
    193  1.1  macallan 
    194  1.1  macallan 	while ((d & STATUS_SEND_DATA) != 0) {
    195  1.1  macallan 		delay(10);
    196  1.1  macallan 		bail++;
    197  1.1  macallan 		if (bail > 1000) {
    198  1.1  macallan 			printf("%s: timeout waiting for accept data %02x\n", __func__, d);
    199  1.1  macallan 			break;
    200  1.1  macallan 		}
    201  1.1  macallan 		d = tadpmu_status();
    202  1.1  macallan 	}
    203  1.1  macallan }
    204  1.1  macallan 
    205  1.1  macallan static void
    206  1.1  macallan tadpmu_sensors_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
    207  1.1  macallan {
    208  1.1  macallan 	int res;
    209  1.1  macallan 	if (edata->private > 0) {
    210  1.4  macallan 		mutex_enter(&tadpmu_lock);
    211  1.1  macallan 		tadpmu_flush();
    212  1.1  macallan 		tadpmu_send_cmd(edata->private);
    213  1.1  macallan 		res = tadpmu_recv();
    214  1.4  macallan 		mutex_exit(&tadpmu_lock);
    215  1.1  macallan 		if (edata->units == ENVSYS_STEMP) {
    216  1.1  macallan 			edata->value_cur = res * 1000000 + 273150000;
    217  1.1  macallan 		} else {
    218  1.1  macallan 			edata->value_cur = res;
    219  1.1  macallan 		}
    220  1.1  macallan 		edata->state = ENVSYS_SVALID;
    221  1.1  macallan 	} else {
    222  1.1  macallan 		edata->state = ENVSYS_SINVALID;
    223  1.1  macallan 	}
    224  1.1  macallan }
    225  1.1  macallan 
    226  1.4  macallan static void
    227  1.4  macallan tadpmu_events(void *cookie)
    228  1.4  macallan {
    229  1.4  macallan 	uint8_t res, ores = 0;
    230  1.4  macallan 	while (!tadpmu_dying) {
    231  1.4  macallan 		mutex_enter(&tadpmu_lock);
    232  1.4  macallan 		tadpmu_flush();
    233  1.4  macallan 		tadpmu_send_cmd(CMD_READ_GENSTAT);
    234  1.4  macallan 		res = tadpmu_recv();
    235  1.4  macallan 		mutex_exit(&tadpmu_lock);
    236  1.4  macallan 		res &= GENSTAT_LID_CLOSED;
    237  1.4  macallan 		if (res != ores) {
    238  1.4  macallan 			ores = res;
    239  1.4  macallan 			sysmon_pswitch_event(&tadpmu_lidswitch,
    240  1.4  macallan 				    (res & GENSTAT_LID_CLOSED) ?
    241  1.4  macallan 				        PSWITCH_EVENT_PRESSED :
    242  1.4  macallan 				        PSWITCH_EVENT_RELEASED);
    243  1.4  macallan 		}
    244  1.4  macallan 		tsleep(tadpmuev, 0, "tadpmuev", hz);
    245  1.4  macallan 	}
    246  1.4  macallan 	kthread_exit(0);
    247  1.4  macallan }
    248  1.4  macallan 
    249  1.4  macallan 
    250  1.2  macallan int
    251  1.2  macallan tadpmu_intr(void *cookie)
    252  1.2  macallan {
    253  1.2  macallan 	uint8_t s = tadpmu_status(), d;
    254  1.2  macallan 	if (s & STATUS_INTR) {
    255  1.2  macallan 		/* interrupt message */
    256  1.2  macallan 		d = tadpmu_data();
    257  1.2  macallan 		DPRINTF("status change %02x\n", d);
    258  1.2  macallan 		switch (d) {
    259  1.2  macallan 			case TADPMU_POWERBUTTON:
    260  1.2  macallan 				sysmon_pswitch_event(&tadpmu_pbutton,
    261  1.2  macallan 				    PSWITCH_EVENT_PRESSED);
    262  1.2  macallan 				break;
    263  1.2  macallan 			case TADPMU_LID:
    264  1.2  macallan 				/* read genstat and report lid */
    265  1.4  macallan 				wakeup(tadpmuev);
    266  1.2  macallan 				break;
    267  1.2  macallan 		}
    268  1.2  macallan 	}
    269  1.2  macallan 	s = tadpmu_status();
    270  1.2  macallan 	if (s & STATUS_HAVE_DATA) {
    271  1.2  macallan 		idata = tadpmu_data();
    272  1.2  macallan 		ivalid = 1;
    273  1.2  macallan 		wakeup(tadpmu);
    274  1.2  macallan 		DPRINTF("%s data %02x\n", __func__, idata);
    275  1.2  macallan 	}
    276  1.2  macallan 
    277  1.2  macallan 	return 1;
    278  1.2  macallan }
    279  1.2  macallan 
    280  1.1  macallan int
    281  1.1  macallan tadpmu_init(bus_space_tag_t t, bus_space_handle_t hcmd, bus_space_handle_t hdata)
    282  1.1  macallan {
    283  1.1  macallan 	int ver;
    284  1.1  macallan 
    285  1.1  macallan 	tadpmu_iot = t;
    286  1.1  macallan 	tadpmu_hcmd = hcmd;
    287  1.1  macallan 	tadpmu_hdata = hdata;
    288  1.1  macallan 
    289  1.1  macallan 	tadpmu_flush();
    290  1.1  macallan 	delay(1000);
    291  1.1  macallan 
    292  1.1  macallan 	tadpmu_send_cmd(CMD_READ_VERSION);
    293  1.1  macallan 	ver = tadpmu_recv();
    294  1.1  macallan 	printf("Tadpole PMU Version 1.%d\n", ver);
    295  1.1  macallan 
    296  1.1  macallan 	tadpmu_send_cmd(CMD_SET_OPMODE);
    297  1.1  macallan 	tadpmu_send(0x75);
    298  1.1  macallan 
    299  1.1  macallan 	tadpmu_send_cmd(CMD_READ_SYSTEMP);
    300  1.1  macallan 	ver = tadpmu_recv();
    301  1.1  macallan 	printf("Temperature %d\n", ver);
    302  1.1  macallan 
    303  1.1  macallan 	tadpmu_send_cmd(CMD_READ_VBATT);
    304  1.1  macallan 	ver = tadpmu_recv();
    305  1.1  macallan 	printf("Battery voltage %d\n", ver);
    306  1.1  macallan 
    307  1.1  macallan 	tadpmu_send_cmd(CMD_READ_GENSTAT);
    308  1.1  macallan 	ver = tadpmu_recv();
    309  1.1  macallan 	printf("status %02x\n", ver);
    310  1.1  macallan 
    311  1.4  macallan 	mutex_init(&tadpmu_lock, MUTEX_DEFAULT, IPL_NONE);
    312  1.4  macallan 
    313  1.1  macallan 	tadpmu_sme = sysmon_envsys_create();
    314  1.1  macallan 	tadpmu_sme->sme_name = "tadpmu";
    315  1.1  macallan 	tadpmu_sme->sme_cookie = NULL;
    316  1.1  macallan 	tadpmu_sme->sme_refresh = tadpmu_sensors_refresh;
    317  1.1  macallan 
    318  1.1  macallan 	tadpmu_sensors[0].units = ENVSYS_STEMP;
    319  1.1  macallan 	tadpmu_sensors[0].private = CMD_READ_SYSTEMP;
    320  1.1  macallan 	strcpy(tadpmu_sensors[0].desc, "systemp");
    321  1.1  macallan 	sysmon_envsys_sensor_attach(tadpmu_sme, &tadpmu_sensors[0]);
    322  1.1  macallan #ifdef TADPMU_DEBUG
    323  1.1  macallan 	tadpmu_sensors[1].units = ENVSYS_INTEGER;
    324  1.1  macallan 	tadpmu_sensors[1].private = 0x17;
    325  1.1  macallan 	strcpy(tadpmu_sensors[1].desc, "reg 17");
    326  1.1  macallan 	sysmon_envsys_sensor_attach(tadpmu_sme, &tadpmu_sensors[1]);
    327  1.1  macallan 	tadpmu_sensors[2].units = ENVSYS_INTEGER;
    328  1.1  macallan 	tadpmu_sensors[2].private = 0x18;
    329  1.1  macallan 	strcpy(tadpmu_sensors[2].desc, "reg 18");
    330  1.1  macallan 	sysmon_envsys_sensor_attach(tadpmu_sme, &tadpmu_sensors[2]);
    331  1.1  macallan 	tadpmu_sensors[3].units = ENVSYS_INTEGER;
    332  1.1  macallan 	tadpmu_sensors[3].private = CMD_READ_GENSTAT;
    333  1.1  macallan 	strcpy(tadpmu_sensors[3].desc, "genstat");
    334  1.1  macallan 	sysmon_envsys_sensor_attach(tadpmu_sme, &tadpmu_sensors[3]);
    335  1.1  macallan #if 0
    336  1.1  macallan 	tadpmu_sensors[4].units = ENVSYS_INTEGER;
    337  1.1  macallan 	tadpmu_sensors[4].private = CMD_READ_VBATT;
    338  1.1  macallan 	strcpy(tadpmu_sensors[4].desc, "Vbatt");
    339  1.1  macallan 	sysmon_envsys_sensor_attach(tadpmu_sme, &tadpmu_sensors[4]);
    340  1.1  macallan #endif
    341  1.1  macallan #endif
    342  1.1  macallan 	sysmon_envsys_register(tadpmu_sme);
    343  1.1  macallan 
    344  1.2  macallan 	sysmon_task_queue_init();
    345  1.2  macallan 	memset(&tadpmu_pbutton, 0, sizeof(struct sysmon_pswitch));
    346  1.4  macallan 	tadpmu_pbutton.smpsw_name = "power";
    347  1.2  macallan 	tadpmu_pbutton.smpsw_type = PSWITCH_TYPE_POWER;
    348  1.2  macallan 	if (sysmon_pswitch_register(&tadpmu_pbutton) != 0)
    349  1.2  macallan 		aprint_error(
    350  1.2  macallan 		    "unable to register power button with sysmon\n");
    351  1.2  macallan 
    352  1.4  macallan 	tadpmu_lidswitch.smpsw_name = "lid";
    353  1.4  macallan 	tadpmu_lidswitch.smpsw_type = PSWITCH_TYPE_LID;
    354  1.4  macallan 	if (sysmon_pswitch_register(&tadpmu_lidswitch) != 0)
    355  1.4  macallan 		aprint_error(
    356  1.4  macallan 		    "unable to register lid switch with sysmon\n");
    357  1.4  macallan 
    358  1.4  macallan 	kthread_create(PRI_NONE, 0, curcpu(), tadpmu_events, NULL,
    359  1.4  macallan 	    &tadpmu_thread, "tadpmu_events");
    360  1.4  macallan 
    361  1.1  macallan 	return 0;
    362  1.1  macallan }
    363  1.3  macallan #endif /* HAVE_TADPMU */
    364