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