qi-hardware/openwrt-xburst
1
0
Fork 0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2024-11-28 20:15:18 +02:00
Code

jz_battery: fix bug cause kernel panic.

Browse Source 
all about container_of macro.

Signed-off-by: JieJing.Zhang <kzjeef@gmail.com>
This commit is contained in:
JieJing.Zhang 2009-10-20 02:47:31 +08:00 committed by Xiangfu Liu
parent 110c87a5f7
commit 907a34b80e
1 changed files with 178 additions and 133 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

265
target/linux/xburst/files-2.6.31/drivers/power/jz4740-battery.c
View File

@ -24,6 +24,9 @@
#include <linux/jz4740-adc.h> #include <linux/jz4740-adc.h>
struct jz_battery_info { struct jz_battery_info {
struct power_supply usb;
struct power_supply bat;
struct power_supply ac;
int bat_status; int bat_status;
struct jz_batt_info *pdata; struct jz_batt_info *pdata;
struct mutex work_lock; struct mutex work_lock;
@ -31,26 +34,27 @@ struct jz_battery_info {
struct delayed_work bat_work; struct delayed_work bat_work;
}; };
static struct jz_battery_info jz_main_bat = { #define ps_to_jz_battery(x) container_of((x), struct jz_battery_info, bat);
.bat_status = POWER_SUPPLY_STATUS_DISCHARGING,
.pdata = 0,
};
/********************************************************************* /*********************************************************************
* Power * Power
*********************************************************************/ *********************************************************************/
static int jz_get_power_prop(struct power_supply *psy,
static int jz_get_power_prop(struct jz_battery_info *bat_info,
struct power_supply *psy,
enum power_supply_property psp, enum power_supply_property psp,
union power_supply_propval *val) union power_supply_propval *val)
{ {
if (!jz_main_bat.pdata) int gpio;
return -EINVAL;
int gpio = (psy->type == POWER_SUPPLY_TYPE_MAINS) ? jz_main_bat.pdata->dc_dect_gpio : jz_main_bat.pdata->usb_dect_gpio;
if (bat_info == 0 || bat_info->pdata == 0)
return -EINVAL;
gpio = (psy->type == POWER_SUPPLY_TYPE_MAINS) ?
bat_info->pdata->dc_dect_gpio :
bat_info->pdata->usb_dect_gpio;
if (!gpio_is_valid(gpio)) if (!gpio_is_valid(gpio))
return -EINVAL; return -EINVAL;
switch (psp) { switch (psp) {
case POWER_SUPPLY_PROP_ONLINE: case POWER_SUPPLY_PROP_ONLINE:
val->intval = !gpio_get_value(gpio); val->intval = !gpio_get_value(gpio);
@ -62,6 +66,23 @@ static int jz_get_power_prop(struct power_supply *psy,
return 0; return 0;
} }
static int jz_usb_get_power_prop(struct power_supply *psy,
enum power_supply_property psp,
union power_supply_propval *val)
{
struct jz_battery_info *bat_info = container_of(psy, struct jz_battery_info, usb);
return jz_get_power_prop(bat_info, psy, psp, val);
}
static int jz_ac_get_power_prop(struct power_supply *psy,
enum power_supply_property psp,
union power_supply_propval *val)
{
struct jz_battery_info *bat_info = container_of(psy, struct jz_battery_info, ac);
return jz_get_power_prop(bat_info, psy, psp, val);
}
static enum power_supply_property jz_power_props[] = { static enum power_supply_property jz_power_props[] = {
POWER_SUPPLY_PROP_ONLINE, POWER_SUPPLY_PROP_ONLINE,
}; };
@ -71,7 +92,7 @@ static struct power_supply jz_ac = {
.type = POWER_SUPPLY_TYPE_MAINS, .type = POWER_SUPPLY_TYPE_MAINS,
.properties = jz_power_props, .properties = jz_power_props,
.num_properties = ARRAY_SIZE(jz_power_props), .num_properties = ARRAY_SIZE(jz_power_props),
.get_property = jz_get_power_prop, .get_property = jz_ac_get_power_prop,
}; };
static struct power_supply jz_usb = { static struct power_supply jz_usb = {
@ -79,7 +100,7 @@ static struct power_supply jz_usb = {
.type = POWER_SUPPLY_TYPE_USB, .type = POWER_SUPPLY_TYPE_USB,
.properties = jz_power_props, .properties = jz_power_props,
.num_properties = ARRAY_SIZE(jz_power_props), .num_properties = ARRAY_SIZE(jz_power_props),
.get_property = jz_get_power_prop, .get_property = jz_usb_get_power_prop,
}; };
@ -87,34 +108,31 @@ static struct power_supply jz_usb = {
* Battery properties * Battery properties
*********************************************************************/ *********************************************************************/
static long jz_read_bat(struct power_supply *bat_ps) static long jz_read_bat(struct power_supply *psy)
{ {
struct jz_battery_info *bat_info = ps_to_jz_battery(psy);
enum jz_adc_battery_scale scale; enum jz_adc_battery_scale scale;
if (!jz_main_bat.pdata)
return -EINVAL;
if (jz_main_bat.pdata->max_voltag > 2500000) if (bat_info->pdata->max_voltag > 2500000)
scale = JZ_ADC_BATTERY_SCALE_7V5; scale = JZ_ADC_BATTERY_SCALE_7V5;
else else
scale = JZ_ADC_BATTERY_SCALE_2V5; scale = JZ_ADC_BATTERY_SCALE_2V5;
return jz4740_adc_read_battery_voltage(bat_ps->dev->parent->parent, scale); return jz4740_adc_read_battery_voltage(psy->dev->parent->parent, scale);
} }
static int jz_bat_get_capacity(struct power_supply *bat_ps) static int jz_bat_get_capacity(struct power_supply *psy)
{ {
int ret; int ret;
struct jz_battery_info *bat_info = ps_to_jz_battery(psy);
if (!jz_main_bat.pdata) ret = jz_read_bat(psy);
return -EINVAL;
ret = jz_read_bat(bat_ps);
if (ret < 0) if (ret < 0)
return ret; return ret;
ret = (ret - jz_main_bat.pdata->min_voltag) * 100 ret = (ret - bat_info->pdata->min_voltag) * 100
/ (jz_main_bat.pdata->max_voltag - jz_main_bat.pdata->min_voltag); / (bat_info->pdata->max_voltag - bat_info->pdata->min_voltag);
if (ret > 100) if (ret > 100)
ret = 100; ret = 100;
@ -124,47 +142,46 @@ static int jz_bat_get_capacity(struct power_supply *bat_ps)
return ret; return ret;
} }
static int jz_bat_get_property(struct power_supply *bat_ps, static int jz_bat_get_property(struct power_supply *psy,
enum power_supply_property psp, enum power_supply_property psp,
union power_supply_propval *val) union power_supply_propval *val)
{ {
if (!jz_main_bat.pdata) struct jz_battery_info *bat_info = ps_to_jz_battery(psy)
return -EINVAL;
switch (psp) { switch (psp) {
case POWER_SUPPLY_PROP_STATUS: case POWER_SUPPLY_PROP_STATUS:
val->intval = jz_main_bat.bat_status; val->intval = bat_info->bat_status;
break; break;
case POWER_SUPPLY_PROP_TECHNOLOGY: case POWER_SUPPLY_PROP_TECHNOLOGY:
val->intval = jz_main_bat.pdata->batt_tech; val->intval = bat_info->pdata->batt_tech;
break; break;
case POWER_SUPPLY_PROP_HEALTH: case POWER_SUPPLY_PROP_HEALTH:
if(jz_read_bat(bat_ps) < jz_main_bat.pdata->min_voltag) { if(jz_read_bat(psy) < bat_info->pdata->min_voltag) {
dev_dbg(bat_ps->dev, "%s: battery is dead," dev_dbg(psy->dev, "%s: battery is dead,"
"voltage too low!\n", __func__); "voltage too low!\n", __func__);
val->intval = POWER_SUPPLY_HEALTH_DEAD; val->intval = POWER_SUPPLY_HEALTH_DEAD;
} else { } else {
dev_dbg(bat_ps->dev, "%s: battery is good," dev_dbg(psy->dev, "%s: battery is good,"
"voltage normal.\n", __func__); "voltage normal.\n", __func__);
val->intval = POWER_SUPPLY_HEALTH_GOOD; val->intval = POWER_SUPPLY_HEALTH_GOOD;
} }
break; break;
case POWER_SUPPLY_PROP_CAPACITY: case POWER_SUPPLY_PROP_CAPACITY:
val->intval = jz_bat_get_capacity(bat_ps); val->intval = jz_bat_get_capacity(psy);
dev_dbg(bat_ps->dev, "%s: battery_capacity = %d\n", dev_dbg(psy->dev, "%s: battery_capacity = %d\n",
__func__, val->intval); __func__, val->intval);
break; break;
case POWER_SUPPLY_PROP_VOLTAGE_NOW: case POWER_SUPPLY_PROP_VOLTAGE_NOW:
val->intval = jz_read_bat(bat_ps); val->intval = jz_read_bat(psy);
if (val->intval < 0) if (val->intval < 0)
return val->intval; return val->intval;
break; break;
case POWER_SUPPLY_PROP_VOLTAGE_MAX: case POWER_SUPPLY_PROP_VOLTAGE_MAX:
case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
val->intval = jz_main_bat.pdata->max_voltag; val->intval = bat_info->pdata->max_voltag;
break; break;
case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
val->intval = jz_main_bat.pdata->min_voltag; val->intval = bat_info->pdata->min_voltag;
break; break;
case POWER_SUPPLY_PROP_PRESENT: case POWER_SUPPLY_PROP_PRESENT:
val->intval = 1; val->intval = 1;
@ -175,10 +192,12 @@ static int jz_bat_get_property(struct power_supply *bat_ps,
return 0; return 0;
} }
static void jz_bat_external_power_changed(struct power_supply *bat_ps) static void jz_bat_external_power_changed(struct power_supply *psy)
{ {
cancel_delayed_work(&jz_main_bat.bat_work); struct jz_battery_info *bat_info = ps_to_jz_battery(psy);
queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, HZ / 8);
cancel_delayed_work(&bat_info->bat_work);
queue_delayed_work(bat_info->monitor_wqueue, &bat_info->bat_work, HZ / 8);
} }
static char *status_text[] = { static char *status_text[] = {
@ -188,40 +207,42 @@ static char *status_text[] = {
[POWER_SUPPLY_STATUS_NOT_CHARGING] = "Not charging", [POWER_SUPPLY_STATUS_NOT_CHARGING] = "Not charging",
}; };
static void jz_bat_update(struct power_supply *bat_ps) static void jz_bat_update(struct power_supply *psy)
{ {
int old_status = jz_main_bat.bat_status; struct jz_battery_info *bat_info = ps_to_jz_battery(psy);
int old_status = bat_info->bat_status;
static unsigned long old_batt_vol = 0; static unsigned long old_batt_vol = 0;
unsigned long batt_vol = jz_read_bat(bat_ps); unsigned long batt_vol = jz_read_bat(psy);
mutex_lock(&jz_main_bat.work_lock);
if (!jz_main_bat.pdata) mutex_lock(&bat_info->work_lock);
goto err;
if (!gpio_is_valid(jz_main_bat.pdata->charg_stat_gpio)) if (gpio_is_valid(bat_info->pdata->charg_stat_gpio)) {
goto err; if(!gpio_get_value(bat_info->pdata->charg_stat_gpio))
bat_info->bat_status = POWER_SUPPLY_STATUS_CHARGING;
if(!gpio_get_value(jz_main_bat.pdata->charg_stat_gpio))
jz_main_bat.bat_status = POWER_SUPPLY_STATUS_CHARGING;
else else
jz_main_bat.bat_status = POWER_SUPPLY_STATUS_NOT_CHARGING; bat_info->bat_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
dev_dbg(psy->dev, "%s: battery status=%s\n",
__func__, status_text[bat_info->bat_status]);
dev_dbg(bat_ps->dev, "%s: battery status=%s\n", if (old_status != bat_info->bat_status) {
__func__, status_text[jz_main_bat.bat_status]); dev_dbg(psy->dev, "%s %s -> %s\n",
psy->name,
if ((old_status != jz_main_bat.bat_status) ||
(old_batt_vol - batt_vol > 50000)) {
dev_dbg(bat_ps->dev, "%s %s -> %s\n",
bat_ps->name,
status_text[old_status], status_text[old_status],
status_text[jz_main_bat.bat_status]); status_text[bat_info->bat_status]);
power_supply_changed(bat_ps); power_supply_changed(psy);
}
} }
if (old_batt_vol - batt_vol > 50000) {
dev_dbg(psy->dev, "voltage change : %ld -> %ld\n",
old_batt_vol, batt_vol);
power_supply_changed(psy);
old_batt_vol = batt_vol; old_batt_vol = batt_vol;
err: }
mutex_unlock(&jz_main_bat.work_lock);
mutex_unlock(&bat_info->work_lock);
} }
static enum power_supply_property jz_bat_main_props[] = { static enum power_supply_property jz_bat_main_props[] = {
@ -249,24 +270,31 @@ static void jz_bat_work(struct work_struct *work)
{ {
/* query interval too small will increase system workload*/ /* query interval too small will increase system workload*/
const int interval = HZ * 30; const int interval = HZ * 30;
struct jz_battery_info *bat_info = container_of(work,struct jz_battery_info, bat_work.work);
jz_bat_update(&bat_ps); jz_bat_update(&bat_info->bat);
queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, interval); queue_delayed_work(bat_info->monitor_wqueue,
&bat_info->bat_work, interval);
} }
#ifdef CONFIG_PM #ifdef CONFIG_PM
static int jz_bat_suspend(struct platform_device *dev, pm_message_t state) static int jz_bat_suspend(struct platform_device *pdev, pm_message_t state)
{ {
jz_main_bat.bat_status = POWER_SUPPLY_STATUS_UNKNOWN; struct jz_battery_info *bat_info = platform_get_drvdata(pdev);
bat_info->bat_status = POWER_SUPPLY_STATUS_UNKNOWN;
return 0; return 0;
} }
static int jz_bat_resume(struct platform_device *dev) static int jz_bat_resume(struct platform_device *pdev)
{ {
jz_main_bat.bat_status = POWER_SUPPLY_STATUS_UNKNOWN; struct jz_battery_info *bat_info = platform_get_drvdata(pdev);
cancel_delayed_work(&jz_main_bat.bat_work);
queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, HZ/10); bat_info->bat_status = POWER_SUPPLY_STATUS_UNKNOWN;
cancel_delayed_work(&bat_info->bat_work);
queue_delayed_work(bat_info->monitor_wqueue, &bat_info->bat_work, HZ/10);
return 0; return 0;
} }
@ -275,29 +303,38 @@ static int jz_bat_resume(struct platform_device *dev)
#define jz_bat_resume NULL #define jz_bat_resume NULL
#endif #endif
static int __devinit jz_bat_probe(struct platform_device *pdev) static int jz_bat_probe(struct platform_device *pdev)
{ {
int ret = 0; int ret = 0;
struct jz_battery_info *bat_info;
printk("JZ battery init.\n"); bat_info = kzalloc(sizeof(struct jz_battery_info), GFP_KERNEL);
mutex_init(&jz_main_bat.work_lock);
INIT_DELAYED_WORK(&jz_main_bat.bat_work, jz_bat_work); if (!bat_info) {
return -ENOMEM;
}
if (!pdev->dev.platform_data) { if (!pdev->dev.platform_data) {
dev_err(&pdev->dev, "Please set battery info\n"); dev_err(&pdev->dev, "Please set battery info\n");
return -EINVAL; ret = -EINVAL;
goto err_platform_data;
} }
platform_set_drvdata(pdev, bat_info);
bat_info->pdata = pdev->dev.platform_data;
bat_info->bat = bat_ps;
bat_info->usb = jz_usb;
bat_info->ac = jz_ac;
mutex_init(&bat_info->work_lock);
INIT_DELAYED_WORK(&bat_info->bat_work, jz_bat_work);
jz_main_bat.pdata = pdev->dev.platform_data; if (gpio_is_valid(bat_info->pdata->dc_dect_gpio)) {
ret = gpio_request(bat_info->pdata->dc_dect_gpio, "AC/DC DECT");
if (gpio_is_valid(jz_main_bat.pdata->dc_dect_gpio)) {
ret = gpio_request(jz_main_bat.pdata->dc_dect_gpio, "AC/DC DECT");
if (ret) { if (ret) {
dev_err(&pdev->dev, "ac/dc dect gpio request failed.\n"); dev_err(&pdev->dev, "ac/dc dect gpio request failed.\n");
goto err_dc_gpio_request; goto err_dc_gpio_request;
} }
ret = gpio_direction_input(jz_main_bat.pdata->dc_dect_gpio); ret = gpio_direction_input(bat_info->pdata->dc_dect_gpio);
if (ret) { if (ret) {
dev_err(&pdev->dev, "ac/dc dect gpio direction failed.\n"); dev_err(&pdev->dev, "ac/dc dect gpio direction failed.\n");
@ -305,90 +342,98 @@ static int __devinit jz_bat_probe(struct platform_device *pdev)
} }
} }
if (gpio_is_valid(jz_main_bat.pdata->usb_dect_gpio)) { if (gpio_is_valid(bat_info->pdata->usb_dect_gpio)) {
ret = gpio_request(jz_main_bat.pdata->usb_dect_gpio, "USB DECT"); ret = gpio_request(bat_info->pdata->usb_dect_gpio, "USB DECT");
if (ret) { if (ret) {
dev_err(&pdev->dev, "usb dect gpio request failed.\n"); dev_err(&pdev->dev, "usb dect gpio request failed.\n");
goto err_usb_gpio_request; goto err_usb_gpio_request;
} }
ret = gpio_direction_input(jz_main_bat.pdata->usb_dect_gpio); ret = gpio_direction_input(bat_info->pdata->usb_dect_gpio);
if (ret) { if (ret) {
dev_err(&pdev->dev, "usb dect gpio set direction failed.\n"); dev_err(&pdev->dev, "usb dect gpio set direction failed.\n");
goto err_usb_gpio_direction; goto err_usb_gpio_direction;
} }
jz_gpio_disable_pullup(jz_main_bat.pdata->usb_dect_gpio); jz_gpio_disable_pullup(bat_info->pdata->usb_dect_gpio);
/* TODO: Use generic gpio is better */ /* TODO: Use generic gpio is better */
} }
if (gpio_is_valid(jz_main_bat.pdata->charg_stat_gpio)) { if (gpio_is_valid(bat_info->pdata->charg_stat_gpio)) {
ret = gpio_request(jz_main_bat.pdata->charg_stat_gpio, "CHARG STAT"); ret = gpio_request(bat_info->pdata->charg_stat_gpio, "CHARG STAT");
if (ret) { if (ret) {
dev_err(&pdev->dev, "charger state gpio request failed.\n"); dev_err(&pdev->dev, "charger state gpio request failed.\n");
goto err_charg_gpio_request; goto err_charg_gpio_request;
} }
ret = gpio_direction_input(jz_main_bat.pdata->charg_stat_gpio); ret = gpio_direction_input(bat_info->pdata->charg_stat_gpio);
if (ret) { if (ret) {
dev_err(&pdev->dev, "charger state gpio set direction failed.\n"); dev_err(&pdev->dev, "charger state gpio set direction failed.\n");
goto err_charg_gpio_direction; goto err_charg_gpio_direction;
} }
} }
ret = power_supply_register(&pdev->dev, &jz_ac); if (gpio_is_valid(bat_info->pdata->dc_dect_gpio)) {
ret = power_supply_register(&pdev->dev, &bat_info->ac);
if (ret) { if (ret) {
dev_err(&pdev->dev, "power supply ac/dc register failed.\n"); dev_err(&pdev->dev, "power supply ac/dc register failed.\n");
goto err_power_register_ac; goto err_power_register_ac;
} }
}
ret = power_supply_register(&pdev->dev, &jz_usb); if (gpio_is_valid(bat_info->pdata->usb_dect_gpio)) {
ret = power_supply_register(&pdev->dev, &bat_info->usb);
if (ret) { if (ret) {
dev_err(&pdev->dev, "power supply usb register failed.\n"); dev_err(&pdev->dev, "power supply usb register failed.\n");
goto err_power_register_usb; goto err_power_register_usb;
} }
}
ret = power_supply_register(&pdev->dev, &bat_ps); if (gpio_is_valid(bat_info->pdata->charg_stat_gpio)) {
ret = power_supply_register(&pdev->dev, &bat_info->bat);
if (ret) { if (ret) {
dev_err(&pdev->dev, "power supply battery register failed.\n"); dev_err(&pdev->dev, "power supply battery register failed.\n");
goto err_power_register_bat; goto err_power_register_bat;
} } else {
bat_info->monitor_wqueue = create_singlethread_workqueue("jz_battery");
if (!ret) { if (!bat_info->monitor_wqueue) {
jz_main_bat.monitor_wqueue = create_singlethread_workqueue("jz_battery");
if (!jz_main_bat.monitor_wqueue) {
return -ESRCH; return -ESRCH;
} }
queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, HZ * 1); queue_delayed_work(bat_info->monitor_wqueue, &bat_info->bat_work, HZ * 1);
} }
}
printk(KERN_INFO "jz_bat init success.\n");
return ret; return ret;
err_power_register_bat: err_power_register_bat:
power_supply_unregister(&jz_usb); power_supply_unregister(&bat_info->usb);
err_power_register_usb: err_power_register_usb:
power_supply_unregister(&jz_ac); power_supply_unregister(&bat_info->ac);
err_power_register_ac: err_power_register_ac:
err_charg_gpio_direction: err_charg_gpio_direction:
gpio_free(jz_main_bat.pdata->charg_stat_gpio); gpio_free(bat_info->pdata->charg_stat_gpio);
err_charg_gpio_request: err_charg_gpio_request:
err_usb_gpio_direction: err_usb_gpio_direction:
gpio_free(jz_main_bat.pdata->usb_dect_gpio); gpio_free(bat_info->pdata->usb_dect_gpio);
err_usb_gpio_request: err_usb_gpio_request:
err_dc_gpio_direction: err_dc_gpio_direction:
gpio_free(jz_main_bat.pdata->dc_dect_gpio); gpio_free(bat_info->pdata->dc_dect_gpio);
err_dc_gpio_request: err_dc_gpio_request:
err_platform_data:
kfree(bat_info);
return ret; return ret;
} }
static int __devexit jz_bat_remove(struct platform_device *dev) static int jz_bat_remove(struct platform_device *pdev)
{ {
if (jz_main_bat.pdata) { struct jz_battery_info *bat_info = platform_get_drvdata(pdev);
if (gpio_is_valid(jz_main_bat.pdata->dc_dect_gpio))
gpio_free(jz_main_bat.pdata->dc_dect_gpio); if (bat_info->pdata) {
if (gpio_is_valid(jz_main_bat.pdata->usb_dect_gpio)) if (gpio_is_valid(bat_info->pdata->dc_dect_gpio))
gpio_free(jz_main_bat.pdata->usb_dect_gpio); gpio_free(bat_info->pdata->dc_dect_gpio);
if (gpio_is_valid(jz_main_bat.pdata->charg_stat_gpio)) if (gpio_is_valid(bat_info->pdata->usb_dect_gpio))
gpio_free(jz_main_bat.pdata->charg_stat_gpio); gpio_free(bat_info->pdata->usb_dect_gpio);
if (gpio_is_valid(bat_info->pdata->charg_stat_gpio))
gpio_free(bat_info->pdata->charg_stat_gpio);
} }
power_supply_unregister(&bat_ps); power_supply_unregister(&bat_ps);