rt5033_battery.c 4.6 KB

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