18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Battery and Power Management code for the Sharp SL-5x00 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright (C) 2009 Thomas Kunze 68c2ecf20Sopenharmony_ci * 78c2ecf20Sopenharmony_ci * based on tosa_battery.c 88c2ecf20Sopenharmony_ci */ 98c2ecf20Sopenharmony_ci#include <linux/kernel.h> 108c2ecf20Sopenharmony_ci#include <linux/module.h> 118c2ecf20Sopenharmony_ci#include <linux/power_supply.h> 128c2ecf20Sopenharmony_ci#include <linux/delay.h> 138c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 148c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 158c2ecf20Sopenharmony_ci#include <linux/gpio.h> 168c2ecf20Sopenharmony_ci#include <linux/mfd/ucb1x00.h> 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci#include <asm/mach/sharpsl_param.h> 198c2ecf20Sopenharmony_ci#include <asm/mach-types.h> 208c2ecf20Sopenharmony_ci#include <mach/collie.h> 218c2ecf20Sopenharmony_ci 228c2ecf20Sopenharmony_cistatic DEFINE_MUTEX(bat_lock); /* protects gpio pins */ 238c2ecf20Sopenharmony_cistatic struct work_struct bat_work; 248c2ecf20Sopenharmony_cistatic struct ucb1x00 *ucb; 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_cistruct collie_bat { 278c2ecf20Sopenharmony_ci int status; 288c2ecf20Sopenharmony_ci struct power_supply *psy; 298c2ecf20Sopenharmony_ci int full_chrg; 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci struct mutex work_lock; /* protects data */ 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_ci bool (*is_present)(struct collie_bat *bat); 348c2ecf20Sopenharmony_ci int gpio_full; 358c2ecf20Sopenharmony_ci int gpio_charge_on; 368c2ecf20Sopenharmony_ci 378c2ecf20Sopenharmony_ci int technology; 388c2ecf20Sopenharmony_ci 398c2ecf20Sopenharmony_ci int gpio_bat; 408c2ecf20Sopenharmony_ci int adc_bat; 418c2ecf20Sopenharmony_ci int adc_bat_divider; 428c2ecf20Sopenharmony_ci int bat_max; 438c2ecf20Sopenharmony_ci int bat_min; 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ci int gpio_temp; 468c2ecf20Sopenharmony_ci int adc_temp; 478c2ecf20Sopenharmony_ci int adc_temp_divider; 488c2ecf20Sopenharmony_ci}; 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_cistatic struct collie_bat collie_bat_main; 518c2ecf20Sopenharmony_ci 528c2ecf20Sopenharmony_cistatic unsigned long collie_read_bat(struct collie_bat *bat) 538c2ecf20Sopenharmony_ci{ 548c2ecf20Sopenharmony_ci unsigned long value = 0; 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_ci if (bat->gpio_bat < 0 || bat->adc_bat < 0) 578c2ecf20Sopenharmony_ci return 0; 588c2ecf20Sopenharmony_ci mutex_lock(&bat_lock); 598c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_bat, 1); 608c2ecf20Sopenharmony_ci msleep(5); 618c2ecf20Sopenharmony_ci ucb1x00_adc_enable(ucb); 628c2ecf20Sopenharmony_ci value = ucb1x00_adc_read(ucb, bat->adc_bat, UCB_SYNC); 638c2ecf20Sopenharmony_ci ucb1x00_adc_disable(ucb); 648c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_bat, 0); 658c2ecf20Sopenharmony_ci mutex_unlock(&bat_lock); 668c2ecf20Sopenharmony_ci value = value * 1000000 / bat->adc_bat_divider; 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci return value; 698c2ecf20Sopenharmony_ci} 708c2ecf20Sopenharmony_ci 718c2ecf20Sopenharmony_cistatic unsigned long collie_read_temp(struct collie_bat *bat) 728c2ecf20Sopenharmony_ci{ 738c2ecf20Sopenharmony_ci unsigned long value = 0; 748c2ecf20Sopenharmony_ci if (bat->gpio_temp < 0 || bat->adc_temp < 0) 758c2ecf20Sopenharmony_ci return 0; 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci mutex_lock(&bat_lock); 788c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_temp, 1); 798c2ecf20Sopenharmony_ci msleep(5); 808c2ecf20Sopenharmony_ci ucb1x00_adc_enable(ucb); 818c2ecf20Sopenharmony_ci value = ucb1x00_adc_read(ucb, bat->adc_temp, UCB_SYNC); 828c2ecf20Sopenharmony_ci ucb1x00_adc_disable(ucb); 838c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_temp, 0); 848c2ecf20Sopenharmony_ci mutex_unlock(&bat_lock); 858c2ecf20Sopenharmony_ci 868c2ecf20Sopenharmony_ci value = value * 10000 / bat->adc_temp_divider; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci return value; 898c2ecf20Sopenharmony_ci} 908c2ecf20Sopenharmony_ci 918c2ecf20Sopenharmony_cistatic int collie_bat_get_property(struct power_supply *psy, 928c2ecf20Sopenharmony_ci enum power_supply_property psp, 938c2ecf20Sopenharmony_ci union power_supply_propval *val) 948c2ecf20Sopenharmony_ci{ 958c2ecf20Sopenharmony_ci int ret = 0; 968c2ecf20Sopenharmony_ci struct collie_bat *bat = power_supply_get_drvdata(psy); 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_ci if (bat->is_present && !bat->is_present(bat) 998c2ecf20Sopenharmony_ci && psp != POWER_SUPPLY_PROP_PRESENT) { 1008c2ecf20Sopenharmony_ci return -ENODEV; 1018c2ecf20Sopenharmony_ci } 1028c2ecf20Sopenharmony_ci 1038c2ecf20Sopenharmony_ci switch (psp) { 1048c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_STATUS: 1058c2ecf20Sopenharmony_ci val->intval = bat->status; 1068c2ecf20Sopenharmony_ci break; 1078c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_TECHNOLOGY: 1088c2ecf20Sopenharmony_ci val->intval = bat->technology; 1098c2ecf20Sopenharmony_ci break; 1108c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_NOW: 1118c2ecf20Sopenharmony_ci val->intval = collie_read_bat(bat); 1128c2ecf20Sopenharmony_ci break; 1138c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_MAX: 1148c2ecf20Sopenharmony_ci if (bat->full_chrg == -1) 1158c2ecf20Sopenharmony_ci val->intval = bat->bat_max; 1168c2ecf20Sopenharmony_ci else 1178c2ecf20Sopenharmony_ci val->intval = bat->full_chrg; 1188c2ecf20Sopenharmony_ci break; 1198c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: 1208c2ecf20Sopenharmony_ci val->intval = bat->bat_max; 1218c2ecf20Sopenharmony_ci break; 1228c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: 1238c2ecf20Sopenharmony_ci val->intval = bat->bat_min; 1248c2ecf20Sopenharmony_ci break; 1258c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_TEMP: 1268c2ecf20Sopenharmony_ci val->intval = collie_read_temp(bat); 1278c2ecf20Sopenharmony_ci break; 1288c2ecf20Sopenharmony_ci case POWER_SUPPLY_PROP_PRESENT: 1298c2ecf20Sopenharmony_ci val->intval = bat->is_present ? bat->is_present(bat) : 1; 1308c2ecf20Sopenharmony_ci break; 1318c2ecf20Sopenharmony_ci default: 1328c2ecf20Sopenharmony_ci ret = -EINVAL; 1338c2ecf20Sopenharmony_ci break; 1348c2ecf20Sopenharmony_ci } 1358c2ecf20Sopenharmony_ci return ret; 1368c2ecf20Sopenharmony_ci} 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_cistatic void collie_bat_external_power_changed(struct power_supply *psy) 1398c2ecf20Sopenharmony_ci{ 1408c2ecf20Sopenharmony_ci schedule_work(&bat_work); 1418c2ecf20Sopenharmony_ci} 1428c2ecf20Sopenharmony_ci 1438c2ecf20Sopenharmony_cistatic irqreturn_t collie_bat_gpio_isr(int irq, void *data) 1448c2ecf20Sopenharmony_ci{ 1458c2ecf20Sopenharmony_ci pr_info("collie_bat_gpio irq\n"); 1468c2ecf20Sopenharmony_ci schedule_work(&bat_work); 1478c2ecf20Sopenharmony_ci return IRQ_HANDLED; 1488c2ecf20Sopenharmony_ci} 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_cistatic void collie_bat_update(struct collie_bat *bat) 1518c2ecf20Sopenharmony_ci{ 1528c2ecf20Sopenharmony_ci int old; 1538c2ecf20Sopenharmony_ci struct power_supply *psy = bat->psy; 1548c2ecf20Sopenharmony_ci 1558c2ecf20Sopenharmony_ci mutex_lock(&bat->work_lock); 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_ci old = bat->status; 1588c2ecf20Sopenharmony_ci 1598c2ecf20Sopenharmony_ci if (bat->is_present && !bat->is_present(bat)) { 1608c2ecf20Sopenharmony_ci printk(KERN_NOTICE "%s not present\n", psy->desc->name); 1618c2ecf20Sopenharmony_ci bat->status = POWER_SUPPLY_STATUS_UNKNOWN; 1628c2ecf20Sopenharmony_ci bat->full_chrg = -1; 1638c2ecf20Sopenharmony_ci } else if (power_supply_am_i_supplied(psy)) { 1648c2ecf20Sopenharmony_ci if (bat->status == POWER_SUPPLY_STATUS_DISCHARGING) { 1658c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_charge_on, 1); 1668c2ecf20Sopenharmony_ci mdelay(15); 1678c2ecf20Sopenharmony_ci } 1688c2ecf20Sopenharmony_ci 1698c2ecf20Sopenharmony_ci if (gpio_get_value(bat->gpio_full)) { 1708c2ecf20Sopenharmony_ci if (old == POWER_SUPPLY_STATUS_CHARGING || 1718c2ecf20Sopenharmony_ci bat->full_chrg == -1) 1728c2ecf20Sopenharmony_ci bat->full_chrg = collie_read_bat(bat); 1738c2ecf20Sopenharmony_ci 1748c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_charge_on, 0); 1758c2ecf20Sopenharmony_ci bat->status = POWER_SUPPLY_STATUS_FULL; 1768c2ecf20Sopenharmony_ci } else { 1778c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_charge_on, 1); 1788c2ecf20Sopenharmony_ci bat->status = POWER_SUPPLY_STATUS_CHARGING; 1798c2ecf20Sopenharmony_ci } 1808c2ecf20Sopenharmony_ci } else { 1818c2ecf20Sopenharmony_ci gpio_set_value(bat->gpio_charge_on, 0); 1828c2ecf20Sopenharmony_ci bat->status = POWER_SUPPLY_STATUS_DISCHARGING; 1838c2ecf20Sopenharmony_ci } 1848c2ecf20Sopenharmony_ci 1858c2ecf20Sopenharmony_ci if (old != bat->status) 1868c2ecf20Sopenharmony_ci power_supply_changed(psy); 1878c2ecf20Sopenharmony_ci 1888c2ecf20Sopenharmony_ci mutex_unlock(&bat->work_lock); 1898c2ecf20Sopenharmony_ci} 1908c2ecf20Sopenharmony_ci 1918c2ecf20Sopenharmony_cistatic void collie_bat_work(struct work_struct *work) 1928c2ecf20Sopenharmony_ci{ 1938c2ecf20Sopenharmony_ci collie_bat_update(&collie_bat_main); 1948c2ecf20Sopenharmony_ci} 1958c2ecf20Sopenharmony_ci 1968c2ecf20Sopenharmony_ci 1978c2ecf20Sopenharmony_cistatic enum power_supply_property collie_bat_main_props[] = { 1988c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_STATUS, 1998c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_TECHNOLOGY, 2008c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, 2018c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_NOW, 2028c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 2038c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MAX, 2048c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_PRESENT, 2058c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_TEMP, 2068c2ecf20Sopenharmony_ci}; 2078c2ecf20Sopenharmony_ci 2088c2ecf20Sopenharmony_cistatic enum power_supply_property collie_bat_bu_props[] = { 2098c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_STATUS, 2108c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_TECHNOLOGY, 2118c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, 2128c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_NOW, 2138c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 2148c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_VOLTAGE_MAX, 2158c2ecf20Sopenharmony_ci POWER_SUPPLY_PROP_PRESENT, 2168c2ecf20Sopenharmony_ci}; 2178c2ecf20Sopenharmony_ci 2188c2ecf20Sopenharmony_cistatic const struct power_supply_desc collie_bat_main_desc = { 2198c2ecf20Sopenharmony_ci .name = "main-battery", 2208c2ecf20Sopenharmony_ci .type = POWER_SUPPLY_TYPE_BATTERY, 2218c2ecf20Sopenharmony_ci .properties = collie_bat_main_props, 2228c2ecf20Sopenharmony_ci .num_properties = ARRAY_SIZE(collie_bat_main_props), 2238c2ecf20Sopenharmony_ci .get_property = collie_bat_get_property, 2248c2ecf20Sopenharmony_ci .external_power_changed = collie_bat_external_power_changed, 2258c2ecf20Sopenharmony_ci .use_for_apm = 1, 2268c2ecf20Sopenharmony_ci}; 2278c2ecf20Sopenharmony_ci 2288c2ecf20Sopenharmony_cistatic struct collie_bat collie_bat_main = { 2298c2ecf20Sopenharmony_ci .status = POWER_SUPPLY_STATUS_DISCHARGING, 2308c2ecf20Sopenharmony_ci .full_chrg = -1, 2318c2ecf20Sopenharmony_ci .psy = NULL, 2328c2ecf20Sopenharmony_ci 2338c2ecf20Sopenharmony_ci .gpio_full = COLLIE_GPIO_CO, 2348c2ecf20Sopenharmony_ci .gpio_charge_on = COLLIE_GPIO_CHARGE_ON, 2358c2ecf20Sopenharmony_ci 2368c2ecf20Sopenharmony_ci .technology = POWER_SUPPLY_TECHNOLOGY_LIPO, 2378c2ecf20Sopenharmony_ci 2388c2ecf20Sopenharmony_ci .gpio_bat = COLLIE_GPIO_MBAT_ON, 2398c2ecf20Sopenharmony_ci .adc_bat = UCB_ADC_INP_AD1, 2408c2ecf20Sopenharmony_ci .adc_bat_divider = 155, 2418c2ecf20Sopenharmony_ci .bat_max = 4310000, 2428c2ecf20Sopenharmony_ci .bat_min = 1551 * 1000000 / 414, 2438c2ecf20Sopenharmony_ci 2448c2ecf20Sopenharmony_ci .gpio_temp = COLLIE_GPIO_TMP_ON, 2458c2ecf20Sopenharmony_ci .adc_temp = UCB_ADC_INP_AD0, 2468c2ecf20Sopenharmony_ci .adc_temp_divider = 10000, 2478c2ecf20Sopenharmony_ci}; 2488c2ecf20Sopenharmony_ci 2498c2ecf20Sopenharmony_cistatic const struct power_supply_desc collie_bat_bu_desc = { 2508c2ecf20Sopenharmony_ci .name = "backup-battery", 2518c2ecf20Sopenharmony_ci .type = POWER_SUPPLY_TYPE_BATTERY, 2528c2ecf20Sopenharmony_ci .properties = collie_bat_bu_props, 2538c2ecf20Sopenharmony_ci .num_properties = ARRAY_SIZE(collie_bat_bu_props), 2548c2ecf20Sopenharmony_ci .get_property = collie_bat_get_property, 2558c2ecf20Sopenharmony_ci .external_power_changed = collie_bat_external_power_changed, 2568c2ecf20Sopenharmony_ci}; 2578c2ecf20Sopenharmony_ci 2588c2ecf20Sopenharmony_cistatic struct collie_bat collie_bat_bu = { 2598c2ecf20Sopenharmony_ci .status = POWER_SUPPLY_STATUS_UNKNOWN, 2608c2ecf20Sopenharmony_ci .full_chrg = -1, 2618c2ecf20Sopenharmony_ci .psy = NULL, 2628c2ecf20Sopenharmony_ci 2638c2ecf20Sopenharmony_ci .gpio_full = -1, 2648c2ecf20Sopenharmony_ci .gpio_charge_on = -1, 2658c2ecf20Sopenharmony_ci 2668c2ecf20Sopenharmony_ci .technology = POWER_SUPPLY_TECHNOLOGY_LiMn, 2678c2ecf20Sopenharmony_ci 2688c2ecf20Sopenharmony_ci .gpio_bat = COLLIE_GPIO_BBAT_ON, 2698c2ecf20Sopenharmony_ci .adc_bat = UCB_ADC_INP_AD1, 2708c2ecf20Sopenharmony_ci .adc_bat_divider = 155, 2718c2ecf20Sopenharmony_ci .bat_max = 3000000, 2728c2ecf20Sopenharmony_ci .bat_min = 1900000, 2738c2ecf20Sopenharmony_ci 2748c2ecf20Sopenharmony_ci .gpio_temp = -1, 2758c2ecf20Sopenharmony_ci .adc_temp = -1, 2768c2ecf20Sopenharmony_ci .adc_temp_divider = -1, 2778c2ecf20Sopenharmony_ci}; 2788c2ecf20Sopenharmony_ci 2798c2ecf20Sopenharmony_cistatic struct gpio collie_batt_gpios[] = { 2808c2ecf20Sopenharmony_ci { COLLIE_GPIO_CO, GPIOF_IN, "main battery full" }, 2818c2ecf20Sopenharmony_ci { COLLIE_GPIO_MAIN_BAT_LOW, GPIOF_IN, "main battery low" }, 2828c2ecf20Sopenharmony_ci { COLLIE_GPIO_CHARGE_ON, GPIOF_OUT_INIT_LOW, "main charge on" }, 2838c2ecf20Sopenharmony_ci { COLLIE_GPIO_MBAT_ON, GPIOF_OUT_INIT_LOW, "main battery" }, 2848c2ecf20Sopenharmony_ci { COLLIE_GPIO_TMP_ON, GPIOF_OUT_INIT_LOW, "main battery temp" }, 2858c2ecf20Sopenharmony_ci { COLLIE_GPIO_BBAT_ON, GPIOF_OUT_INIT_LOW, "backup battery" }, 2868c2ecf20Sopenharmony_ci}; 2878c2ecf20Sopenharmony_ci 2888c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 2898c2ecf20Sopenharmony_cistatic int wakeup_enabled; 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_cistatic int collie_bat_suspend(struct ucb1x00_dev *dev) 2928c2ecf20Sopenharmony_ci{ 2938c2ecf20Sopenharmony_ci /* flush all pending status updates */ 2948c2ecf20Sopenharmony_ci flush_work(&bat_work); 2958c2ecf20Sopenharmony_ci 2968c2ecf20Sopenharmony_ci if (device_may_wakeup(&dev->ucb->dev) && 2978c2ecf20Sopenharmony_ci collie_bat_main.status == POWER_SUPPLY_STATUS_CHARGING) 2988c2ecf20Sopenharmony_ci wakeup_enabled = !enable_irq_wake(gpio_to_irq(COLLIE_GPIO_CO)); 2998c2ecf20Sopenharmony_ci else 3008c2ecf20Sopenharmony_ci wakeup_enabled = 0; 3018c2ecf20Sopenharmony_ci 3028c2ecf20Sopenharmony_ci return 0; 3038c2ecf20Sopenharmony_ci} 3048c2ecf20Sopenharmony_ci 3058c2ecf20Sopenharmony_cistatic int collie_bat_resume(struct ucb1x00_dev *dev) 3068c2ecf20Sopenharmony_ci{ 3078c2ecf20Sopenharmony_ci if (wakeup_enabled) 3088c2ecf20Sopenharmony_ci disable_irq_wake(gpio_to_irq(COLLIE_GPIO_CO)); 3098c2ecf20Sopenharmony_ci 3108c2ecf20Sopenharmony_ci /* things may have changed while we were away */ 3118c2ecf20Sopenharmony_ci schedule_work(&bat_work); 3128c2ecf20Sopenharmony_ci return 0; 3138c2ecf20Sopenharmony_ci} 3148c2ecf20Sopenharmony_ci#else 3158c2ecf20Sopenharmony_ci#define collie_bat_suspend NULL 3168c2ecf20Sopenharmony_ci#define collie_bat_resume NULL 3178c2ecf20Sopenharmony_ci#endif 3188c2ecf20Sopenharmony_ci 3198c2ecf20Sopenharmony_cistatic int collie_bat_probe(struct ucb1x00_dev *dev) 3208c2ecf20Sopenharmony_ci{ 3218c2ecf20Sopenharmony_ci int ret; 3228c2ecf20Sopenharmony_ci struct power_supply_config psy_main_cfg = {}, psy_bu_cfg = {}; 3238c2ecf20Sopenharmony_ci 3248c2ecf20Sopenharmony_ci if (!machine_is_collie()) 3258c2ecf20Sopenharmony_ci return -ENODEV; 3268c2ecf20Sopenharmony_ci 3278c2ecf20Sopenharmony_ci ucb = dev->ucb; 3288c2ecf20Sopenharmony_ci 3298c2ecf20Sopenharmony_ci ret = gpio_request_array(collie_batt_gpios, 3308c2ecf20Sopenharmony_ci ARRAY_SIZE(collie_batt_gpios)); 3318c2ecf20Sopenharmony_ci if (ret) 3328c2ecf20Sopenharmony_ci return ret; 3338c2ecf20Sopenharmony_ci 3348c2ecf20Sopenharmony_ci mutex_init(&collie_bat_main.work_lock); 3358c2ecf20Sopenharmony_ci 3368c2ecf20Sopenharmony_ci INIT_WORK(&bat_work, collie_bat_work); 3378c2ecf20Sopenharmony_ci 3388c2ecf20Sopenharmony_ci psy_main_cfg.drv_data = &collie_bat_main; 3398c2ecf20Sopenharmony_ci collie_bat_main.psy = power_supply_register(&dev->ucb->dev, 3408c2ecf20Sopenharmony_ci &collie_bat_main_desc, 3418c2ecf20Sopenharmony_ci &psy_main_cfg); 3428c2ecf20Sopenharmony_ci if (IS_ERR(collie_bat_main.psy)) { 3438c2ecf20Sopenharmony_ci ret = PTR_ERR(collie_bat_main.psy); 3448c2ecf20Sopenharmony_ci goto err_psy_reg_main; 3458c2ecf20Sopenharmony_ci } 3468c2ecf20Sopenharmony_ci 3478c2ecf20Sopenharmony_ci psy_bu_cfg.drv_data = &collie_bat_bu; 3488c2ecf20Sopenharmony_ci collie_bat_bu.psy = power_supply_register(&dev->ucb->dev, 3498c2ecf20Sopenharmony_ci &collie_bat_bu_desc, 3508c2ecf20Sopenharmony_ci &psy_bu_cfg); 3518c2ecf20Sopenharmony_ci if (IS_ERR(collie_bat_bu.psy)) { 3528c2ecf20Sopenharmony_ci ret = PTR_ERR(collie_bat_bu.psy); 3538c2ecf20Sopenharmony_ci goto err_psy_reg_bu; 3548c2ecf20Sopenharmony_ci } 3558c2ecf20Sopenharmony_ci 3568c2ecf20Sopenharmony_ci ret = request_irq(gpio_to_irq(COLLIE_GPIO_CO), 3578c2ecf20Sopenharmony_ci collie_bat_gpio_isr, 3588c2ecf20Sopenharmony_ci IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, 3598c2ecf20Sopenharmony_ci "main full", &collie_bat_main); 3608c2ecf20Sopenharmony_ci if (ret) 3618c2ecf20Sopenharmony_ci goto err_irq; 3628c2ecf20Sopenharmony_ci 3638c2ecf20Sopenharmony_ci device_init_wakeup(&ucb->dev, 1); 3648c2ecf20Sopenharmony_ci schedule_work(&bat_work); 3658c2ecf20Sopenharmony_ci 3668c2ecf20Sopenharmony_ci return 0; 3678c2ecf20Sopenharmony_ci 3688c2ecf20Sopenharmony_cierr_irq: 3698c2ecf20Sopenharmony_ci power_supply_unregister(collie_bat_bu.psy); 3708c2ecf20Sopenharmony_cierr_psy_reg_bu: 3718c2ecf20Sopenharmony_ci power_supply_unregister(collie_bat_main.psy); 3728c2ecf20Sopenharmony_cierr_psy_reg_main: 3738c2ecf20Sopenharmony_ci 3748c2ecf20Sopenharmony_ci /* see comment in collie_bat_remove */ 3758c2ecf20Sopenharmony_ci cancel_work_sync(&bat_work); 3768c2ecf20Sopenharmony_ci gpio_free_array(collie_batt_gpios, ARRAY_SIZE(collie_batt_gpios)); 3778c2ecf20Sopenharmony_ci return ret; 3788c2ecf20Sopenharmony_ci} 3798c2ecf20Sopenharmony_ci 3808c2ecf20Sopenharmony_cistatic void collie_bat_remove(struct ucb1x00_dev *dev) 3818c2ecf20Sopenharmony_ci{ 3828c2ecf20Sopenharmony_ci free_irq(gpio_to_irq(COLLIE_GPIO_CO), &collie_bat_main); 3838c2ecf20Sopenharmony_ci 3848c2ecf20Sopenharmony_ci power_supply_unregister(collie_bat_bu.psy); 3858c2ecf20Sopenharmony_ci power_supply_unregister(collie_bat_main.psy); 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci /* 3888c2ecf20Sopenharmony_ci * Now cancel the bat_work. We won't get any more schedules, 3898c2ecf20Sopenharmony_ci * since all sources (isr and external_power_changed) are 3908c2ecf20Sopenharmony_ci * unregistered now. 3918c2ecf20Sopenharmony_ci */ 3928c2ecf20Sopenharmony_ci cancel_work_sync(&bat_work); 3938c2ecf20Sopenharmony_ci gpio_free_array(collie_batt_gpios, ARRAY_SIZE(collie_batt_gpios)); 3948c2ecf20Sopenharmony_ci} 3958c2ecf20Sopenharmony_ci 3968c2ecf20Sopenharmony_cistatic struct ucb1x00_driver collie_bat_driver = { 3978c2ecf20Sopenharmony_ci .add = collie_bat_probe, 3988c2ecf20Sopenharmony_ci .remove = collie_bat_remove, 3998c2ecf20Sopenharmony_ci .suspend = collie_bat_suspend, 4008c2ecf20Sopenharmony_ci .resume = collie_bat_resume, 4018c2ecf20Sopenharmony_ci}; 4028c2ecf20Sopenharmony_ci 4038c2ecf20Sopenharmony_cistatic int __init collie_bat_init(void) 4048c2ecf20Sopenharmony_ci{ 4058c2ecf20Sopenharmony_ci return ucb1x00_register_driver(&collie_bat_driver); 4068c2ecf20Sopenharmony_ci} 4078c2ecf20Sopenharmony_ci 4088c2ecf20Sopenharmony_cistatic void __exit collie_bat_exit(void) 4098c2ecf20Sopenharmony_ci{ 4108c2ecf20Sopenharmony_ci ucb1x00_unregister_driver(&collie_bat_driver); 4118c2ecf20Sopenharmony_ci} 4128c2ecf20Sopenharmony_ci 4138c2ecf20Sopenharmony_cimodule_init(collie_bat_init); 4148c2ecf20Sopenharmony_cimodule_exit(collie_bat_exit); 4158c2ecf20Sopenharmony_ci 4168c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 4178c2ecf20Sopenharmony_ciMODULE_AUTHOR("Thomas Kunze"); 4188c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Collie battery driver"); 419