1 // SPDX-License-Identifier: GPL-2.0-only
3 * Battery measurement code for Zipit Z2
5 * Copyright (C) 2009 Peter Edwards <sweetlilmre@gmail.com>
8 #include <linux/module.h>
9 #include <linux/gpio/consumer.h>
10 #include <linux/i2c.h>
11 #include <linux/interrupt.h>
12 #include <linux/irq.h>
13 #include <linux/power_supply.h>
14 #include <linux/slab.h>
15 #include <linux/z2_battery.h>
17 #define Z2_DEFAULT_NAME "Z2"
20 struct z2_battery_info *info;
21 struct gpio_desc *charge_gpiod;
23 struct i2c_client *client;
24 struct power_supply *batt_ps;
25 struct power_supply_desc batt_ps_desc;
26 struct mutex work_lock;
27 struct work_struct bat_work;
30 static unsigned long z2_read_bat(struct z2_charger *charger)
33 data = i2c_smbus_read_byte_data(charger->client,
34 charger->info->batt_I2C_reg);
38 return data * charger->info->batt_mult / charger->info->batt_div;
41 static int z2_batt_get_property(struct power_supply *batt_ps,
42 enum power_supply_property psp,
43 union power_supply_propval *val)
45 struct z2_charger *charger = power_supply_get_drvdata(batt_ps);
46 struct z2_battery_info *info = charger->info;
49 case POWER_SUPPLY_PROP_STATUS:
50 val->intval = charger->bat_status;
52 case POWER_SUPPLY_PROP_TECHNOLOGY:
53 val->intval = info->batt_tech;
55 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
56 if (info->batt_I2C_reg >= 0)
57 val->intval = z2_read_bat(charger);
61 case POWER_SUPPLY_PROP_VOLTAGE_MAX:
62 if (info->max_voltage >= 0)
63 val->intval = info->max_voltage;
67 case POWER_SUPPLY_PROP_VOLTAGE_MIN:
68 if (info->min_voltage >= 0)
69 val->intval = info->min_voltage;
73 case POWER_SUPPLY_PROP_PRESENT:
83 static void z2_batt_ext_power_changed(struct power_supply *batt_ps)
85 struct z2_charger *charger = power_supply_get_drvdata(batt_ps);
87 schedule_work(&charger->bat_work);
90 static void z2_batt_update(struct z2_charger *charger)
92 int old_status = charger->bat_status;
94 mutex_lock(&charger->work_lock);
96 charger->bat_status = charger->charge_gpiod ?
97 (gpiod_get_value(charger->charge_gpiod) ?
98 POWER_SUPPLY_STATUS_CHARGING :
99 POWER_SUPPLY_STATUS_DISCHARGING) :
100 POWER_SUPPLY_STATUS_UNKNOWN;
102 if (old_status != charger->bat_status) {
103 pr_debug("%s: %i -> %i\n", charger->batt_ps->desc->name,
105 charger->bat_status);
106 power_supply_changed(charger->batt_ps);
109 mutex_unlock(&charger->work_lock);
112 static void z2_batt_work(struct work_struct *work)
114 struct z2_charger *charger;
115 charger = container_of(work, struct z2_charger, bat_work);
116 z2_batt_update(charger);
119 static irqreturn_t z2_charge_switch_irq(int irq, void *devid)
121 struct z2_charger *charger = devid;
122 schedule_work(&charger->bat_work);
126 static int z2_batt_ps_init(struct z2_charger *charger, int props)
129 enum power_supply_property *prop;
130 struct z2_battery_info *info = charger->info;
132 if (charger->charge_gpiod)
133 props++; /* POWER_SUPPLY_PROP_STATUS */
134 if (info->batt_tech >= 0)
135 props++; /* POWER_SUPPLY_PROP_TECHNOLOGY */
136 if (info->batt_I2C_reg >= 0)
137 props++; /* POWER_SUPPLY_PROP_VOLTAGE_NOW */
138 if (info->max_voltage >= 0)
139 props++; /* POWER_SUPPLY_PROP_VOLTAGE_MAX */
140 if (info->min_voltage >= 0)
141 props++; /* POWER_SUPPLY_PROP_VOLTAGE_MIN */
143 prop = kcalloc(props, sizeof(*prop), GFP_KERNEL);
147 prop[i++] = POWER_SUPPLY_PROP_PRESENT;
148 if (charger->charge_gpiod)
149 prop[i++] = POWER_SUPPLY_PROP_STATUS;
150 if (info->batt_tech >= 0)
151 prop[i++] = POWER_SUPPLY_PROP_TECHNOLOGY;
152 if (info->batt_I2C_reg >= 0)
153 prop[i++] = POWER_SUPPLY_PROP_VOLTAGE_NOW;
154 if (info->max_voltage >= 0)
155 prop[i++] = POWER_SUPPLY_PROP_VOLTAGE_MAX;
156 if (info->min_voltage >= 0)
157 prop[i++] = POWER_SUPPLY_PROP_VOLTAGE_MIN;
159 if (!info->batt_name) {
160 dev_info(&charger->client->dev,
161 "Please consider setting proper battery "
162 "name in platform definition file, falling "
163 "back to name \" Z2_DEFAULT_NAME \"\n");
164 charger->batt_ps_desc.name = Z2_DEFAULT_NAME;
166 charger->batt_ps_desc.name = info->batt_name;
168 charger->batt_ps_desc.properties = prop;
169 charger->batt_ps_desc.num_properties = props;
170 charger->batt_ps_desc.type = POWER_SUPPLY_TYPE_BATTERY;
171 charger->batt_ps_desc.get_property = z2_batt_get_property;
172 charger->batt_ps_desc.external_power_changed =
173 z2_batt_ext_power_changed;
174 charger->batt_ps_desc.use_for_apm = 1;
179 static int z2_batt_probe(struct i2c_client *client,
180 const struct i2c_device_id *id)
183 int props = 1; /* POWER_SUPPLY_PROP_PRESENT */
184 struct z2_charger *charger;
185 struct z2_battery_info *info = client->dev.platform_data;
186 struct power_supply_config psy_cfg = {};
189 dev_err(&client->dev,
190 "Please set platform device platform_data"
191 " to a valid z2_battery_info pointer!\n");
195 charger = kzalloc(sizeof(*charger), GFP_KERNEL);
199 charger->bat_status = POWER_SUPPLY_STATUS_UNKNOWN;
200 charger->info = info;
201 charger->client = client;
202 i2c_set_clientdata(client, charger);
203 psy_cfg.drv_data = charger;
205 mutex_init(&charger->work_lock);
207 charger->charge_gpiod = devm_gpiod_get_optional(&client->dev,
209 if (IS_ERR(charger->charge_gpiod))
210 return dev_err_probe(&client->dev,
211 PTR_ERR(charger->charge_gpiod),
212 "failed to get charge GPIO\n");
214 if (charger->charge_gpiod) {
215 gpiod_set_consumer_name(charger->charge_gpiod, "BATT CHRG");
217 irq_set_irq_type(gpiod_to_irq(charger->charge_gpiod),
219 ret = request_irq(gpiod_to_irq(charger->charge_gpiod),
220 z2_charge_switch_irq, 0,
221 "AC Detect", charger);
226 ret = z2_batt_ps_init(charger, props);
230 INIT_WORK(&charger->bat_work, z2_batt_work);
232 charger->batt_ps = power_supply_register(&client->dev,
233 &charger->batt_ps_desc,
235 if (IS_ERR(charger->batt_ps)) {
236 ret = PTR_ERR(charger->batt_ps);
240 schedule_work(&charger->bat_work);
245 kfree(charger->batt_ps_desc.properties);
247 if (charger->charge_gpiod)
248 free_irq(gpiod_to_irq(charger->charge_gpiod), charger);
254 static int z2_batt_remove(struct i2c_client *client)
256 struct z2_charger *charger = i2c_get_clientdata(client);
258 cancel_work_sync(&charger->bat_work);
259 power_supply_unregister(charger->batt_ps);
261 kfree(charger->batt_ps_desc.properties);
262 if (charger->charge_gpiod)
263 free_irq(gpiod_to_irq(charger->charge_gpiod), charger);
271 static int z2_batt_suspend(struct device *dev)
273 struct i2c_client *client = to_i2c_client(dev);
274 struct z2_charger *charger = i2c_get_clientdata(client);
276 flush_work(&charger->bat_work);
280 static int z2_batt_resume(struct device *dev)
282 struct i2c_client *client = to_i2c_client(dev);
283 struct z2_charger *charger = i2c_get_clientdata(client);
285 schedule_work(&charger->bat_work);
289 static const struct dev_pm_ops z2_battery_pm_ops = {
290 .suspend = z2_batt_suspend,
291 .resume = z2_batt_resume,
294 #define Z2_BATTERY_PM_OPS (&z2_battery_pm_ops)
297 #define Z2_BATTERY_PM_OPS (NULL)
300 static const struct i2c_device_id z2_batt_id[] = {
304 MODULE_DEVICE_TABLE(i2c, z2_batt_id);
306 static struct i2c_driver z2_batt_driver = {
308 .name = "z2-battery",
309 .pm = Z2_BATTERY_PM_OPS
311 .probe = z2_batt_probe,
312 .remove = z2_batt_remove,
313 .id_table = z2_batt_id,
315 module_i2c_driver(z2_batt_driver);
317 MODULE_LICENSE("GPL");
318 MODULE_AUTHOR("Peter Edwards <sweetlilmre@gmail.com>");
319 MODULE_DESCRIPTION("Zipit Z2 battery driver");