2 * PMU driver for Wolfson Microelectronics wm831x PMICs
4 * Copyright 2009 Wolfson Microelectronics PLC.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/module.h>
12 #include <linux/err.h>
13 #include <linux/platform_device.h>
14 #include <linux/power_supply.h>
15 #include <linux/slab.h>
17 #include <linux/mfd/wm831x/core.h>
18 #include <linux/mfd/wm831x/auxadc.h>
19 #include <linux/mfd/wm831x/pmu.h>
20 #include <linux/mfd/wm831x/pdata.h>
21 #include <linux/mfd/wm831x/irq.h>
27 #define WM_BATT_DBG(x...) printk(KERN_INFO x)
29 #define WM_BATT_DBG(x...) do {} while (0)
32 #define WM831X_CHG_SYSLO_SHIFT 4
33 #define WM831X_CHG_SYSOK_SHIFT 0
34 #define WM831X_CHG_SYSLO_MASK ~(0x7 << 4)
35 #define WM831X_CHG_SYSOK_MASK ~(0x7 << 0)
39 static int batt_step_table[batt_num] = {
40 3400,3420,3440,3475,3505,3525,
41 3540,3557,3570,3580,3610,
42 3630,3640,3652,3662,3672,
43 3680,3687,3693,3699,3705,
44 3710,3714,3718,3722,3726,
45 3730,3734,3738,3742,3746,
46 3750,3756,3764,3774,3786,
47 3800,3808,3817,3827,3838,
48 3950,3964,3982,4002,4026,
49 4050,4074,4098,4123,4149,4178
52 static int batt_disp_table[batt_num] = {
65 static int batt_chg_step_table[batt_num] = {
66 3530,3565,3600,3635,3655,3680,//+160
67 3700,3717,3734,3745,3755,//+150
68 3770,3778,3786,3795,3803,//+140
69 3810,3814,3818,3822,3825,//+130
70 3830,3832,3834,3836,3837,//+120
71 3840,3842,3844,3846,3847,//+110
72 3850,3857,3864,3871,3876,//+100
73 3890,3897,3904,3911,3918,//+90
74 4030,4047,4064,4080,4096,//+80
75 4120,4132,4144,4156,4170,4180//+70
80 #define TIMER_MS_COUNTS 1000
81 struct wm_batt_priv_data {
91 struct wm831x *wm831x;
92 struct power_supply wall;
93 struct power_supply usb;
94 struct power_supply battery;
95 struct work_struct batt_work;
96 struct timer_list timer;
97 struct wm_batt_priv_data batt_info;
98 struct wake_lock syslo_wake;
102 struct wm831x_power *g_wm831x_power;
104 static int power_test_sysfs_init(void);
105 extern void wm831x_batt_vol_level(struct wm831x_power *power, int batt_vol, int *level);
106 static DEFINE_MUTEX(charging_mutex);
107 static struct wake_lock batt_wake_lock;
109 int wm831x_read_on_pin_status(void)
115 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
119 ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_ON_PIN_CONTROL);
123 return !(ret & WM831X_ON_PIN_STS) ? 1 : 0;
126 static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
127 union power_supply_propval *val)
131 ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
143 int wm831x_read_chg_status(void)
145 int ret, usb_chg = 0, wall_chg = 0;
149 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
153 ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
157 if (ret & WM831X_PWR_USB)
159 if (ret & WM831X_PWR_WALL)
162 return ((usb_chg | wall_chg) ? 1 : 0);
165 static int wm831x_power_read_voltage(struct wm831x *wm831x,
166 enum wm831x_auxadc src,
167 union power_supply_propval *val)
170 ret = wm831x_auxadc_read_uv(wm831x, src);
177 int wm831x_read_batt_voltage(void)
183 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
187 ret = wm831x_auxadc_read_uv(g_wm831x_power->wm831x, WM831X_AUX_BATT);
190 //EXPORT_SYMBOL_GPL(wm831x_get_batt_voltage);
192 /*********************************************************************
194 *********************************************************************/
195 static int wm831x_wall_get_prop(struct power_supply *psy,
196 enum power_supply_property psp,
197 union power_supply_propval *val)
199 struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
200 struct wm831x *wm831x = wm831x_power->wm831x;
204 case POWER_SUPPLY_PROP_ONLINE:
205 ret = wm831x_power_check_online(wm831x, WM831X_PWR_WALL, val);
207 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
208 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_WALL, val);
218 static enum power_supply_property wm831x_wall_props[] = {
219 POWER_SUPPLY_PROP_ONLINE,
220 POWER_SUPPLY_PROP_VOLTAGE_NOW,
223 /*********************************************************************
225 *********************************************************************/
226 static int wm831x_usb_get_prop(struct power_supply *psy,
227 enum power_supply_property psp,
228 union power_supply_propval *val)
230 struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
231 struct wm831x *wm831x = wm831x_power->wm831x;
235 case POWER_SUPPLY_PROP_ONLINE:
236 ret = wm831x_power_check_online(wm831x, WM831X_PWR_USB, val);
238 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
239 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_USB, val);
249 static enum power_supply_property wm831x_usb_props[] = {
250 POWER_SUPPLY_PROP_ONLINE,
251 POWER_SUPPLY_PROP_VOLTAGE_NOW,
254 /*********************************************************************
256 *********************************************************************/
263 static struct chg_map trickle_ilims[] = {
264 { 50, 0 << WM831X_CHG_TRKL_ILIM_SHIFT },
265 { 100, 1 << WM831X_CHG_TRKL_ILIM_SHIFT },
266 { 150, 2 << WM831X_CHG_TRKL_ILIM_SHIFT },
267 { 200, 3 << WM831X_CHG_TRKL_ILIM_SHIFT },
270 static struct chg_map vsels[] = {
271 { 4050, 0 << WM831X_CHG_VSEL_SHIFT },
272 { 4100, 1 << WM831X_CHG_VSEL_SHIFT },
273 { 4150, 2 << WM831X_CHG_VSEL_SHIFT },
274 { 4200, 3 << WM831X_CHG_VSEL_SHIFT },
277 static struct chg_map fast_ilims[] = {
278 { 0, 0 << WM831X_CHG_FAST_ILIM_SHIFT },
279 { 50, 1 << WM831X_CHG_FAST_ILIM_SHIFT },
280 { 100, 2 << WM831X_CHG_FAST_ILIM_SHIFT },
281 { 150, 3 << WM831X_CHG_FAST_ILIM_SHIFT },
282 { 200, 4 << WM831X_CHG_FAST_ILIM_SHIFT },
283 { 250, 5 << WM831X_CHG_FAST_ILIM_SHIFT },
284 { 300, 6 << WM831X_CHG_FAST_ILIM_SHIFT },
285 { 350, 7 << WM831X_CHG_FAST_ILIM_SHIFT },
286 { 400, 8 << WM831X_CHG_FAST_ILIM_SHIFT },
287 { 450, 9 << WM831X_CHG_FAST_ILIM_SHIFT },
288 { 500, 10 << WM831X_CHG_FAST_ILIM_SHIFT },
289 { 600, 11 << WM831X_CHG_FAST_ILIM_SHIFT },
290 { 700, 12 << WM831X_CHG_FAST_ILIM_SHIFT },
291 { 800, 13 << WM831X_CHG_FAST_ILIM_SHIFT },
292 { 900, 14 << WM831X_CHG_FAST_ILIM_SHIFT },
293 { 1000, 15 << WM831X_CHG_FAST_ILIM_SHIFT },
296 static struct chg_map eoc_iterms[] = {
297 { 20, 0 << WM831X_CHG_ITERM_SHIFT },
298 { 30, 1 << WM831X_CHG_ITERM_SHIFT },
299 { 40, 2 << WM831X_CHG_ITERM_SHIFT },
300 { 50, 3 << WM831X_CHG_ITERM_SHIFT },
301 { 60, 4 << WM831X_CHG_ITERM_SHIFT },
302 { 70, 5 << WM831X_CHG_ITERM_SHIFT },
303 { 80, 6 << WM831X_CHG_ITERM_SHIFT },
304 { 90, 7 << WM831X_CHG_ITERM_SHIFT },
307 static struct chg_map chg_times[] = {
308 { 60, 0 << WM831X_CHG_TIME_SHIFT },
309 { 90, 1 << WM831X_CHG_TIME_SHIFT },
310 { 120, 2 << WM831X_CHG_TIME_SHIFT },
311 { 150, 3 << WM831X_CHG_TIME_SHIFT },
312 { 180, 4 << WM831X_CHG_TIME_SHIFT },
313 { 210, 5 << WM831X_CHG_TIME_SHIFT },
314 { 240, 6 << WM831X_CHG_TIME_SHIFT },
315 { 270, 7 << WM831X_CHG_TIME_SHIFT },
316 { 300, 8 << WM831X_CHG_TIME_SHIFT },
317 { 330, 9 << WM831X_CHG_TIME_SHIFT },
318 { 360, 10 << WM831X_CHG_TIME_SHIFT },
319 { 390, 11 << WM831X_CHG_TIME_SHIFT },
320 { 420, 12 << WM831X_CHG_TIME_SHIFT },
321 { 450, 13 << WM831X_CHG_TIME_SHIFT },
322 { 480, 14 << WM831X_CHG_TIME_SHIFT },
323 { 510, 15 << WM831X_CHG_TIME_SHIFT },
326 static struct chg_map chg_syslos[] = {
327 { 2800, 0 << WM831X_CHG_SYSLO_SHIFT},
328 { 2900, 1 << WM831X_CHG_SYSLO_SHIFT},
329 { 3000, 2 << WM831X_CHG_SYSLO_SHIFT},
330 { 3100, 3 << WM831X_CHG_SYSLO_SHIFT},
331 { 3200, 4 << WM831X_CHG_SYSLO_SHIFT},
332 { 3300, 5 << WM831X_CHG_SYSLO_SHIFT},
333 { 3400, 6 << WM831X_CHG_SYSLO_SHIFT},
334 { 3500, 7 << WM831X_CHG_SYSLO_SHIFT},
337 static struct chg_map chg_sysoks[] = {
338 { 2800, 0 << WM831X_CHG_SYSOK_SHIFT},
339 { 2900, 1 << WM831X_CHG_SYSOK_SHIFT},
340 { 3000, 2 << WM831X_CHG_SYSOK_SHIFT},
341 { 3100, 3 << WM831X_CHG_SYSOK_SHIFT},
342 { 3200, 4 << WM831X_CHG_SYSOK_SHIFT},
343 { 3300, 5 << WM831X_CHG_SYSOK_SHIFT},
344 { 3400, 6 << WM831X_CHG_SYSOK_SHIFT},
345 { 3500, 7 << WM831X_CHG_SYSOK_SHIFT},
348 static void wm831x_battey_apply_config(struct wm831x *wm831x,
349 struct chg_map *map, int count, int val,
350 int *reg, const char *name,
354 for (i = 0; i < count; i++)
355 if (val == map[i].val)
358 dev_err(wm831x->dev, "Invalid %s %d%s\n",
361 *reg |= map[i].reg_val;
362 dev_dbg(wm831x->dev, "Set %s of %d%s\n", name, val, units);
366 static void wm831x_config_battery(struct wm831x *wm831x)
368 struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
369 struct wm831x_battery_pdata *pdata;
370 int ret, reg1, reg2, reg3;
372 if (!wm831x_pdata || !wm831x_pdata->battery) {
373 dev_warn(wm831x->dev,
374 "No battery charger configuration\n");
378 pdata = wm831x_pdata->battery;
384 if (!pdata->enable) {
385 dev_info(wm831x->dev, "Battery charger disabled\n");
389 reg1 |= WM831X_CHG_ENA;
391 reg2 |= WM831X_CHG_OFF_MSK;
392 if (pdata->fast_enable)
393 reg1 |= WM831X_CHG_FAST;
395 wm831x_battey_apply_config(wm831x, trickle_ilims,
396 ARRAY_SIZE(trickle_ilims),
397 pdata->trickle_ilim, ®2,
398 "trickle charge current limit", "mA");
400 wm831x_battey_apply_config(wm831x, vsels, ARRAY_SIZE(vsels),
402 "target voltage", "mV");
404 wm831x_battey_apply_config(wm831x, fast_ilims, ARRAY_SIZE(fast_ilims),
405 pdata->fast_ilim, ®2,
406 "fast charge current limit", "mA");
408 wm831x_battey_apply_config(wm831x, eoc_iterms, ARRAY_SIZE(eoc_iterms),
409 pdata->eoc_iterm, ®1,
410 "end of charge current threshold", "mA");
412 wm831x_battey_apply_config(wm831x, chg_times, ARRAY_SIZE(chg_times),
413 pdata->timeout, ®2,
414 "charger timeout", "min");
416 wm831x_battey_apply_config(wm831x, chg_syslos, ARRAY_SIZE(chg_syslos),
418 "syslo voltage", "mV");
420 wm831x_battey_apply_config(wm831x, chg_sysoks, ARRAY_SIZE(chg_sysoks),
422 "sysok voltage", "mV");
424 ret = wm831x_reg_unlock(wm831x);
426 dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
430 ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_1,
431 WM831X_CHG_ENA_MASK |
432 WM831X_CHG_FAST_MASK |
433 WM831X_CHG_ITERM_MASK,
436 dev_err(wm831x->dev, "Failed to set charger control 1: %d\n",
439 ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_2,
441 WM831X_CHG_TIME_MASK |
442 WM831X_CHG_FAST_ILIM_MASK |
443 WM831X_CHG_TRKL_ILIM_MASK |
444 WM831X_CHG_VSEL_MASK,
447 dev_err(wm831x->dev, "Failed to set charger control 2: %d\n",
451 ret = wm831x_set_bits(wm831x, WM831X_SYSVDD_CONTROL,
452 WM831X_CHG_SYSLO_MASK |
453 WM831X_CHG_SYSOK_MASK,
456 dev_err(wm831x->dev, "Failed to set sysvdd control reg: %d\n",ret);
459 wm831x_reg_lock(wm831x);
462 static int wm831x_bat_check_status(struct wm831x *wm831x, int *status)
466 ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
470 if (ret & WM831X_PWR_SRC_BATT) {
471 *status = POWER_SUPPLY_STATUS_DISCHARGING;
475 ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
480 switch (ret & WM831X_CHG_STATE_MASK) {
481 case WM831X_CHG_STATE_OFF:
482 *status = POWER_SUPPLY_STATUS_NOT_CHARGING;
484 case WM831X_CHG_STATE_TRICKLE:
485 case WM831X_CHG_STATE_FAST:
486 *status = POWER_SUPPLY_STATUS_CHARGING;
490 *status = POWER_SUPPLY_STATUS_UNKNOWN;
496 int wm831x_read_bat_charging_status(void)
502 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
506 ret = wm831x_bat_check_status(g_wm831x_power->wm831x, &status);
509 if (status == POWER_SUPPLY_STATUS_CHARGING)
514 static int wm831x_bat_check_type(struct wm831x *wm831x, int *type)
517 #ifdef WM831X_DEBUG_0
518 ret = wm831x_reg_read(wm831x, WM831X_POWER_STATE);
521 WM_BATT_DBG("%s: wm831x power status %#x\n", __FUNCTION__, ret);
523 ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
526 WM_BATT_DBG("%s: wm831x system status %#x\n", __FUNCTION__, ret);
528 ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_1);
531 WM_BATT_DBG("%s: wm831x charger control1 %#x\n", __FUNCTION__, ret);
533 ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_2);
536 WM_BATT_DBG("%s: wm831x charger control2 %#x\n", __FUNCTION__, ret);
538 ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
541 WM_BATT_DBG("%s: wm831x charger status %#x\n\n", __FUNCTION__, ret);
544 ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
548 switch (ret & WM831X_CHG_STATE_MASK) {
549 case WM831X_CHG_STATE_TRICKLE:
550 case WM831X_CHG_STATE_TRICKLE_OT:
551 *type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
553 case WM831X_CHG_STATE_FAST:
554 case WM831X_CHG_STATE_FAST_OT:
555 *type = POWER_SUPPLY_CHARGE_TYPE_FAST;
558 *type = POWER_SUPPLY_CHARGE_TYPE_NONE;
565 static int wm831x_bat_check_health(struct wm831x *wm831x, int *health)
569 ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
573 if (ret & WM831X_BATT_HOT_STS) {
574 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
578 if (ret & WM831X_BATT_COLD_STS) {
579 *health = POWER_SUPPLY_HEALTH_COLD;
583 if (ret & WM831X_BATT_OV_STS) {
584 *health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
588 switch (ret & WM831X_CHG_STATE_MASK) {
589 case WM831X_CHG_STATE_TRICKLE_OT:
590 case WM831X_CHG_STATE_FAST_OT:
591 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
593 case WM831X_CHG_STATE_DEFECTIVE:
594 *health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
597 *health = POWER_SUPPLY_HEALTH_GOOD;
604 static int wm831x_bat_get_prop(struct power_supply *psy,
605 enum power_supply_property psp,
606 union power_supply_propval *val)
608 struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
609 struct wm831x *wm831x = wm831x_power->wm831x;
613 case POWER_SUPPLY_PROP_STATUS:
614 ret = wm831x_bat_check_status(wm831x, &val->intval);
615 //val->intval = wm831x_power->batt_info.status;
617 case POWER_SUPPLY_PROP_PRESENT:
618 //case POWER_SUPPLY_PROP_ONLINE:
619 //ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT, val);
620 val->intval = wm831x_power->batt_info.online;
622 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
623 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
624 val->intval = wm831x_power->batt_info.voltage;//uV
626 case POWER_SUPPLY_PROP_HEALTH:
627 //ret = wm831x_bat_check_health(wm831x, &val->intval);
628 val->intval = wm831x_power->batt_info.health;
630 case POWER_SUPPLY_PROP_CHARGE_TYPE:
631 ret = wm831x_bat_check_type(wm831x, &val->intval);
633 case POWER_SUPPLY_PROP_CAPACITY:
634 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
635 //wm831x_batt_vol_level(wm831x_power, val->intval, &level);
636 //val->intval = level;
637 val->intval = wm831x_power->batt_info.level;
639 case POWER_SUPPLY_PROP_TEMP:
642 case POWER_SUPPLY_PROP_TECHNOLOGY:
643 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
653 static enum power_supply_property wm831x_bat_props[] = {
654 POWER_SUPPLY_PROP_STATUS,
655 POWER_SUPPLY_PROP_HEALTH,
656 POWER_SUPPLY_PROP_PRESENT,
657 POWER_SUPPLY_PROP_VOLTAGE_NOW,
658 POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
659 POWER_SUPPLY_PROP_TECHNOLOGY,
660 POWER_SUPPLY_PROP_TEMP,
661 POWER_SUPPLY_PROP_CHARGE_TYPE,
664 #ifdef CONFIG_WM831X_WITH_BATTERY
665 static const char *wm831x_bat_irqs[] = {
676 static irqreturn_t wm831x_bat_irq(int irq, void *data)
678 struct wm831x_power *wm831x_power = data;
679 struct wm831x *wm831x = wm831x_power->wm831x;
682 irq0 = wm831x->irq_base + WM831X_IRQ_CHG_BATT_HOT + 1;
683 dev_crit(wm831x->dev, "battery changed: i=%d\n", irq-irq0);
685 /* The battery charger is autonomous so we don't need to do
686 * anything except kick user space */
687 power_supply_changed(&wm831x_power->battery);
693 /*********************************************************************
695 *********************************************************************/
697 static irqreturn_t wm831x_syslo_irq(int irq, void *data)
699 struct wm831x_power *wm831x_power = data;
700 struct wm831x *wm831x = wm831x_power->wm831x;
702 /* Not much we can actually *do* but tell people for
703 * posterity, we're probably about to run out of power. */
704 dev_crit(wm831x->dev, "SYSVDD under voltage and wake lock 60s\n");
705 wake_lock_timeout(&wm831x_power->syslo_wake,60*HZ);//wait for android closing system
709 static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
711 struct wm831x_power *wm831x_power = data;
712 struct wm831x *wm831x = wm831x_power->wm831x;
714 wake_lock_timeout(&batt_wake_lock, 30 * HZ);
715 dev_dbg(wm831x->dev, "Power source changed\n");
716 WM_BATT_DBG("%s:Power source changed\n", __FUNCTION__);
717 /* Just notify for everything - little harm in overnotifying. */
718 power_supply_changed(&wm831x_power->battery);
719 power_supply_changed(&wm831x_power->usb);
720 power_supply_changed(&wm831x_power->wall);
726 static void wm831x_batt_timer_handler(unsigned long data)
728 struct wm831x_power *wm831x_power = (struct wm831x_power*)data;
729 schedule_work(&wm831x_power->batt_work);
730 mod_timer(&wm831x_power->timer, jiffies + msecs_to_jiffies(wm831x_power->interval));
733 void wm831x_batt_vol_level(struct wm831x_power *wm831x_power, int batt_vol, int *level)
736 static int chg_plus = 1000;
737 static int chg_minus = 1000;
738 static int chg_curr = 0;
739 static int chg_num = 60;
740 static int disp_plus = 1000;
741 static int disp_minus = 1000;
742 static int disp_curr = 0;
743 static int disp_num = 50;
746 *level = wm831x_power->batt_info.level;
747 ret = wm831x_bat_check_status(wm831x_power->wm831x, &status);
749 printk("%s: check bat status failer...err = %d\n", __FUNCTION__, ret);
753 if (status == POWER_SUPPLY_STATUS_NOT_CHARGING
754 && batt_vol >= batt_step_table[batt_num-1]) {
759 if (status == POWER_SUPPLY_STATUS_CHARGING)
765 for(i = 0; i < batt_num; i++){
766 if((batt_chg_step_table[i] <= batt_vol) &&
767 (batt_chg_step_table[i+1] > batt_vol))
770 *level = batt_disp_table[i];
772 if (batt_vol <= batt_chg_step_table[0])
774 if (batt_vol >= batt_chg_step_table[batt_num - 1])
778 if ((chg_plus == 1000) && (chg_minus == 1000))
788 if (*level >= (wm831x_power->batt_info.level+1))
793 if (++chg_plus > chg_num)
795 *level = wm831x_power->batt_info.level + 1;
806 *level = wm831x_power->batt_info.level;
810 else if (*level >= wm831x_power->batt_info.level)
815 if (++chg_curr > chg_num)
822 *level = wm831x_power->batt_info.level;
825 else if (*level < (wm831x_power->batt_info.level-1))
830 if (++chg_minus > (chg_num<<1))
832 *level = wm831x_power->batt_info.level - 1;
843 *level = wm831x_power->batt_info.level;
851 *level = wm831x_power->batt_info.level;
867 for(i = 0; i < batt_num; i++){
868 if(batt_vol >= batt_step_table[i] &&
869 batt_vol < batt_step_table[i+1])
872 *level = batt_disp_table[i];
874 if (batt_vol <= batt_step_table[0])
876 if (batt_vol >= batt_step_table[batt_num - 1])
880 if ((disp_plus == 1000) && (disp_minus == 1000))
890 if (*level <= (wm831x_power->batt_info.level-1))
895 if (++disp_minus > disp_num)
897 *level = wm831x_power->batt_info.level - 1;
900 if((*level < 17) || (*level > 85))
908 *level = wm831x_power->batt_info.level;
911 else if (*level <= wm831x_power->batt_info.level)
916 if (++disp_curr > disp_num)
923 *level = wm831x_power->batt_info.level;
926 else if (*level >= (wm831x_power->batt_info.level+1))
931 if (++disp_plus > (disp_num<<1))
933 *level = wm831x_power->batt_info.level + 1;
935 if((*level < 17) || (*level > 85))
942 *level = wm831x_power->batt_info.level;
950 *level = wm831x_power->batt_info.level;
961 static void wm831x_batt_work(struct work_struct *work)
963 int online, status,health,level, ret;
964 union power_supply_propval val;
965 struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
967 ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
969 printk("%s: check bat online failer... err = %d\n", __FUNCTION__, ret);
974 ret = wm831x_bat_check_status(power->wm831x, &status);
976 printk("%s: check bat status failer... err = %d\n", __FUNCTION__, ret);
980 ret = wm831x_bat_check_health(power->wm831x, &health);
982 printk("%s: check bat health failer... err = %d\n", __FUNCTION__, ret);
986 ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
988 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
991 power->batt_info.voltage = val.intval;
993 wm831x_batt_vol_level(power, val.intval / 1000, &level);
994 //mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
996 if (online != power->batt_info.online || status != power->batt_info.status
997 || health != power->batt_info.health || level != power->batt_info.level)
999 power->batt_info.online = online;
1000 power->batt_info.status = status;
1001 power->batt_info.health = health;
1002 power->batt_info.level = level;
1004 power_supply_changed(&power->battery);
1009 #ifdef CONFIG_POWER_ON_CHARGER_DISPLAY
1010 static void wm831x_batt_check(struct wm831x_power *power)
1012 int online, status,health,level, ret;
1013 union power_supply_propval val;
1014 // struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
1016 ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
1018 printk("%s: check bat online failer... err = %d\n", __FUNCTION__, ret);
1021 online = val.intval;
1023 ret = wm831x_bat_check_status(power->wm831x, &status);
1025 printk("%s: check bat status failer... err = %d\n", __FUNCTION__, ret);
1029 ret = wm831x_bat_check_health(power->wm831x, &health);
1031 printk("%s: check bat health failer... err = %d\n", __FUNCTION__, ret);
1035 ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
1037 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
1040 power->batt_info.voltage = val.intval;
1042 wm831x_batt_vol_level(power, val.intval / 1000, &level);
1043 //mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
1045 if (online != power->batt_info.online || status != power->batt_info.status
1046 || health != power->batt_info.health || level != power->batt_info.level)
1048 power->batt_info.online = online;
1049 power->batt_info.status = status;
1050 power->batt_info.health = health;
1051 power->batt_info.level = level;
1053 power_supply_changed(&power->battery);
1059 static __devinit int wm831x_power_probe(struct platform_device *pdev)
1061 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
1062 struct wm831x_power *power;
1063 struct power_supply *usb;
1064 struct power_supply *battery;
1065 struct power_supply *wall;
1068 power = kzalloc(sizeof(struct wm831x_power), GFP_KERNEL);
1072 power->wm831x = wm831x;
1073 platform_set_drvdata(pdev, power);
1076 battery = &power->battery;
1077 wall = &power->wall;
1079 /* We ignore configuration failures since we can still read back
1080 * the status without enabling the charger.
1082 wm831x_config_battery(wm831x);
1083 wake_lock_init(&batt_wake_lock, WAKE_LOCK_SUSPEND, "batt_lock");
1085 wall->name = "wm831x-wall";
1086 wall->type = POWER_SUPPLY_TYPE_MAINS;
1087 wall->properties = wm831x_wall_props;
1088 wall->num_properties = ARRAY_SIZE(wm831x_wall_props);
1089 wall->get_property = wm831x_wall_get_prop;
1090 ret = power_supply_register(&pdev->dev, wall);
1094 battery->name = "wm831x-battery";
1095 battery->properties = wm831x_bat_props;
1096 battery->num_properties = ARRAY_SIZE(wm831x_bat_props);
1097 battery->get_property = wm831x_bat_get_prop;
1098 battery->use_for_apm = 1;
1099 ret = power_supply_register(&pdev->dev, battery);
1103 usb->name = "wm831x-usb",
1104 usb->type = POWER_SUPPLY_TYPE_USB;
1105 usb->properties = wm831x_usb_props;
1106 usb->num_properties = ARRAY_SIZE(wm831x_usb_props);
1107 usb->get_property = wm831x_usb_get_prop;
1108 ret = power_supply_register(&pdev->dev, usb);
1112 irq = platform_get_irq_byname(pdev, "SYSLO");
1113 ret = request_threaded_irq(irq, NULL, wm831x_syslo_irq,
1114 IRQF_TRIGGER_RISING, "System power low",
1117 dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
1122 irq = platform_get_irq_byname(pdev, "PWR SRC");
1123 ret = request_threaded_irq(irq, NULL, wm831x_pwr_src_irq,
1124 IRQF_TRIGGER_RISING, "Power source",
1127 dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
1132 #ifdef CONFIG_WM831X_WITH_BATTERY
1134 for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1135 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1136 ret = request_threaded_irq(irq, NULL, wm831x_bat_irq,
1137 IRQF_TRIGGER_RISING,
1140 WM_BATT_DBG("%s: %s irq no %d\n", __FUNCTION__, wm831x_bat_irqs[i], irq);
1143 "Failed to request %s IRQ %d: %d\n",
1144 wm831x_bat_irqs[i], irq, ret);
1150 power->interval = TIMER_MS_COUNTS;
1151 power->batt_info.level = 100;
1152 power->batt_info.voltage = 4200000;
1153 power->batt_info.online = 1;
1154 power->batt_info.status = POWER_SUPPLY_STATUS_DISCHARGING;
1155 power->batt_info.health = POWER_SUPPLY_HEALTH_GOOD;
1157 wake_lock_init(&power->syslo_wake, WAKE_LOCK_SUSPEND, "wm831x_syslo_wake");
1158 INIT_WORK(&power->batt_work, wm831x_batt_work);
1159 setup_timer(&power->timer, wm831x_batt_timer_handler, (unsigned long)power);
1160 power->timer.expires = jiffies + msecs_to_jiffies(1000);
1161 add_timer(&power->timer);
1163 g_wm831x_power = power;
1164 #ifdef CONFIG_POWER_ON_CHARGER_DISPLAY
1165 wm831x_batt_check(power);//xsf
1168 printk("%s:wm831x_power initialized\n",__FUNCTION__);
1169 power_test_sysfs_init();
1172 #ifdef CONFIG_WM831X_WITH_BATTERY
1174 for (; i >= 0; i--) {
1175 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1176 free_irq(irq, power);
1178 irq = platform_get_irq_byname(pdev, "PWR SRC");
1179 free_irq(irq, power);
1183 irq = platform_get_irq_byname(pdev, "SYSLO");
1184 free_irq(irq, power);
1186 power_supply_unregister(usb);
1188 power_supply_unregister(battery);
1190 power_supply_unregister(wall);
1196 static __devexit int wm831x_power_remove(struct platform_device *pdev)
1198 struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
1200 #ifdef CONFIG_WM831X_WITH_BATTERY
1202 for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1203 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1204 free_irq(irq, wm831x_power);
1207 irq = platform_get_irq_byname(pdev, "PWR SRC");
1208 free_irq(irq, wm831x_power);
1210 irq = platform_get_irq_byname(pdev, "SYSLO");
1211 free_irq(irq, wm831x_power);
1213 power_supply_unregister(&wm831x_power->battery);
1214 power_supply_unregister(&wm831x_power->wall);
1215 power_supply_unregister(&wm831x_power->usb);
1216 kfree(wm831x_power);
1221 static int wm831x_battery_suspend(struct platform_device *dev, pm_message_t state)
1223 struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1224 flush_scheduled_work();
1225 del_timer(&power->timer);
1229 static int wm831x_battery_resume(struct platform_device *dev)
1231 struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1232 power->timer.expires = jiffies + msecs_to_jiffies(power->interval);
1233 add_timer(&power->timer);
1237 #define wm831x_battery_suspend NULL
1238 #define wm831x_battery_resume NULL
1241 static struct platform_driver wm831x_power_driver = {
1242 .probe = wm831x_power_probe,
1243 .remove = __devexit_p(wm831x_power_remove),
1244 .suspend = wm831x_battery_suspend,
1245 .resume = wm831x_battery_resume,
1247 .name = "wm831x-power",
1250 static int __init wm831x_power_init(void)
1252 return platform_driver_register(&wm831x_power_driver);
1254 #ifndef CONFIG_POWER_ON_CHARGER_DISPLAY
1255 module_init(wm831x_power_init);
1257 subsys_initcall(wm831x_power_init);
1260 static void __exit wm831x_power_exit(void)
1262 platform_driver_unregister(&wm831x_power_driver);
1264 module_exit(wm831x_power_exit);
1267 static ssize_t power_prop_show(struct device *dev,
1268 struct device_attribute *attr, char *buf)
1271 int level, power_status, system_status, chg_ctl1, chg_ctl2, chg_status;
1272 union power_supply_propval val;
1274 if (!g_wm831x_power)
1276 power_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_POWER_STATE);
1277 if (power_status < 0)
1278 return power_status;
1279 //printk("wm831x power status %#x\n", ret);
1281 system_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
1282 if (system_status < 0)
1283 return system_status;
1284 //printk("wm831x system status %#x\n", ret);
1286 chg_ctl1 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_1);
1289 //printk("wm831x charger control1 %#x\n", ret);
1291 chg_ctl2 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_2);
1294 //printk("wm831x charger control2 %#x\n", ret);
1296 chg_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_STATUS);
1299 //printk("wm831x charger status %#x\n", ret);
1301 ret = wm831x_power_read_voltage(g_wm831x_power->wm831x, WM831X_AUX_BATT, &val);
1304 wm831x_batt_vol_level(g_wm831x_power, val.intval / 1000, &level);
1305 //printk("batt_vol = %d batt_level = %d\n", val.intval, level);
1307 sprintf(buf, "power_status=%#x\n"
1308 "system_status=%#x\n"
1313 "batt_level=%d%%\n",
1321 ret = strlen(buf) + 1;
1325 static DEVICE_ATTR(prop, 0444, power_prop_show, NULL);
1327 static struct kobject *power_test_kobj;
1329 static int power_test_sysfs_init(void)
1332 power_test_kobj = kobject_create_and_add("power_test_prop", NULL);
1333 if (power_test_kobj == NULL) {
1335 "power_test_sysfs_init:"\
1336 "subsystem_register failed\n");
1340 ret = sysfs_create_file(power_test_kobj, &dev_attr_prop.attr);
1343 "power_test_sysfs_init:"\
1344 "sysfs_create_group failed\n");
1350 kobject_del(power_test_kobj);
1356 MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
1357 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
1358 MODULE_LICENSE("GPL");
1359 MODULE_ALIAS("platform:wm831x-power");