0001
0002
0003
0004
0005
0006
0007
0008
0009 #include <linux/module.h>
0010 #include <linux/platform_device.h>
0011 #include <linux/power_supply.h>
0012 #include <linux/mfd/rt5033-private.h>
0013 #include <linux/mfd/rt5033.h>
0014
0015 static int rt5033_battery_get_capacity(struct i2c_client *client)
0016 {
0017 struct rt5033_battery *battery = i2c_get_clientdata(client);
0018 u32 msb;
0019
0020 regmap_read(battery->regmap, RT5033_FUEL_REG_SOC_H, &msb);
0021
0022 return msb;
0023 }
0024
0025 static int rt5033_battery_get_present(struct i2c_client *client)
0026 {
0027 struct rt5033_battery *battery = i2c_get_clientdata(client);
0028 u32 val;
0029
0030 regmap_read(battery->regmap, RT5033_FUEL_REG_CONFIG_L, &val);
0031
0032 return (val & RT5033_FUEL_BAT_PRESENT) ? true : false;
0033 }
0034
0035 static int rt5033_battery_get_watt_prop(struct i2c_client *client,
0036 enum power_supply_property psp)
0037 {
0038 struct rt5033_battery *battery = i2c_get_clientdata(client);
0039 unsigned int regh, regl;
0040 int ret;
0041 u32 msb, lsb;
0042
0043 switch (psp) {
0044 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
0045 regh = RT5033_FUEL_REG_VBAT_H;
0046 regl = RT5033_FUEL_REG_VBAT_L;
0047 break;
0048 case POWER_SUPPLY_PROP_VOLTAGE_AVG:
0049 regh = RT5033_FUEL_REG_AVG_VOLT_H;
0050 regl = RT5033_FUEL_REG_AVG_VOLT_L;
0051 break;
0052 case POWER_SUPPLY_PROP_VOLTAGE_OCV:
0053 regh = RT5033_FUEL_REG_OCV_H;
0054 regl = RT5033_FUEL_REG_OCV_L;
0055 break;
0056 default:
0057 return -EINVAL;
0058 }
0059
0060 regmap_read(battery->regmap, regh, &msb);
0061 regmap_read(battery->regmap, regl, &lsb);
0062
0063 ret = ((msb << 4) + (lsb >> 4)) * 1250;
0064
0065 return ret;
0066 }
0067
0068 static int rt5033_battery_get_property(struct power_supply *psy,
0069 enum power_supply_property psp,
0070 union power_supply_propval *val)
0071 {
0072 struct rt5033_battery *battery = power_supply_get_drvdata(psy);
0073
0074 switch (psp) {
0075 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
0076 case POWER_SUPPLY_PROP_VOLTAGE_AVG:
0077 case POWER_SUPPLY_PROP_VOLTAGE_OCV:
0078 val->intval = rt5033_battery_get_watt_prop(battery->client,
0079 psp);
0080 break;
0081 case POWER_SUPPLY_PROP_PRESENT:
0082 val->intval = rt5033_battery_get_present(battery->client);
0083 break;
0084 case POWER_SUPPLY_PROP_CAPACITY:
0085 val->intval = rt5033_battery_get_capacity(battery->client);
0086 break;
0087 default:
0088 return -EINVAL;
0089 }
0090 return 0;
0091 }
0092
0093 static enum power_supply_property rt5033_battery_props[] = {
0094 POWER_SUPPLY_PROP_VOLTAGE_NOW,
0095 POWER_SUPPLY_PROP_VOLTAGE_AVG,
0096 POWER_SUPPLY_PROP_VOLTAGE_OCV,
0097 POWER_SUPPLY_PROP_PRESENT,
0098 POWER_SUPPLY_PROP_CAPACITY,
0099 };
0100
0101 static const struct regmap_config rt5033_battery_regmap_config = {
0102 .reg_bits = 8,
0103 .val_bits = 8,
0104 .max_register = RT5033_FUEL_REG_END,
0105 };
0106
0107 static const struct power_supply_desc rt5033_battery_desc = {
0108 .name = "rt5033-battery",
0109 .type = POWER_SUPPLY_TYPE_BATTERY,
0110 .get_property = rt5033_battery_get_property,
0111 .properties = rt5033_battery_props,
0112 .num_properties = ARRAY_SIZE(rt5033_battery_props),
0113 };
0114
0115 static int rt5033_battery_probe(struct i2c_client *client,
0116 const struct i2c_device_id *id)
0117 {
0118 struct i2c_adapter *adapter = client->adapter;
0119 struct power_supply_config psy_cfg = {};
0120 struct rt5033_battery *battery;
0121 u32 ret;
0122
0123 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE))
0124 return -EIO;
0125
0126 battery = devm_kzalloc(&client->dev, sizeof(*battery), GFP_KERNEL);
0127 if (!battery)
0128 return -ENOMEM;
0129
0130 battery->client = client;
0131 battery->regmap = devm_regmap_init_i2c(client,
0132 &rt5033_battery_regmap_config);
0133 if (IS_ERR(battery->regmap)) {
0134 dev_err(&client->dev, "Failed to initialize regmap\n");
0135 return -EINVAL;
0136 }
0137
0138 i2c_set_clientdata(client, battery);
0139 psy_cfg.drv_data = battery;
0140
0141 battery->psy = power_supply_register(&client->dev,
0142 &rt5033_battery_desc, &psy_cfg);
0143 if (IS_ERR(battery->psy)) {
0144 dev_err(&client->dev, "Failed to register power supply\n");
0145 ret = PTR_ERR(battery->psy);
0146 return ret;
0147 }
0148
0149 return 0;
0150 }
0151
0152 static int rt5033_battery_remove(struct i2c_client *client)
0153 {
0154 struct rt5033_battery *battery = i2c_get_clientdata(client);
0155
0156 power_supply_unregister(battery->psy);
0157
0158 return 0;
0159 }
0160
0161 static const struct i2c_device_id rt5033_battery_id[] = {
0162 { "rt5033-battery", },
0163 { }
0164 };
0165 MODULE_DEVICE_TABLE(i2c, rt5033_battery_id);
0166
0167 static const struct of_device_id rt5033_battery_of_match[] = {
0168 { .compatible = "richtek,rt5033-battery", },
0169 { }
0170 };
0171 MODULE_DEVICE_TABLE(of, rt5033_battery_of_match);
0172
0173 static struct i2c_driver rt5033_battery_driver = {
0174 .driver = {
0175 .name = "rt5033-battery",
0176 .of_match_table = rt5033_battery_of_match,
0177 },
0178 .probe = rt5033_battery_probe,
0179 .remove = rt5033_battery_remove,
0180 .id_table = rt5033_battery_id,
0181 };
0182 module_i2c_driver(rt5033_battery_driver);
0183
0184 MODULE_DESCRIPTION("Richtek RT5033 fuel gauge driver");
0185 MODULE_AUTHOR("Beomho Seo <beomho.seo@samsung.com>");
0186 MODULE_LICENSE("GPL");