1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Fuel gauge driver for Richtek RT5033
4 *
5 * Copyright (C) 2014 Samsung Electronics, Co., Ltd.
6 * Author: Beomho Seo <beomho.seo@samsung.com>
7 */
8
9#include <linux/module.h>
10#include <linux/platform_device.h>
11#include <linux/power_supply.h>
12#include <linux/mfd/rt5033-private.h>
13#include <linux/mfd/rt5033.h>
14
15static int rt5033_battery_get_capacity(struct i2c_client *client)
16{
17	struct rt5033_battery *battery = i2c_get_clientdata(client);
18	u32 msb;
19
20	regmap_read(battery->regmap, RT5033_FUEL_REG_SOC_H, &msb);
21
22	return msb;
23}
24
25static int rt5033_battery_get_present(struct i2c_client *client)
26{
27	struct rt5033_battery *battery = i2c_get_clientdata(client);
28	u32 val;
29
30	regmap_read(battery->regmap, RT5033_FUEL_REG_CONFIG_L, &val);
31
32	return (val & RT5033_FUEL_BAT_PRESENT) ? true : false;
33}
34
35static int rt5033_battery_get_watt_prop(struct i2c_client *client,
36		enum power_supply_property psp)
37{
38	struct rt5033_battery *battery = i2c_get_clientdata(client);
39	unsigned int regh, regl;
40	int ret;
41	u32 msb, lsb;
42
43	switch (psp) {
44	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
45		regh = RT5033_FUEL_REG_VBAT_H;
46		regl = RT5033_FUEL_REG_VBAT_L;
47		break;
48	case POWER_SUPPLY_PROP_VOLTAGE_AVG:
49		regh = RT5033_FUEL_REG_AVG_VOLT_H;
50		regl = RT5033_FUEL_REG_AVG_VOLT_L;
51		break;
52	case POWER_SUPPLY_PROP_VOLTAGE_OCV:
53		regh = RT5033_FUEL_REG_OCV_H;
54		regl = RT5033_FUEL_REG_OCV_L;
55		break;
56	default:
57		return -EINVAL;
58	}
59
60	regmap_read(battery->regmap, regh, &msb);
61	regmap_read(battery->regmap, regl, &lsb);
62
63	ret = ((msb << 4) + (lsb >> 4)) * 1250;
64
65	return ret;
66}
67
68static int rt5033_battery_get_property(struct power_supply *psy,
69		enum power_supply_property psp,
70		union power_supply_propval *val)
71{
72	struct rt5033_battery *battery = power_supply_get_drvdata(psy);
73
74	switch (psp) {
75	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
76	case POWER_SUPPLY_PROP_VOLTAGE_AVG:
77	case POWER_SUPPLY_PROP_VOLTAGE_OCV:
78		val->intval = rt5033_battery_get_watt_prop(battery->client,
79									psp);
80		break;
81	case POWER_SUPPLY_PROP_PRESENT:
82		val->intval = rt5033_battery_get_present(battery->client);
83		break;
84	case POWER_SUPPLY_PROP_CAPACITY:
85		val->intval = rt5033_battery_get_capacity(battery->client);
86		break;
87	default:
88		return -EINVAL;
89	}
90	return 0;
91}
92
93static enum power_supply_property rt5033_battery_props[] = {
94	POWER_SUPPLY_PROP_VOLTAGE_NOW,
95	POWER_SUPPLY_PROP_VOLTAGE_AVG,
96	POWER_SUPPLY_PROP_VOLTAGE_OCV,
97	POWER_SUPPLY_PROP_PRESENT,
98	POWER_SUPPLY_PROP_CAPACITY,
99};
100
101static const struct regmap_config rt5033_battery_regmap_config = {
102	.reg_bits	= 8,
103	.val_bits	= 8,
104	.max_register	= RT5033_FUEL_REG_END,
105};
106
107static const struct power_supply_desc rt5033_battery_desc = {
108	.name		= "rt5033-battery",
109	.type		= POWER_SUPPLY_TYPE_BATTERY,
110	.get_property	= rt5033_battery_get_property,
111	.properties	= rt5033_battery_props,
112	.num_properties	= ARRAY_SIZE(rt5033_battery_props),
113};
114
115static int rt5033_battery_probe(struct i2c_client *client,
116		const struct i2c_device_id *id)
117{
118	struct i2c_adapter *adapter = client->adapter;
119	struct power_supply_config psy_cfg = {};
120	struct rt5033_battery *battery;
121	u32 ret;
122
123	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE))
124		return -EIO;
125
126	battery = devm_kzalloc(&client->dev, sizeof(*battery), GFP_KERNEL);
127	if (!battery)
128		return -ENOMEM;
129
130	battery->client = client;
131	battery->regmap = devm_regmap_init_i2c(client,
132			&rt5033_battery_regmap_config);
133	if (IS_ERR(battery->regmap)) {
134		dev_err(&client->dev, "Failed to initialize regmap\n");
135		return -EINVAL;
136	}
137
138	i2c_set_clientdata(client, battery);
139	psy_cfg.drv_data = battery;
140
141	battery->psy = power_supply_register(&client->dev,
142					     &rt5033_battery_desc, &psy_cfg);
143	if (IS_ERR(battery->psy)) {
144		dev_err(&client->dev, "Failed to register power supply\n");
145		ret = PTR_ERR(battery->psy);
146		return ret;
147	}
148
149	return 0;
150}
151
152static int rt5033_battery_remove(struct i2c_client *client)
153{
154	struct rt5033_battery *battery = i2c_get_clientdata(client);
155
156	power_supply_unregister(battery->psy);
157
158	return 0;
159}
160
161static const struct i2c_device_id rt5033_battery_id[] = {
162	{ "rt5033-battery", },
163	{ }
164};
165MODULE_DEVICE_TABLE(i2c, rt5033_battery_id);
166
167static const struct of_device_id rt5033_battery_of_match[] = {
168	{ .compatible = "richtek,rt5033-battery", },
169	{ }
170};
171MODULE_DEVICE_TABLE(of, rt5033_battery_of_match);
172
173static struct i2c_driver rt5033_battery_driver = {
174	.driver = {
175		.name = "rt5033-battery",
176		.of_match_table = rt5033_battery_of_match,
177	},
178	.probe = rt5033_battery_probe,
179	.remove = rt5033_battery_remove,
180	.id_table = rt5033_battery_id,
181};
182module_i2c_driver(rt5033_battery_driver);
183
184MODULE_DESCRIPTION("Richtek RT5033 fuel gauge driver");
185MODULE_AUTHOR("Beomho Seo <beomho.seo@samsung.com>");
186MODULE_LICENSE("GPL");
187