Home | History | Annotate | Line # | Download | only in i2c
axppmic.c revision 1.4
      1  1.4  jmcneill /* $NetBSD: axppmic.c,v 1.4 2018/05/05 10:56:40 jmcneill Exp $ */
      2  1.1  jmcneill 
      3  1.1  jmcneill /*-
      4  1.1  jmcneill  * Copyright (c) 2014-2018 Jared McNeill <jmcneill (at) invisible.ca>
      5  1.1  jmcneill  * All rights reserved.
      6  1.1  jmcneill  *
      7  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8  1.1  jmcneill  * modification, are permitted provided that the following conditions
      9  1.1  jmcneill  * are met:
     10  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15  1.1  jmcneill  *
     16  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  jmcneill  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  jmcneill  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  jmcneill  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  jmcneill  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  jmcneill  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  jmcneill  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  jmcneill  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  jmcneill  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  jmcneill  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  jmcneill  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  jmcneill  */
     28  1.1  jmcneill 
     29  1.1  jmcneill #include <sys/cdefs.h>
     30  1.4  jmcneill __KERNEL_RCSID(0, "$NetBSD: axppmic.c,v 1.4 2018/05/05 10:56:40 jmcneill Exp $");
     31  1.1  jmcneill 
     32  1.1  jmcneill #include <sys/param.h>
     33  1.1  jmcneill #include <sys/systm.h>
     34  1.1  jmcneill #include <sys/kernel.h>
     35  1.1  jmcneill #include <sys/device.h>
     36  1.1  jmcneill #include <sys/conf.h>
     37  1.1  jmcneill #include <sys/bus.h>
     38  1.1  jmcneill #include <sys/kmem.h>
     39  1.1  jmcneill 
     40  1.1  jmcneill #include <dev/i2c/i2cvar.h>
     41  1.1  jmcneill 
     42  1.1  jmcneill #include <dev/sysmon/sysmonvar.h>
     43  1.1  jmcneill #include <dev/sysmon/sysmon_taskq.h>
     44  1.1  jmcneill 
     45  1.1  jmcneill #include <dev/fdt/fdtvar.h>
     46  1.1  jmcneill 
     47  1.3  jmcneill #define	AXP_POWER_SOURCE_REG	0x00
     48  1.3  jmcneill #define	 AXP_POWER_SOURCE_ACIN_PRESENT	__BIT(7)
     49  1.3  jmcneill #define	 AXP_POWER_SOURCE_VBUS_PRESENT	__BIT(5)
     50  1.3  jmcneill 
     51  1.2  jmcneill #define	AXP_POWER_MODE_REG	0x01
     52  1.2  jmcneill #define	 AXP_POWER_MODE_BATT_VALID	__BIT(4)
     53  1.2  jmcneill #define	 AXP_POWER_MODE_BATT_PRESENT	__BIT(5)
     54  1.2  jmcneill #define	 AXP_POWER_MODE_BATT_CHARGING	__BIT(6)
     55  1.2  jmcneill 
     56  1.1  jmcneill #define AXP_POWER_DISABLE_REG	0x32
     57  1.1  jmcneill #define	 AXP_POWER_DISABLE_CTRL	__BIT(7)
     58  1.1  jmcneill 
     59  1.1  jmcneill #define AXP_IRQ_ENABLE_REG(n)	(0x40 + (n) - 1)
     60  1.1  jmcneill #define	 AXP_IRQ2_POKSIRQ	__BIT(1)
     61  1.1  jmcneill #define AXP_IRQ_STATUS_REG(n)	(0x48 + (n) - 1)
     62  1.1  jmcneill 
     63  1.2  jmcneill #define	AXP_FUEL_GAUGE_CTRL_REG	0xb8
     64  1.2  jmcneill #define	 AXP_FUEL_GAUGE_CTRL_EN	__BIT(7)
     65  1.2  jmcneill #define	AXP_BATT_CAP_REG	0xb9
     66  1.2  jmcneill #define	 AXP_BATT_CAP_VALID	__BIT(7)
     67  1.2  jmcneill #define	 AXP_BATT_CAP_PERCENT	__BITS(6,0)
     68  1.2  jmcneill 
     69  1.2  jmcneill #define	AXP_BATT_CAP_WARN_REG	0xe6
     70  1.2  jmcneill #define	 AXP_BATT_CAP_WARN_LV1	__BITS(7,4)
     71  1.2  jmcneill #define	 AXP_BATT_CAP_WARN_LV2	__BITS(3,0)
     72  1.2  jmcneill 
     73  1.1  jmcneill struct axppmic_ctrl {
     74  1.1  jmcneill 	device_t	c_dev;
     75  1.1  jmcneill 
     76  1.1  jmcneill 	const char *	c_name;
     77  1.1  jmcneill 	u_int		c_min;
     78  1.1  jmcneill 	u_int		c_max;
     79  1.1  jmcneill 	u_int		c_step1;
     80  1.1  jmcneill 	u_int		c_step1cnt;
     81  1.1  jmcneill 	u_int		c_step2;
     82  1.1  jmcneill 	u_int		c_step2cnt;
     83  1.1  jmcneill 
     84  1.1  jmcneill 	uint8_t		c_enable_reg;
     85  1.1  jmcneill 	uint8_t		c_enable_mask;
     86  1.1  jmcneill 
     87  1.1  jmcneill 	uint8_t		c_voltage_reg;
     88  1.1  jmcneill 	uint8_t		c_voltage_mask;
     89  1.1  jmcneill };
     90  1.1  jmcneill 
     91  1.1  jmcneill #define AXP_CTRL(name, min, max, step, ereg, emask, vreg, vmask)	\
     92  1.1  jmcneill 	{ .c_name = (name), .c_min = (min), .c_max = (max),		\
     93  1.1  jmcneill 	  .c_step1 = (step), .c_step1cnt = (((max) - (min)) / (step)) + 1, \
     94  1.1  jmcneill 	  .c_step2 = 0, .c_step2cnt = 0,				\
     95  1.1  jmcneill 	  .c_enable_reg = (ereg), .c_enable_mask = (emask),		\
     96  1.1  jmcneill 	  .c_voltage_reg = (vreg), .c_voltage_mask = (vmask) }
     97  1.1  jmcneill 
     98  1.1  jmcneill #define AXP_CTRL2(name, min, max, step1, step1cnt, step2, step2cnt, ereg, emask, vreg, vmask) \
     99  1.1  jmcneill 	{ .c_name = (name), .c_min = (min), .c_max = (max),		\
    100  1.1  jmcneill 	  .c_step1 = (step1), .c_step1cnt = (step1cnt),			\
    101  1.1  jmcneill 	  .c_step2 = (step2), .c_step2cnt = (step2cnt),			\
    102  1.1  jmcneill 	  .c_enable_reg = (ereg), .c_enable_mask = (emask),		\
    103  1.1  jmcneill 	  .c_voltage_reg = (vreg), .c_voltage_mask = (vmask) }
    104  1.1  jmcneill 
    105  1.1  jmcneill static const struct axppmic_ctrl axp803_ctrls[] = {
    106  1.1  jmcneill 	AXP_CTRL("dldo1", 700, 3300, 100,
    107  1.1  jmcneill 		0x12, __BIT(3), 0x15, __BITS(4,0)),
    108  1.1  jmcneill 	AXP_CTRL2("dldo2", 700, 4200, 100, 28, 200, 4,
    109  1.1  jmcneill 		0x12, __BIT(4), 0x16, __BITS(4,0)),
    110  1.1  jmcneill 	AXP_CTRL("dldo3", 700, 3300, 100,
    111  1.1  jmcneill 	 	0x12, __BIT(5), 0x17, __BITS(4,0)),
    112  1.1  jmcneill 	AXP_CTRL("dldo4", 700, 3300, 100,
    113  1.1  jmcneill 		0x12, __BIT(6), 0x18, __BITS(4,0)),
    114  1.1  jmcneill 	AXP_CTRL("eldo1", 700, 1900, 50,
    115  1.1  jmcneill 		0x12, __BIT(0), 0x19, __BITS(4,0)),
    116  1.1  jmcneill 	AXP_CTRL("eldo2", 700, 1900, 50,
    117  1.1  jmcneill 		0x12, __BIT(1), 0x1a, __BITS(4,0)),
    118  1.1  jmcneill 	AXP_CTRL("eldo3", 700, 1900, 50,
    119  1.1  jmcneill 		0x12, __BIT(2), 0x1b, __BITS(4,0)),
    120  1.1  jmcneill 	AXP_CTRL("fldo1", 700, 1450, 50,
    121  1.1  jmcneill 		0x13, __BIT(2), 0x1c, __BITS(3,0)),
    122  1.1  jmcneill 	AXP_CTRL("fldo2", 700, 1450, 50,
    123  1.1  jmcneill 		0x13, __BIT(3), 0x1d, __BITS(3,0)),
    124  1.1  jmcneill 	AXP_CTRL("dcdc1", 1600, 3400, 100,
    125  1.1  jmcneill 		0x10, __BIT(0), 0x20, __BITS(4,0)),
    126  1.1  jmcneill 	AXP_CTRL2("dcdc2", 500, 1300, 10, 71, 20, 5,
    127  1.1  jmcneill 		0x10, __BIT(1), 0x21, __BITS(6,0)),
    128  1.1  jmcneill 	AXP_CTRL2("dcdc3", 500, 1300, 10, 71, 20, 5,
    129  1.1  jmcneill 		0x10, __BIT(2), 0x22, __BITS(6,0)),
    130  1.1  jmcneill 	AXP_CTRL2("dcdc4", 500, 1300, 10, 71, 20, 5,
    131  1.1  jmcneill 		0x10, __BIT(3), 0x23, __BITS(6,0)),
    132  1.1  jmcneill 	AXP_CTRL2("dcdc5", 800, 1840, 10, 33, 20, 36,
    133  1.1  jmcneill 		0x10, __BIT(4), 0x24, __BITS(6,0)),
    134  1.1  jmcneill 	AXP_CTRL2("dcdc6", 600, 1520, 10, 51, 20, 21,
    135  1.1  jmcneill 		0x10, __BIT(5), 0x25, __BITS(6,0)),
    136  1.1  jmcneill 	AXP_CTRL("aldo1", 700, 3300, 100,
    137  1.1  jmcneill 		0x13, __BIT(5), 0x28, __BITS(4,0)),
    138  1.1  jmcneill 	AXP_CTRL("aldo2", 700, 3300, 100,
    139  1.1  jmcneill 		0x13, __BIT(6), 0x29, __BITS(4,0)),
    140  1.1  jmcneill 	AXP_CTRL("aldo3", 700, 3300, 100,
    141  1.1  jmcneill 		0x13, __BIT(7), 0x2a, __BITS(4,0)),
    142  1.1  jmcneill };
    143  1.1  jmcneill 
    144  1.1  jmcneill static const struct axppmic_ctrl axp805_ctrls[] = {
    145  1.1  jmcneill 	AXP_CTRL2("dcdca", 600, 1520, 10, 51, 20, 21,
    146  1.1  jmcneill 		0x10, __BIT(0), 0x12, __BITS(6,0)),
    147  1.1  jmcneill 	AXP_CTRL("dcdcb", 1000, 2550, 50,
    148  1.1  jmcneill 		0x10, __BIT(1), 0x13, __BITS(4,0)),
    149  1.1  jmcneill 	AXP_CTRL2("dcdcc", 600, 1520, 10, 51, 20, 21,
    150  1.1  jmcneill 		0x10, __BIT(2), 0x14, __BITS(6,0)),
    151  1.1  jmcneill 	AXP_CTRL2("dcdcd", 600, 3300, 20, 46, 100, 18,
    152  1.1  jmcneill 		0x10, __BIT(3), 0x15, __BITS(5,0)),
    153  1.1  jmcneill 	AXP_CTRL("dcdce", 1100, 3400, 100,
    154  1.1  jmcneill 		0x10, __BIT(4), 0x16, __BITS(4,0)),
    155  1.1  jmcneill 	AXP_CTRL("aldo1", 700, 3300, 100,
    156  1.1  jmcneill 		0x10, __BIT(5), 0x17, __BITS(4,0)),
    157  1.1  jmcneill 	AXP_CTRL("aldo2", 700, 3400, 100,
    158  1.1  jmcneill 		0x10, __BIT(6), 0x18, __BITS(4,0)),
    159  1.1  jmcneill 	AXP_CTRL("aldo3", 700, 3300, 100,
    160  1.1  jmcneill 		0x10, __BIT(7), 0x19, __BITS(4,0)),
    161  1.1  jmcneill 	AXP_CTRL("bldo1", 700, 1900, 100,
    162  1.1  jmcneill 		0x11, __BIT(0), 0x20, __BITS(3,0)),
    163  1.1  jmcneill 	AXP_CTRL("bldo2", 700, 1900, 100,
    164  1.1  jmcneill 		0x11, __BIT(1), 0x21, __BITS(3,0)),
    165  1.1  jmcneill 	AXP_CTRL("bldo3", 700, 1900, 100,
    166  1.1  jmcneill 		0x11, __BIT(2), 0x22, __BITS(3,0)),
    167  1.1  jmcneill 	AXP_CTRL("bldo4", 700, 1900, 100,
    168  1.1  jmcneill 		0x11, __BIT(3), 0x23, __BITS(3,0)),
    169  1.1  jmcneill 	AXP_CTRL("cldo1", 700, 3300, 100,
    170  1.1  jmcneill 		0x11, __BIT(4), 0x24, __BITS(4,0)),
    171  1.1  jmcneill 	AXP_CTRL2("cldo2", 700, 4200, 100, 28, 200, 4,
    172  1.1  jmcneill 		0x11, __BIT(5), 0x25, __BITS(4,0)),
    173  1.1  jmcneill 	AXP_CTRL("cldo3", 700, 3300, 100,
    174  1.1  jmcneill 		0x11, __BIT(6), 0x26, __BITS(4,0)),
    175  1.1  jmcneill };
    176  1.1  jmcneill 
    177  1.1  jmcneill struct axppmic_config {
    178  1.1  jmcneill 	const char *name;
    179  1.1  jmcneill 	const struct axppmic_ctrl *controls;
    180  1.1  jmcneill 	u_int ncontrols;
    181  1.1  jmcneill 	u_int irq_regs;
    182  1.2  jmcneill 	bool has_battery;
    183  1.2  jmcneill 	bool has_fuel_gauge;
    184  1.2  jmcneill };
    185  1.2  jmcneill 
    186  1.2  jmcneill enum axppmic_sensor {
    187  1.3  jmcneill 	AXP_SENSOR_ACIN_PRESENT,
    188  1.3  jmcneill 	AXP_SENSOR_VBUS_PRESENT,
    189  1.2  jmcneill 	AXP_SENSOR_BATT_PRESENT,
    190  1.2  jmcneill 	AXP_SENSOR_BATT_CHARGING,
    191  1.2  jmcneill 	AXP_SENSOR_BATT_CHARGE_STATE,
    192  1.2  jmcneill 	AXP_SENSOR_BATT_CAPACITY,
    193  1.2  jmcneill 	AXP_NSENSORS
    194  1.1  jmcneill };
    195  1.1  jmcneill 
    196  1.1  jmcneill struct axppmic_softc {
    197  1.1  jmcneill 	device_t	sc_dev;
    198  1.1  jmcneill 	i2c_tag_t	sc_i2c;
    199  1.1  jmcneill 	i2c_addr_t	sc_addr;
    200  1.1  jmcneill 	int		sc_phandle;
    201  1.1  jmcneill 
    202  1.2  jmcneill 	bool		sc_has_battery;
    203  1.2  jmcneill 	bool		sc_has_fuel_gauge;
    204  1.2  jmcneill 
    205  1.1  jmcneill 	struct sysmon_pswitch sc_smpsw;
    206  1.1  jmcneill 
    207  1.2  jmcneill 	struct sysmon_envsys *sc_sme;
    208  1.3  jmcneill 
    209  1.2  jmcneill 	envsys_data_t	sc_sensor[AXP_NSENSORS];
    210  1.4  jmcneill 
    211  1.4  jmcneill 	u_int		sc_warn_thres;
    212  1.4  jmcneill 	u_int		sc_shut_thres;
    213  1.1  jmcneill };
    214  1.1  jmcneill 
    215  1.1  jmcneill struct axpreg_softc {
    216  1.1  jmcneill 	device_t	sc_dev;
    217  1.1  jmcneill 	i2c_tag_t	sc_i2c;
    218  1.1  jmcneill 	i2c_addr_t	sc_addr;
    219  1.1  jmcneill 	const struct axppmic_ctrl *sc_ctrl;
    220  1.1  jmcneill };
    221  1.1  jmcneill 
    222  1.1  jmcneill struct axpreg_attach_args {
    223  1.1  jmcneill 	const struct axppmic_ctrl *reg_ctrl;
    224  1.1  jmcneill 	int		reg_phandle;
    225  1.1  jmcneill 	i2c_tag_t	reg_i2c;
    226  1.1  jmcneill 	i2c_addr_t	reg_addr;
    227  1.1  jmcneill };
    228  1.1  jmcneill 
    229  1.1  jmcneill static const struct axppmic_config axp803_config = {
    230  1.1  jmcneill 	.name = "AXP803",
    231  1.1  jmcneill 	.controls = axp803_ctrls,
    232  1.1  jmcneill 	.ncontrols = __arraycount(axp803_ctrls),
    233  1.1  jmcneill 	.irq_regs = 6,
    234  1.2  jmcneill 	.has_battery = true,
    235  1.2  jmcneill 	.has_fuel_gauge = true,
    236  1.1  jmcneill };
    237  1.1  jmcneill 
    238  1.1  jmcneill static const struct axppmic_config axp805_config = {
    239  1.1  jmcneill 	.name = "AXP805/806",
    240  1.1  jmcneill 	.controls = axp805_ctrls,
    241  1.1  jmcneill 	.ncontrols = __arraycount(axp805_ctrls),
    242  1.1  jmcneill 	.irq_regs = 2,
    243  1.1  jmcneill };
    244  1.1  jmcneill 
    245  1.1  jmcneill static const struct of_compat_data compat_data[] = {
    246  1.1  jmcneill 	{ "x-powers,axp803",	(uintptr_t)&axp803_config },
    247  1.1  jmcneill 	{ "x-powers,axp805",	(uintptr_t)&axp805_config },
    248  1.1  jmcneill 	{ "x-powers,axp806",	(uintptr_t)&axp805_config },
    249  1.1  jmcneill 	{ NULL }
    250  1.1  jmcneill };
    251  1.1  jmcneill 
    252  1.1  jmcneill static int
    253  1.1  jmcneill axppmic_read(i2c_tag_t tag, i2c_addr_t addr, uint8_t reg, uint8_t *val, int flags)
    254  1.1  jmcneill {
    255  1.1  jmcneill 	return iic_smbus_read_byte(tag, addr, reg, val, flags);
    256  1.1  jmcneill }
    257  1.1  jmcneill 
    258  1.1  jmcneill static int
    259  1.1  jmcneill axppmic_write(i2c_tag_t tag, i2c_addr_t addr, uint8_t reg, uint8_t val, int flags)
    260  1.1  jmcneill {
    261  1.1  jmcneill 	return iic_smbus_write_byte(tag, addr, reg, val, flags);
    262  1.1  jmcneill }
    263  1.1  jmcneill 
    264  1.1  jmcneill static int
    265  1.1  jmcneill axppmic_set_voltage(i2c_tag_t tag, i2c_addr_t addr, const struct axppmic_ctrl *c, u_int min, u_int max)
    266  1.1  jmcneill {
    267  1.1  jmcneill 	const int flags = (cold ? I2C_F_POLL : 0);
    268  1.1  jmcneill 	u_int vol, reg_val;
    269  1.1  jmcneill 	int nstep, error;
    270  1.1  jmcneill 	uint8_t val;
    271  1.1  jmcneill 
    272  1.1  jmcneill 	if (!c->c_voltage_mask)
    273  1.1  jmcneill 		return EINVAL;
    274  1.1  jmcneill 
    275  1.1  jmcneill 	if (min < c->c_min || min > c->c_max)
    276  1.1  jmcneill 		return EINVAL;
    277  1.1  jmcneill 
    278  1.1  jmcneill 	reg_val = 0;
    279  1.1  jmcneill 	nstep = 1;
    280  1.1  jmcneill 	vol = c->c_min;
    281  1.1  jmcneill 
    282  1.1  jmcneill 	for (nstep = 0; nstep < c->c_step1cnt && vol < min; nstep++) {
    283  1.1  jmcneill 		++reg_val;
    284  1.1  jmcneill 		vol += c->c_step1;
    285  1.1  jmcneill 	}
    286  1.1  jmcneill 	for (nstep = 0; nstep < c->c_step2cnt && vol < min; nstep++) {
    287  1.1  jmcneill 		++reg_val;
    288  1.1  jmcneill 		vol += c->c_step2;
    289  1.1  jmcneill 	}
    290  1.1  jmcneill 
    291  1.1  jmcneill 	if (vol > max)
    292  1.1  jmcneill 		return EINVAL;
    293  1.1  jmcneill 
    294  1.1  jmcneill 	iic_acquire_bus(tag, flags);
    295  1.1  jmcneill 	if ((error = axppmic_read(tag, addr, c->c_voltage_reg, &val, flags)) == 0) {
    296  1.1  jmcneill 		val &= ~c->c_voltage_mask;
    297  1.1  jmcneill 		val |= __SHIFTIN(reg_val, c->c_voltage_mask);
    298  1.1  jmcneill 		error = axppmic_write(tag, addr, c->c_voltage_reg, val, flags);
    299  1.1  jmcneill 	}
    300  1.1  jmcneill 	iic_release_bus(tag, flags);
    301  1.1  jmcneill 
    302  1.1  jmcneill 	return error;
    303  1.1  jmcneill }
    304  1.1  jmcneill 
    305  1.1  jmcneill static int
    306  1.1  jmcneill axppmic_get_voltage(i2c_tag_t tag, i2c_addr_t addr, const struct axppmic_ctrl *c, u_int *pvol)
    307  1.1  jmcneill {
    308  1.1  jmcneill 	const int flags = (cold ? I2C_F_POLL : 0);
    309  1.1  jmcneill 	int reg_val, error;
    310  1.1  jmcneill 	uint8_t val;
    311  1.1  jmcneill 
    312  1.1  jmcneill 	if (!c->c_voltage_mask)
    313  1.1  jmcneill 		return EINVAL;
    314  1.1  jmcneill 
    315  1.1  jmcneill 	iic_acquire_bus(tag, flags);
    316  1.1  jmcneill 	error = axppmic_read(tag, addr, c->c_voltage_reg, &val, flags);
    317  1.1  jmcneill 	iic_release_bus(tag, flags);
    318  1.1  jmcneill 	if (error)
    319  1.1  jmcneill 		return error;
    320  1.1  jmcneill 
    321  1.1  jmcneill 	reg_val = __SHIFTOUT(val, c->c_voltage_mask);
    322  1.1  jmcneill 	if (reg_val < c->c_step1cnt) {
    323  1.1  jmcneill 		*pvol = c->c_min + reg_val * c->c_step1;
    324  1.1  jmcneill 	} else {
    325  1.1  jmcneill 		*pvol = c->c_min + (c->c_step1cnt * c->c_step1) +
    326  1.1  jmcneill 		    ((reg_val - c->c_step1cnt) * c->c_step2);
    327  1.1  jmcneill 	}
    328  1.1  jmcneill 
    329  1.1  jmcneill 	return 0;
    330  1.1  jmcneill }
    331  1.1  jmcneill 
    332  1.1  jmcneill static void
    333  1.1  jmcneill axppmic_power_poweroff(device_t dev)
    334  1.1  jmcneill {
    335  1.1  jmcneill 	struct axppmic_softc *sc = device_private(dev);
    336  1.1  jmcneill 
    337  1.1  jmcneill 	delay(1000000);
    338  1.1  jmcneill 
    339  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, I2C_F_POLL);
    340  1.1  jmcneill 	axppmic_write(sc->sc_i2c, sc->sc_addr, AXP_POWER_DISABLE_REG, AXP_POWER_DISABLE_CTRL, I2C_F_POLL);
    341  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, I2C_F_POLL);
    342  1.1  jmcneill }
    343  1.1  jmcneill 
    344  1.1  jmcneill static struct fdtbus_power_controller_func axppmic_power_funcs = {
    345  1.1  jmcneill 	.poweroff = axppmic_power_poweroff,
    346  1.1  jmcneill };
    347  1.1  jmcneill 
    348  1.1  jmcneill static void
    349  1.1  jmcneill axppmic_task_shut(void *priv)
    350  1.1  jmcneill {
    351  1.1  jmcneill 	struct axppmic_softc *sc = priv;
    352  1.1  jmcneill 
    353  1.1  jmcneill 	sysmon_pswitch_event(&sc->sc_smpsw, PSWITCH_EVENT_PRESSED);
    354  1.1  jmcneill }
    355  1.1  jmcneill 
    356  1.1  jmcneill static int
    357  1.1  jmcneill axppmic_intr(void *priv)
    358  1.1  jmcneill {
    359  1.1  jmcneill 	struct axppmic_softc *sc = priv;
    360  1.1  jmcneill 	const int flags = I2C_F_POLL;
    361  1.1  jmcneill 	uint8_t stat;
    362  1.1  jmcneill 
    363  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, flags);
    364  1.2  jmcneill 	if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_IRQ_STATUS_REG(2), &stat, flags) == 0) {
    365  1.1  jmcneill 		if (stat & AXP_IRQ2_POKSIRQ)
    366  1.1  jmcneill 			sysmon_task_queue_sched(0, axppmic_task_shut, sc);
    367  1.1  jmcneill 
    368  1.1  jmcneill 		axppmic_write(sc->sc_i2c, sc->sc_addr, AXP_IRQ_STATUS_REG(2), stat, flags);
    369  1.1  jmcneill 	}
    370  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, flags);
    371  1.1  jmcneill 
    372  1.1  jmcneill 	return 1;
    373  1.1  jmcneill }
    374  1.1  jmcneill 
    375  1.2  jmcneill static void
    376  1.2  jmcneill axppmic_sensor_refresh(struct sysmon_envsys *sme, envsys_data_t *e)
    377  1.2  jmcneill {
    378  1.2  jmcneill 	struct axppmic_softc *sc = sme->sme_cookie;
    379  1.2  jmcneill 	const int flags = I2C_F_POLL;
    380  1.4  jmcneill 	uint8_t val;
    381  1.2  jmcneill 
    382  1.2  jmcneill 	e->state = ENVSYS_SINVALID;
    383  1.2  jmcneill 
    384  1.2  jmcneill 	iic_acquire_bus(sc->sc_i2c, flags);
    385  1.2  jmcneill 	switch (e->private) {
    386  1.3  jmcneill 	case AXP_SENSOR_ACIN_PRESENT:
    387  1.3  jmcneill 		if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_POWER_SOURCE_REG, &val, flags) == 0) {
    388  1.3  jmcneill 			e->state = ENVSYS_SVALID;
    389  1.3  jmcneill 			e->value_cur = !!(val & AXP_POWER_SOURCE_ACIN_PRESENT);
    390  1.3  jmcneill 		}
    391  1.3  jmcneill 		break;
    392  1.3  jmcneill 	case AXP_SENSOR_VBUS_PRESENT:
    393  1.3  jmcneill 		if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_POWER_SOURCE_REG, &val, flags) == 0) {
    394  1.3  jmcneill 			e->state = ENVSYS_SVALID;
    395  1.3  jmcneill 			e->value_cur = !!(val & AXP_POWER_SOURCE_VBUS_PRESENT);
    396  1.3  jmcneill 		}
    397  1.3  jmcneill 		break;
    398  1.2  jmcneill 	case AXP_SENSOR_BATT_PRESENT:
    399  1.2  jmcneill 		if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_POWER_MODE_REG, &val, flags) == 0) {
    400  1.2  jmcneill 			if (val & AXP_POWER_MODE_BATT_VALID) {
    401  1.2  jmcneill 				e->state = ENVSYS_SVALID;
    402  1.2  jmcneill 				e->value_cur = !!(val & AXP_POWER_MODE_BATT_PRESENT);
    403  1.2  jmcneill 			}
    404  1.2  jmcneill 		}
    405  1.2  jmcneill 		break;
    406  1.2  jmcneill 	case AXP_SENSOR_BATT_CHARGING:
    407  1.2  jmcneill 		if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_POWER_MODE_REG, &val, flags) == 0) {
    408  1.2  jmcneill 			e->state = ENVSYS_SVALID;
    409  1.2  jmcneill 			e->value_cur = !!(val & AXP_POWER_MODE_BATT_CHARGING);
    410  1.2  jmcneill 		}
    411  1.2  jmcneill 		break;
    412  1.2  jmcneill 	case AXP_SENSOR_BATT_CHARGE_STATE:
    413  1.2  jmcneill 		if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_POWER_MODE_REG, &val, flags) == 0 &&
    414  1.2  jmcneill 		    (val & AXP_POWER_MODE_BATT_VALID) != 0 &&
    415  1.2  jmcneill 		    (val & AXP_POWER_MODE_BATT_PRESENT) != 0 &&
    416  1.2  jmcneill 		    axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_BATT_CAP_REG, &val, flags) == 0 &&
    417  1.4  jmcneill 		    (val & AXP_BATT_CAP_VALID) != 0) {
    418  1.2  jmcneill 			const u_int batt_val = __SHIFTOUT(val, AXP_BATT_CAP_PERCENT);
    419  1.4  jmcneill 			if (batt_val <= sc->sc_shut_thres) {
    420  1.2  jmcneill 				e->state = ENVSYS_SCRITICAL;
    421  1.2  jmcneill 				e->value_cur = ENVSYS_BATTERY_CAPACITY_CRITICAL;
    422  1.4  jmcneill 			} else if (batt_val <= sc->sc_warn_thres) {
    423  1.2  jmcneill 				e->state = ENVSYS_SWARNUNDER;
    424  1.2  jmcneill 				e->value_cur = ENVSYS_BATTERY_CAPACITY_WARNING;
    425  1.2  jmcneill 			} else {
    426  1.2  jmcneill 				e->state = ENVSYS_SVALID;
    427  1.2  jmcneill 				e->value_cur = ENVSYS_BATTERY_CAPACITY_NORMAL;
    428  1.2  jmcneill 			}
    429  1.2  jmcneill 		}
    430  1.2  jmcneill 		break;
    431  1.2  jmcneill 	case AXP_SENSOR_BATT_CAPACITY:
    432  1.2  jmcneill 		if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_POWER_MODE_REG, &val, flags) == 0 &&
    433  1.2  jmcneill 		    (val & AXP_POWER_MODE_BATT_VALID) != 0 &&
    434  1.2  jmcneill 		    (val & AXP_POWER_MODE_BATT_PRESENT) != 0 &&
    435  1.2  jmcneill 		    axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_BATT_CAP_REG, &val, flags) == 0 &&
    436  1.2  jmcneill 		    (val & AXP_BATT_CAP_VALID) != 0) {
    437  1.2  jmcneill 			e->state = ENVSYS_SVALID;
    438  1.2  jmcneill 			e->value_cur = __SHIFTOUT(val, AXP_BATT_CAP_PERCENT);
    439  1.2  jmcneill 		}
    440  1.2  jmcneill 		break;
    441  1.2  jmcneill 	}
    442  1.2  jmcneill 	iic_release_bus(sc->sc_i2c, flags);
    443  1.2  jmcneill }
    444  1.2  jmcneill 
    445  1.2  jmcneill static void
    446  1.3  jmcneill axppmic_attach_acadapter(struct axppmic_softc *sc)
    447  1.3  jmcneill {
    448  1.3  jmcneill 	envsys_data_t *e;
    449  1.3  jmcneill 
    450  1.3  jmcneill 	e = &sc->sc_sensor[AXP_SENSOR_ACIN_PRESENT];
    451  1.3  jmcneill 	e->private = AXP_SENSOR_ACIN_PRESENT;
    452  1.3  jmcneill 	e->units = ENVSYS_INDICATOR;
    453  1.3  jmcneill 	e->state = ENVSYS_SINVALID;
    454  1.3  jmcneill 	strlcpy(e->desc, "ACIN present", sizeof(e->desc));
    455  1.3  jmcneill 	sysmon_envsys_sensor_attach(sc->sc_sme, e);
    456  1.3  jmcneill 
    457  1.3  jmcneill 	e = &sc->sc_sensor[AXP_SENSOR_VBUS_PRESENT];
    458  1.3  jmcneill 	e->private = AXP_SENSOR_VBUS_PRESENT;
    459  1.3  jmcneill 	e->units = ENVSYS_INDICATOR;
    460  1.3  jmcneill 	e->state = ENVSYS_SINVALID;
    461  1.3  jmcneill 	strlcpy(e->desc, "VBUS present", sizeof(e->desc));
    462  1.3  jmcneill 	sysmon_envsys_sensor_attach(sc->sc_sme, e);
    463  1.3  jmcneill }
    464  1.3  jmcneill 
    465  1.3  jmcneill static void
    466  1.2  jmcneill axppmic_attach_battery(struct axppmic_softc *sc)
    467  1.2  jmcneill {
    468  1.2  jmcneill 	envsys_data_t *e;
    469  1.4  jmcneill 	uint8_t val;
    470  1.4  jmcneill 
    471  1.4  jmcneill 	iic_acquire_bus(sc->sc_i2c, I2C_F_POLL);
    472  1.4  jmcneill 	if (axppmic_read(sc->sc_i2c, sc->sc_addr, AXP_BATT_CAP_WARN_REG, &val, I2C_F_POLL) == 0) {
    473  1.4  jmcneill 		sc->sc_warn_thres = __SHIFTOUT(val, AXP_BATT_CAP_WARN_LV1) + 5;
    474  1.4  jmcneill 		sc->sc_shut_thres = __SHIFTOUT(val, AXP_BATT_CAP_WARN_LV2);
    475  1.4  jmcneill 	}
    476  1.4  jmcneill 	iic_release_bus(sc->sc_i2c, I2C_F_POLL);
    477  1.2  jmcneill 
    478  1.2  jmcneill 	e = &sc->sc_sensor[AXP_SENSOR_BATT_PRESENT];
    479  1.2  jmcneill 	e->private = AXP_SENSOR_BATT_PRESENT;
    480  1.2  jmcneill 	e->units = ENVSYS_INDICATOR;
    481  1.2  jmcneill 	e->state = ENVSYS_SINVALID;
    482  1.2  jmcneill 	strlcpy(e->desc, "battery present", sizeof(e->desc));
    483  1.2  jmcneill 	sysmon_envsys_sensor_attach(sc->sc_sme, e);
    484  1.2  jmcneill 
    485  1.2  jmcneill 	e = &sc->sc_sensor[AXP_SENSOR_BATT_CHARGING];
    486  1.2  jmcneill 	e->private = AXP_SENSOR_BATT_CHARGING;
    487  1.2  jmcneill 	e->units = ENVSYS_BATTERY_CHARGE;
    488  1.2  jmcneill 	e->state = ENVSYS_SINVALID;
    489  1.2  jmcneill 	strlcpy(e->desc, "charging", sizeof(e->desc));
    490  1.2  jmcneill 	sysmon_envsys_sensor_attach(sc->sc_sme, e);
    491  1.2  jmcneill 
    492  1.2  jmcneill 	e = &sc->sc_sensor[AXP_SENSOR_BATT_CHARGE_STATE];
    493  1.2  jmcneill 	e->private = AXP_SENSOR_BATT_CHARGE_STATE;
    494  1.2  jmcneill 	e->units = ENVSYS_BATTERY_CAPACITY;
    495  1.2  jmcneill 	e->flags = ENVSYS_FMONSTCHANGED;
    496  1.2  jmcneill 	e->state = ENVSYS_SVALID;
    497  1.2  jmcneill 	e->value_cur = ENVSYS_BATTERY_CAPACITY_NORMAL;
    498  1.2  jmcneill 	strlcpy(e->desc, "charge state", sizeof(e->desc));
    499  1.2  jmcneill 	sysmon_envsys_sensor_attach(sc->sc_sme, e);
    500  1.2  jmcneill 
    501  1.2  jmcneill 	if (sc->sc_has_fuel_gauge) {
    502  1.2  jmcneill 		e = &sc->sc_sensor[AXP_SENSOR_BATT_CAPACITY];
    503  1.2  jmcneill 		e->private = AXP_SENSOR_BATT_CAPACITY;
    504  1.2  jmcneill 		e->units = ENVSYS_INTEGER;
    505  1.2  jmcneill 		e->state = ENVSYS_SINVALID;
    506  1.2  jmcneill 		e->flags = ENVSYS_FPERCENT;
    507  1.2  jmcneill 		strlcpy(e->desc, "battery percent", sizeof(e->desc));
    508  1.2  jmcneill 		sysmon_envsys_sensor_attach(sc->sc_sme, e);
    509  1.2  jmcneill 	}
    510  1.2  jmcneill }
    511  1.2  jmcneill 
    512  1.2  jmcneill static void
    513  1.2  jmcneill axppmic_attach_sensors(struct axppmic_softc *sc)
    514  1.2  jmcneill {
    515  1.2  jmcneill 	if (sc->sc_has_battery) {
    516  1.2  jmcneill 		sc->sc_sme = sysmon_envsys_create();
    517  1.2  jmcneill 		sc->sc_sme->sme_name = device_xname(sc->sc_dev);
    518  1.2  jmcneill 		sc->sc_sme->sme_cookie = sc;
    519  1.2  jmcneill 		sc->sc_sme->sme_refresh = axppmic_sensor_refresh;
    520  1.2  jmcneill 		sc->sc_sme->sme_class = SME_CLASS_BATTERY;
    521  1.2  jmcneill 		sc->sc_sme->sme_flags = SME_POLL_ONLY | SME_INIT_REFRESH;
    522  1.2  jmcneill 
    523  1.3  jmcneill 		axppmic_attach_acadapter(sc);
    524  1.2  jmcneill 		axppmic_attach_battery(sc);
    525  1.2  jmcneill 
    526  1.2  jmcneill 		sysmon_envsys_register(sc->sc_sme);
    527  1.2  jmcneill 	}
    528  1.2  jmcneill }
    529  1.2  jmcneill 
    530  1.2  jmcneill 
    531  1.1  jmcneill static int
    532  1.1  jmcneill axppmic_match(device_t parent, cfdata_t match, void *aux)
    533  1.1  jmcneill {
    534  1.1  jmcneill 	struct i2c_attach_args *ia = aux;
    535  1.1  jmcneill 
    536  1.1  jmcneill 	if (ia->ia_name != NULL) {
    537  1.1  jmcneill 		if (ia->ia_cookie)
    538  1.1  jmcneill 			return of_match_compat_data(ia->ia_cookie, compat_data);
    539  1.1  jmcneill 		else
    540  1.1  jmcneill 			return 0;
    541  1.1  jmcneill 	}
    542  1.1  jmcneill 
    543  1.1  jmcneill 	return 1;
    544  1.1  jmcneill }
    545  1.1  jmcneill 
    546  1.1  jmcneill static void
    547  1.1  jmcneill axppmic_attach(device_t parent, device_t self, void *aux)
    548  1.1  jmcneill {
    549  1.1  jmcneill 	struct axppmic_softc *sc = device_private(self);
    550  1.1  jmcneill 	const struct axppmic_config *c;
    551  1.1  jmcneill 	struct axpreg_attach_args aaa;
    552  1.1  jmcneill 	struct i2c_attach_args *ia = aux;
    553  1.1  jmcneill 	int phandle, child, i;
    554  1.1  jmcneill 	uint32_t irq_mask;
    555  1.1  jmcneill 	void *ih;
    556  1.1  jmcneill 
    557  1.1  jmcneill 	c = (void *)of_search_compatible(ia->ia_cookie, compat_data)->data;
    558  1.1  jmcneill 
    559  1.1  jmcneill 	sc->sc_dev = self;
    560  1.1  jmcneill 	sc->sc_i2c = ia->ia_tag;
    561  1.1  jmcneill 	sc->sc_addr = ia->ia_addr;
    562  1.1  jmcneill 	sc->sc_phandle = ia->ia_cookie;
    563  1.2  jmcneill 	sc->sc_has_battery = c->has_battery;
    564  1.2  jmcneill 	sc->sc_has_fuel_gauge = c->has_fuel_gauge;
    565  1.1  jmcneill 
    566  1.1  jmcneill 	aprint_naive("\n");
    567  1.1  jmcneill 	aprint_normal(": %s\n", c->name);
    568  1.1  jmcneill 
    569  1.1  jmcneill 	sc->sc_smpsw.smpsw_name = device_xname(self);
    570  1.1  jmcneill 	sc->sc_smpsw.smpsw_type = PSWITCH_TYPE_POWER;
    571  1.1  jmcneill 	sysmon_pswitch_register(&sc->sc_smpsw);
    572  1.1  jmcneill 
    573  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, I2C_F_POLL);
    574  1.2  jmcneill 	for (i = 1; i <= c->irq_regs; i++) {
    575  1.1  jmcneill 		irq_mask = 0;
    576  1.1  jmcneill 		if (i == 2)
    577  1.1  jmcneill 			irq_mask |= AXP_IRQ2_POKSIRQ;
    578  1.1  jmcneill 		axppmic_write(sc->sc_i2c, sc->sc_addr, AXP_IRQ_ENABLE_REG(i), irq_mask, I2C_F_POLL);
    579  1.1  jmcneill 	}
    580  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, I2C_F_POLL);
    581  1.1  jmcneill 
    582  1.1  jmcneill 	ih = fdtbus_intr_establish(sc->sc_phandle, 0, IPL_VM, FDT_INTR_MPSAFE,
    583  1.1  jmcneill 	    axppmic_intr, sc);
    584  1.1  jmcneill 	if (ih == NULL) {
    585  1.1  jmcneill 		aprint_error_dev(self, "WARNING: couldn't establish interrupt handler\n");
    586  1.1  jmcneill 	}
    587  1.1  jmcneill 
    588  1.1  jmcneill 	fdtbus_register_power_controller(sc->sc_dev, sc->sc_phandle,
    589  1.1  jmcneill 	    &axppmic_power_funcs);
    590  1.1  jmcneill 
    591  1.1  jmcneill 	phandle = of_find_firstchild_byname(sc->sc_phandle, "regulators");
    592  1.2  jmcneill 	if (phandle > 0) {
    593  1.2  jmcneill 		aaa.reg_i2c = sc->sc_i2c;
    594  1.2  jmcneill 		aaa.reg_addr = sc->sc_addr;
    595  1.2  jmcneill 		for (i = 0; i < c->ncontrols; i++) {
    596  1.2  jmcneill 			const struct axppmic_ctrl *ctrl = &c->controls[i];
    597  1.2  jmcneill 			child = of_find_firstchild_byname(phandle, ctrl->c_name);
    598  1.2  jmcneill 			if (child <= 0)
    599  1.2  jmcneill 				continue;
    600  1.2  jmcneill 			aaa.reg_ctrl = ctrl;
    601  1.2  jmcneill 			aaa.reg_phandle = child;
    602  1.2  jmcneill 			config_found(sc->sc_dev, &aaa, NULL);
    603  1.2  jmcneill 		}
    604  1.2  jmcneill 	}
    605  1.1  jmcneill 
    606  1.2  jmcneill 	if (c->has_battery)
    607  1.2  jmcneill 		axppmic_attach_sensors(sc);
    608  1.1  jmcneill }
    609  1.1  jmcneill 
    610  1.1  jmcneill static int
    611  1.1  jmcneill axpreg_acquire(device_t dev)
    612  1.1  jmcneill {
    613  1.1  jmcneill 	return 0;
    614  1.1  jmcneill }
    615  1.1  jmcneill 
    616  1.1  jmcneill static void
    617  1.1  jmcneill axpreg_release(device_t dev)
    618  1.1  jmcneill {
    619  1.1  jmcneill }
    620  1.1  jmcneill 
    621  1.1  jmcneill static int
    622  1.1  jmcneill axpreg_enable(device_t dev, bool enable)
    623  1.1  jmcneill {
    624  1.1  jmcneill 	struct axpreg_softc *sc = device_private(dev);
    625  1.1  jmcneill 	const struct axppmic_ctrl *c = sc->sc_ctrl;
    626  1.1  jmcneill 	const int flags = (cold ? I2C_F_POLL : 0);
    627  1.1  jmcneill 	uint8_t val;
    628  1.1  jmcneill 	int error;
    629  1.1  jmcneill 
    630  1.1  jmcneill 	if (!c->c_enable_mask)
    631  1.1  jmcneill 		return EINVAL;
    632  1.1  jmcneill 
    633  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, flags);
    634  1.1  jmcneill 	if ((error = axppmic_read(sc->sc_i2c, sc->sc_addr, c->c_enable_reg, &val, flags)) == 0) {
    635  1.1  jmcneill 		if (enable)
    636  1.1  jmcneill 			val |= c->c_enable_mask;
    637  1.1  jmcneill 		else
    638  1.1  jmcneill 			val &= ~c->c_enable_mask;
    639  1.1  jmcneill 		error = axppmic_write(sc->sc_i2c, sc->sc_addr, c->c_enable_reg, val, flags);
    640  1.1  jmcneill 	}
    641  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, flags);
    642  1.1  jmcneill 
    643  1.1  jmcneill 	return error;
    644  1.1  jmcneill }
    645  1.1  jmcneill 
    646  1.1  jmcneill static int
    647  1.1  jmcneill axpreg_set_voltage(device_t dev, u_int min_uvol, u_int max_uvol)
    648  1.1  jmcneill {
    649  1.1  jmcneill 	struct axpreg_softc *sc = device_private(dev);
    650  1.1  jmcneill 	const struct axppmic_ctrl *c = sc->sc_ctrl;
    651  1.1  jmcneill 
    652  1.1  jmcneill 	return axppmic_set_voltage(sc->sc_i2c, sc->sc_addr, c,
    653  1.1  jmcneill 	    min_uvol / 1000, max_uvol / 1000);
    654  1.1  jmcneill }
    655  1.1  jmcneill 
    656  1.1  jmcneill static int
    657  1.1  jmcneill axpreg_get_voltage(device_t dev, u_int *puvol)
    658  1.1  jmcneill {
    659  1.1  jmcneill 	struct axpreg_softc *sc = device_private(dev);
    660  1.1  jmcneill 	const struct axppmic_ctrl *c = sc->sc_ctrl;
    661  1.1  jmcneill 	int error;
    662  1.1  jmcneill 	u_int vol;
    663  1.1  jmcneill 
    664  1.1  jmcneill 	error = axppmic_get_voltage(sc->sc_i2c, sc->sc_addr, c, &vol);
    665  1.1  jmcneill 	if (error)
    666  1.1  jmcneill 		return error;
    667  1.1  jmcneill 
    668  1.1  jmcneill 	*puvol = vol * 1000;
    669  1.1  jmcneill 	return 0;
    670  1.1  jmcneill }
    671  1.1  jmcneill 
    672  1.1  jmcneill static struct fdtbus_regulator_controller_func axpreg_funcs = {
    673  1.1  jmcneill 	.acquire = axpreg_acquire,
    674  1.1  jmcneill 	.release = axpreg_release,
    675  1.1  jmcneill 	.enable = axpreg_enable,
    676  1.1  jmcneill 	.set_voltage = axpreg_set_voltage,
    677  1.1  jmcneill 	.get_voltage = axpreg_get_voltage,
    678  1.1  jmcneill };
    679  1.1  jmcneill 
    680  1.1  jmcneill static int
    681  1.1  jmcneill axpreg_match(device_t parent, cfdata_t match, void *aux)
    682  1.1  jmcneill {
    683  1.1  jmcneill 	return 1;
    684  1.1  jmcneill }
    685  1.1  jmcneill 
    686  1.1  jmcneill static void
    687  1.1  jmcneill axpreg_attach(device_t parent, device_t self, void *aux)
    688  1.1  jmcneill {
    689  1.1  jmcneill 	struct axpreg_softc *sc = device_private(self);
    690  1.1  jmcneill 	struct axpreg_attach_args *aaa = aux;
    691  1.1  jmcneill 	const int phandle = aaa->reg_phandle;
    692  1.1  jmcneill 	const char *name;
    693  1.1  jmcneill 
    694  1.1  jmcneill 	sc->sc_dev = self;
    695  1.1  jmcneill 	sc->sc_i2c = aaa->reg_i2c;
    696  1.1  jmcneill 	sc->sc_addr = aaa->reg_addr;
    697  1.1  jmcneill 	sc->sc_ctrl = aaa->reg_ctrl;
    698  1.1  jmcneill 
    699  1.1  jmcneill 	fdtbus_register_regulator_controller(self, phandle,
    700  1.1  jmcneill 	    &axpreg_funcs);
    701  1.1  jmcneill 
    702  1.1  jmcneill 	aprint_naive("\n");
    703  1.1  jmcneill 	name = fdtbus_get_string(phandle, "regulator-name");
    704  1.1  jmcneill 	if (name)
    705  1.1  jmcneill 		aprint_normal(": %s\n", name);
    706  1.1  jmcneill 	else
    707  1.1  jmcneill 		aprint_normal("\n");
    708  1.1  jmcneill }
    709  1.1  jmcneill 
    710  1.1  jmcneill CFATTACH_DECL_NEW(axppmic, sizeof(struct axppmic_softc),
    711  1.1  jmcneill     axppmic_match, axppmic_attach, NULL, NULL);
    712  1.1  jmcneill 
    713  1.1  jmcneill CFATTACH_DECL_NEW(axpreg, sizeof(struct axpreg_softc),
    714  1.1  jmcneill     axpreg_match, axpreg_attach, NULL, NULL);
    715