^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * PMU driver for Wolfson Microelectronics wm831x PMICs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright 2009 Wolfson Microelectronics PLC.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/power_supply.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/usb/phy.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/mfd/wm831x/core.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/mfd/wm831x/auxadc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/mfd/wm831x/pmu.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/mfd/wm831x/pdata.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) struct wm831x_power {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct wm831x *wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct power_supply *wall;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) struct power_supply *usb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) struct power_supply *battery;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) struct power_supply_desc wall_desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct power_supply_desc usb_desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct power_supply_desc battery_desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) char wall_name[20];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) char usb_name[20];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) char battery_name[20];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) bool have_battery;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct usb_phy *usb_phy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) struct notifier_block usb_notify;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) if (ret & supply)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) val->intval = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) val->intval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) static int wm831x_power_read_voltage(struct wm831x *wm831x,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) enum wm831x_auxadc src,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) ret = wm831x_auxadc_read_uv(wm831x, src);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) if (ret >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) val->intval = ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) /*********************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) * WALL Power
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) *********************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) static int wm831x_wall_get_prop(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) case POWER_SUPPLY_PROP_ONLINE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) ret = wm831x_power_check_online(wm831x, WM831X_PWR_WALL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) case POWER_SUPPLY_PROP_VOLTAGE_NOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_WALL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) static enum power_supply_property wm831x_wall_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) POWER_SUPPLY_PROP_ONLINE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) POWER_SUPPLY_PROP_VOLTAGE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) /*********************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) * USB Power
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) *********************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static int wm831x_usb_get_prop(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) case POWER_SUPPLY_PROP_ONLINE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) ret = wm831x_power_check_online(wm831x, WM831X_PWR_USB, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) case POWER_SUPPLY_PROP_VOLTAGE_NOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_USB, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static enum power_supply_property wm831x_usb_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) POWER_SUPPLY_PROP_ONLINE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) POWER_SUPPLY_PROP_VOLTAGE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) /* In milliamps */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) static const unsigned int wm831x_usb_limits[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 100,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 500,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 900,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 1500,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 1800,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 550,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static int wm831x_usb_limit_change(struct notifier_block *nb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) unsigned long limit, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) struct wm831x_power *wm831x_power = container_of(nb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) struct wm831x_power,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) usb_notify);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) unsigned int i, best;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) /* Find the highest supported limit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) best = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) for (i = 0; i < ARRAY_SIZE(wm831x_usb_limits); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) if (limit >= wm831x_usb_limits[i] &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) wm831x_usb_limits[best] < wm831x_usb_limits[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) best = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) dev_dbg(wm831x_power->wm831x->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) "Limiting USB current to %umA", wm831x_usb_limits[best]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) wm831x_set_bits(wm831x_power->wm831x, WM831X_POWER_STATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) WM831X_USB_ILIM_MASK, best);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /*********************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) * Battery properties
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) *********************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) struct chg_map {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) int reg_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static struct chg_map trickle_ilims[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) { 50, 0 << WM831X_CHG_TRKL_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) { 100, 1 << WM831X_CHG_TRKL_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) { 150, 2 << WM831X_CHG_TRKL_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) { 200, 3 << WM831X_CHG_TRKL_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) static struct chg_map vsels[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) { 4050, 0 << WM831X_CHG_VSEL_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) { 4100, 1 << WM831X_CHG_VSEL_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) { 4150, 2 << WM831X_CHG_VSEL_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) { 4200, 3 << WM831X_CHG_VSEL_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) static struct chg_map fast_ilims[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) { 0, 0 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) { 50, 1 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) { 100, 2 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) { 150, 3 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) { 200, 4 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) { 250, 5 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) { 300, 6 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) { 350, 7 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) { 400, 8 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) { 450, 9 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) { 500, 10 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) { 600, 11 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) { 700, 12 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) { 800, 13 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) { 900, 14 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) { 1000, 15 << WM831X_CHG_FAST_ILIM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) static struct chg_map eoc_iterms[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) { 20, 0 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) { 30, 1 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) { 40, 2 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) { 50, 3 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) { 60, 4 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) { 70, 5 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) { 80, 6 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) { 90, 7 << WM831X_CHG_ITERM_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) static struct chg_map chg_times[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) { 60, 0 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) { 90, 1 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) { 120, 2 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) { 150, 3 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) { 180, 4 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) { 210, 5 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) { 240, 6 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) { 270, 7 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) { 300, 8 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) { 330, 9 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) { 360, 10 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) { 390, 11 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) { 420, 12 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) { 450, 13 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) { 480, 14 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) { 510, 15 << WM831X_CHG_TIME_SHIFT },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) static void wm831x_battey_apply_config(struct wm831x *wm831x,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct chg_map *map, int count, int val,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) int *reg, const char *name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) const char *units)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) for (i = 0; i < count; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) if (val == map[i].val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) if (i == count) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) dev_err(wm831x->dev, "Invalid %s %d%s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) name, val, units);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) *reg |= map[i].reg_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) dev_dbg(wm831x->dev, "Set %s of %d%s\n", name, val, units);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) static void wm831x_config_battery(struct wm831x *wm831x)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) struct wm831x_battery_pdata *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) int ret, reg1, reg2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) if (!wm831x_pdata || !wm831x_pdata->battery) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) dev_warn(wm831x->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) "No battery charger configuration\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) pdata = wm831x_pdata->battery;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) reg1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) reg2 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) if (!pdata->enable) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) dev_info(wm831x->dev, "Battery charger disabled\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) reg1 |= WM831X_CHG_ENA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) if (pdata->off_mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) reg2 |= WM831X_CHG_OFF_MSK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) if (pdata->fast_enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) reg1 |= WM831X_CHG_FAST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) wm831x_battey_apply_config(wm831x, trickle_ilims,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) ARRAY_SIZE(trickle_ilims),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) pdata->trickle_ilim, ®2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) "trickle charge current limit", "mA");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) wm831x_battey_apply_config(wm831x, vsels, ARRAY_SIZE(vsels),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) pdata->vsel, ®2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) "target voltage", "mV");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) wm831x_battey_apply_config(wm831x, fast_ilims, ARRAY_SIZE(fast_ilims),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) pdata->fast_ilim, ®2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) "fast charge current limit", "mA");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) wm831x_battey_apply_config(wm831x, eoc_iterms, ARRAY_SIZE(eoc_iterms),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) pdata->eoc_iterm, ®1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) "end of charge current threshold", "mA");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) wm831x_battey_apply_config(wm831x, chg_times, ARRAY_SIZE(chg_times),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) pdata->timeout, ®2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) "charger timeout", "min");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) ret = wm831x_reg_unlock(wm831x);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) WM831X_CHG_ENA_MASK |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) WM831X_CHG_FAST_MASK |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) WM831X_CHG_ITERM_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) reg1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) if (ret != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) dev_err(wm831x->dev, "Failed to set charger control 1: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) WM831X_CHG_OFF_MSK |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) WM831X_CHG_TIME_MASK |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) WM831X_CHG_FAST_ILIM_MASK |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) WM831X_CHG_TRKL_ILIM_MASK |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) WM831X_CHG_VSEL_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) reg2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) if (ret != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) dev_err(wm831x->dev, "Failed to set charger control 2: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) wm831x_reg_lock(wm831x);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) static int wm831x_bat_check_status(struct wm831x *wm831x, int *status)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) if (ret & WM831X_PWR_SRC_BATT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) *status = POWER_SUPPLY_STATUS_DISCHARGING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) switch (ret & WM831X_CHG_STATE_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) case WM831X_CHG_STATE_OFF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) *status = POWER_SUPPLY_STATUS_NOT_CHARGING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) case WM831X_CHG_STATE_TRICKLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) case WM831X_CHG_STATE_FAST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) *status = POWER_SUPPLY_STATUS_CHARGING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) *status = POWER_SUPPLY_STATUS_UNKNOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) static int wm831x_bat_check_type(struct wm831x *wm831x, int *type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) switch (ret & WM831X_CHG_STATE_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) case WM831X_CHG_STATE_TRICKLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) case WM831X_CHG_STATE_TRICKLE_OT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) *type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) case WM831X_CHG_STATE_FAST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) case WM831X_CHG_STATE_FAST_OT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) *type = POWER_SUPPLY_CHARGE_TYPE_FAST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) *type = POWER_SUPPLY_CHARGE_TYPE_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) static int wm831x_bat_check_health(struct wm831x *wm831x, int *health)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) if (ret & WM831X_BATT_HOT_STS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) *health = POWER_SUPPLY_HEALTH_OVERHEAT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) if (ret & WM831X_BATT_COLD_STS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) *health = POWER_SUPPLY_HEALTH_COLD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) if (ret & WM831X_BATT_OV_STS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) *health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) switch (ret & WM831X_CHG_STATE_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) case WM831X_CHG_STATE_TRICKLE_OT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) case WM831X_CHG_STATE_FAST_OT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) *health = POWER_SUPPLY_HEALTH_OVERHEAT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) case WM831X_CHG_STATE_DEFECTIVE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) *health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) *health = POWER_SUPPLY_HEALTH_GOOD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) static int wm831x_bat_get_prop(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) case POWER_SUPPLY_PROP_STATUS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) ret = wm831x_bat_check_status(wm831x, &val->intval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) case POWER_SUPPLY_PROP_ONLINE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) case POWER_SUPPLY_PROP_VOLTAGE_NOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) case POWER_SUPPLY_PROP_HEALTH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) ret = wm831x_bat_check_health(wm831x, &val->intval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) case POWER_SUPPLY_PROP_CHARGE_TYPE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) ret = wm831x_bat_check_type(wm831x, &val->intval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) static enum power_supply_property wm831x_bat_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) POWER_SUPPLY_PROP_STATUS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) POWER_SUPPLY_PROP_ONLINE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) POWER_SUPPLY_PROP_VOLTAGE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) POWER_SUPPLY_PROP_HEALTH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) POWER_SUPPLY_PROP_CHARGE_TYPE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static const char *wm831x_bat_irqs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) "BATT HOT",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) "BATT COLD",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) "BATT FAIL",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) "OV",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) "END",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) "TO",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) "MODE",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) "START",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) static irqreturn_t wm831x_bat_irq(int irq, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) struct wm831x_power *wm831x_power = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) dev_dbg(wm831x->dev, "Battery status changed: %d\n", irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) /* The battery charger is autonomous so we don't need to do
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) * anything except kick user space */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) if (wm831x_power->have_battery)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) power_supply_changed(wm831x_power->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) /*********************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) * Initialisation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) *********************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) static irqreturn_t wm831x_syslo_irq(int irq, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) struct wm831x_power *wm831x_power = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) /* Not much we can actually *do* but tell people for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) * posterity, we're probably about to run out of power. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) dev_crit(wm831x->dev, "SYSVDD under voltage\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) struct wm831x_power *wm831x_power = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) dev_dbg(wm831x->dev, "Power source changed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) /* Just notify for everything - little harm in overnotifying. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) if (wm831x_power->have_battery)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) power_supply_changed(wm831x_power->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) power_supply_changed(wm831x_power->usb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) power_supply_changed(wm831x_power->wall);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) static int wm831x_power_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) struct wm831x_power *power;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) int ret, irq, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) power = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_power),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) if (power == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) power->wm831x = wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) platform_set_drvdata(pdev, power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) if (wm831x_pdata && wm831x_pdata->wm831x_num) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) snprintf(power->wall_name, sizeof(power->wall_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) "wm831x-wall.%d", wm831x_pdata->wm831x_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) snprintf(power->battery_name, sizeof(power->wall_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) "wm831x-battery.%d", wm831x_pdata->wm831x_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) snprintf(power->usb_name, sizeof(power->wall_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) "wm831x-usb.%d", wm831x_pdata->wm831x_num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) snprintf(power->wall_name, sizeof(power->wall_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) "wm831x-wall");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) snprintf(power->battery_name, sizeof(power->wall_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) "wm831x-battery");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) snprintf(power->usb_name, sizeof(power->wall_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) "wm831x-usb");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) /* We ignore configuration failures since we can still read back
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) * the status without enabling the charger.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) wm831x_config_battery(wm831x);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) power->wall_desc.name = power->wall_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) power->wall_desc.type = POWER_SUPPLY_TYPE_MAINS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) power->wall_desc.properties = wm831x_wall_props;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) power->wall_desc.num_properties = ARRAY_SIZE(wm831x_wall_props);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) power->wall_desc.get_property = wm831x_wall_get_prop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) power->wall = power_supply_register(&pdev->dev, &power->wall_desc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) if (IS_ERR(power->wall)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) ret = PTR_ERR(power->wall);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) power->usb_desc.name = power->usb_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) power->usb_desc.type = POWER_SUPPLY_TYPE_USB;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) power->usb_desc.properties = wm831x_usb_props;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) power->usb_desc.num_properties = ARRAY_SIZE(wm831x_usb_props);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) power->usb_desc.get_property = wm831x_usb_get_prop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) power->usb = power_supply_register(&pdev->dev, &power->usb_desc, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) if (IS_ERR(power->usb)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) ret = PTR_ERR(power->usb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) goto err_wall;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) goto err_wall;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) power->have_battery = ret & WM831X_CHG_ENA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) if (power->have_battery) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) power->battery_desc.name = power->battery_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) power->battery_desc.properties = wm831x_bat_props;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) power->battery_desc.num_properties = ARRAY_SIZE(wm831x_bat_props);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) power->battery_desc.get_property = wm831x_bat_get_prop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) power->battery_desc.use_for_apm = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) power->battery = power_supply_register(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) &power->battery_desc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) if (IS_ERR(power->battery)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) ret = PTR_ERR(power->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) goto err_usb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "SYSLO"));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) ret = request_threaded_irq(irq, NULL, wm831x_syslo_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) IRQF_TRIGGER_RISING | IRQF_ONESHOT, "System power low",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) irq, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) goto err_battery;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "PWR SRC"));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) ret = request_threaded_irq(irq, NULL, wm831x_pwr_src_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) IRQF_TRIGGER_RISING | IRQF_ONESHOT, "Power source",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) irq, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) goto err_syslo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) irq = wm831x_irq(wm831x,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) platform_get_irq_byname(pdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) wm831x_bat_irqs[i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) ret = request_threaded_irq(irq, NULL, wm831x_bat_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) IRQF_TRIGGER_RISING | IRQF_ONESHOT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) wm831x_bat_irqs[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) dev_err(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) "Failed to request %s IRQ %d: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) wm831x_bat_irqs[i], irq, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) goto err_bat_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) power->usb_phy = devm_usb_get_phy_by_phandle(&pdev->dev, "phys", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) ret = PTR_ERR_OR_ZERO(power->usb_phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) switch (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) power->usb_notify.notifier_call = wm831x_usb_limit_change;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) ret = usb_register_notifier(power->usb_phy, &power->usb_notify);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) dev_err(&pdev->dev, "Failed to register notifier: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) goto err_bat_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) case -EINVAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) case -ENODEV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) /* ignore missing usb-phy, it's optional */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) power->usb_phy = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) dev_err(&pdev->dev, "Failed to find USB phy: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) case -EPROBE_DEFER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) goto err_bat_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) err_bat_irq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) --i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) for (; i >= 0; i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) free_irq(irq, power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "PWR SRC"));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) free_irq(irq, power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) err_syslo:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "SYSLO"));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) free_irq(irq, power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) err_battery:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) if (power->have_battery)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) power_supply_unregister(power->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) err_usb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) power_supply_unregister(power->usb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) err_wall:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) power_supply_unregister(power->wall);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) static int wm831x_power_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) struct wm831x *wm831x = wm831x_power->wm831x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) int irq, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) if (wm831x_power->usb_phy) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) usb_unregister_notifier(wm831x_power->usb_phy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) &wm831x_power->usb_notify);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) irq = wm831x_irq(wm831x,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) platform_get_irq_byname(pdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) wm831x_bat_irqs[i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) free_irq(irq, wm831x_power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "PWR SRC"));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) free_irq(irq, wm831x_power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "SYSLO"));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) free_irq(irq, wm831x_power);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) if (wm831x_power->have_battery)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) power_supply_unregister(wm831x_power->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) power_supply_unregister(wm831x_power->wall);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) power_supply_unregister(wm831x_power->usb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) static struct platform_driver wm831x_power_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) .probe = wm831x_power_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) .remove = wm831x_power_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) .name = "wm831x-power",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) module_platform_driver(wm831x_power_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) MODULE_ALIAS("platform:wm831x-power");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags