|  | /* | 
|  | * Battery and Power Management code for the Sharp SL-6000x | 
|  | * | 
|  | * Copyright (c) 2005 Dirk Opfer | 
|  | * Copyright (c) 2008 Dmitry Baryshkov | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License version 2 as | 
|  | * published by the Free Software Foundation. | 
|  | * | 
|  | */ | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/power_supply.h> | 
|  | #include <linux/wm97xx.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/spinlock.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/gpio.h> | 
|  |  | 
|  | #include <asm/mach-types.h> | 
|  | #include <mach/tosa.h> | 
|  |  | 
|  | static DEFINE_MUTEX(bat_lock); /* protects gpio pins */ | 
|  | static struct work_struct bat_work; | 
|  |  | 
|  | struct tosa_bat { | 
|  | int status; | 
|  | struct power_supply psy; | 
|  | int full_chrg; | 
|  |  | 
|  | struct mutex work_lock; /* protects data */ | 
|  |  | 
|  | bool (*is_present)(struct tosa_bat *bat); | 
|  | int gpio_full; | 
|  | int gpio_charge_off; | 
|  |  | 
|  | int technology; | 
|  |  | 
|  | int gpio_bat; | 
|  | int adc_bat; | 
|  | int adc_bat_divider; | 
|  | int bat_max; | 
|  | int bat_min; | 
|  |  | 
|  | int gpio_temp; | 
|  | int adc_temp; | 
|  | int adc_temp_divider; | 
|  | }; | 
|  |  | 
|  | static struct tosa_bat tosa_bat_main; | 
|  | static struct tosa_bat tosa_bat_jacket; | 
|  |  | 
|  | static unsigned long tosa_read_bat(struct tosa_bat *bat) | 
|  | { | 
|  | unsigned long value = 0; | 
|  |  | 
|  | if (bat->gpio_bat < 0 || bat->adc_bat < 0) | 
|  | return 0; | 
|  |  | 
|  | mutex_lock(&bat_lock); | 
|  | gpio_set_value(bat->gpio_bat, 1); | 
|  | msleep(5); | 
|  | value = wm97xx_read_aux_adc(dev_get_drvdata(bat->psy.dev->parent), | 
|  | bat->adc_bat); | 
|  | gpio_set_value(bat->gpio_bat, 0); | 
|  | mutex_unlock(&bat_lock); | 
|  |  | 
|  | value = value * 1000000 / bat->adc_bat_divider; | 
|  |  | 
|  | return value; | 
|  | } | 
|  |  | 
|  | static unsigned long tosa_read_temp(struct tosa_bat *bat) | 
|  | { | 
|  | unsigned long value = 0; | 
|  |  | 
|  | if (bat->gpio_temp < 0 || bat->adc_temp < 0) | 
|  | return 0; | 
|  |  | 
|  | mutex_lock(&bat_lock); | 
|  | gpio_set_value(bat->gpio_temp, 1); | 
|  | msleep(5); | 
|  | value = wm97xx_read_aux_adc(dev_get_drvdata(bat->psy.dev->parent), | 
|  | bat->adc_temp); | 
|  | gpio_set_value(bat->gpio_temp, 0); | 
|  | mutex_unlock(&bat_lock); | 
|  |  | 
|  | value = value * 10000 / bat->adc_temp_divider; | 
|  |  | 
|  | return value; | 
|  | } | 
|  |  | 
|  | static int tosa_bat_get_property(struct power_supply *psy, | 
|  | enum power_supply_property psp, | 
|  | union power_supply_propval *val) | 
|  | { | 
|  | int ret = 0; | 
|  | struct tosa_bat *bat = container_of(psy, struct tosa_bat, psy); | 
|  |  | 
|  | if (bat->is_present && !bat->is_present(bat) | 
|  | && psp != POWER_SUPPLY_PROP_PRESENT) { | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | switch (psp) { | 
|  | case POWER_SUPPLY_PROP_STATUS: | 
|  | val->intval = bat->status; | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_TECHNOLOGY: | 
|  | val->intval = bat->technology; | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_VOLTAGE_NOW: | 
|  | val->intval = tosa_read_bat(bat); | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_VOLTAGE_MAX: | 
|  | if (bat->full_chrg == -1) | 
|  | val->intval = bat->bat_max; | 
|  | else | 
|  | val->intval = bat->full_chrg; | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: | 
|  | val->intval = bat->bat_max; | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: | 
|  | val->intval = bat->bat_min; | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_TEMP: | 
|  | val->intval = tosa_read_temp(bat); | 
|  | break; | 
|  | case POWER_SUPPLY_PROP_PRESENT: | 
|  | val->intval = bat->is_present ? bat->is_present(bat) : 1; | 
|  | break; | 
|  | default: | 
|  | ret = -EINVAL; | 
|  | break; | 
|  | } | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static bool tosa_jacket_bat_is_present(struct tosa_bat *bat) | 
|  | { | 
|  | return gpio_get_value(TOSA_GPIO_JACKET_DETECT) == 0; | 
|  | } | 
|  |  | 
|  | static void tosa_bat_external_power_changed(struct power_supply *psy) | 
|  | { | 
|  | schedule_work(&bat_work); | 
|  | } | 
|  |  | 
|  | static irqreturn_t tosa_bat_gpio_isr(int irq, void *data) | 
|  | { | 
|  | pr_info("tosa_bat_gpio irq: %d\n", gpio_get_value(irq_to_gpio(irq))); | 
|  | schedule_work(&bat_work); | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static void tosa_bat_update(struct tosa_bat *bat) | 
|  | { | 
|  | int old; | 
|  | struct power_supply *psy = &bat->psy; | 
|  |  | 
|  | mutex_lock(&bat->work_lock); | 
|  |  | 
|  | old = bat->status; | 
|  |  | 
|  | if (bat->is_present && !bat->is_present(bat)) { | 
|  | printk(KERN_NOTICE "%s not present\n", psy->name); | 
|  | bat->status = POWER_SUPPLY_STATUS_UNKNOWN; | 
|  | bat->full_chrg = -1; | 
|  | } else if (power_supply_am_i_supplied(psy)) { | 
|  | if (bat->status == POWER_SUPPLY_STATUS_DISCHARGING) { | 
|  | gpio_set_value(bat->gpio_charge_off, 0); | 
|  | mdelay(15); | 
|  | } | 
|  |  | 
|  | if (gpio_get_value(bat->gpio_full)) { | 
|  | if (old == POWER_SUPPLY_STATUS_CHARGING || | 
|  | bat->full_chrg == -1) | 
|  | bat->full_chrg = tosa_read_bat(bat); | 
|  |  | 
|  | gpio_set_value(bat->gpio_charge_off, 1); | 
|  | bat->status = POWER_SUPPLY_STATUS_FULL; | 
|  | } else { | 
|  | gpio_set_value(bat->gpio_charge_off, 0); | 
|  | bat->status = POWER_SUPPLY_STATUS_CHARGING; | 
|  | } | 
|  | } else { | 
|  | gpio_set_value(bat->gpio_charge_off, 1); | 
|  | bat->status = POWER_SUPPLY_STATUS_DISCHARGING; | 
|  | } | 
|  |  | 
|  | if (old != bat->status) | 
|  | power_supply_changed(psy); | 
|  |  | 
|  | mutex_unlock(&bat->work_lock); | 
|  | } | 
|  |  | 
|  | static void tosa_bat_work(struct work_struct *work) | 
|  | { | 
|  | tosa_bat_update(&tosa_bat_main); | 
|  | tosa_bat_update(&tosa_bat_jacket); | 
|  | } | 
|  |  | 
|  |  | 
|  | static enum power_supply_property tosa_bat_main_props[] = { | 
|  | POWER_SUPPLY_PROP_STATUS, | 
|  | POWER_SUPPLY_PROP_TECHNOLOGY, | 
|  | POWER_SUPPLY_PROP_VOLTAGE_NOW, | 
|  | POWER_SUPPLY_PROP_VOLTAGE_MAX, | 
|  | POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, | 
|  | POWER_SUPPLY_PROP_TEMP, | 
|  | POWER_SUPPLY_PROP_PRESENT, | 
|  | }; | 
|  |  | 
|  | static enum power_supply_property tosa_bat_bu_props[] = { | 
|  | POWER_SUPPLY_PROP_STATUS, | 
|  | POWER_SUPPLY_PROP_TECHNOLOGY, | 
|  | POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, | 
|  | POWER_SUPPLY_PROP_VOLTAGE_NOW, | 
|  | POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, | 
|  | POWER_SUPPLY_PROP_PRESENT, | 
|  | }; | 
|  |  | 
|  | static struct tosa_bat tosa_bat_main = { | 
|  | .status = POWER_SUPPLY_STATUS_DISCHARGING, | 
|  | .full_chrg = -1, | 
|  | .psy = { | 
|  | .name		= "main-battery", | 
|  | .type		= POWER_SUPPLY_TYPE_BATTERY, | 
|  | .properties	= tosa_bat_main_props, | 
|  | .num_properties	= ARRAY_SIZE(tosa_bat_main_props), | 
|  | .get_property	= tosa_bat_get_property, | 
|  | .external_power_changed = tosa_bat_external_power_changed, | 
|  | .use_for_apm	= 1, | 
|  | }, | 
|  |  | 
|  | .gpio_full = TOSA_GPIO_BAT0_CRG, | 
|  | .gpio_charge_off = TOSA_GPIO_CHARGE_OFF, | 
|  |  | 
|  | .technology = POWER_SUPPLY_TECHNOLOGY_LIPO, | 
|  |  | 
|  | .gpio_bat = TOSA_GPIO_BAT0_V_ON, | 
|  | .adc_bat = WM97XX_AUX_ID3, | 
|  | .adc_bat_divider = 414, | 
|  | .bat_max = 4310000, | 
|  | .bat_min = 1551 * 1000000 / 414, | 
|  |  | 
|  | .gpio_temp = TOSA_GPIO_BAT1_TH_ON, | 
|  | .adc_temp = WM97XX_AUX_ID2, | 
|  | .adc_temp_divider = 10000, | 
|  | }; | 
|  |  | 
|  | static struct tosa_bat tosa_bat_jacket = { | 
|  | .status = POWER_SUPPLY_STATUS_DISCHARGING, | 
|  | .full_chrg = -1, | 
|  | .psy = { | 
|  | .name		= "jacket-battery", | 
|  | .type		= POWER_SUPPLY_TYPE_BATTERY, | 
|  | .properties	= tosa_bat_main_props, | 
|  | .num_properties	= ARRAY_SIZE(tosa_bat_main_props), | 
|  | .get_property	= tosa_bat_get_property, | 
|  | .external_power_changed = tosa_bat_external_power_changed, | 
|  | }, | 
|  |  | 
|  | .is_present = tosa_jacket_bat_is_present, | 
|  | .gpio_full = TOSA_GPIO_BAT1_CRG, | 
|  | .gpio_charge_off = TOSA_GPIO_CHARGE_OFF_JC, | 
|  |  | 
|  | .technology = POWER_SUPPLY_TECHNOLOGY_LIPO, | 
|  |  | 
|  | .gpio_bat = TOSA_GPIO_BAT1_V_ON, | 
|  | .adc_bat = WM97XX_AUX_ID3, | 
|  | .adc_bat_divider = 414, | 
|  | .bat_max = 4310000, | 
|  | .bat_min = 1551 * 1000000 / 414, | 
|  |  | 
|  | .gpio_temp = TOSA_GPIO_BAT0_TH_ON, | 
|  | .adc_temp = WM97XX_AUX_ID2, | 
|  | .adc_temp_divider = 10000, | 
|  | }; | 
|  |  | 
|  | static struct tosa_bat tosa_bat_bu = { | 
|  | .status = POWER_SUPPLY_STATUS_UNKNOWN, | 
|  | .full_chrg = -1, | 
|  |  | 
|  | .psy = { | 
|  | .name		= "backup-battery", | 
|  | .type		= POWER_SUPPLY_TYPE_BATTERY, | 
|  | .properties	= tosa_bat_bu_props, | 
|  | .num_properties	= ARRAY_SIZE(tosa_bat_bu_props), | 
|  | .get_property	= tosa_bat_get_property, | 
|  | .external_power_changed = tosa_bat_external_power_changed, | 
|  | }, | 
|  |  | 
|  | .gpio_full = -1, | 
|  | .gpio_charge_off = -1, | 
|  |  | 
|  | .technology = POWER_SUPPLY_TECHNOLOGY_LiMn, | 
|  |  | 
|  | .gpio_bat = TOSA_GPIO_BU_CHRG_ON, | 
|  | .adc_bat = WM97XX_AUX_ID4, | 
|  | .adc_bat_divider = 1266, | 
|  |  | 
|  | .gpio_temp = -1, | 
|  | .adc_temp = -1, | 
|  | .adc_temp_divider = -1, | 
|  | }; | 
|  |  | 
|  | static struct { | 
|  | int gpio; | 
|  | char *name; | 
|  | bool output; | 
|  | int value; | 
|  | } gpios[] = { | 
|  | { TOSA_GPIO_CHARGE_OFF,		"main charge off",	1, 1 }, | 
|  | { TOSA_GPIO_CHARGE_OFF_JC,	"jacket charge off",	1, 1 }, | 
|  | { TOSA_GPIO_BAT_SW_ON,		"battery switch",	1, 0 }, | 
|  | { TOSA_GPIO_BAT0_V_ON,		"main battery",		1, 0 }, | 
|  | { TOSA_GPIO_BAT1_V_ON,		"jacket battery",	1, 0 }, | 
|  | { TOSA_GPIO_BAT1_TH_ON,		"main battery temp",	1, 0 }, | 
|  | { TOSA_GPIO_BAT0_TH_ON,		"jacket battery temp",	1, 0 }, | 
|  | { TOSA_GPIO_BU_CHRG_ON,		"backup battery",	1, 0 }, | 
|  | { TOSA_GPIO_BAT0_CRG,		"main battery full",	0, 0 }, | 
|  | { TOSA_GPIO_BAT1_CRG,		"jacket battery full",	0, 0 }, | 
|  | { TOSA_GPIO_BAT0_LOW,		"main battery low",	0, 0 }, | 
|  | { TOSA_GPIO_BAT1_LOW,		"jacket battery low",	0, 0 }, | 
|  | { TOSA_GPIO_JACKET_DETECT,	"jacket detect",	0, 0 }, | 
|  | }; | 
|  |  | 
|  | #ifdef CONFIG_PM | 
|  | static int tosa_bat_suspend(struct platform_device *dev, pm_message_t state) | 
|  | { | 
|  | /* flush all pending status updates */ | 
|  | flush_work_sync(&bat_work); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tosa_bat_resume(struct platform_device *dev) | 
|  | { | 
|  | /* things may have changed while we were away */ | 
|  | schedule_work(&bat_work); | 
|  | return 0; | 
|  | } | 
|  | #else | 
|  | #define tosa_bat_suspend NULL | 
|  | #define tosa_bat_resume NULL | 
|  | #endif | 
|  |  | 
|  | static int __devinit tosa_bat_probe(struct platform_device *dev) | 
|  | { | 
|  | int ret; | 
|  | int i; | 
|  |  | 
|  | if (!machine_is_tosa()) | 
|  | return -ENODEV; | 
|  |  | 
|  | for (i = 0; i < ARRAY_SIZE(gpios); i++) { | 
|  | ret = gpio_request(gpios[i].gpio, gpios[i].name); | 
|  | if (ret) { | 
|  | i--; | 
|  | goto err_gpio; | 
|  | } | 
|  |  | 
|  | if (gpios[i].output) | 
|  | ret = gpio_direction_output(gpios[i].gpio, | 
|  | gpios[i].value); | 
|  | else | 
|  | ret = gpio_direction_input(gpios[i].gpio); | 
|  |  | 
|  | if (ret) | 
|  | goto err_gpio; | 
|  | } | 
|  |  | 
|  | mutex_init(&tosa_bat_main.work_lock); | 
|  | mutex_init(&tosa_bat_jacket.work_lock); | 
|  |  | 
|  | INIT_WORK(&bat_work, tosa_bat_work); | 
|  |  | 
|  | ret = power_supply_register(&dev->dev, &tosa_bat_main.psy); | 
|  | if (ret) | 
|  | goto err_psy_reg_main; | 
|  | ret = power_supply_register(&dev->dev, &tosa_bat_jacket.psy); | 
|  | if (ret) | 
|  | goto err_psy_reg_jacket; | 
|  | ret = power_supply_register(&dev->dev, &tosa_bat_bu.psy); | 
|  | if (ret) | 
|  | goto err_psy_reg_bu; | 
|  |  | 
|  | ret = request_irq(gpio_to_irq(TOSA_GPIO_BAT0_CRG), | 
|  | tosa_bat_gpio_isr, | 
|  | IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, | 
|  | "main full", &tosa_bat_main); | 
|  | if (ret) | 
|  | goto err_req_main; | 
|  |  | 
|  | ret = request_irq(gpio_to_irq(TOSA_GPIO_BAT1_CRG), | 
|  | tosa_bat_gpio_isr, | 
|  | IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, | 
|  | "jacket full", &tosa_bat_jacket); | 
|  | if (ret) | 
|  | goto err_req_jacket; | 
|  |  | 
|  | ret = request_irq(gpio_to_irq(TOSA_GPIO_JACKET_DETECT), | 
|  | tosa_bat_gpio_isr, | 
|  | IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, | 
|  | "jacket detect", &tosa_bat_jacket); | 
|  | if (!ret) { | 
|  | schedule_work(&bat_work); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | free_irq(gpio_to_irq(TOSA_GPIO_BAT1_CRG), &tosa_bat_jacket); | 
|  | err_req_jacket: | 
|  | free_irq(gpio_to_irq(TOSA_GPIO_BAT0_CRG), &tosa_bat_main); | 
|  | err_req_main: | 
|  | power_supply_unregister(&tosa_bat_bu.psy); | 
|  | err_psy_reg_bu: | 
|  | power_supply_unregister(&tosa_bat_jacket.psy); | 
|  | err_psy_reg_jacket: | 
|  | power_supply_unregister(&tosa_bat_main.psy); | 
|  | err_psy_reg_main: | 
|  |  | 
|  | /* see comment in tosa_bat_remove */ | 
|  | cancel_work_sync(&bat_work); | 
|  |  | 
|  | i--; | 
|  | err_gpio: | 
|  | for (; i >= 0; i--) | 
|  | gpio_free(gpios[i].gpio); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int __devexit tosa_bat_remove(struct platform_device *dev) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | free_irq(gpio_to_irq(TOSA_GPIO_JACKET_DETECT), &tosa_bat_jacket); | 
|  | free_irq(gpio_to_irq(TOSA_GPIO_BAT1_CRG), &tosa_bat_jacket); | 
|  | free_irq(gpio_to_irq(TOSA_GPIO_BAT0_CRG), &tosa_bat_main); | 
|  |  | 
|  | power_supply_unregister(&tosa_bat_bu.psy); | 
|  | power_supply_unregister(&tosa_bat_jacket.psy); | 
|  | power_supply_unregister(&tosa_bat_main.psy); | 
|  |  | 
|  | /* | 
|  | * Now cancel the bat_work.  We won't get any more schedules, | 
|  | * since all sources (isr and external_power_changed) are | 
|  | * unregistered now. | 
|  | */ | 
|  | cancel_work_sync(&bat_work); | 
|  |  | 
|  | for (i = ARRAY_SIZE(gpios) - 1; i >= 0; i--) | 
|  | gpio_free(gpios[i].gpio); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static struct platform_driver tosa_bat_driver = { | 
|  | .driver.name	= "wm97xx-battery", | 
|  | .driver.owner	= THIS_MODULE, | 
|  | .probe		= tosa_bat_probe, | 
|  | .remove		= __devexit_p(tosa_bat_remove), | 
|  | .suspend	= tosa_bat_suspend, | 
|  | .resume		= tosa_bat_resume, | 
|  | }; | 
|  |  | 
|  | static int __init tosa_bat_init(void) | 
|  | { | 
|  | return platform_driver_register(&tosa_bat_driver); | 
|  | } | 
|  |  | 
|  | static void __exit tosa_bat_exit(void) | 
|  | { | 
|  | platform_driver_unregister(&tosa_bat_driver); | 
|  | } | 
|  |  | 
|  | module_init(tosa_bat_init); | 
|  | module_exit(tosa_bat_exit); | 
|  |  | 
|  | MODULE_LICENSE("GPL"); | 
|  | MODULE_AUTHOR("Dmitry Baryshkov"); | 
|  | MODULE_DESCRIPTION("Tosa battery driver"); | 
|  | MODULE_ALIAS("platform:wm97xx-battery"); |