Revert "wm831x:fix building error"
[firefly-linux-kernel-4.4.55.git] / drivers / power / wm831x_power.c
1 /*
2  * PMU driver for Wolfson Microelectronics wm831x PMICs
3  *
4  * Copyright 2009 Wolfson Microelectronics PLC.
5  *
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.
9  */
10
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>
16
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>
22
23 #define WM831X_DEBUG
24 #undef  WM831X_DEBUG
25
26 #ifdef WM831X_DEBUG
27 #define WM_BATT_DBG(x...) printk(KERN_INFO x)
28 #else
29 #define WM_BATT_DBG(x...)  do {} while (0)
30 #endif
31
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)
36
37 #define batt_num   52
38
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
50 };
51
52 static int batt_disp_table[batt_num] = {
53         0,1,2,3,5,7,
54         9,11,13,15,17,
55         19,21,23,25,27,
56         29,31,33,35,37,
57         39,41,43,45,47,
58         49,51,53,55,57,
59         59,61,63,65,67,
60         69,71,73,75,77,
61         79,81,83,85,87,
62         89,91,93,95,97,100
63 };
64
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
76 };
77
78
79
80 #define TIMER_MS_COUNTS 1000
81 struct wm_batt_priv_data {
82         int online;
83         int status;
84         int health;
85         int level;
86         int temp;
87         int voltage;
88 };
89
90 struct wm831x_power {
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;
99         int interval;
100 };
101
102 struct wm831x_power *g_wm831x_power;
103
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
108 int wm831x_read_on_pin_status(void)
109 {
110         int ret;
111         
112         if(!g_wm831x_power)
113         {
114                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
115                 return -1;
116         }
117         
118         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_ON_PIN_CONTROL);
119         if (ret < 0)
120                 return ret;
121
122         return !(ret & WM831X_ON_PIN_STS) ? 1 : 0;
123 }
124
125 static int wm831x_power_check_online(struct wm831x *wm831x, int supply,
126                                      union power_supply_propval *val)
127 {
128         int ret;
129
130         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
131         if (ret < 0)
132                 return ret;
133
134         if (ret & supply)
135                 val->intval = 1;
136         else
137                 val->intval = 0;
138
139         return 0;
140 }
141
142 int wm831x_read_chg_status(void)
143 {
144         int ret, usb_chg = 0, wall_chg = 0;
145         
146         if(!g_wm831x_power)
147         {
148                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
149                 return -1;
150         }
151         
152         ret = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
153         if (ret < 0)
154                 return ret;
155
156         if (ret & WM831X_PWR_USB)
157                 usb_chg = 1;
158         if (ret & WM831X_PWR_WALL)
159                 wall_chg = 1;
160
161         return ((usb_chg | wall_chg) ? 1 : 0);
162 }
163
164 static int wm831x_power_read_voltage(struct wm831x *wm831x,
165                                      enum wm831x_auxadc src,
166                                      union power_supply_propval *val)
167 {
168         int ret;
169         ret = wm831x_auxadc_read_uv(wm831x, src);
170         if (ret >= 0)
171                 val->intval = ret / 1000;
172         
173         return ret ;
174 }
175
176 int wm831x_read_batt_voltage(void)
177 {
178         int ret = 0;
179         
180         if(!g_wm831x_power)
181         {
182                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
183                 return -1;
184         }
185         
186         ret = wm831x_auxadc_read_uv(g_wm831x_power->wm831x, WM831X_AUX_BATT);
187         return ret / 1000;
188 }
189 //EXPORT_SYMBOL_GPL(wm831x_get_batt_voltage);
190
191 /*********************************************************************
192  *              WALL Power
193  *********************************************************************/
194 static int wm831x_wall_get_prop(struct power_supply *psy,
195                                 enum power_supply_property psp,
196                                 union power_supply_propval *val)
197 {
198         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
199         struct wm831x *wm831x = wm831x_power->wm831x;
200         int ret = 0;
201
202         switch (psp) {
203         case POWER_SUPPLY_PROP_ONLINE:
204                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_WALL, val);
205                 break;
206         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
207                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_WALL, val);
208                 break;
209         default:
210                 ret = -EINVAL;
211                 break;
212         }
213
214         return ret;
215 }
216
217 static enum power_supply_property wm831x_wall_props[] = {
218         POWER_SUPPLY_PROP_ONLINE,
219         POWER_SUPPLY_PROP_VOLTAGE_NOW,
220 };
221
222 /*********************************************************************
223  *              USB Power
224  *********************************************************************/
225 static int wm831x_usb_get_prop(struct power_supply *psy,
226                                enum power_supply_property psp,
227                                union power_supply_propval *val)
228 {
229         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
230         struct wm831x *wm831x = wm831x_power->wm831x;
231         int ret = 0;
232
233         switch (psp) {
234         case POWER_SUPPLY_PROP_ONLINE:
235                 ret = wm831x_power_check_online(wm831x, WM831X_PWR_USB, val);
236                 break;
237         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
238                 ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_USB, val);
239                 break;
240         default:
241                 ret = -EINVAL;
242                 break;
243         }
244
245         return ret;
246 }
247
248 static enum power_supply_property wm831x_usb_props[] = {
249         POWER_SUPPLY_PROP_ONLINE,
250         POWER_SUPPLY_PROP_VOLTAGE_NOW,
251 };
252
253 /*********************************************************************
254  *              Battery properties
255  *********************************************************************/
256
257 struct chg_map {
258         int val;
259         int reg_val;
260 };
261
262 static struct chg_map trickle_ilims[] = {
263         {  50, 0 << WM831X_CHG_TRKL_ILIM_SHIFT },
264         { 100, 1 << WM831X_CHG_TRKL_ILIM_SHIFT },
265         { 150, 2 << WM831X_CHG_TRKL_ILIM_SHIFT },
266         { 200, 3 << WM831X_CHG_TRKL_ILIM_SHIFT },
267 };
268
269 static struct chg_map vsels[] = {
270         { 4050, 0 << WM831X_CHG_VSEL_SHIFT },
271         { 4100, 1 << WM831X_CHG_VSEL_SHIFT },
272         { 4150, 2 << WM831X_CHG_VSEL_SHIFT },
273         { 4200, 3 << WM831X_CHG_VSEL_SHIFT },
274 };
275
276 static struct chg_map fast_ilims[] = {
277         {    0,  0 << WM831X_CHG_FAST_ILIM_SHIFT },
278         {   50,  1 << WM831X_CHG_FAST_ILIM_SHIFT },
279         {  100,  2 << WM831X_CHG_FAST_ILIM_SHIFT },
280         {  150,  3 << WM831X_CHG_FAST_ILIM_SHIFT },
281         {  200,  4 << WM831X_CHG_FAST_ILIM_SHIFT },
282         {  250,  5 << WM831X_CHG_FAST_ILIM_SHIFT },
283         {  300,  6 << WM831X_CHG_FAST_ILIM_SHIFT },
284         {  350,  7 << WM831X_CHG_FAST_ILIM_SHIFT },
285         {  400,  8 << WM831X_CHG_FAST_ILIM_SHIFT },
286         {  450,  9 << WM831X_CHG_FAST_ILIM_SHIFT },
287         {  500, 10 << WM831X_CHG_FAST_ILIM_SHIFT },
288         {  600, 11 << WM831X_CHG_FAST_ILIM_SHIFT },
289         {  700, 12 << WM831X_CHG_FAST_ILIM_SHIFT },
290         {  800, 13 << WM831X_CHG_FAST_ILIM_SHIFT },
291         {  900, 14 << WM831X_CHG_FAST_ILIM_SHIFT },
292         { 1000, 15 << WM831X_CHG_FAST_ILIM_SHIFT },
293 };
294
295 static struct chg_map eoc_iterms[] = {
296         { 20, 0 << WM831X_CHG_ITERM_SHIFT },
297         { 30, 1 << WM831X_CHG_ITERM_SHIFT },
298         { 40, 2 << WM831X_CHG_ITERM_SHIFT },
299         { 50, 3 << WM831X_CHG_ITERM_SHIFT },
300         { 60, 4 << WM831X_CHG_ITERM_SHIFT },
301         { 70, 5 << WM831X_CHG_ITERM_SHIFT },
302         { 80, 6 << WM831X_CHG_ITERM_SHIFT },
303         { 90, 7 << WM831X_CHG_ITERM_SHIFT },
304 };
305
306 static struct chg_map chg_times[] = {
307         {  60,  0 << WM831X_CHG_TIME_SHIFT },
308         {  90,  1 << WM831X_CHG_TIME_SHIFT },
309         { 120,  2 << WM831X_CHG_TIME_SHIFT },
310         { 150,  3 << WM831X_CHG_TIME_SHIFT },
311         { 180,  4 << WM831X_CHG_TIME_SHIFT },
312         { 210,  5 << WM831X_CHG_TIME_SHIFT },
313         { 240,  6 << WM831X_CHG_TIME_SHIFT },
314         { 270,  7 << WM831X_CHG_TIME_SHIFT },
315         { 300,  8 << WM831X_CHG_TIME_SHIFT },
316         { 330,  9 << WM831X_CHG_TIME_SHIFT },
317         { 360, 10 << WM831X_CHG_TIME_SHIFT },
318         { 390, 11 << WM831X_CHG_TIME_SHIFT },
319         { 420, 12 << WM831X_CHG_TIME_SHIFT },
320         { 450, 13 << WM831X_CHG_TIME_SHIFT },
321         { 480, 14 << WM831X_CHG_TIME_SHIFT },
322         { 510, 15 << WM831X_CHG_TIME_SHIFT },
323 };
324
325 static struct chg_map chg_syslos[] = {
326         { 2800, 0 << WM831X_CHG_SYSLO_SHIFT},
327         { 2900, 1 << WM831X_CHG_SYSLO_SHIFT},
328         { 3000, 2 << WM831X_CHG_SYSLO_SHIFT},
329         { 3100, 3 << WM831X_CHG_SYSLO_SHIFT},
330         { 3200, 4 << WM831X_CHG_SYSLO_SHIFT},
331         { 3300, 5 << WM831X_CHG_SYSLO_SHIFT},
332         { 3400, 6 << WM831X_CHG_SYSLO_SHIFT},
333         { 3500, 7 << WM831X_CHG_SYSLO_SHIFT},
334 };
335
336 static struct chg_map chg_sysoks[] = {
337         { 2800, 0 << WM831X_CHG_SYSOK_SHIFT},
338         { 2900, 1 << WM831X_CHG_SYSOK_SHIFT},
339         { 3000, 2 << WM831X_CHG_SYSOK_SHIFT},
340         { 3100, 3 << WM831X_CHG_SYSOK_SHIFT},
341         { 3200, 4 << WM831X_CHG_SYSOK_SHIFT},
342         { 3300, 5 << WM831X_CHG_SYSOK_SHIFT},
343         { 3400, 6 << WM831X_CHG_SYSOK_SHIFT},
344         { 3500, 7 << WM831X_CHG_SYSOK_SHIFT},
345 };
346
347 static void wm831x_battey_apply_config(struct wm831x *wm831x,
348                                        struct chg_map *map, int count, int val,
349                                        int *reg, const char *name,
350                                        const char *units)
351 {
352         int i;
353         for (i = 0; i < count; i++)
354                 if (val == map[i].val)
355                         break;
356         if (i == count) {
357                 dev_err(wm831x->dev, "Invalid %s %d%s\n",
358                         name, val, units);
359         } else {
360                 *reg |= map[i].reg_val;
361                 dev_dbg(wm831x->dev, "Set %s of %d%s\n", name, val, units);
362         }
363 }
364
365 static void wm831x_config_battery(struct wm831x *wm831x)
366 {
367         struct wm831x_pdata *wm831x_pdata = wm831x->dev->platform_data;
368         struct wm831x_battery_pdata *pdata;
369         int ret, reg1, reg2, reg3;
370
371         if (!wm831x_pdata || !wm831x_pdata->battery) {
372                 dev_warn(wm831x->dev,
373                          "No battery charger configuration\n");
374                 return;
375         }
376
377         pdata = wm831x_pdata->battery;
378
379         reg1 = 0;
380         reg2 = 0;
381         reg3 = 0;
382
383         if (!pdata->enable) {
384                 dev_info(wm831x->dev, "Battery charger disabled\n");
385                 return;
386         }
387
388         reg1 |= WM831X_CHG_ENA;
389         if (pdata->off_mask)
390                 reg2 |= WM831X_CHG_OFF_MSK;
391         if (pdata->fast_enable)
392                 reg1 |= WM831X_CHG_FAST;
393
394         wm831x_battey_apply_config(wm831x, trickle_ilims,
395                                    ARRAY_SIZE(trickle_ilims),
396                                    pdata->trickle_ilim, &reg2,
397                                    "trickle charge current limit", "mA");
398
399         wm831x_battey_apply_config(wm831x, vsels, ARRAY_SIZE(vsels),
400                                    pdata->vsel, &reg2,
401                                    "target voltage", "mV");
402
403         wm831x_battey_apply_config(wm831x, fast_ilims, ARRAY_SIZE(fast_ilims),
404                                    pdata->fast_ilim, &reg2,
405                                    "fast charge current limit", "mA");
406
407         wm831x_battey_apply_config(wm831x, eoc_iterms, ARRAY_SIZE(eoc_iterms),
408                                    pdata->eoc_iterm, &reg1,
409                                    "end of charge current threshold", "mA");
410
411         wm831x_battey_apply_config(wm831x, chg_times, ARRAY_SIZE(chg_times),
412                                    pdata->timeout, &reg2,
413                                    "charger timeout", "min");
414
415         wm831x_battey_apply_config(wm831x, chg_syslos, ARRAY_SIZE(chg_syslos),
416                                    pdata->syslo, &reg3,
417                                    "syslo voltage", "mV");
418
419         wm831x_battey_apply_config(wm831x, chg_sysoks, ARRAY_SIZE(chg_sysoks),
420                                    pdata->sysok, &reg3,
421                                    "sysok voltage", "mV");
422
423         ret = wm831x_reg_unlock(wm831x);
424         if (ret != 0) {
425                 dev_err(wm831x->dev, "Failed to unlock registers: %d\n", ret);
426                 return;
427         }
428
429         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_1,
430                               WM831X_CHG_ENA_MASK |
431                               WM831X_CHG_FAST_MASK |
432                               WM831X_CHG_ITERM_MASK,
433                               reg1);
434         if (ret != 0) {
435                 dev_err(wm831x->dev, "Failed to set charger control 1: %d\n",
436                         ret);
437         }
438         ret = wm831x_set_bits(wm831x, WM831X_CHARGER_CONTROL_2,
439                               WM831X_CHG_OFF_MSK |
440                               WM831X_CHG_TIME_MASK |
441                               WM831X_CHG_FAST_ILIM_MASK |
442                               WM831X_CHG_TRKL_ILIM_MASK |
443                               WM831X_CHG_VSEL_MASK,
444                               reg2);
445         if (ret != 0) {
446                 dev_err(wm831x->dev, "Failed to set charger control 2: %d\n",
447                         ret);
448         }
449
450         ret = wm831x_set_bits(wm831x, WM831X_SYSVDD_CONTROL,
451                                           WM831X_CHG_SYSLO_MASK |
452                                                   WM831X_CHG_SYSOK_MASK,
453                                                   reg3);
454         if (ret < 0) {
455                 dev_err(wm831x->dev, "Failed to set sysvdd control reg: %d\n",ret);
456         }
457
458         wm831x_reg_lock(wm831x);
459 }
460
461 static int wm831x_bat_check_status(struct wm831x *wm831x, int *status)
462 {
463         int ret;
464
465         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
466         if (ret < 0)
467                 return ret;
468
469         if (ret & WM831X_PWR_SRC_BATT) {
470                 *status = POWER_SUPPLY_STATUS_DISCHARGING;
471                 return 0;
472         }
473
474         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
475         if (ret < 0)
476                 return ret;
477
478         switch (ret & WM831X_CHG_STATE_MASK) {
479         case WM831X_CHG_STATE_OFF:
480                 *status = POWER_SUPPLY_STATUS_NOT_CHARGING;
481                 break;
482         case WM831X_CHG_STATE_TRICKLE:
483         case WM831X_CHG_STATE_FAST:
484                 *status = POWER_SUPPLY_STATUS_CHARGING;
485                 break;
486
487         default:
488                 *status = POWER_SUPPLY_STATUS_UNKNOWN;
489                 break;
490         }
491
492         return 0;
493 }
494 int wm831x_read_bat_charging_status(void)
495 {
496         int ret, status;
497         
498         if(!g_wm831x_power)
499         {
500                 printk("err:%s:g_wm831x_power address is 0\n",__FUNCTION__);
501                 return -1;
502         }
503         
504         ret = wm831x_bat_check_status(g_wm831x_power->wm831x, &status);
505         if (ret < 0)
506                 return ret;
507         if (status == POWER_SUPPLY_STATUS_CHARGING) 
508                 return 1;
509         return 0;
510 }
511
512 static int wm831x_bat_check_type(struct wm831x *wm831x, int *type)
513 {
514         int ret;
515 #ifdef WM831X_DEBUG_0 
516         ret = wm831x_reg_read(wm831x, WM831X_POWER_STATE);
517         if (ret < 0)
518                 return ret;
519         WM_BATT_DBG("%s: wm831x power status %#x\n", __FUNCTION__, ret);
520
521         ret = wm831x_reg_read(wm831x, WM831X_SYSTEM_STATUS);
522         if (ret < 0)
523                 return ret;
524         WM_BATT_DBG("%s: wm831x system status %#x\n", __FUNCTION__, ret);
525
526         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_1);
527         if (ret < 0)
528                 return ret;
529         WM_BATT_DBG("%s: wm831x charger control1 %#x\n", __FUNCTION__, ret);
530
531         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_CONTROL_2);
532         if (ret < 0)
533                 return ret;
534         WM_BATT_DBG("%s: wm831x charger control2 %#x\n", __FUNCTION__, ret);
535
536         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
537         if (ret < 0)
538                 return ret;
539         WM_BATT_DBG("%s: wm831x charger status %#x\n\n", __FUNCTION__, ret);
540 #endif
541
542         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
543         if (ret < 0)
544                 return ret;
545
546         switch (ret & WM831X_CHG_STATE_MASK) {
547         case WM831X_CHG_STATE_TRICKLE:
548         case WM831X_CHG_STATE_TRICKLE_OT:
549                 *type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
550                 break;
551         case WM831X_CHG_STATE_FAST:
552         case WM831X_CHG_STATE_FAST_OT:
553                 *type = POWER_SUPPLY_CHARGE_TYPE_FAST;
554                 break;
555         default:
556                 *type = POWER_SUPPLY_CHARGE_TYPE_NONE;
557                 break;
558         }
559
560         return 0;
561 }
562
563 static int wm831x_bat_check_health(struct wm831x *wm831x, int *health)
564 {
565         int ret;
566
567         ret = wm831x_reg_read(wm831x, WM831X_CHARGER_STATUS);
568         if (ret < 0)
569                 return ret;
570
571         if (ret & WM831X_BATT_HOT_STS) {
572                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
573                 return 0;
574         }
575
576         if (ret & WM831X_BATT_COLD_STS) {
577                 *health = POWER_SUPPLY_HEALTH_COLD;
578                 return 0;
579         }
580
581         if (ret & WM831X_BATT_OV_STS) {
582                 *health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
583                 return 0;
584         }
585
586         switch (ret & WM831X_CHG_STATE_MASK) {
587         case WM831X_CHG_STATE_TRICKLE_OT:
588         case WM831X_CHG_STATE_FAST_OT:
589                 *health = POWER_SUPPLY_HEALTH_OVERHEAT;
590                 break;
591         case WM831X_CHG_STATE_DEFECTIVE:
592                 *health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
593                 break;
594         default:
595                 *health = POWER_SUPPLY_HEALTH_GOOD;
596                 break;
597         }
598
599         return 0;
600 }
601
602 static int wm831x_bat_get_prop(struct power_supply *psy,
603                                enum power_supply_property psp,
604                                union power_supply_propval *val)
605 {
606         struct wm831x_power *wm831x_power = dev_get_drvdata(psy->dev->parent);
607         struct wm831x *wm831x = wm831x_power->wm831x;
608         int ret = 0;
609
610         switch (psp) {
611         case POWER_SUPPLY_PROP_STATUS:
612                 ret = wm831x_bat_check_status(wm831x, &val->intval);
613                 //val->intval = wm831x_power->batt_info.status;
614                 break;
615         case POWER_SUPPLY_PROP_PRESENT:
616         case POWER_SUPPLY_PROP_ONLINE:
617                 //ret = wm831x_power_check_online(wm831x, WM831X_PWR_SRC_BATT, val);
618                 val->intval = wm831x_power->batt_info.online;
619                 break;
620         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
621                 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
622                 val->intval = wm831x_power->batt_info.voltage*1000;//uV
623                 break;
624         case POWER_SUPPLY_PROP_HEALTH:
625                 //ret = wm831x_bat_check_health(wm831x, &val->intval);
626                 val->intval = wm831x_power->batt_info.health;
627                 break;
628         case POWER_SUPPLY_PROP_CHARGE_TYPE:
629                 ret = wm831x_bat_check_type(wm831x, &val->intval);
630                 break;
631         case POWER_SUPPLY_PROP_CAPACITY:
632                 //ret = wm831x_power_read_voltage(wm831x, WM831X_AUX_BATT, val);
633                 //wm831x_batt_vol_level(wm831x_power, val->intval, &level);
634                 //val->intval = level;
635                 val->intval = wm831x_power->batt_info.level;
636                 break;
637         case POWER_SUPPLY_PROP_TEMP:
638                 val->intval = 0;
639                 break;
640         case POWER_SUPPLY_PROP_TECHNOLOGY:
641                 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
642                 break;
643         default:
644                 ret = -EINVAL;
645                 break;
646         }
647
648         return ret;
649 }
650
651 static enum power_supply_property wm831x_bat_props[] = {
652         POWER_SUPPLY_PROP_STATUS,
653         POWER_SUPPLY_PROP_HEALTH,
654         POWER_SUPPLY_PROP_PRESENT,
655         POWER_SUPPLY_PROP_VOLTAGE_NOW,
656         POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
657         POWER_SUPPLY_PROP_TECHNOLOGY,
658         POWER_SUPPLY_PROP_TEMP,
659         POWER_SUPPLY_PROP_CHARGE_TYPE,
660 };
661
662 #ifdef CONFIG_WM831X_WITH_BATTERY
663 static const char *wm831x_bat_irqs[] = {
664         "BATT HOT",
665         "BATT COLD",
666         "BATT FAIL",
667         "OV",
668         "END",
669         "TO",
670         "MODE",
671         "START",
672 };
673
674 static irqreturn_t wm831x_bat_irq(int irq, void *data)
675 {
676         struct wm831x_power *wm831x_power = data;
677         struct wm831x *wm831x = wm831x_power->wm831x;
678         int irq0;
679         
680         irq0 = wm831x->irq_base + WM831X_IRQ_CHG_BATT_HOT + 1;
681         dev_crit(wm831x->dev, "battery changed: i=%d\n", irq-irq0);
682                         
683         /* The battery charger is autonomous so we don't need to do
684          * anything except kick user space */
685         power_supply_changed(&wm831x_power->battery);
686
687         return IRQ_HANDLED;
688 }
689 #endif
690
691 /*********************************************************************
692  *              Initialisation
693  *********************************************************************/
694
695 static irqreturn_t wm831x_syslo_irq(int irq, void *data)
696 {
697         struct wm831x_power *wm831x_power = data;
698         struct wm831x *wm831x = wm831x_power->wm831x;
699
700         /* Not much we can actually *do* but tell people for
701          * posterity, we're probably about to run out of power. */
702         dev_crit(wm831x->dev, "SYSVDD under voltage and wake lock 60s\n");
703         wake_lock_timeout(&wm831x_power->syslo_wake,60*HZ);//wait for android closing system
704         return IRQ_HANDLED;
705 }
706
707 static irqreturn_t wm831x_pwr_src_irq(int irq, void *data)
708 {
709         struct wm831x_power *wm831x_power = data;
710         struct wm831x *wm831x = wm831x_power->wm831x;
711
712         dev_dbg(wm831x->dev, "Power source changed\n");
713         WM_BATT_DBG("%s:Power source changed\n", __FUNCTION__); 
714         /* Just notify for everything - little harm in overnotifying. */
715         power_supply_changed(&wm831x_power->battery);
716         power_supply_changed(&wm831x_power->usb);
717         power_supply_changed(&wm831x_power->wall);
718
719         return IRQ_HANDLED;
720 }
721
722 static void wm831x_batt_timer_handler(unsigned long data)
723 {
724         struct wm831x_power *wm831x_power = (struct wm831x_power*)data;
725         schedule_work(&wm831x_power->batt_work);
726         mod_timer(&wm831x_power->timer, jiffies + msecs_to_jiffies(wm831x_power->interval));
727 }
728
729 void wm831x_batt_vol_level(struct wm831x_power *wm831x_power, int batt_vol, int *level)
730 {
731         int i, ret, status;
732         static int chg_plus = 1000;
733         static int chg_minus = 1000;
734         static int chg_curr = 0;
735         static int chg_num = 60;
736         static int disp_plus = 1000;
737         static int disp_minus = 1000;
738         static int disp_curr = 0;
739         static int disp_num = 50;
740
741
742         *level = wm831x_power->batt_info.level;
743         ret = wm831x_bat_check_status(wm831x_power->wm831x, &status);
744         if (ret < 0) {
745                 printk("%s: check bat status failer...err = %d\n", __FUNCTION__, ret);
746                 return;
747         }
748
749         if (status == POWER_SUPPLY_STATUS_NOT_CHARGING 
750                         && batt_vol >= batt_step_table[batt_num-1]) {
751                 *level = 100;
752                 return;
753         }
754
755         if (status == POWER_SUPPLY_STATUS_CHARGING) 
756         {
757                 disp_plus = 0;
758                 disp_minus = 0;
759                 disp_curr = 0;
760                 
761                 for(i = 0; i < batt_num; i++){        
762                         if((batt_chg_step_table[i] <= batt_vol) && 
763                                          (batt_chg_step_table[i+1] > batt_vol))
764                                 break;     
765                 }
766                 *level = batt_disp_table[i];
767
768                 if (batt_vol <= batt_chg_step_table[0])
769                         *level = 0;
770                 if (batt_vol >= batt_chg_step_table[batt_num - 1])
771                         *level = 100;
772
773                 // Â³ÃµÃŠÂ¼Ã—´Ì¬
774                 if ((chg_plus == 1000) && (chg_minus == 1000))
775                 {
776                         *level = *level;
777                         chg_plus = 0;
778                         chg_minus = 0;
779                         chg_curr = 0;
780                 }
781                 else
782                 {                       
783
784                         if (*level >= (wm831x_power->batt_info.level+1))
785                         {
786                                 chg_minus = 0;
787                                 chg_curr = 0;
788                                 
789                                 if (++chg_plus > chg_num)
790                                 {
791                                         *level = wm831x_power->batt_info.level + 1;
792                                         chg_plus = 0;
793                                         
794                                         if(*level < 85)
795                                         chg_num = 60;
796                                         else 
797                                         chg_num = 20;
798                         
799                                 }
800                                 else
801                                 {
802                                         *level = wm831x_power->batt_info.level;
803                                 }               
804                         }
805
806                         else if (*level >= wm831x_power->batt_info.level)
807                         {
808                                 chg_plus = 0;
809                                 chg_minus = 0;
810
811                                 if (++chg_curr > chg_num)
812                                 {
813                                         *level = *level;
814                                         chg_curr = 0;
815                                 }
816                                 else
817                                 {
818                                         *level = wm831x_power->batt_info.level;
819                                 }
820                         }
821                         else if (*level < (wm831x_power->batt_info.level-1))    
822                         {
823                                 chg_plus = 0;
824                                 chg_curr = 0;
825                                 
826                                 if (++chg_minus > (chg_num<<1))
827                                 {
828                                         *level = wm831x_power->batt_info.level - 1;
829                                         chg_minus = 0;
830
831                                         if(*level < 85)
832                                         chg_num = 60;
833                                         else 
834                                         chg_num = 20;
835
836                                 }
837                                 else
838                                 {
839                                         *level = wm831x_power->batt_info.level;
840                                 }
841                         }
842                         else
843                         {
844                                 chg_plus = 0;
845                                 chg_minus = 0;
846                                 chg_curr = 0;
847                                 *level = wm831x_power->batt_info.level;
848                         }
849                 }
850                 
851
852                 if (*level >= 100)
853                         *level = 100;
854                 if (*level < 0)
855                         *level = 0;
856         }
857         else 
858         {
859                 chg_plus = 0;
860                 chg_minus = 0;
861                 chg_curr = 0;
862
863                 for(i = 0; i < batt_num; i++){        
864                         if(batt_vol >= batt_step_table[i] && 
865                                          batt_vol < batt_step_table[i+1])
866                                 break;     
867                 }
868                 *level = batt_disp_table[i];
869
870                 if (batt_vol <= batt_step_table[0])
871                         *level = 0;
872                 if (batt_vol >= batt_step_table[batt_num - 1])
873                         *level = 100;
874
875                 // Â³ÃµÃŠÂ¼Ã—´Ì¬
876                 if ((disp_plus == 1000) && (disp_minus == 1000))
877                 {
878                         *level = *level;
879                         disp_plus = 0;
880                         disp_minus = 0;
881                         disp_curr = 0;
882                 }
883                 else
884                 {                       
885
886                         if (*level <= (wm831x_power->batt_info.level-1))        
887                         {
888                                 disp_plus = 0;
889                                 disp_curr = 0;
890                                 
891                                 if (++disp_minus > disp_num)
892                                 {
893                                         *level = wm831x_power->batt_info.level - 1;
894                                         disp_minus = 0;
895
896                                         if((*level < 17) || (*level > 85))
897                                         disp_num = 10;
898                                         else
899                                         disp_num = 50;
900
901                                 }
902                                 else
903                                 {
904                                         *level = wm831x_power->batt_info.level;
905                                 }
906                         }
907                         else if (*level <= wm831x_power->batt_info.level)
908                         {
909                                 disp_plus = 0;
910                                 disp_minus = 0;
911
912                                 if (++disp_curr > disp_num)
913                                 {
914                                         *level = *level;
915                                         disp_curr = 0;
916                                 }
917                                 else
918                                 {
919                                         *level = wm831x_power->batt_info.level;
920                                 }
921                         }
922                         else if (*level >= (wm831x_power->batt_info.level+1))
923                         {
924                                 disp_minus = 0;
925                                 disp_curr = 0;
926                                 
927                                 if (++disp_plus > (disp_num<<1))
928                                 {
929                                         *level = wm831x_power->batt_info.level + 1;
930                                         disp_plus = 0;
931                                         if((*level < 17) || (*level > 85))
932                                         disp_num = 10;
933                                         else
934                                         disp_num = 50;
935                                 }
936                                 else
937                                 {
938                                         *level = wm831x_power->batt_info.level;
939                                 }               
940                         }
941                         else
942                         {
943                                 disp_plus = 0;
944                                 disp_minus = 0;
945                                 disp_curr = 0;
946                                 *level = wm831x_power->batt_info.level;
947                         }
948                 }
949
950                 if (*level >= 100)
951                         *level = 100;
952                 if (*level < 0)
953                         *level = 0;
954         }
955 }
956
957 static void wm831x_batt_work(struct work_struct *work)
958 {
959         int online, status,health,level, ret; 
960     union power_supply_propval val;
961         struct wm831x_power *power = container_of(work, struct wm831x_power, batt_work);
962
963         ret = wm831x_power_check_online(power->wm831x, WM831X_PWR_SRC_BATT, &val);
964         if (ret < 0) {
965                 printk("%s: check bat online failer...  err = %d\n", __FUNCTION__, ret);
966                 return;
967         }
968         online = val.intval;
969
970         ret = wm831x_bat_check_status(power->wm831x, &status);
971         if (ret < 0) {
972                 printk("%s: check bat status failer...  err = %d\n", __FUNCTION__, ret);
973                 return;
974         }
975
976         ret = wm831x_bat_check_health(power->wm831x, &health);
977         if (ret < 0) {
978                 printk("%s: check bat health failer...  err = %d\n", __FUNCTION__, ret);
979                 return;
980         }
981
982         ret = wm831x_power_read_voltage(power->wm831x, WM831X_AUX_BATT, &val);
983         if (ret < 0) {
984                 printk("%s: read bat voltage failer...err = %d\n", __FUNCTION__, ret);
985                 return;
986         }
987         power->batt_info.voltage = val.intval;
988
989         wm831x_batt_vol_level(power, val.intval, &level);
990         //mod_timer(&power->timer, jiffies + msecs_to_jiffies(power->interval));
991
992         if (online != power->batt_info.online || status != power->batt_info.status
993                         || health != power->batt_info.health || level != power->batt_info.level)
994         {
995                 power->batt_info.online = online;
996                 power->batt_info.status = status;
997                 power->batt_info.health = health;
998                 power->batt_info.level  = level;
999
1000                 power_supply_changed(&power->battery);
1001         }
1002
1003 }
1004
1005 static __devinit int wm831x_power_probe(struct platform_device *pdev)
1006 {
1007         struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
1008         struct wm831x_power *power;
1009         struct power_supply *usb;
1010         struct power_supply *battery;
1011         struct power_supply *wall;
1012         int ret, irq, i;
1013
1014         power = kzalloc(sizeof(struct wm831x_power), GFP_KERNEL);
1015         if (power == NULL)
1016                 return -ENOMEM;
1017
1018         power->wm831x = wm831x;
1019         platform_set_drvdata(pdev, power);
1020
1021         usb = &power->usb;
1022         battery = &power->battery;
1023         wall = &power->wall;
1024
1025         /* We ignore configuration failures since we can still read back
1026          * the status without enabling the charger.
1027          */
1028         wm831x_config_battery(wm831x);
1029
1030         wall->name = "wm831x-wall";
1031         wall->type = POWER_SUPPLY_TYPE_MAINS;
1032         wall->properties = wm831x_wall_props;
1033         wall->num_properties = ARRAY_SIZE(wm831x_wall_props);
1034         wall->get_property = wm831x_wall_get_prop;
1035         ret = power_supply_register(&pdev->dev, wall);
1036         if (ret)
1037                 goto err_kmalloc;
1038
1039         battery->name = "wm831x-battery";
1040         battery->properties = wm831x_bat_props;
1041         battery->num_properties = ARRAY_SIZE(wm831x_bat_props);
1042         battery->get_property = wm831x_bat_get_prop;
1043         battery->use_for_apm = 1;
1044         ret = power_supply_register(&pdev->dev, battery);
1045         if (ret)
1046                 goto err_wall;
1047
1048         usb->name = "wm831x-usb",
1049         usb->type = POWER_SUPPLY_TYPE_USB;
1050         usb->properties = wm831x_usb_props;
1051         usb->num_properties = ARRAY_SIZE(wm831x_usb_props);
1052         usb->get_property = wm831x_usb_get_prop;
1053         ret = power_supply_register(&pdev->dev, usb);
1054         if (ret)
1055                 goto err_battery;
1056
1057         irq = platform_get_irq_byname(pdev, "SYSLO");
1058         ret = request_threaded_irq(irq, NULL, wm831x_syslo_irq,
1059                                    IRQF_TRIGGER_RISING, "System power low",
1060                                    power);
1061         if (ret != 0) {
1062                 dev_err(&pdev->dev, "Failed to request SYSLO IRQ %d: %d\n",
1063                         irq, ret);
1064                 goto err_usb;
1065         }
1066
1067         irq = platform_get_irq_byname(pdev, "PWR SRC");
1068         ret = request_threaded_irq(irq, NULL, wm831x_pwr_src_irq,
1069                                    IRQF_TRIGGER_RISING, "Power source",
1070                                    power);
1071         if (ret != 0) {
1072                 dev_err(&pdev->dev, "Failed to request PWR SRC IRQ %d: %d\n",
1073                         irq, ret);
1074                 goto err_syslo;
1075         }
1076
1077 #ifdef CONFIG_WM831X_WITH_BATTERY
1078         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1079                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1080                 ret = request_threaded_irq(irq, NULL, wm831x_bat_irq,
1081                                            IRQF_TRIGGER_RISING,
1082                                            wm831x_bat_irqs[i],
1083                                            power);
1084                 WM_BATT_DBG("%s: %s irq no %d\n", __FUNCTION__, wm831x_bat_irqs[i], irq);
1085                 if (ret != 0) {
1086                         dev_err(&pdev->dev,
1087                                 "Failed to request %s IRQ %d: %d\n",
1088                                 wm831x_bat_irqs[i], irq, ret);
1089                         goto err_bat_irq;
1090                 }
1091         }
1092 #endif
1093
1094         power->interval = TIMER_MS_COUNTS;
1095         power->batt_info.level = 100;
1096         power->batt_info.voltage   = 4200;
1097         power->batt_info.online    = 1;
1098         power->batt_info.status    = POWER_SUPPLY_STATUS_DISCHARGING;
1099         power->batt_info.health    = POWER_SUPPLY_HEALTH_GOOD;
1100
1101         wake_lock_init(&power->syslo_wake, WAKE_LOCK_SUSPEND, "wm831x_syslo_wake");
1102         INIT_WORK(&power->batt_work, wm831x_batt_work);
1103         setup_timer(&power->timer, wm831x_batt_timer_handler, (unsigned long)power);
1104         power->timer.expires = jiffies + msecs_to_jiffies(1000);
1105         add_timer(&power->timer);
1106
1107         g_wm831x_power = power;
1108         printk("%s:wm831x_power initialized\n",__FUNCTION__);
1109         power_test_sysfs_init();
1110         return ret;
1111         
1112 #ifdef CONFIG_WM831X_WITH_BATTERY
1113 err_bat_irq:
1114         for (; i >= 0; i--) {
1115                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1116                 free_irq(irq, power);
1117         }
1118         irq = platform_get_irq_byname(pdev, "PWR SRC");
1119         free_irq(irq, power);
1120 #endif
1121
1122 err_syslo:
1123         irq = platform_get_irq_byname(pdev, "SYSLO");
1124         free_irq(irq, power);
1125 err_usb:
1126         power_supply_unregister(usb);
1127 err_battery:
1128         power_supply_unregister(battery);
1129 err_wall:
1130         power_supply_unregister(wall);
1131 err_kmalloc:
1132         kfree(power);
1133         return ret;
1134 }
1135
1136 static __devexit int wm831x_power_remove(struct platform_device *pdev)
1137 {
1138         struct wm831x_power *wm831x_power = platform_get_drvdata(pdev);
1139         int irq, i;
1140 #ifdef CONFIG_WM831X_WITH_BATTERY
1141         for (i = 0; i < ARRAY_SIZE(wm831x_bat_irqs); i++) {
1142                 irq = platform_get_irq_byname(pdev, wm831x_bat_irqs[i]);
1143                 free_irq(irq, wm831x_power);
1144         }
1145 #endif
1146         irq = platform_get_irq_byname(pdev, "PWR SRC");
1147         free_irq(irq, wm831x_power);
1148
1149         irq = platform_get_irq_byname(pdev, "SYSLO");
1150         free_irq(irq, wm831x_power);
1151
1152         power_supply_unregister(&wm831x_power->battery);
1153         power_supply_unregister(&wm831x_power->wall);
1154         power_supply_unregister(&wm831x_power->usb);
1155         kfree(wm831x_power);
1156         return 0;
1157 }
1158
1159 #ifdef CONFIG_PM
1160 static int wm831x_battery_suspend(struct platform_device *dev, pm_message_t state)
1161 {
1162         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1163         flush_scheduled_work();
1164         del_timer(&power->timer);
1165         return 0;
1166 }
1167
1168 static int wm831x_battery_resume(struct platform_device *dev)
1169 {
1170         struct wm831x_power *power = (struct wm831x_power *)platform_get_drvdata(dev);
1171         power->timer.expires = jiffies + msecs_to_jiffies(power->interval);
1172         add_timer(&power->timer);
1173         return 0;
1174 }
1175 #else
1176 #define wm831x_battery_suspend NULL
1177 #define wm831x_battery_resume  NULL
1178 #endif
1179
1180 static struct platform_driver wm831x_power_driver = {
1181         .probe = wm831x_power_probe,
1182         .remove = __devexit_p(wm831x_power_remove),
1183         .suspend = wm831x_battery_suspend,
1184         .resume = wm831x_battery_resume,
1185         .driver = {
1186                 .name = "wm831x-power",
1187         },
1188 };
1189 static int __init wm831x_power_init(void)
1190 {
1191         return platform_driver_register(&wm831x_power_driver);
1192 }
1193 module_init(wm831x_power_init);
1194
1195 static void __exit wm831x_power_exit(void)
1196 {
1197         platform_driver_unregister(&wm831x_power_driver);
1198 }
1199 module_exit(wm831x_power_exit);
1200
1201
1202 static ssize_t power_prop_show(struct device *dev,
1203                 struct device_attribute *attr, char *buf)
1204 {
1205         ssize_t ret = 0;
1206         int level, power_status, system_status, chg_ctl1, chg_ctl2, chg_status;
1207     union power_supply_propval val;
1208
1209         if (!g_wm831x_power)
1210                 return -1;
1211         power_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_POWER_STATE);
1212         if (power_status < 0)
1213                 return power_status;
1214         //printk("wm831x power status %#x\n", ret);
1215
1216         system_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_SYSTEM_STATUS);
1217         if (system_status < 0)
1218                 return system_status;
1219         //printk("wm831x system status %#x\n", ret);
1220
1221         chg_ctl1 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_1);
1222         if (chg_ctl1 < 0)
1223                 return chg_ctl1;
1224         //printk("wm831x charger control1 %#x\n", ret);
1225
1226         chg_ctl2 = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_CONTROL_2);
1227         if (chg_ctl2 < 0)
1228                 return chg_ctl2;
1229         //printk("wm831x charger control2 %#x\n", ret);
1230
1231         chg_status = wm831x_reg_read(g_wm831x_power->wm831x, WM831X_CHARGER_STATUS);
1232         if (chg_status < 0)
1233                 return chg_status;
1234         //printk("wm831x charger status %#x\n", ret);
1235
1236         ret = wm831x_power_read_voltage(g_wm831x_power->wm831x, WM831X_AUX_BATT, &val);
1237         if (ret < 0)
1238                 return ret;
1239         wm831x_batt_vol_level(g_wm831x_power, val.intval, &level);
1240         //printk("batt_vol = %d batt_level = %d\n", val.intval, level);
1241         //
1242         sprintf(buf, "power_status=%#x\n"
1243                              "system_status=%#x\n"
1244                                  "chg_ctl1=%#x\n"
1245                                  "chg_ctl2=%#x\n"
1246                                  "chg_status=%#x\n"
1247                                  "batt_vol=%d\n"
1248                                  "batt_level=%d%%\n",
1249                                  power_status,
1250                                  system_status,
1251                                  chg_ctl1,
1252                                  chg_ctl2,
1253                                  chg_status,
1254                                  val.intval,
1255                                  level);
1256         ret = strlen(buf) + 1;
1257         return ret;
1258 }
1259
1260 static DEVICE_ATTR(prop, 0444, power_prop_show, NULL);
1261
1262 static struct kobject *power_test_kobj;
1263
1264 static int power_test_sysfs_init(void)
1265 {
1266         int ret ;
1267         power_test_kobj = kobject_create_and_add("power_test_prop", NULL);
1268         if (power_test_kobj == NULL) {
1269                 printk(KERN_ERR
1270                        "power_test_sysfs_init:"\
1271                        "subsystem_register failed\n");
1272                 ret = -ENOMEM;
1273                 goto err;
1274         }
1275         ret = sysfs_create_file(power_test_kobj, &dev_attr_prop.attr);
1276         if (ret) {
1277                 printk(KERN_ERR
1278                        "power_test_sysfs_init:"\
1279                        "sysfs_create_group failed\n");
1280                 goto err1;
1281         }
1282
1283         return 0 ;
1284 err1:
1285         kobject_del(power_test_kobj);
1286 err:
1287         return ret ;
1288 }
1289
1290
1291 MODULE_DESCRIPTION("Power supply driver for WM831x PMICs");
1292 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
1293 MODULE_LICENSE("GPL");
1294 MODULE_ALIAS("platform:wm831x-power");