0001
0002
0003
0004
0005
0006
0007
0008
0009 #include <linux/i2c.h>
0010 #include <linux/interrupt.h>
0011 #include <linux/module.h>
0012 #include <asm/unaligned.h>
0013
0014 #include <linux/power/bq27xxx_battery.h>
0015
0016 static DEFINE_IDR(battery_id);
0017 static DEFINE_MUTEX(battery_mutex);
0018
0019 static irqreturn_t bq27xxx_battery_irq_handler_thread(int irq, void *data)
0020 {
0021 struct bq27xxx_device_info *di = data;
0022
0023 bq27xxx_battery_update(di);
0024
0025 return IRQ_HANDLED;
0026 }
0027
0028 static int bq27xxx_battery_i2c_read(struct bq27xxx_device_info *di, u8 reg,
0029 bool single)
0030 {
0031 struct i2c_client *client = to_i2c_client(di->dev);
0032 struct i2c_msg msg[2];
0033 u8 data[2];
0034 int ret;
0035
0036 if (!client->adapter)
0037 return -ENODEV;
0038
0039 msg[0].addr = client->addr;
0040 msg[0].flags = 0;
0041 msg[0].buf = ®
0042 msg[0].len = sizeof(reg);
0043 msg[1].addr = client->addr;
0044 msg[1].flags = I2C_M_RD;
0045 msg[1].buf = data;
0046 if (single)
0047 msg[1].len = 1;
0048 else
0049 msg[1].len = 2;
0050
0051 ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
0052 if (ret < 0)
0053 return ret;
0054
0055 if (!single)
0056 ret = get_unaligned_le16(data);
0057 else
0058 ret = data[0];
0059
0060 return ret;
0061 }
0062
0063 static int bq27xxx_battery_i2c_write(struct bq27xxx_device_info *di, u8 reg,
0064 int value, bool single)
0065 {
0066 struct i2c_client *client = to_i2c_client(di->dev);
0067 struct i2c_msg msg;
0068 u8 data[4];
0069 int ret;
0070
0071 if (!client->adapter)
0072 return -ENODEV;
0073
0074 data[0] = reg;
0075 if (single) {
0076 data[1] = (u8) value;
0077 msg.len = 2;
0078 } else {
0079 put_unaligned_le16(value, &data[1]);
0080 msg.len = 3;
0081 }
0082
0083 msg.buf = data;
0084 msg.addr = client->addr;
0085 msg.flags = 0;
0086
0087 ret = i2c_transfer(client->adapter, &msg, 1);
0088 if (ret < 0)
0089 return ret;
0090 if (ret != 1)
0091 return -EINVAL;
0092 return 0;
0093 }
0094
0095 static int bq27xxx_battery_i2c_bulk_read(struct bq27xxx_device_info *di, u8 reg,
0096 u8 *data, int len)
0097 {
0098 struct i2c_client *client = to_i2c_client(di->dev);
0099 int ret;
0100
0101 if (!client->adapter)
0102 return -ENODEV;
0103
0104 ret = i2c_smbus_read_i2c_block_data(client, reg, len, data);
0105 if (ret < 0)
0106 return ret;
0107 if (ret != len)
0108 return -EINVAL;
0109 return 0;
0110 }
0111
0112 static int bq27xxx_battery_i2c_bulk_write(struct bq27xxx_device_info *di,
0113 u8 reg, u8 *data, int len)
0114 {
0115 struct i2c_client *client = to_i2c_client(di->dev);
0116 struct i2c_msg msg;
0117 u8 buf[33];
0118 int ret;
0119
0120 if (!client->adapter)
0121 return -ENODEV;
0122
0123 buf[0] = reg;
0124 memcpy(&buf[1], data, len);
0125
0126 msg.buf = buf;
0127 msg.addr = client->addr;
0128 msg.flags = 0;
0129 msg.len = len + 1;
0130
0131 ret = i2c_transfer(client->adapter, &msg, 1);
0132 if (ret < 0)
0133 return ret;
0134 if (ret != 1)
0135 return -EINVAL;
0136 return 0;
0137 }
0138
0139 static int bq27xxx_battery_i2c_probe(struct i2c_client *client,
0140 const struct i2c_device_id *id)
0141 {
0142 struct bq27xxx_device_info *di;
0143 int ret;
0144 char *name;
0145 int num;
0146
0147
0148 mutex_lock(&battery_mutex);
0149 num = idr_alloc(&battery_id, client, 0, 0, GFP_KERNEL);
0150 mutex_unlock(&battery_mutex);
0151 if (num < 0)
0152 return num;
0153
0154 name = devm_kasprintf(&client->dev, GFP_KERNEL, "%s-%d", id->name, num);
0155 if (!name)
0156 goto err_mem;
0157
0158 di = devm_kzalloc(&client->dev, sizeof(*di), GFP_KERNEL);
0159 if (!di)
0160 goto err_mem;
0161
0162 di->id = num;
0163 di->dev = &client->dev;
0164 di->chip = id->driver_data;
0165 di->name = name;
0166
0167 di->bus.read = bq27xxx_battery_i2c_read;
0168 di->bus.write = bq27xxx_battery_i2c_write;
0169 di->bus.read_bulk = bq27xxx_battery_i2c_bulk_read;
0170 di->bus.write_bulk = bq27xxx_battery_i2c_bulk_write;
0171
0172 ret = bq27xxx_battery_setup(di);
0173 if (ret)
0174 goto err_failed;
0175
0176
0177 schedule_delayed_work(&di->work, 60 * HZ);
0178
0179 i2c_set_clientdata(client, di);
0180
0181 if (client->irq) {
0182 ret = devm_request_threaded_irq(&client->dev, client->irq,
0183 NULL, bq27xxx_battery_irq_handler_thread,
0184 IRQF_ONESHOT,
0185 di->name, di);
0186 if (ret) {
0187 dev_err(&client->dev,
0188 "Unable to register IRQ %d error %d\n",
0189 client->irq, ret);
0190 bq27xxx_battery_teardown(di);
0191 goto err_failed;
0192 }
0193 }
0194
0195 return 0;
0196
0197 err_mem:
0198 ret = -ENOMEM;
0199
0200 err_failed:
0201 mutex_lock(&battery_mutex);
0202 idr_remove(&battery_id, num);
0203 mutex_unlock(&battery_mutex);
0204
0205 return ret;
0206 }
0207
0208 static int bq27xxx_battery_i2c_remove(struct i2c_client *client)
0209 {
0210 struct bq27xxx_device_info *di = i2c_get_clientdata(client);
0211
0212 bq27xxx_battery_teardown(di);
0213
0214 mutex_lock(&battery_mutex);
0215 idr_remove(&battery_id, di->id);
0216 mutex_unlock(&battery_mutex);
0217
0218 return 0;
0219 }
0220
0221 static const struct i2c_device_id bq27xxx_i2c_id_table[] = {
0222 { "bq27200", BQ27000 },
0223 { "bq27210", BQ27010 },
0224 { "bq27500", BQ2750X },
0225 { "bq27510", BQ2751X },
0226 { "bq27520", BQ2752X },
0227 { "bq27500-1", BQ27500 },
0228 { "bq27510g1", BQ27510G1 },
0229 { "bq27510g2", BQ27510G2 },
0230 { "bq27510g3", BQ27510G3 },
0231 { "bq27520g1", BQ27520G1 },
0232 { "bq27520g2", BQ27520G2 },
0233 { "bq27520g3", BQ27520G3 },
0234 { "bq27520g4", BQ27520G4 },
0235 { "bq27521", BQ27521 },
0236 { "bq27530", BQ27530 },
0237 { "bq27531", BQ27531 },
0238 { "bq27541", BQ27541 },
0239 { "bq27542", BQ27542 },
0240 { "bq27546", BQ27546 },
0241 { "bq27742", BQ27742 },
0242 { "bq27545", BQ27545 },
0243 { "bq27411", BQ27411 },
0244 { "bq27421", BQ27421 },
0245 { "bq27425", BQ27425 },
0246 { "bq27426", BQ27426 },
0247 { "bq27441", BQ27441 },
0248 { "bq27621", BQ27621 },
0249 { "bq27z561", BQ27Z561 },
0250 { "bq28z610", BQ28Z610 },
0251 { "bq34z100", BQ34Z100 },
0252 { "bq78z100", BQ78Z100 },
0253 {},
0254 };
0255 MODULE_DEVICE_TABLE(i2c, bq27xxx_i2c_id_table);
0256
0257 #ifdef CONFIG_OF
0258 static const struct of_device_id bq27xxx_battery_i2c_of_match_table[] = {
0259 { .compatible = "ti,bq27200" },
0260 { .compatible = "ti,bq27210" },
0261 { .compatible = "ti,bq27500" },
0262 { .compatible = "ti,bq27510" },
0263 { .compatible = "ti,bq27520" },
0264 { .compatible = "ti,bq27500-1" },
0265 { .compatible = "ti,bq27510g1" },
0266 { .compatible = "ti,bq27510g2" },
0267 { .compatible = "ti,bq27510g3" },
0268 { .compatible = "ti,bq27520g1" },
0269 { .compatible = "ti,bq27520g2" },
0270 { .compatible = "ti,bq27520g3" },
0271 { .compatible = "ti,bq27520g4" },
0272 { .compatible = "ti,bq27521" },
0273 { .compatible = "ti,bq27530" },
0274 { .compatible = "ti,bq27531" },
0275 { .compatible = "ti,bq27541" },
0276 { .compatible = "ti,bq27542" },
0277 { .compatible = "ti,bq27546" },
0278 { .compatible = "ti,bq27742" },
0279 { .compatible = "ti,bq27545" },
0280 { .compatible = "ti,bq27411" },
0281 { .compatible = "ti,bq27421" },
0282 { .compatible = "ti,bq27425" },
0283 { .compatible = "ti,bq27426" },
0284 { .compatible = "ti,bq27441" },
0285 { .compatible = "ti,bq27621" },
0286 { .compatible = "ti,bq27z561" },
0287 { .compatible = "ti,bq28z610" },
0288 { .compatible = "ti,bq34z100" },
0289 { .compatible = "ti,bq78z100" },
0290 {},
0291 };
0292 MODULE_DEVICE_TABLE(of, bq27xxx_battery_i2c_of_match_table);
0293 #endif
0294
0295 static struct i2c_driver bq27xxx_battery_i2c_driver = {
0296 .driver = {
0297 .name = "bq27xxx-battery",
0298 .of_match_table = of_match_ptr(bq27xxx_battery_i2c_of_match_table),
0299 },
0300 .probe = bq27xxx_battery_i2c_probe,
0301 .remove = bq27xxx_battery_i2c_remove,
0302 .id_table = bq27xxx_i2c_id_table,
0303 };
0304 module_i2c_driver(bq27xxx_battery_i2c_driver);
0305
0306 MODULE_AUTHOR("Andrew F. Davis <afd@ti.com>");
0307 MODULE_DESCRIPTION("BQ27xxx battery monitor i2c driver");
0308 MODULE_LICENSE("GPL");