From 797e4e86e1002bb6579ff610aa5d1a0c17b4e176 Mon Sep 17 00:00:00 2001 From: Syed Rafiuddin Date: Wed, 8 Feb 2012 22:50:57 +0530 Subject: power: max17048: exit driver when battery is not detected Exit max17048 driver when battery is not detected on KAI platform. Change-Id: I2d98f0a7635c6adc047c58040170b9e37e95b1ef Signed-off-by: Syed Rafiuddin Signed-off-by: Kerwin Wan Reviewed-on: http://git-master/r/80074 Reviewed-by: Liangchuan Mi Tested-by: Liangchuan Mi Reviewed-by: Dan Willemsen --- drivers/power/max17048_battery.c | 21 ++++++++++++--------- 1 file changed, 12 insertions(+), 9 deletions(-) (limited to 'drivers/power') diff --git a/drivers/power/max17048_battery.c b/drivers/power/max17048_battery.c index faf497635bcc..cf8ea0bfdd65 100644 --- a/drivers/power/max17048_battery.c +++ b/drivers/power/max17048_battery.c @@ -11,6 +11,7 @@ * published by the Free Software Foundation. */ +#include #include #include #include @@ -38,6 +39,7 @@ #define RESET_LSB 0x00 #define MAX17048_DELAY 1000 #define MAX17048_BATTERY_FULL 95 +#define MAX17048_VERSION_NO 0x11 struct max17048_chip { struct i2c_client *client; @@ -170,15 +172,9 @@ static void max17048_get_soc(struct i2c_client *client) chip->soc = msb; } -static void max17048_get_version(struct i2c_client *client) +static uint16_t max17048_get_version(struct i2c_client *client) { - u8 msb; - u8 lsb; - - msb = max17048_read_reg(client, MAX17048_VER_MSB); - lsb = max17048_read_reg(client, MAX17048_VER_LSB); - - dev_info(&client->dev, "MAX17048 Fuel-Gauge Ver %d%d\n", msb, lsb); + return swab16(i2c_smbus_read_word_data(client, MAX17048_VER_MSB)); } static void max17048_get_online(struct i2c_client *client) @@ -263,6 +259,7 @@ static int __devinit max17048_probe(struct i2c_client *client, struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent); struct max17048_chip *chip; int ret; + uint16_t version; chip = kzalloc(sizeof(*chip), GFP_KERNEL); if (!chip) @@ -275,6 +272,13 @@ static int __devinit max17048_probe(struct i2c_client *client, i2c_set_clientdata(client, chip); + version = max17048_get_version(client); + if (version != MAX17048_VERSION_NO) { + ret = -ENODEV; + goto error2; + } + dev_info(&client->dev, "MAX17048 Fuel-Gauge Ver 0x%x\n", version); + chip->battery.name = "battery"; chip->battery.type = POWER_SUPPLY_TYPE_BATTERY; chip->battery.get_property = max17048_get_property; @@ -311,7 +315,6 @@ static int __devinit max17048_probe(struct i2c_client *client, goto error; } max17048_reset(client); - max17048_get_version(client); INIT_DELAYED_WORK_DEFERRABLE(&chip->work, max17048_work); schedule_delayed_work(&chip->work, MAX17048_DELAY); -- cgit v1.2.3