* git://git.infradead.org/battery-2.6: power_supply: Makefile cleanup bq27x00_battery: Add missing kfree(di->bus) in bq27x00_battery_remove() power_supply: Introduce maximum current property power_supply: Add types for USB chargers ds2782_battery: Fix units power_supply: Add driver for TWL4030/TPS65950 BCI charger bq20z75: Add support for more power supply properties wm831x_power: Add missing kfree(wm831x_power) in wm831x_power_remove() jz4740-battery: Add missing kfree(jz_battery) in jz_battery_remove() ds2760_battery: Add missing kfree(di) in ds2760_battery_remove() olpc_battery: Fix endian neutral breakage for s16 values ds2760_battery: Fix W1 and W1_SLAVE_DS2760 dependency pcf50633-charger: Add missing sysfs_remove_group() power_supply: Add driver for TI BQ20Z75 gas gauge IC wm831x_power: Remove duplicate chg mask omap: rx51: Add support for USB chargers power_supply: Add isp1704 charger detection drivertirimbino
Linus Torvalds
14 years ago
commit
45352bbf48
@ -0,0 +1,493 @@ |
||||
/*
|
||||
* Gas Gauge driver for TI's BQ20Z75 |
||||
* |
||||
* Copyright (c) 2010, NVIDIA Corporation. |
||||
* |
||||
* 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. |
||||
* |
||||
* This program is distributed in the hope that it will be useful, but WITHOUT |
||||
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
||||
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
||||
* more details. |
||||
* |
||||
* 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., |
||||
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
||||
*/ |
||||
|
||||
#include <linux/init.h> |
||||
#include <linux/module.h> |
||||
#include <linux/kernel.h> |
||||
#include <linux/err.h> |
||||
#include <linux/power_supply.h> |
||||
#include <linux/i2c.h> |
||||
#include <linux/slab.h> |
||||
|
||||
enum { |
||||
REG_MANUFACTURER_DATA, |
||||
REG_TEMPERATURE, |
||||
REG_VOLTAGE, |
||||
REG_CURRENT, |
||||
REG_CAPACITY, |
||||
REG_TIME_TO_EMPTY, |
||||
REG_TIME_TO_FULL, |
||||
REG_STATUS, |
||||
REG_CYCLE_COUNT, |
||||
REG_SERIAL_NUMBER, |
||||
REG_REMAINING_CAPACITY, |
||||
REG_FULL_CHARGE_CAPACITY, |
||||
REG_DESIGN_CAPACITY, |
||||
REG_DESIGN_VOLTAGE, |
||||
}; |
||||
|
||||
/* manufacturer access defines */ |
||||
#define MANUFACTURER_ACCESS_STATUS 0x0006 |
||||
#define MANUFACTURER_ACCESS_SLEEP 0x0011 |
||||
|
||||
/* battery status value bits */ |
||||
#define BATTERY_DISCHARGING 0x40 |
||||
#define BATTERY_FULL_CHARGED 0x20 |
||||
#define BATTERY_FULL_DISCHARGED 0x10 |
||||
|
||||
#define BQ20Z75_DATA(_psp, _addr, _min_value, _max_value) { \ |
||||
.psp = _psp, \
|
||||
.addr = _addr, \
|
||||
.min_value = _min_value, \
|
||||
.max_value = _max_value, \
|
||||
} |
||||
|
||||
static const struct bq20z75_device_data { |
||||
enum power_supply_property psp; |
||||
u8 addr; |
||||
int min_value; |
||||
int max_value; |
||||
} bq20z75_data[] = { |
||||
[REG_MANUFACTURER_DATA] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_PRESENT, 0x00, 0, 65535), |
||||
[REG_TEMPERATURE] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_TEMP, 0x08, 0, 65535), |
||||
[REG_VOLTAGE] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_VOLTAGE_NOW, 0x09, 0, 20000), |
||||
[REG_CURRENT] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_CURRENT_NOW, 0x0A, -32768, |
||||
32767), |
||||
[REG_CAPACITY] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_CAPACITY, 0x0E, 0, 100), |
||||
[REG_REMAINING_CAPACITY] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_ENERGY_NOW, 0x0F, 0, 65535), |
||||
[REG_FULL_CHARGE_CAPACITY] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_ENERGY_FULL, 0x10, 0, 65535), |
||||
[REG_TIME_TO_EMPTY] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG, 0x12, 0, |
||||
65535), |
||||
[REG_TIME_TO_FULL] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_TIME_TO_FULL_AVG, 0x13, 0, |
||||
65535), |
||||
[REG_STATUS] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_STATUS, 0x16, 0, 65535), |
||||
[REG_CYCLE_COUNT] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_CYCLE_COUNT, 0x17, 0, 65535), |
||||
[REG_DESIGN_CAPACITY] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, 0x18, 0, |
||||
65535), |
||||
[REG_DESIGN_VOLTAGE] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 0x19, 0, |
||||
65535), |
||||
[REG_SERIAL_NUMBER] = |
||||
BQ20Z75_DATA(POWER_SUPPLY_PROP_SERIAL_NUMBER, 0x1C, 0, 65535), |
||||
}; |
||||
|
||||
static enum power_supply_property bq20z75_properties[] = { |
||||
POWER_SUPPLY_PROP_STATUS, |
||||
POWER_SUPPLY_PROP_HEALTH, |
||||
POWER_SUPPLY_PROP_PRESENT, |
||||
POWER_SUPPLY_PROP_TECHNOLOGY, |
||||
POWER_SUPPLY_PROP_CYCLE_COUNT, |
||||
POWER_SUPPLY_PROP_VOLTAGE_NOW, |
||||
POWER_SUPPLY_PROP_CURRENT_NOW, |
||||
POWER_SUPPLY_PROP_CAPACITY, |
||||
POWER_SUPPLY_PROP_TEMP, |
||||
POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG, |
||||
POWER_SUPPLY_PROP_TIME_TO_FULL_AVG, |
||||
POWER_SUPPLY_PROP_SERIAL_NUMBER, |
||||
POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, |
||||
POWER_SUPPLY_PROP_ENERGY_NOW, |
||||
POWER_SUPPLY_PROP_ENERGY_FULL, |
||||
POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, |
||||
}; |
||||
|
||||
struct bq20z75_info { |
||||
struct i2c_client *client; |
||||
struct power_supply power_supply; |
||||
}; |
||||
|
||||
static int bq20z75_read_word_data(struct i2c_client *client, u8 address) |
||||
{ |
||||
s32 ret; |
||||
|
||||
ret = i2c_smbus_read_word_data(client, address); |
||||
if (ret < 0) { |
||||
dev_err(&client->dev, |
||||
"%s: i2c read at address 0x%x failed\n", |
||||
__func__, address); |
||||
return ret; |
||||
} |
||||
return le16_to_cpu(ret); |
||||
} |
||||
|
||||
static int bq20z75_write_word_data(struct i2c_client *client, u8 address, |
||||
u16 value) |
||||
{ |
||||
s32 ret; |
||||
|
||||
ret = i2c_smbus_write_word_data(client, address, le16_to_cpu(value)); |
||||
if (ret < 0) { |
||||
dev_err(&client->dev, |
||||
"%s: i2c write to address 0x%x failed\n", |
||||
__func__, address); |
||||
return ret; |
||||
} |
||||
return 0; |
||||
} |
||||
|
||||
static int bq20z75_get_battery_presence_and_health( |
||||
struct i2c_client *client, enum power_supply_property psp, |
||||
union power_supply_propval *val) |
||||
{ |
||||
s32 ret; |
||||
|
||||
/* Write to ManufacturerAccess with
|
||||
* ManufacturerAccess command and then |
||||
* read the status */ |
||||
ret = bq20z75_write_word_data(client, |
||||
bq20z75_data[REG_MANUFACTURER_DATA].addr, |
||||
MANUFACTURER_ACCESS_STATUS); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
|
||||
ret = bq20z75_read_word_data(client, |
||||
bq20z75_data[REG_MANUFACTURER_DATA].addr); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
if (ret < bq20z75_data[REG_MANUFACTURER_DATA].min_value || |
||||
ret > bq20z75_data[REG_MANUFACTURER_DATA].max_value) { |
||||
val->intval = 0; |
||||
return 0; |
||||
} |
||||
|
||||
/* Mask the upper nibble of 2nd byte and
|
||||
* lower byte of response then |
||||
* shift the result by 8 to get status*/ |
||||
ret &= 0x0F00; |
||||
ret >>= 8; |
||||
if (psp == POWER_SUPPLY_PROP_PRESENT) { |
||||
if (ret == 0x0F) |
||||
/* battery removed */ |
||||
val->intval = 0; |
||||
else |
||||
val->intval = 1; |
||||
} else if (psp == POWER_SUPPLY_PROP_HEALTH) { |
||||
if (ret == 0x09) |
||||
val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE; |
||||
else if (ret == 0x0B) |
||||
val->intval = POWER_SUPPLY_HEALTH_OVERHEAT; |
||||
else if (ret == 0x0C) |
||||
val->intval = POWER_SUPPLY_HEALTH_DEAD; |
||||
else |
||||
val->intval = POWER_SUPPLY_HEALTH_GOOD; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int bq20z75_get_battery_property(struct i2c_client *client, |
||||
int reg_offset, enum power_supply_property psp, |
||||
union power_supply_propval *val) |
||||
{ |
||||
s32 ret; |
||||
|
||||
ret = bq20z75_read_word_data(client, |
||||
bq20z75_data[reg_offset].addr); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
/* returned values are 16 bit */ |
||||
if (bq20z75_data[reg_offset].min_value < 0) |
||||
ret = (s16)ret; |
||||
|
||||
if (ret >= bq20z75_data[reg_offset].min_value && |
||||
ret <= bq20z75_data[reg_offset].max_value) { |
||||
val->intval = ret; |
||||
if (psp == POWER_SUPPLY_PROP_STATUS) { |
||||
if (ret & BATTERY_FULL_CHARGED) |
||||
val->intval = POWER_SUPPLY_STATUS_FULL; |
||||
else if (ret & BATTERY_FULL_DISCHARGED) |
||||
val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING; |
||||
else if (ret & BATTERY_DISCHARGING) |
||||
val->intval = POWER_SUPPLY_STATUS_DISCHARGING; |
||||
else |
||||
val->intval = POWER_SUPPLY_STATUS_CHARGING; |
||||
} |
||||
} else { |
||||
if (psp == POWER_SUPPLY_PROP_STATUS) |
||||
val->intval = POWER_SUPPLY_STATUS_UNKNOWN; |
||||
else |
||||
val->intval = 0; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static void bq20z75_unit_adjustment(struct i2c_client *client, |
||||
enum power_supply_property psp, union power_supply_propval *val) |
||||
{ |
||||
#define BASE_UNIT_CONVERSION 1000 |
||||
#define BATTERY_MODE_CAP_MULT_WATT (10 * BASE_UNIT_CONVERSION) |
||||
#define TIME_UNIT_CONVERSION 600 |
||||
#define TEMP_KELVIN_TO_CELCIUS 2731 |
||||
switch (psp) { |
||||
case POWER_SUPPLY_PROP_ENERGY_NOW: |
||||
case POWER_SUPPLY_PROP_ENERGY_FULL: |
||||
case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN: |
||||
val->intval *= BATTERY_MODE_CAP_MULT_WATT; |
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
||||
case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: |
||||
case POWER_SUPPLY_PROP_CURRENT_NOW: |
||||
val->intval *= BASE_UNIT_CONVERSION; |
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_TEMP: |
||||
/* bq20z75 provides battery tempreture in 0.1°K
|
||||
* so convert it to 0.1°C */ |
||||
val->intval -= TEMP_KELVIN_TO_CELCIUS; |
||||
val->intval *= 10; |
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG: |
||||
case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG: |
||||
val->intval *= TIME_UNIT_CONVERSION; |
||||
break; |
||||
|
||||
default: |
||||
dev_dbg(&client->dev, |
||||
"%s: no need for unit conversion %d\n", __func__, psp); |
||||
} |
||||
} |
||||
|
||||
static int bq20z75_get_battery_capacity(struct i2c_client *client, |
||||
int reg_offset, enum power_supply_property psp, |
||||
union power_supply_propval *val) |
||||
{ |
||||
s32 ret; |
||||
|
||||
ret = bq20z75_read_word_data(client, bq20z75_data[reg_offset].addr); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
if (psp == POWER_SUPPLY_PROP_CAPACITY) { |
||||
/* bq20z75 spec says that this can be >100 %
|
||||
* even if max value is 100 % */ |
||||
val->intval = min(ret, 100); |
||||
} else |
||||
val->intval = ret; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static char bq20z75_serial[5]; |
||||
static int bq20z75_get_battery_serial_number(struct i2c_client *client, |
||||
union power_supply_propval *val) |
||||
{ |
||||
int ret; |
||||
|
||||
ret = bq20z75_read_word_data(client, |
||||
bq20z75_data[REG_SERIAL_NUMBER].addr); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
ret = sprintf(bq20z75_serial, "%04x", ret); |
||||
val->strval = bq20z75_serial; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int bq20z75_get_property(struct power_supply *psy, |
||||
enum power_supply_property psp, |
||||
union power_supply_propval *val) |
||||
{ |
||||
int count; |
||||
int ret; |
||||
struct bq20z75_info *bq20z75_device = container_of(psy, |
||||
struct bq20z75_info, power_supply); |
||||
struct i2c_client *client = bq20z75_device->client; |
||||
|
||||
switch (psp) { |
||||
case POWER_SUPPLY_PROP_PRESENT: |
||||
case POWER_SUPPLY_PROP_HEALTH: |
||||
ret = bq20z75_get_battery_presence_and_health(client, psp, val); |
||||
if (ret) |
||||
return ret; |
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_TECHNOLOGY: |
||||
val->intval = POWER_SUPPLY_TECHNOLOGY_LION; |
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_ENERGY_NOW: |
||||
case POWER_SUPPLY_PROP_ENERGY_FULL: |
||||
case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN: |
||||
case POWER_SUPPLY_PROP_CAPACITY: |
||||
for (count = 0; count < ARRAY_SIZE(bq20z75_data); count++) { |
||||
if (psp == bq20z75_data[count].psp) |
||||
break; |
||||
} |
||||
|
||||
ret = bq20z75_get_battery_capacity(client, count, psp, val); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_SERIAL_NUMBER: |
||||
ret = bq20z75_get_battery_serial_number(client, val); |
||||
if (ret) |
||||
return ret; |
||||
break; |
||||
|
||||
case POWER_SUPPLY_PROP_STATUS: |
||||
case POWER_SUPPLY_PROP_CYCLE_COUNT: |
||||
case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
||||
case POWER_SUPPLY_PROP_CURRENT_NOW: |
||||
case POWER_SUPPLY_PROP_TEMP: |
||||
case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG: |
||||
case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG: |
||||
case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: |
||||
for (count = 0; count < ARRAY_SIZE(bq20z75_data); count++) { |
||||
if (psp == bq20z75_data[count].psp) |
||||
break; |
||||
} |
||||
|
||||
ret = bq20z75_get_battery_property(client, count, psp, val); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
break; |
||||
|
||||
default: |
||||
dev_err(&client->dev, |
||||
"%s: INVALID property\n", __func__); |
||||
return -EINVAL; |
||||
} |
||||
|
||||
/* Convert units to match requirements for power supply class */ |
||||
bq20z75_unit_adjustment(client, psp, val); |
||||
|
||||
dev_dbg(&client->dev, |
||||
"%s: property = %d, value = %d\n", __func__, psp, val->intval); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int bq20z75_probe(struct i2c_client *client, |
||||
const struct i2c_device_id *id) |
||||
{ |
||||
struct bq20z75_info *bq20z75_device; |
||||
int rc; |
||||
|
||||
bq20z75_device = kzalloc(sizeof(struct bq20z75_info), GFP_KERNEL); |
||||
if (!bq20z75_device) |
||||
return -ENOMEM; |
||||
|
||||
bq20z75_device->client = client; |
||||
bq20z75_device->power_supply.name = "battery"; |
||||
bq20z75_device->power_supply.type = POWER_SUPPLY_TYPE_BATTERY; |
||||
bq20z75_device->power_supply.properties = bq20z75_properties; |
||||
bq20z75_device->power_supply.num_properties = |
||||
ARRAY_SIZE(bq20z75_properties); |
||||
bq20z75_device->power_supply.get_property = bq20z75_get_property; |
||||
|
||||
i2c_set_clientdata(client, bq20z75_device); |
||||
|
||||
rc = power_supply_register(&client->dev, &bq20z75_device->power_supply); |
||||
if (rc) { |
||||
dev_err(&client->dev, |
||||
"%s: Failed to register power supply\n", __func__); |
||||
kfree(bq20z75_device); |
||||
return rc; |
||||
} |
||||
|
||||
dev_info(&client->dev, |
||||
"%s: battery gas gauge device registered\n", client->name); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int bq20z75_remove(struct i2c_client *client) |
||||
{ |
||||
struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client); |
||||
|
||||
power_supply_unregister(&bq20z75_device->power_supply); |
||||
kfree(bq20z75_device); |
||||
bq20z75_device = NULL; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
#if defined CONFIG_PM |
||||
static int bq20z75_suspend(struct i2c_client *client, |
||||
pm_message_t state) |
||||
{ |
||||
s32 ret; |
||||
|
||||
/* write to manufacturer access with sleep command */ |
||||
ret = bq20z75_write_word_data(client, |
||||
bq20z75_data[REG_MANUFACTURER_DATA].addr, |
||||
MANUFACTURER_ACCESS_SLEEP); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
return 0; |
||||
} |
||||
#else |
||||
#define bq20z75_suspend NULL |
||||
#endif |
||||
/* any smbus transaction will wake up bq20z75 */ |
||||
#define bq20z75_resume NULL |
||||
|
||||
static const struct i2c_device_id bq20z75_id[] = { |
||||
{ "bq20z75", 0 }, |
||||
{} |
||||
}; |
||||
|
||||
static struct i2c_driver bq20z75_battery_driver = { |
||||
.probe = bq20z75_probe, |
||||
.remove = bq20z75_remove, |
||||
.suspend = bq20z75_suspend, |
||||
.resume = bq20z75_resume, |
||||
.id_table = bq20z75_id, |
||||
.driver = { |
||||
.name = "bq20z75-battery", |
||||
}, |
||||
}; |
||||
|
||||
static int __init bq20z75_battery_init(void) |
||||
{ |
||||
return i2c_add_driver(&bq20z75_battery_driver); |
||||
} |
||||
module_init(bq20z75_battery_init); |
||||
|
||||
static void __exit bq20z75_battery_exit(void) |
||||
{ |
||||
i2c_del_driver(&bq20z75_battery_driver); |
||||
} |
||||
module_exit(bq20z75_battery_exit); |
||||
|
||||
MODULE_DESCRIPTION("BQ20z75 battery monitor driver"); |
||||
MODULE_LICENSE("GPL"); |
||||
@ -0,0 +1,369 @@ |
||||
/*
|
||||
* ISP1704 USB Charger Detection driver |
||||
* |
||||
* Copyright (C) 2010 Nokia Corporation |
||||
* |
||||
* 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. |
||||
* |
||||
* This program is distributed in the hope that it will be useful, |
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
||||
* GNU General Public License for more details. |
||||
* |
||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
||||
*/ |
||||
|
||||
#include <linux/kernel.h> |
||||
#include <linux/module.h> |
||||
#include <linux/err.h> |
||||
#include <linux/init.h> |
||||
#include <linux/types.h> |
||||
#include <linux/device.h> |
||||
#include <linux/sysfs.h> |
||||
#include <linux/platform_device.h> |
||||
#include <linux/power_supply.h> |
||||
#include <linux/delay.h> |
||||
|
||||
#include <linux/usb/otg.h> |
||||
#include <linux/usb/ulpi.h> |
||||
#include <linux/usb/ch9.h> |
||||
#include <linux/usb/gadget.h> |
||||
|
||||
/* Vendor specific Power Control register */ |
||||
#define ISP1704_PWR_CTRL 0x3d |
||||
#define ISP1704_PWR_CTRL_SWCTRL (1 << 0) |
||||
#define ISP1704_PWR_CTRL_DET_COMP (1 << 1) |
||||
#define ISP1704_PWR_CTRL_BVALID_RISE (1 << 2) |
||||
#define ISP1704_PWR_CTRL_BVALID_FALL (1 << 3) |
||||
#define ISP1704_PWR_CTRL_DP_WKPU_EN (1 << 4) |
||||
#define ISP1704_PWR_CTRL_VDAT_DET (1 << 5) |
||||
#define ISP1704_PWR_CTRL_DPVSRC_EN (1 << 6) |
||||
#define ISP1704_PWR_CTRL_HWDETECT (1 << 7) |
||||
|
||||
#define NXP_VENDOR_ID 0x04cc |
||||
|
||||
static u16 isp170x_id[] = { |
||||
0x1704, |
||||
0x1707, |
||||
}; |
||||
|
||||
struct isp1704_charger { |
||||
struct device *dev; |
||||
struct power_supply psy; |
||||
struct otg_transceiver *otg; |
||||
struct notifier_block nb; |
||||
struct work_struct work; |
||||
|
||||
char model[7]; |
||||
unsigned present:1; |
||||
}; |
||||
|
||||
/*
|
||||
* ISP1704 detects PS/2 adapters as charger. To make sure the detected charger |
||||
* is actually a dedicated charger, the following steps need to be taken. |
||||
*/ |
||||
static inline int isp1704_charger_verify(struct isp1704_charger *isp) |
||||
{ |
||||
int ret = 0; |
||||
u8 r; |
||||
|
||||
/* Reset the transceiver */ |
||||
r = otg_io_read(isp->otg, ULPI_FUNC_CTRL); |
||||
r |= ULPI_FUNC_CTRL_RESET; |
||||
otg_io_write(isp->otg, ULPI_FUNC_CTRL, r); |
||||
usleep_range(1000, 2000); |
||||
|
||||
/* Set normal mode */ |
||||
r &= ~(ULPI_FUNC_CTRL_RESET | ULPI_FUNC_CTRL_OPMODE_MASK); |
||||
otg_io_write(isp->otg, ULPI_FUNC_CTRL, r); |
||||
|
||||
/* Clear the DP and DM pull-down bits */ |
||||
r = ULPI_OTG_CTRL_DP_PULLDOWN | ULPI_OTG_CTRL_DM_PULLDOWN; |
||||
otg_io_write(isp->otg, ULPI_CLR(ULPI_OTG_CTRL), r); |
||||
|
||||
/* Enable strong pull-up on DP (1.5K) and reset */ |
||||
r = ULPI_FUNC_CTRL_TERMSELECT | ULPI_FUNC_CTRL_RESET; |
||||
otg_io_write(isp->otg, ULPI_SET(ULPI_FUNC_CTRL), r); |
||||
usleep_range(1000, 2000); |
||||
|
||||
/* Read the line state */ |
||||
if (!otg_io_read(isp->otg, ULPI_DEBUG)) { |
||||
/* Disable strong pull-up on DP (1.5K) */ |
||||
otg_io_write(isp->otg, ULPI_CLR(ULPI_FUNC_CTRL), |
||||
ULPI_FUNC_CTRL_TERMSELECT); |
||||
return 1; |
||||
} |
||||
|
||||
/* Is it a charger or PS/2 connection */ |
||||
|
||||
/* Enable weak pull-up resistor on DP */ |
||||
otg_io_write(isp->otg, ULPI_SET(ISP1704_PWR_CTRL), |
||||
ISP1704_PWR_CTRL_DP_WKPU_EN); |
||||
|
||||
/* Disable strong pull-up on DP (1.5K) */ |
||||
otg_io_write(isp->otg, ULPI_CLR(ULPI_FUNC_CTRL), |
||||
ULPI_FUNC_CTRL_TERMSELECT); |
||||
|
||||
/* Enable weak pull-down resistor on DM */ |
||||
otg_io_write(isp->otg, ULPI_SET(ULPI_OTG_CTRL), |
||||
ULPI_OTG_CTRL_DM_PULLDOWN); |
||||
|
||||
/* It's a charger if the line states are clear */ |
||||
if (!(otg_io_read(isp->otg, ULPI_DEBUG))) |
||||
ret = 1; |
||||
|
||||
/* Disable weak pull-up resistor on DP */ |
||||
otg_io_write(isp->otg, ULPI_CLR(ISP1704_PWR_CTRL), |
||||
ISP1704_PWR_CTRL_DP_WKPU_EN); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static inline int isp1704_charger_detect(struct isp1704_charger *isp) |
||||
{ |
||||
unsigned long timeout; |
||||
u8 r; |
||||
int ret = 0; |
||||
|
||||
/* set SW control bit in PWR_CTRL register */ |
||||
otg_io_write(isp->otg, ISP1704_PWR_CTRL, |
||||
ISP1704_PWR_CTRL_SWCTRL); |
||||
|
||||
/* enable manual charger detection */ |
||||
r = (ISP1704_PWR_CTRL_SWCTRL | ISP1704_PWR_CTRL_DPVSRC_EN); |
||||
otg_io_write(isp->otg, ULPI_SET(ISP1704_PWR_CTRL), r); |
||||
usleep_range(1000, 2000); |
||||
|
||||
timeout = jiffies + msecs_to_jiffies(300); |
||||
do { |
||||
/* Check if there is a charger */ |
||||
if (otg_io_read(isp->otg, ISP1704_PWR_CTRL) |
||||
& ISP1704_PWR_CTRL_VDAT_DET) { |
||||
ret = isp1704_charger_verify(isp); |
||||
break; |
||||
} |
||||
} while (!time_after(jiffies, timeout)); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static void isp1704_charger_work(struct work_struct *data) |
||||
{ |
||||
int detect; |
||||
struct isp1704_charger *isp = |
||||
container_of(data, struct isp1704_charger, work); |
||||
|
||||
/*
|
||||
* FIXME Only supporting dedicated chargers even though isp1704 can |
||||
* detect HUB and HOST chargers. If the device has already been |
||||
* enumerated, the detection will break the connection. |
||||
*/ |
||||
if (isp->otg->state != OTG_STATE_B_IDLE) |
||||
return; |
||||
|
||||
/* disable data pullups */ |
||||
if (isp->otg->gadget) |
||||
usb_gadget_disconnect(isp->otg->gadget); |
||||
|
||||
/* detect charger */ |
||||
detect = isp1704_charger_detect(isp); |
||||
if (detect) { |
||||
isp->present = detect; |
||||
power_supply_changed(&isp->psy); |
||||
} |
||||
|
||||
/* enable data pullups */ |
||||
if (isp->otg->gadget) |
||||
usb_gadget_connect(isp->otg->gadget); |
||||
} |
||||
|
||||
static int isp1704_notifier_call(struct notifier_block *nb, |
||||
unsigned long event, void *unused) |
||||
{ |
||||
struct isp1704_charger *isp = |
||||
container_of(nb, struct isp1704_charger, nb); |
||||
|
||||
switch (event) { |
||||
case USB_EVENT_VBUS: |
||||
schedule_work(&isp->work); |
||||
break; |
||||
case USB_EVENT_NONE: |
||||
if (isp->present) { |
||||
isp->present = 0; |
||||
power_supply_changed(&isp->psy); |
||||
} |
||||
break; |
||||
default: |
||||
return NOTIFY_DONE; |
||||
} |
||||
|
||||
return NOTIFY_OK; |
||||
} |
||||
|
||||
static int isp1704_charger_get_property(struct power_supply *psy, |
||||
enum power_supply_property psp, |
||||
union power_supply_propval *val) |
||||
{ |
||||
struct isp1704_charger *isp = |
||||
container_of(psy, struct isp1704_charger, psy); |
||||
|
||||
switch (psp) { |
||||
case POWER_SUPPLY_PROP_PRESENT: |
||||
val->intval = isp->present; |
||||
break; |
||||
case POWER_SUPPLY_PROP_MODEL_NAME: |
||||
val->strval = isp->model; |
||||
break; |
||||
case POWER_SUPPLY_PROP_MANUFACTURER: |
||||
val->strval = "NXP"; |
||||
break; |
||||
default: |
||||
return -EINVAL; |
||||
} |
||||
return 0; |
||||
} |
||||
|
||||
static enum power_supply_property power_props[] = { |
||||
POWER_SUPPLY_PROP_PRESENT, |
||||
POWER_SUPPLY_PROP_MODEL_NAME, |
||||
POWER_SUPPLY_PROP_MANUFACTURER, |
||||
}; |
||||
|
||||
static inline int isp1704_test_ulpi(struct isp1704_charger *isp) |
||||
{ |
||||
int vendor; |
||||
int product; |
||||
int i; |
||||
int ret = -ENODEV; |
||||
|
||||
/* Test ULPI interface */ |
||||
ret = otg_io_write(isp->otg, ULPI_SCRATCH, 0xaa); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
ret = otg_io_read(isp->otg, ULPI_SCRATCH); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
if (ret != 0xaa) |
||||
return -ENODEV; |
||||
|
||||
/* Verify the product and vendor id matches */ |
||||
vendor = otg_io_read(isp->otg, ULPI_VENDOR_ID_LOW); |
||||
vendor |= otg_io_read(isp->otg, ULPI_VENDOR_ID_HIGH) << 8; |
||||
if (vendor != NXP_VENDOR_ID) |
||||
return -ENODEV; |
||||
|
||||
product = otg_io_read(isp->otg, ULPI_PRODUCT_ID_LOW); |
||||
product |= otg_io_read(isp->otg, ULPI_PRODUCT_ID_HIGH) << 8; |
||||
|
||||
for (i = 0; i < ARRAY_SIZE(isp170x_id); i++) { |
||||
if (product == isp170x_id[i]) { |
||||
sprintf(isp->model, "isp%x", product); |
||||
return product; |
||||
} |
||||
} |
||||
|
||||
dev_err(isp->dev, "product id %x not matching known ids", product); |
||||
|
||||
return -ENODEV; |
||||
} |
||||
|
||||
static int __devinit isp1704_charger_probe(struct platform_device *pdev) |
||||
{ |
||||
struct isp1704_charger *isp; |
||||
int ret = -ENODEV; |
||||
|
||||
isp = kzalloc(sizeof *isp, GFP_KERNEL); |
||||
if (!isp) |
||||
return -ENOMEM; |
||||
|
||||
isp->otg = otg_get_transceiver(); |
||||
if (!isp->otg) |
||||
goto fail0; |
||||
|
||||
ret = isp1704_test_ulpi(isp); |
||||
if (ret < 0) |
||||
goto fail1; |
||||
|
||||
isp->dev = &pdev->dev; |
||||
platform_set_drvdata(pdev, isp); |
||||
|
||||
isp->psy.name = "isp1704"; |
||||
isp->psy.type = POWER_SUPPLY_TYPE_USB; |
||||
isp->psy.properties = power_props; |
||||
isp->psy.num_properties = ARRAY_SIZE(power_props); |
||||
isp->psy.get_property = isp1704_charger_get_property; |
||||
|
||||
ret = power_supply_register(isp->dev, &isp->psy); |
||||
if (ret) |
||||
goto fail1; |
||||
|
||||
/*
|
||||
* REVISIT: using work in order to allow the otg notifications to be |
||||
* made atomically in the future. |
||||
*/ |
||||
INIT_WORK(&isp->work, isp1704_charger_work); |
||||
|
||||
isp->nb.notifier_call = isp1704_notifier_call; |
||||
|
||||
ret = otg_register_notifier(isp->otg, &isp->nb); |
||||
if (ret) |
||||
goto fail2; |
||||
|
||||
dev_info(isp->dev, "registered with product id %s\n", isp->model); |
||||
|
||||
return 0; |
||||
fail2: |
||||
power_supply_unregister(&isp->psy); |
||||
fail1: |
||||
otg_put_transceiver(isp->otg); |
||||
fail0: |
||||
kfree(isp); |
||||
|
||||
dev_err(&pdev->dev, "failed to register isp1704 with error %d\n", ret); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int __devexit isp1704_charger_remove(struct platform_device *pdev) |
||||
{ |
||||
struct isp1704_charger *isp = platform_get_drvdata(pdev); |
||||
|
||||
otg_unregister_notifier(isp->otg, &isp->nb); |
||||
power_supply_unregister(&isp->psy); |
||||
otg_put_transceiver(isp->otg); |
||||
kfree(isp); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static struct platform_driver isp1704_charger_driver = { |
||||
.driver = { |
||||
.name = "isp1704_charger", |
||||
}, |
||||
.probe = isp1704_charger_probe, |
||||
.remove = __devexit_p(isp1704_charger_remove), |
||||
}; |
||||
|
||||
static int __init isp1704_charger_init(void) |
||||
{ |
||||
return platform_driver_register(&isp1704_charger_driver); |
||||
} |
||||
module_init(isp1704_charger_init); |
||||
|
||||
static void __exit isp1704_charger_exit(void) |
||||
{ |
||||
platform_driver_unregister(&isp1704_charger_driver); |
||||
} |
||||
module_exit(isp1704_charger_exit); |
||||
|
||||
MODULE_ALIAS("platform:isp1704_charger"); |
||||
MODULE_AUTHOR("Nokia Corporation"); |
||||
MODULE_DESCRIPTION("ISP170x USB Charger driver"); |
||||
MODULE_LICENSE("GPL"); |
||||
@ -0,0 +1,565 @@ |
||||
/*
|
||||
* TWL4030/TPS65950 BCI (Battery Charger Interface) driver |
||||
* |
||||
* Copyright (C) 2010 Gražvydas Ignotas <notasas@gmail.com> |
||||
* |
||||
* based on twl4030_bci_battery.c by TI |
||||
* Copyright (C) 2008 Texas Instruments, Inc. |
||||
* |
||||
* 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. |
||||
*/ |
||||
|
||||
#include <linux/init.h> |
||||
#include <linux/module.h> |
||||
#include <linux/slab.h> |
||||
#include <linux/platform_device.h> |
||||
#include <linux/interrupt.h> |
||||
#include <linux/i2c/twl.h> |
||||
#include <linux/power_supply.h> |
||||
#include <linux/notifier.h> |
||||
#include <linux/usb/otg.h> |
||||
|
||||
#define TWL4030_BCIMSTATEC 0x02 |
||||
#define TWL4030_BCIICHG 0x08 |
||||
#define TWL4030_BCIVAC 0x0a |
||||
#define TWL4030_BCIVBUS 0x0c |
||||
#define TWL4030_BCIMFSTS4 0x10 |
||||
#define TWL4030_BCICTL1 0x23 |
||||
|
||||
#define TWL4030_BCIAUTOWEN BIT(5) |
||||
#define TWL4030_CONFIG_DONE BIT(4) |
||||
#define TWL4030_BCIAUTOUSB BIT(1) |
||||
#define TWL4030_BCIAUTOAC BIT(0) |
||||
#define TWL4030_CGAIN BIT(5) |
||||
#define TWL4030_USBFASTMCHG BIT(2) |
||||
#define TWL4030_STS_VBUS BIT(7) |
||||
#define TWL4030_STS_USB_ID BIT(2) |
||||
|
||||
/* BCI interrupts */ |
||||
#define TWL4030_WOVF BIT(0) /* Watchdog overflow */ |
||||
#define TWL4030_TMOVF BIT(1) /* Timer overflow */ |
||||
#define TWL4030_ICHGHIGH BIT(2) /* Battery charge current high */ |
||||
#define TWL4030_ICHGLOW BIT(3) /* Battery cc. low / FSM state change */ |
||||
#define TWL4030_ICHGEOC BIT(4) /* Battery current end-of-charge */ |
||||
#define TWL4030_TBATOR2 BIT(5) /* Battery temperature out of range 2 */ |
||||
#define TWL4030_TBATOR1 BIT(6) /* Battery temperature out of range 1 */ |
||||
#define TWL4030_BATSTS BIT(7) /* Battery status */ |
||||
|
||||
#define TWL4030_VBATLVL BIT(0) /* VBAT level */ |
||||
#define TWL4030_VBATOV BIT(1) /* VBAT overvoltage */ |
||||
#define TWL4030_VBUSOV BIT(2) /* VBUS overvoltage */ |
||||
#define TWL4030_ACCHGOV BIT(3) /* Ac charger overvoltage */ |
||||
|
||||
#define TWL4030_MSTATEC_USB BIT(4) |
||||
#define TWL4030_MSTATEC_AC BIT(5) |
||||
#define TWL4030_MSTATEC_MASK 0x0f |
||||
#define TWL4030_MSTATEC_QUICK1 0x02 |
||||
#define TWL4030_MSTATEC_QUICK7 0x07 |
||||
#define TWL4030_MSTATEC_COMPLETE1 0x0b |
||||
#define TWL4030_MSTATEC_COMPLETE4 0x0e |
||||
|
||||
static bool allow_usb; |
||||
module_param(allow_usb, bool, 1); |
||||
MODULE_PARM_DESC(allow_usb, "Allow USB charge drawing default current"); |
||||
|
||||
struct twl4030_bci { |
||||
struct device *dev; |
||||
struct power_supply ac; |
||||
struct power_supply usb; |
||||
struct otg_transceiver *transceiver; |
||||
struct notifier_block otg_nb; |
||||
int irq_chg; |
||||
int irq_bci; |
||||
}; |
||||
|
||||
/*
|
||||
* clear and set bits on an given register on a given module |
||||
*/ |
||||
static int twl4030_clear_set(u8 mod_no, u8 clear, u8 set, u8 reg) |
||||
{ |
||||
u8 val = 0; |
||||
int ret; |
||||
|
||||
ret = twl_i2c_read_u8(mod_no, &val, reg); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
val &= ~clear; |
||||
val |= set; |
||||
|
||||
return twl_i2c_write_u8(mod_no, val, reg); |
||||
} |
||||
|
||||
static int twl4030_bci_read(u8 reg, u8 *val) |
||||
{ |
||||
return twl_i2c_read_u8(TWL4030_MODULE_MAIN_CHARGE, val, reg); |
||||
} |
||||
|
||||
static int twl4030_clear_set_boot_bci(u8 clear, u8 set) |
||||
{ |
||||
return twl4030_clear_set(TWL4030_MODULE_PM_MASTER, 0, |
||||
TWL4030_CONFIG_DONE | TWL4030_BCIAUTOWEN | set, |
||||
TWL4030_PM_MASTER_BOOT_BCI); |
||||
} |
||||
|
||||
static int twl4030bci_read_adc_val(u8 reg) |
||||
{ |
||||
int ret, temp; |
||||
u8 val; |
||||
|
||||
/* read MSB */ |
||||
ret = twl4030_bci_read(reg + 1, &val); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
temp = (int)(val & 0x03) << 8; |
||||
|
||||
/* read LSB */ |
||||
ret = twl4030_bci_read(reg, &val); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
return temp | val; |
||||
} |
||||
|
||||
/*
|
||||
* Check if VBUS power is present |
||||
*/ |
||||
static int twl4030_bci_have_vbus(struct twl4030_bci *bci) |
||||
{ |
||||
int ret; |
||||
u8 hwsts; |
||||
|
||||
ret = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &hwsts, |
||||
TWL4030_PM_MASTER_STS_HW_CONDITIONS); |
||||
if (ret < 0) |
||||
return 0; |
||||
|
||||
dev_dbg(bci->dev, "check_vbus: HW_CONDITIONS %02x\n", hwsts); |
||||
|
||||
/* in case we also have STS_USB_ID, VBUS is driven by TWL itself */ |
||||
if ((hwsts & TWL4030_STS_VBUS) && !(hwsts & TWL4030_STS_USB_ID)) |
||||
return 1; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
/*
|
||||
* Enable/Disable USB Charge funtionality. |
||||
*/ |
||||
static int twl4030_charger_enable_usb(struct twl4030_bci *bci, bool enable) |
||||
{ |
||||
int ret; |
||||
|
||||
if (enable) { |
||||
/* Check for USB charger conneted */ |
||||
if (!twl4030_bci_have_vbus(bci)) |
||||
return -ENODEV; |
||||
|
||||
/*
|
||||
* Until we can find out what current the device can provide, |
||||
* require a module param to enable USB charging. |
||||
*/ |
||||
if (!allow_usb) { |
||||
dev_warn(bci->dev, "USB charging is disabled.\n"); |
||||
return -EACCES; |
||||
} |
||||
|
||||
/* forcing the field BCIAUTOUSB (BOOT_BCI[1]) to 1 */ |
||||
ret = twl4030_clear_set_boot_bci(0, TWL4030_BCIAUTOUSB); |
||||
if (ret < 0) |
||||
return ret; |
||||
|
||||
/* forcing USBFASTMCHG(BCIMFSTS4[2]) to 1 */ |
||||
ret = twl4030_clear_set(TWL4030_MODULE_MAIN_CHARGE, 0, |
||||
TWL4030_USBFASTMCHG, TWL4030_BCIMFSTS4); |
||||
} else { |
||||
ret = twl4030_clear_set_boot_bci(TWL4030_BCIAUTOUSB, 0); |
||||
} |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
/*
|
||||
* Enable/Disable AC Charge funtionality. |
||||
*/ |
||||
static int twl4030_charger_enable_ac(bool enable) |
||||
{ |
||||
int ret; |
||||
|
||||
if (enable) |
||||
ret = twl4030_clear_set_boot_bci(0, TWL4030_BCIAUTOAC); |
||||
else |
||||
ret = twl4030_clear_set_boot_bci(TWL4030_BCIAUTOAC, 0); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
/*
|
||||
* TWL4030 CHG_PRES (AC charger presence) events |
||||
*/ |
||||
static irqreturn_t twl4030_charger_interrupt(int irq, void *arg) |
||||
{ |
||||
struct twl4030_bci *bci = arg; |
||||
|
||||
dev_dbg(bci->dev, "CHG_PRES irq\n"); |
||||
power_supply_changed(&bci->ac); |
||||
power_supply_changed(&bci->usb); |
||||
|
||||
return IRQ_HANDLED; |
||||
} |
||||
|
||||
/*
|
||||
* TWL4030 BCI monitoring events |
||||
*/ |
||||
static irqreturn_t twl4030_bci_interrupt(int irq, void *arg) |
||||
{ |
||||
struct twl4030_bci *bci = arg; |
||||
u8 irqs1, irqs2; |
||||
int ret; |
||||
|
||||
ret = twl_i2c_read_u8(TWL4030_MODULE_INTERRUPTS, &irqs1, |
||||
TWL4030_INTERRUPTS_BCIISR1A); |
||||
if (ret < 0) |
||||
return IRQ_HANDLED; |
||||
|
||||
ret = twl_i2c_read_u8(TWL4030_MODULE_INTERRUPTS, &irqs2, |
||||
TWL4030_INTERRUPTS_BCIISR2A); |
||||
if (ret < 0) |
||||
return IRQ_HANDLED; |
||||
|
||||
dev_dbg(bci->dev, "BCI irq %02x %02x\n", irqs2, irqs1); |
||||
|
||||
if (irqs1 & (TWL4030_ICHGLOW | TWL4030_ICHGEOC)) { |
||||
/* charger state change, inform the core */ |
||||
power_supply_changed(&bci->ac); |
||||
power_supply_changed(&bci->usb); |
||||
} |
||||
|
||||
/* various monitoring events, for now we just log them here */ |
||||
if (irqs1 & (TWL4030_TBATOR2 | TWL4030_TBATOR1)) |
||||
dev_warn(bci->dev, "battery temperature out of range\n"); |
||||
|
||||
if (irqs1 & TWL4030_BATSTS) |
||||
dev_crit(bci->dev, "battery disconnected\n"); |
||||
|
||||
if (irqs2 & TWL4030_VBATOV) |
||||
dev_crit(bci->dev, "VBAT overvoltage\n"); |
||||
|
||||
if (irqs2 & TWL4030_VBUSOV) |
||||
dev_crit(bci->dev, "VBUS overvoltage\n"); |
||||
|
||||
if (irqs2 & TWL4030_ACCHGOV) |
||||
dev_crit(bci->dev, "Ac charger overvoltage\n"); |
||||
|
||||
return IRQ_HANDLED; |
||||
} |
||||
|
||||
static int twl4030_bci_usb_ncb(struct notifier_block *nb, unsigned long val, |
||||
void *priv) |
||||
{ |
||||
struct twl4030_bci *bci = container_of(nb, struct twl4030_bci, otg_nb); |
||||
|
||||
dev_dbg(bci->dev, "OTG notify %lu\n", val); |
||||
|
||||
switch (val) { |
||||
case USB_EVENT_VBUS: |
||||
case USB_EVENT_CHARGER: |
||||
twl4030_charger_enable_usb(bci, true); |
||||
break; |
||||
case USB_EVENT_NONE: |
||||
twl4030_charger_enable_usb(bci, false); |
||||
break; |
||||
} |
||||
|
||||
return NOTIFY_OK; |
||||
} |
||||
|
||||
/*
|
||||
* TI provided formulas: |
||||
* CGAIN == 0: ICHG = (BCIICHG * 1.7) / (2^10 - 1) - 0.85 |
||||
* CGAIN == 1: ICHG = (BCIICHG * 3.4) / (2^10 - 1) - 1.7 |
||||
* Here we use integer approximation of: |
||||
* CGAIN == 0: val * 1.6618 - 0.85 |
||||
* CGAIN == 1: (val * 1.6618 - 0.85) * 2 |
||||
*/ |
||||
static int twl4030_charger_get_current(void) |
||||
{ |
||||
int curr; |
||||
int ret; |
||||
u8 bcictl1; |
||||
|
||||
curr = twl4030bci_read_adc_val(TWL4030_BCIICHG); |
||||
if (curr < 0) |
||||
return curr; |
||||
|
||||
ret = twl4030_bci_read(TWL4030_BCICTL1, &bcictl1); |
||||
if (ret) |
||||
return ret; |
||||
|
||||
ret = (curr * 16618 - 850 * 10000) / 10; |
||||
if (bcictl1 & TWL4030_CGAIN) |
||||
ret *= 2; |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
/*
|
||||
* Returns the main charge FSM state |
||||
* Or < 0 on failure. |
||||
*/ |
||||
static int twl4030bci_state(struct twl4030_bci *bci) |
||||
{ |
||||
int ret; |
||||
u8 state; |
||||
|
||||
ret = twl4030_bci_read(TWL4030_BCIMSTATEC, &state); |
||||
if (ret) { |
||||
pr_err("twl4030_bci: error reading BCIMSTATEC\n"); |
||||
return ret; |
||||
} |
||||
|
||||
dev_dbg(bci->dev, "state: %02x\n", state); |
||||
|
||||
return state; |
||||
} |
||||
|
||||
static int twl4030_bci_state_to_status(int state) |
||||
{ |
||||
state &= TWL4030_MSTATEC_MASK; |
||||
if (TWL4030_MSTATEC_QUICK1 <= state && state <= TWL4030_MSTATEC_QUICK7) |
||||
return POWER_SUPPLY_STATUS_CHARGING; |
||||
else if (TWL4030_MSTATEC_COMPLETE1 <= state && |
||||
state <= TWL4030_MSTATEC_COMPLETE4) |
||||
return POWER_SUPPLY_STATUS_FULL; |
||||
else |
||||
return POWER_SUPPLY_STATUS_NOT_CHARGING; |
||||
} |
||||
|
||||
static int twl4030_bci_get_property(struct power_supply *psy, |
||||
enum power_supply_property psp, |
||||
union power_supply_propval *val) |
||||
{ |
||||
struct twl4030_bci *bci = dev_get_drvdata(psy->dev->parent); |
||||
int is_charging; |
||||
int state; |
||||
int ret; |
||||
|
||||
state = twl4030bci_state(bci); |
||||
if (state < 0) |
||||
return state; |
||||
|
||||
if (psy->type == POWER_SUPPLY_TYPE_USB) |
||||
is_charging = state & TWL4030_MSTATEC_USB; |
||||
else |
||||
is_charging = state & TWL4030_MSTATEC_AC; |
||||
|
||||
switch (psp) { |
||||
case POWER_SUPPLY_PROP_STATUS: |
||||
if (is_charging) |
||||
val->intval = twl4030_bci_state_to_status(state); |
||||
else |
||||
val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING; |
||||
break; |
||||
case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
||||
/* charging must be active for meaningful result */ |
||||
if (!is_charging) |
||||
return -ENODATA; |
||||
if (psy->type == POWER_SUPPLY_TYPE_USB) { |
||||
ret = twl4030bci_read_adc_val(TWL4030_BCIVBUS); |
||||
if (ret < 0) |
||||
return ret; |
||||
/* BCIVBUS uses ADCIN8, 7/1023 V/step */ |
||||
val->intval = ret * 6843; |
||||
} else { |
||||
ret = twl4030bci_read_adc_val(TWL4030_BCIVAC); |
||||
if (ret < 0) |
||||
return ret; |
||||
/* BCIVAC uses ADCIN11, 10/1023 V/step */ |
||||
val->intval = ret * 9775; |
||||
} |
||||
break; |
||||
case POWER_SUPPLY_PROP_CURRENT_NOW: |
||||
if (!is_charging) |
||||
return -ENODATA; |
||||
/* current measurement is shared between AC and USB */ |
||||
ret = twl4030_charger_get_current(); |
||||
if (ret < 0) |
||||
return ret; |
||||
val->intval = ret; |
||||
break; |
||||
case POWER_SUPPLY_PROP_ONLINE: |
||||
val->intval = is_charging && |
||||
twl4030_bci_state_to_status(state) != |
||||
POWER_SUPPLY_STATUS_NOT_CHARGING; |
||||
break; |
||||
default: |
||||
return -EINVAL; |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static enum power_supply_property twl4030_charger_props[] = { |
||||
POWER_SUPPLY_PROP_STATUS, |
||||
POWER_SUPPLY_PROP_ONLINE, |
||||
POWER_SUPPLY_PROP_VOLTAGE_NOW, |
||||
POWER_SUPPLY_PROP_CURRENT_NOW, |
||||
}; |
||||
|
||||
static int __init twl4030_bci_probe(struct platform_device *pdev) |
||||
{ |
||||
struct twl4030_bci *bci; |
||||
int ret; |
||||
int reg; |
||||
|
||||
bci = kzalloc(sizeof(*bci), GFP_KERNEL); |
||||
if (bci == NULL) |
||||
return -ENOMEM; |
||||
|
||||
bci->dev = &pdev->dev; |
||||
bci->irq_chg = platform_get_irq(pdev, 0); |
||||
bci->irq_bci = platform_get_irq(pdev, 1); |
||||
|
||||
platform_set_drvdata(pdev, bci); |
||||
|
||||
bci->ac.name = "twl4030_ac"; |
||||
bci->ac.type = POWER_SUPPLY_TYPE_MAINS; |
||||
bci->ac.properties = twl4030_charger_props; |
||||
bci->ac.num_properties = ARRAY_SIZE(twl4030_charger_props); |
||||
bci->ac.get_property = twl4030_bci_get_property; |
||||
|
||||
ret = power_supply_register(&pdev->dev, &bci->ac); |
||||
if (ret) { |
||||
dev_err(&pdev->dev, "failed to register ac: %d\n", ret); |
||||
goto fail_register_ac; |
||||
} |
||||
|
||||
bci->usb.name = "twl4030_usb"; |
||||
bci->usb.type = POWER_SUPPLY_TYPE_USB; |
||||
bci->usb.properties = twl4030_charger_props; |
||||
bci->usb.num_properties = ARRAY_SIZE(twl4030_charger_props); |
||||
bci->usb.get_property = twl4030_bci_get_property; |
||||
|
||||
ret = power_supply_register(&pdev->dev, &bci->usb); |
||||
if (ret) { |
||||
dev_err(&pdev->dev, "failed to register usb: %d\n", ret); |
||||
goto fail_register_usb; |
||||
} |
||||
|
||||
ret = request_threaded_irq(bci->irq_chg, NULL, |
||||
twl4030_charger_interrupt, 0, pdev->name, bci); |
||||
if (ret < 0) { |
||||
dev_err(&pdev->dev, "could not request irq %d, status %d\n", |
||||
bci->irq_chg, ret); |
||||
goto fail_chg_irq; |
||||
} |
||||
|
||||
ret = request_threaded_irq(bci->irq_bci, NULL, |
||||
twl4030_bci_interrupt, 0, pdev->name, bci); |
||||
if (ret < 0) { |
||||
dev_err(&pdev->dev, "could not request irq %d, status %d\n", |
||||
bci->irq_bci, ret); |
||||
goto fail_bci_irq; |
||||
} |
||||
|
||||
bci->transceiver = otg_get_transceiver(); |
||||
if (bci->transceiver != NULL) { |
||||
bci->otg_nb.notifier_call = twl4030_bci_usb_ncb; |
||||
otg_register_notifier(bci->transceiver, &bci->otg_nb); |
||||
} |
||||
|
||||
/* Enable interrupts now. */ |
||||
reg = ~(TWL4030_ICHGLOW | TWL4030_ICHGEOC | TWL4030_TBATOR2 | |
||||
TWL4030_TBATOR1 | TWL4030_BATSTS); |
||||
ret = twl_i2c_write_u8(TWL4030_MODULE_INTERRUPTS, reg, |
||||
TWL4030_INTERRUPTS_BCIIMR1A); |
||||
if (ret < 0) { |
||||
dev_err(&pdev->dev, "failed to unmask interrupts: %d\n", ret); |
||||
goto fail_unmask_interrupts; |
||||
} |
||||
|
||||
reg = ~(TWL4030_VBATOV | TWL4030_VBUSOV | TWL4030_ACCHGOV); |
||||
ret = twl_i2c_write_u8(TWL4030_MODULE_INTERRUPTS, reg, |
||||
TWL4030_INTERRUPTS_BCIIMR2A); |
||||
if (ret < 0) |
||||
dev_warn(&pdev->dev, "failed to unmask interrupts: %d\n", ret); |
||||
|
||||
twl4030_charger_enable_ac(true); |
||||
twl4030_charger_enable_usb(bci, true); |
||||
|
||||
return 0; |
||||
|
||||
fail_unmask_interrupts: |
||||
if (bci->transceiver != NULL) { |
||||
otg_unregister_notifier(bci->transceiver, &bci->otg_nb); |
||||
otg_put_transceiver(bci->transceiver); |
||||
} |
||||
free_irq(bci->irq_bci, bci); |
||||
fail_bci_irq: |
||||
free_irq(bci->irq_chg, bci); |
||||
fail_chg_irq: |
||||
power_supply_unregister(&bci->usb); |
||||
fail_register_usb: |
||||
power_supply_unregister(&bci->ac); |
||||
fail_register_ac: |
||||
platform_set_drvdata(pdev, NULL); |
||||
kfree(bci); |
||||
|
||||
return ret; |
||||
} |
||||
|
||||
static int __exit twl4030_bci_remove(struct platform_device *pdev) |
||||
{ |
||||
struct twl4030_bci *bci = platform_get_drvdata(pdev); |
||||
|
||||
twl4030_charger_enable_ac(false); |
||||
twl4030_charger_enable_usb(bci, false); |
||||
|
||||
/* mask interrupts */ |
||||
twl_i2c_write_u8(TWL4030_MODULE_INTERRUPTS, 0xff, |
||||
TWL4030_INTERRUPTS_BCIIMR1A); |
||||
twl_i2c_write_u8(TWL4030_MODULE_INTERRUPTS, 0xff, |
||||
TWL4030_INTERRUPTS_BCIIMR2A); |
||||
|
||||
if (bci->transceiver != NULL) { |
||||
otg_unregister_notifier(bci->transceiver, &bci->otg_nb); |
||||
otg_put_transceiver(bci->transceiver); |
||||
} |
||||
free_irq(bci->irq_bci, bci); |
||||
free_irq(bci->irq_chg, bci); |
||||
power_supply_unregister(&bci->usb); |
||||
power_supply_unregister(&bci->ac); |
||||
platform_set_drvdata(pdev, NULL); |
||||
kfree(bci); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static struct platform_driver twl4030_bci_driver = { |
||||
.driver = { |
||||
.name = "twl4030_bci", |
||||
.owner = THIS_MODULE, |
||||
}, |
||||
.remove = __exit_p(twl4030_bci_remove), |
||||
}; |
||||
|
||||
static int __init twl4030_bci_init(void) |
||||
{ |
||||
return platform_driver_probe(&twl4030_bci_driver, twl4030_bci_probe); |
||||
} |
||||
module_init(twl4030_bci_init); |
||||
|
||||
static void __exit twl4030_bci_exit(void) |
||||
{ |
||||
platform_driver_unregister(&twl4030_bci_driver); |
||||
} |
||||
module_exit(twl4030_bci_exit); |
||||
|
||||
MODULE_AUTHOR("Gražydas Ignotas"); |
||||
MODULE_DESCRIPTION("TWL4030 Battery Charger Interface driver"); |
||||
MODULE_LICENSE("GPL"); |
||||
MODULE_ALIAS("platform:twl4030_bci"); |
||||
Loading…
Reference in new issue