qi-hardware/openwrt-xburst
1
0
Fork 0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2024-11-25 04:11:54 +02:00
Code

revert commit: 3dbe390f5347b6c279c9d193445e1c86fbee9894

Browse Source 
those change make kernel panic.
This commit is contained in:
Xiangfu Liu 2009-10-16 16:21:12 +08:00
parent 8319e34599
commit 110c87a5f7
1 changed files with 117 additions and 144 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

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

@ -24,7 +24,6 @@
#include <linux/jz4740-adc.h> #include <linux/jz4740-adc.h>
struct jz_battery_info { struct jz_battery_info {
struct power_supply psy;
int bat_status; int bat_status;
struct jz_batt_info *pdata; struct jz_batt_info *pdata;
struct mutex work_lock; struct mutex work_lock;
@ -32,10 +31,10 @@ struct jz_battery_info {
struct delayed_work bat_work; struct delayed_work bat_work;
}; };
static inline struct jz_battery_info *ps_to_jz_battery(struct power_supply *psy) static struct jz_battery_info jz_main_bat = {
{ .bat_status = POWER_SUPPLY_STATUS_DISCHARGING,
return container_of(psy, struct jz_battery_info, psy); .pdata = 0,
} };
/********************************************************************* /*********************************************************************
* Power * Power
@ -45,9 +44,9 @@ static int jz_get_power_prop(struct power_supply *psy,
enum power_supply_property psp, enum power_supply_property psp,
union power_supply_propval *val) union power_supply_propval *val)
{ {
struct jz_battery_info *bat_info = ps_to_jz_battery(psy); if (!jz_main_bat.pdata)
return -EINVAL;
int gpio = (psy->type == POWER_SUPPLY_TYPE_MAINS) ? bat_info->pdata->dc_dect_gpio : bat_info->pdata->usb_dect_gpio; int gpio = (psy->type == POWER_SUPPLY_TYPE_MAINS) ? jz_main_bat.pdata->dc_dect_gpio : jz_main_bat.pdata->usb_dect_gpio;
if (!gpio_is_valid(gpio)) if (!gpio_is_valid(gpio))
return -EINVAL; return -EINVAL;
@ -88,31 +87,34 @@ static struct power_supply jz_usb = {
* Battery properties * Battery properties
*********************************************************************/ *********************************************************************/
static long jz_read_bat(struct power_supply *psy) static long jz_read_bat(struct power_supply *bat_ps)
{ {
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 (bat_info->pdata->max_voltag > 2500000) if (jz_main_bat.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(psy->dev->parent->parent, scale); return jz4740_adc_read_battery_voltage(bat_ps->dev->parent->parent, scale);
} }
static int jz_bat_get_capacity(struct power_supply *psy) static int jz_bat_get_capacity(struct power_supply *bat_ps)
{ {
int ret; int ret;
struct jz_battery_info *bat_info = ps_to_jz_battery(psy);
ret = jz_read_bat(psy); if (!jz_main_bat.pdata)
return -EINVAL;
ret = jz_read_bat(bat_ps);
if (ret < 0) if (ret < 0)
return ret; return ret;
ret = (ret - bat_info->pdata->min_voltag) * 100 ret = (ret - jz_main_bat.pdata->min_voltag) * 100
/ (bat_info->pdata->max_voltag - bat_info->pdata->min_voltag); / (jz_main_bat.pdata->max_voltag - jz_main_bat.pdata->min_voltag);
if (ret > 100) if (ret > 100)
ret = 100; ret = 100;
@ -122,46 +124,47 @@ static int jz_bat_get_capacity(struct power_supply *psy)
return ret; return ret;
} }
static int jz_bat_get_property(struct power_supply *psy, static int jz_bat_get_property(struct power_supply *bat_ps,
enum power_supply_property psp, enum power_supply_property psp,
union power_supply_propval *val) union power_supply_propval *val)
{ {
struct jz_battery_info *bat_info = ps_to_jz_battery(psy); if (!jz_main_bat.pdata)
return -EINVAL;
switch (psp) { switch (psp) {
case POWER_SUPPLY_PROP_STATUS: case POWER_SUPPLY_PROP_STATUS:
val->intval = bat_info->bat_status; val->intval = jz_main_bat.bat_status;
break; break;
case POWER_SUPPLY_PROP_TECHNOLOGY: case POWER_SUPPLY_PROP_TECHNOLOGY:
val->intval = bat_info->pdata->batt_tech; val->intval = jz_main_bat.pdata->batt_tech;
break; break;
case POWER_SUPPLY_PROP_HEALTH: case POWER_SUPPLY_PROP_HEALTH:
if(jz_read_bat(psy) < bat_info->pdata->min_voltag) { if(jz_read_bat(bat_ps) < jz_main_bat.pdata->min_voltag) {
dev_dbg(psy->dev, "%s: battery is dead," dev_dbg(bat_ps->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(psy->dev, "%s: battery is good," dev_dbg(bat_ps->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(psy); val->intval = jz_bat_get_capacity(bat_ps);
dev_dbg(psy->dev, "%s: battery_capacity = %d\n", dev_dbg(bat_ps->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(psy); val->intval = jz_read_bat(bat_ps);
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 = bat_info->pdata->max_voltag; val->intval = jz_main_bat.pdata->max_voltag;
break; break;
case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
val->intval = bat_info->pdata->min_voltag; val->intval = jz_main_bat.pdata->min_voltag;
break; break;
case POWER_SUPPLY_PROP_PRESENT: case POWER_SUPPLY_PROP_PRESENT:
val->intval = 1; val->intval = 1;
@ -172,12 +175,10 @@ static int jz_bat_get_property(struct power_supply *psy,
return 0; return 0;
} }
static void jz_bat_external_power_changed(struct power_supply *psy) static void jz_bat_external_power_changed(struct power_supply *bat_ps)
{ {
struct jz_battery_info *bat_info = ps_to_jz_battery(psy); cancel_delayed_work(&jz_main_bat.bat_work);
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[] = {
@ -187,42 +188,40 @@ 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 *psy) static void jz_bat_update(struct power_supply *bat_ps)
{ {
struct jz_battery_info *bat_info = ps_to_jz_battery(psy); int old_status = jz_main_bat.bat_status;
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(psy); unsigned long batt_vol = jz_read_bat(bat_ps);
mutex_lock(&jz_main_bat.work_lock);
mutex_lock(&bat_info->work_lock); if (!jz_main_bat.pdata)
goto err;
if (gpio_is_valid(bat_info->pdata->charg_stat_gpio)) { if (!gpio_is_valid(jz_main_bat.pdata->charg_stat_gpio))
if(!gpio_get_value(bat_info->pdata->charg_stat_gpio)) goto err;
bat_info->bat_status = POWER_SUPPLY_STATUS_CHARGING;
else
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]);
if (old_status != bat_info->bat_status) {
dev_dbg(psy->dev, "%s %s -> %s\n",
psy->name,
status_text[old_status],
status_text[bat_info->bat_status]);
power_supply_changed(psy); if(!gpio_get_value(jz_main_bat.pdata->charg_stat_gpio))
} jz_main_bat.bat_status = POWER_SUPPLY_STATUS_CHARGING;
else
jz_main_bat.bat_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
dev_dbg(bat_ps->dev, "%s: battery status=%s\n",
__func__, status_text[jz_main_bat.bat_status]);
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[jz_main_bat.bat_status]);
power_supply_changed(bat_ps);
} }
if (old_batt_vol - batt_vol > 50000) { old_batt_vol = batt_vol;
dev_dbg(psy->dev, "voltage change : %ld -> %ld\n", err:
old_batt_vol, batt_vol); mutex_unlock(&jz_main_bat.work_lock);
power_supply_changed(psy);
old_batt_vol = batt_vol;
}
mutex_unlock(&bat_info->work_lock);
} }
static enum power_supply_property jz_bat_main_props[] = { static enum power_supply_property jz_bat_main_props[] = {
@ -250,31 +249,24 @@ 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);
jz_bat_update(&bat_ps); jz_bat_update(&bat_ps);
queue_delayed_work(bat_info->monitor_wqueue, queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, interval);
&bat_info->bat_work, interval);
} }
#ifdef CONFIG_PM #ifdef CONFIG_PM
static int jz_bat_suspend(struct platform_device *pdev, pm_message_t state) static int jz_bat_suspend(struct platform_device *dev, pm_message_t state)
{ {
struct jz_battery_info *bat_info = platform_get_drvdata(pdev); jz_main_bat.bat_status = POWER_SUPPLY_STATUS_UNKNOWN;
bat_info->bat_status = POWER_SUPPLY_STATUS_UNKNOWN;
return 0; return 0;
} }
static int jz_bat_resume(struct platform_device *pdev) static int jz_bat_resume(struct platform_device *dev)
{ {
struct jz_battery_info *bat_info = platform_get_drvdata(pdev); jz_main_bat.bat_status = POWER_SUPPLY_STATUS_UNKNOWN;
cancel_delayed_work(&jz_main_bat.bat_work);
bat_info->bat_status = POWER_SUPPLY_STATUS_UNKNOWN; queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, HZ/10);
cancel_delayed_work(&bat_info->bat_work);
queue_delayed_work(bat_info->monitor_wqueue, &bat_info->bat_work, HZ/10);
return 0; return 0;
} }
@ -286,37 +278,26 @@ static int jz_bat_resume(struct platform_device *pdev)
static int __devinit jz_bat_probe(struct platform_device *pdev) static int __devinit jz_bat_probe(struct platform_device *pdev)
{ {
int ret = 0; int ret = 0;
struct jz_battery_info *bat_info;
printk("JZ battery init.\n"); printk("JZ battery init.\n");
mutex_init(&jz_main_bat.work_lock);
bat_info = kzalloc(sizeof(struct jz_battery_info), GFP_KERNEL); INIT_DELAYED_WORK(&jz_main_bat.bat_work, jz_bat_work);
if (!bat_info) {
return -ENOMEM;
}
platform_set_drvdata(pdev, bat_info);
mutex_init(&bat_info->work_lock);
INIT_DELAYED_WORK(&bat_info->bat_work, jz_bat_work);
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");
ret = -EINVAL; return -EINVAL;
goto err_platform_data;
} }
jz_main_bat.pdata = pdev->dev.platform_data;
bat_info->pdata = pdev->dev.platform_data;
if (gpio_is_valid(bat_info->pdata->dc_dect_gpio)) { if (gpio_is_valid(jz_main_bat.pdata->dc_dect_gpio)) {
ret = gpio_request(bat_info->pdata->dc_dect_gpio, "AC/DC DECT"); 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(bat_info->pdata->dc_dect_gpio); ret = gpio_direction_input(jz_main_bat.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");
@ -324,64 +305,60 @@ static int __devinit jz_bat_probe(struct platform_device *pdev)
} }
} }
if (gpio_is_valid(bat_info->pdata->usb_dect_gpio)) { if (gpio_is_valid(jz_main_bat.pdata->usb_dect_gpio)) {
ret = gpio_request(bat_info->pdata->usb_dect_gpio, "USB DECT"); ret = gpio_request(jz_main_bat.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(bat_info->pdata->usb_dect_gpio); ret = gpio_direction_input(jz_main_bat.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(bat_info->pdata->usb_dect_gpio); jz_gpio_disable_pullup(jz_main_bat.pdata->usb_dect_gpio);
/* TODO: Use generic gpio is better */ /* TODO: Use generic gpio is better */
} }
if (gpio_is_valid(bat_info->pdata->charg_stat_gpio)) { if (gpio_is_valid(jz_main_bat.pdata->charg_stat_gpio)) {
ret = gpio_request(bat_info->pdata->charg_stat_gpio, "CHARG STAT"); ret = gpio_request(jz_main_bat.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(bat_info->pdata->charg_stat_gpio); ret = gpio_direction_input(jz_main_bat.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;
} }
} }
if (gpio_is_valid(bat_info->pdata->dc_dect_gpio)) { ret = power_supply_register(&pdev->dev, &jz_ac);
ret = power_supply_register(&pdev->dev, &jz_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;
}
} }
if (gpio_is_valid(bat_info->pdata->usb_dect_gpio)) { ret = power_supply_register(&pdev->dev, &jz_usb);
ret = power_supply_register(&pdev->dev, &jz_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;
}
} }
if (gpio_is_valid(bat_info->pdata->charg_stat_gpio)) { ret = power_supply_register(&pdev->dev, &bat_ps);
ret = power_supply_register(&pdev->dev, &bat_ps); 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");
return -ESRCH; if (!jz_main_bat.monitor_wqueue) {
} return -ESRCH;
queue_delayed_work(bat_info->monitor_wqueue, &bat_info->bat_work, HZ * 1);
} }
queue_delayed_work(jz_main_bat.monitor_wqueue, &jz_main_bat.bat_work, HZ * 1);
} }
return ret; return ret;
@ -392,30 +369,26 @@ err_power_register_usb:
power_supply_unregister(&jz_ac); power_supply_unregister(&jz_ac);
err_power_register_ac: err_power_register_ac:
err_charg_gpio_direction: err_charg_gpio_direction:
gpio_free(bat_info->pdata->charg_stat_gpio); gpio_free(jz_main_bat.pdata->charg_stat_gpio);
err_charg_gpio_request: err_charg_gpio_request:
err_usb_gpio_direction: err_usb_gpio_direction:
gpio_free(bat_info->pdata->usb_dect_gpio); gpio_free(jz_main_bat.pdata->usb_dect_gpio);
err_usb_gpio_request: err_usb_gpio_request:
err_dc_gpio_direction: err_dc_gpio_direction:
gpio_free(bat_info->pdata->dc_dect_gpio); gpio_free(jz_main_bat.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 *pdev) static int __devexit jz_bat_remove(struct platform_device *dev)
{ {
struct jz_battery_info *bat_info = platform_get_drvdata(pdev); if (jz_main_bat.pdata) {
if (gpio_is_valid(jz_main_bat.pdata->dc_dect_gpio))
if (bat_info->pdata) { gpio_free(jz_main_bat.pdata->dc_dect_gpio);
if (gpio_is_valid(bat_info->pdata->dc_dect_gpio)) if (gpio_is_valid(jz_main_bat.pdata->usb_dect_gpio))
gpio_free(bat_info->pdata->dc_dect_gpio); gpio_free(jz_main_bat.pdata->usb_dect_gpio);
if (gpio_is_valid(bat_info->pdata->usb_dect_gpio)) if (gpio_is_valid(jz_main_bat.pdata->charg_stat_gpio))
gpio_free(bat_info->pdata->usb_dect_gpio); gpio_free(jz_main_bat.pdata->charg_stat_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);