parent
863e3c739a
commit
27a0d8478d
@ -0,0 +1,184 @@ |
|||||||
|
/*
|
||||||
|
* Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de> |
||||||
|
* Driver for chargers indicating their status through a GPIO pin |
||||||
|
* |
||||||
|
* This program is free software; you can redistribute it and/or modify it |
||||||
|
* under the terms of the GNU General Public License as published by the |
||||||
|
* Free Software Foundation; either version 2 of the License, or (at your |
||||||
|
* option) any later version. |
||||||
|
* |
||||||
|
* You should have received a copy of the GNU General Public License along |
||||||
|
* with this program; if not, write to the Free Software Foundation, Inc., |
||||||
|
* 675 Mass Ave, Cambridge, MA 02139, USA. |
||||||
|
* |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <linux/kernel.h> |
||||||
|
#include <linux/module.h> |
||||||
|
#include <linux/init.h> |
||||||
|
#include <linux/types.h> |
||||||
|
#include <linux/device.h> |
||||||
|
#include <linux/platform_device.h> |
||||||
|
#include <linux/power_supply.h> |
||||||
|
#include <linux/interrupt.h> |
||||||
|
#include <linux/gpio.h> |
||||||
|
|
||||||
|
#include <linux/power/gpio-charger.h> |
||||||
|
|
||||||
|
struct gpio_charger { |
||||||
|
const struct gpio_charger_platform_data *pdata; |
||||||
|
|
||||||
|
int irq; |
||||||
|
|
||||||
|
struct power_supply charger; |
||||||
|
}; |
||||||
|
|
||||||
|
static irqreturn_t gpio_charger_irq(int irq, void *devid) |
||||||
|
{ |
||||||
|
struct power_supply *charger = devid; |
||||||
|
power_supply_changed(charger); |
||||||
|
|
||||||
|
return IRQ_HANDLED; |
||||||
|
} |
||||||
|
|
||||||
|
static inline struct gpio_charger *psy_to_gpio_charger(struct power_supply *psy) |
||||||
|
{ |
||||||
|
return container_of(psy, struct gpio_charger, charger); |
||||||
|
} |
||||||
|
|
||||||
|
static int gpio_charger_get_property(struct power_supply *psy, |
||||||
|
enum power_supply_property psp, |
||||||
|
union power_supply_propval *val) |
||||||
|
{ |
||||||
|
struct gpio_charger *gpio_charger = psy_to_gpio_charger(psy); |
||||||
|
const struct gpio_charger_platform_data *pdata = gpio_charger->pdata; |
||||||
|
|
||||||
|
switch (psp) { |
||||||
|
case POWER_SUPPLY_PROP_ONLINE: |
||||||
|
val->intval = gpio_get_value(pdata->gpio); |
||||||
|
val->intval ^= pdata->gpio_active_low; |
||||||
|
break; |
||||||
|
default: |
||||||
|
return -EINVAL; |
||||||
|
} |
||||||
|
|
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
static enum power_supply_property gpio_charger_properties[] = { |
||||||
|
POWER_SUPPLY_PROP_ONLINE, |
||||||
|
}; |
||||||
|
|
||||||
|
static int __devinit gpio_charger_probe(struct platform_device *pdev) |
||||||
|
{ |
||||||
|
const struct gpio_charger_platform_data *pdata = pdev->dev.platform_data; |
||||||
|
struct gpio_charger *gpio_charger; |
||||||
|
struct power_supply *charger; |
||||||
|
int ret; |
||||||
|
|
||||||
|
if (!pdata) { |
||||||
|
dev_err(&pdev->dev, "No platform data"); |
||||||
|
return -EINVAL; |
||||||
|
} |
||||||
|
|
||||||
|
gpio_charger = kzalloc(sizeof(*gpio_charger), GFP_KERNEL); |
||||||
|
|
||||||
|
charger = &gpio_charger->charger; |
||||||
|
|
||||||
|
charger->name = pdata->name; |
||||||
|
charger->type = pdata->type; |
||||||
|
charger->properties = gpio_charger_properties; |
||||||
|
charger->num_properties = ARRAY_SIZE(gpio_charger_properties); |
||||||
|
charger->get_property = gpio_charger_get_property; |
||||||
|
charger->supplied_to = pdata->batteries; |
||||||
|
charger->num_supplicants = pdata->num_batteries; |
||||||
|
|
||||||
|
if (gpio_is_valid(pdata->gpio)) { |
||||||
|
ret = gpio_request(pdata->gpio, dev_name(&pdev->dev)); |
||||||
|
if (ret) { |
||||||
|
dev_err(&pdev->dev, "Failed to request gpio pin: %d\n", ret); |
||||||
|
goto err; |
||||||
|
} |
||||||
|
ret = gpio_direction_input(pdata->gpio); |
||||||
|
if (ret) { |
||||||
|
dev_err(&pdev->dev, "Failed to set gpio to input: %d\n", ret); |
||||||
|
goto err_gpio_free; |
||||||
|
} |
||||||
|
|
||||||
|
gpio_charger->irq = gpio_to_irq(pdata->gpio); |
||||||
|
if (gpio_charger->irq >= 0) { |
||||||
|
ret = request_irq(gpio_charger->irq, gpio_charger_irq, |
||||||
|
IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, |
||||||
|
dev_name(&pdev->dev), charger); |
||||||
|
if (ret) { |
||||||
|
dev_warn(&pdev->dev, "Failed to request online gpio irq: %d\n", ret); |
||||||
|
gpio_charger->irq = -1; |
||||||
|
} |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
ret = power_supply_register(&pdev->dev, charger); |
||||||
|
if (ret < 0) { |
||||||
|
dev_err(&pdev->dev, "Failed to register power supply: %d\n", ret); |
||||||
|
goto err_gpio_free; |
||||||
|
} |
||||||
|
|
||||||
|
gpio_charger->pdata = pdata; |
||||||
|
platform_set_drvdata(pdev, gpio_charger); |
||||||
|
|
||||||
|
return 0; |
||||||
|
|
||||||
|
err_gpio_free: |
||||||
|
if (gpio_is_valid(pdata->gpio)) { |
||||||
|
if (gpio_charger->irq >= 0) |
||||||
|
free_irq(gpio_charger->irq, charger); |
||||||
|
gpio_free(pdata->gpio); |
||||||
|
} |
||||||
|
err: |
||||||
|
return ret; |
||||||
|
} |
||||||
|
|
||||||
|
static int __devexit gpio_charger_remove(struct platform_device *pdev) |
||||||
|
{ |
||||||
|
struct gpio_charger *gpio_charger = platform_get_drvdata(pdev); |
||||||
|
const struct gpio_charger_platform_data *pdata = gpio_charger->pdata; |
||||||
|
|
||||||
|
power_supply_unregister(&gpio_charger->charger); |
||||||
|
|
||||||
|
if (gpio_is_valid(pdata->gpio)) { |
||||||
|
if (gpio_charger->irq >= 0) |
||||||
|
free_irq(gpio_charger->irq, &gpio_charger->charger); |
||||||
|
gpio_free(pdata->gpio); |
||||||
|
} |
||||||
|
|
||||||
|
platform_set_drvdata(pdev, NULL); |
||||||
|
kfree(gpio_charger); |
||||||
|
|
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
static struct platform_driver gpio_charger_driver = { |
||||||
|
.probe = gpio_charger_probe, |
||||||
|
.remove = __devexit_p(gpio_charger_remove), |
||||||
|
.driver = { |
||||||
|
.name = "gpio-charger", |
||||||
|
.owner = THIS_MODULE, |
||||||
|
}, |
||||||
|
}; |
||||||
|
|
||||||
|
static int __init gpio_charger_init(void) |
||||||
|
{ |
||||||
|
return platform_driver_register(&gpio_charger_driver); |
||||||
|
} |
||||||
|
module_init(gpio_charger_init); |
||||||
|
|
||||||
|
static void gpio_charger_exit(void) |
||||||
|
{ |
||||||
|
platform_driver_unregister(&gpio_charger_driver); |
||||||
|
} |
||||||
|
module_exit(gpio_charger_exit); |
||||||
|
|
||||||
|
MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); |
||||||
|
MODULE_DESCRIPTION("Driver for chargers indicating their status through a gpio"); |
||||||
|
MODULE_LICENSE("GPL"); |
||||||
|
MODULE_ALIAS("platform:gpio-charger"); |
@ -0,0 +1,28 @@ |
|||||||
|
/*
|
||||||
|
* Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de> |
||||||
|
* |
||||||
|
* This program is free software; you can redistribute it and/or modify it |
||||||
|
* under the terms of the GNU General Public License as published by the |
||||||
|
* Free Software Foundation; either version 2 of the License, or (at your |
||||||
|
* option) any later version. |
||||||
|
* |
||||||
|
* You should have received a copy of the GNU General Public License along |
||||||
|
* with this program; if not, write to the Free Software Foundation, Inc., |
||||||
|
* 675 Mass Ave, Cambridge, MA 02139, USA. |
||||||
|
* |
||||||
|
*/ |
||||||
|
|
||||||
|
#ifndef __LINUX_POWER_GPIO_CHARGER_H__ |
||||||
|
#define __LINUX_POWER_GPIO_CHARGER_H__ |
||||||
|
|
||||||
|
struct gpio_charger_platform_data { |
||||||
|
const char *name; |
||||||
|
enum power_supply_type type; |
||||||
|
int gpio; |
||||||
|
int gpio_active_low; |
||||||
|
|
||||||
|
char **batteries; |
||||||
|
size_t num_batteries; |
||||||
|
}; |
||||||
|
|
||||||
|
#endif |
@ -0,0 +1,21 @@ |
|||||||
|
--- a/drivers/power/Makefile 2010-02-03 13:16:32.000000000 +0100
|
||||||
|
+++ b/drivers/power/Makefile 2010-02-01 14:55:46.000000000 +0100
|
||||||
|
@@ -30,3 +30,4 @@
|
||||||
|
obj-$(CONFIG_BATTERY_MAX17040) += max17040_battery.o
|
||||||
|
obj-$(CONFIG_CHARGER_PCF50633) += pcf50633-charger.o
|
||||||
|
obj-$(CONFIG_BATTERY_JZ4740) += jz4740-battery.o
|
||||||
|
+obj-$(CONFIG_CHARGER_GPIO) += gpio-charger.o
|
||||||
|
--- a/drivers/power/Kconfig 2010-02-03 13:16:32.000000000 +0100
|
||||||
|
+++ b/drivers/power/Kconfig 2010-02-01 14:58:24.000000000 +0100
|
||||||
|
@@ -121,4 +121,11 @@
|
||||||
|
This driver can be build as a module. If so, the module will be
|
||||||
|
called jz4740-battery.
|
||||||
|
|
||||||
|
+config CHARGER_GPIO
|
||||||
|
+ tristate "GPIO charger"
|
||||||
|
+ depends on GPIOLIB
|
||||||
|
+ help
|
||||||
|
+ Say Y to include support for chargers indicating their status through
|
||||||
|
+ a GPIO pin.
|
||||||
|
+
|
||||||
|
endif # POWER_SUPPLY
|
Loading…
Reference in new issue