[3/3] power: supply: cpcap_battery: Read battery parameters from nvram
Commit Message
Formulas were taken from android blob
Signed-off-by: Ivaylo Dimitrov <ivo.g.dimitrov.75@gmail.com>
---
drivers/power/supply/cpcap-battery.c | 88 ++++++++++++++++++++----------------
1 file changed, 48 insertions(+), 40 deletions(-)
Comments
ping
On 5.11.22 г. 13:25 ч., Ivaylo Dimitrov wrote:
> Formulas were taken from android blob
>
> Signed-off-by: Ivaylo Dimitrov <ivo.g.dimitrov.75@gmail.com>
> ---
> drivers/power/supply/cpcap-battery.c | 88 ++++++++++++++++++++----------------
> 1 file changed, 48 insertions(+), 40 deletions(-)
>
> diff --git a/drivers/power/supply/cpcap-battery.c b/drivers/power/supply/cpcap-battery.c
> index ca6ee2b..92aa66c 100644
> --- a/drivers/power/supply/cpcap-battery.c
> +++ b/drivers/power/supply/cpcap-battery.c
> @@ -74,9 +74,6 @@
>
> #define CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS 250
>
> -#define CPCAP_BATTERY_EB41_HW4X_ID 0x9E
> -#define CPCAP_BATTERY_BW8X_ID 0x98
> -
> enum {
> CPCAP_BATTERY_IIO_BATTDET,
> CPCAP_BATTERY_IIO_VOLTAGE,
> @@ -388,22 +385,9 @@ static int cpcap_battery_cc_to_ua(struct cpcap_battery_ddata *ddata,
> * kernel on droid 4, full is 4351000 and software initiates shutdown
> * at 3078000. The device will die around 2743000.
> */
> -static const struct cpcap_battery_config cpcap_battery_eb41_data = {
> - .cd_factor = 0x3cc,
> - .info.technology = POWER_SUPPLY_TECHNOLOGY_LION,
> - .info.voltage_max_design = 4351000,
> - .info.voltage_min_design = 3100000,
> - .info.charge_full_design = 1740000,
> - .bat.constant_charge_voltage_max_uv = 4200000,
> -};
> -
> -/* Values for the extended Droid Bionic battery bw8x. */
> -static const struct cpcap_battery_config cpcap_battery_bw8x_data = {
> +static struct cpcap_battery_config cpcap_battery_mot_data = {
> .cd_factor = 0x3cc,
> .info.technology = POWER_SUPPLY_TECHNOLOGY_LION,
> - .info.voltage_max_design = 4200000,
> - .info.voltage_min_design = 3200000,
> - .info.charge_full_design = 2760000,
> .bat.constant_charge_voltage_max_uv = 4200000,
> };
>
> @@ -431,39 +415,63 @@ static int cpcap_battery_match_nvmem(struct device *dev, const void *data)
> static void cpcap_battery_detect_battery_type(struct cpcap_battery_ddata *ddata)
> {
> struct nvmem_device *nvmem;
> - u8 battery_id = 0;
> + char buf[24];
> + u8 capacity;
> + u8 mul_idx;
> + u8 charge_voltage;
> + u32 v;
> + static const u32 multipliers[] = {20, 10, 10, 10, 10, 40, 10, 20, 40};
>
> ddata->check_nvmem = false;
>
> nvmem = nvmem_device_find(NULL, &cpcap_battery_match_nvmem);
> if (IS_ERR_OR_NULL(nvmem)) {
> - ddata->check_nvmem = true;
> dev_info_once(ddata->dev, "Can not find battery nvmem device. Assuming generic lipo battery\n");
> - } else {
> - char buf[24];
> -
> - if (nvmem_device_read(nvmem, 96, 4, buf) < 0 ||
> - strncmp(buf, "COPR", 4) != 0 ||
> - nvmem_device_read(nvmem, 104, 24, buf) < 0 ||
> - strncmp(buf, "MOTOROLA E.P CHARGE ONLY", 24) != 0 ||
> - nvmem_device_read(nvmem, 2, 1, &battery_id) < 0) {
> - battery_id = 0;
> - ddata->check_nvmem = true;
> - dev_warn(ddata->dev, "Can not read battery nvmem device. Assuming generic lipo battery\n");
> - }
> + goto unknown;
> + }
>
> + if (nvmem_device_read(nvmem, 96, 4, buf) < 0 ||
> + strncmp(buf, "COPR", 4) != 0 ||
> + nvmem_device_read(nvmem, 104, 24, buf) < 0 ||
> + strncmp(buf, "MOTOROLA E.P CHARGE ONLY", 24) != 0) {
> + dev_warn(ddata->dev, "Unknown battery nvmem device. Assuming generic lipo battery\n");
> + goto unknown;
> }
>
> - switch (battery_id) {
> - case CPCAP_BATTERY_EB41_HW4X_ID:
> - ddata->config = cpcap_battery_eb41_data;
> - break;
> - case CPCAP_BATTERY_BW8X_ID:
> - ddata->config = cpcap_battery_bw8x_data;
> - break;
> - default:
> - ddata->config = cpcap_battery_unkown_data;
> + if (nvmem_device_read(nvmem, 49, 1, &mul_idx) < 0 ||
> + nvmem_device_read(nvmem, 34, 1, &capacity) < 0 ||
> + nvmem_device_read(nvmem, 65, 1, &charge_voltage) < 0) {
> + dev_warn(ddata->dev, "Can not read battery nvmem device. Assuming generic lipo battery\n");
> + goto unknown;
> }
> +
> + /* design capacity */
> + mul_idx -= 2;
> +
> + if (mul_idx < ARRAY_SIZE(multipliers))
> + v = multipliers[mul_idx];
> + else
> + v = 10;
> +
> + cpcap_battery_mot_data.info.charge_full_design = 1000 * v * capacity;
> +
> + /* design max voltage */
> + v = 1000 * ((16702 * charge_voltage) / 1000 + 1260);
> + cpcap_battery_mot_data.info.voltage_max_design = v;
> +
> + /* design min voltage */
> + if (v > 4200000)
> + cpcap_battery_mot_data.info.voltage_min_design = 3100000;
> + else
> + cpcap_battery_mot_data.info.voltage_min_design = 3200000;
> +
> + ddata->config = cpcap_battery_mot_data;
> +
> + return;
> +
> +unknown:
> + ddata->check_nvmem = true;
> + ddata->config = cpcap_battery_unkown_data;
> }
>
> /**
>
@@ -74,9 +74,6 @@
#define CPCAP_BATTERY_CC_SAMPLE_PERIOD_MS 250
-#define CPCAP_BATTERY_EB41_HW4X_ID 0x9E
-#define CPCAP_BATTERY_BW8X_ID 0x98
-
enum {
CPCAP_BATTERY_IIO_BATTDET,
CPCAP_BATTERY_IIO_VOLTAGE,
@@ -388,22 +385,9 @@ static int cpcap_battery_cc_to_ua(struct cpcap_battery_ddata *ddata,
* kernel on droid 4, full is 4351000 and software initiates shutdown
* at 3078000. The device will die around 2743000.
*/
-static const struct cpcap_battery_config cpcap_battery_eb41_data = {
- .cd_factor = 0x3cc,
- .info.technology = POWER_SUPPLY_TECHNOLOGY_LION,
- .info.voltage_max_design = 4351000,
- .info.voltage_min_design = 3100000,
- .info.charge_full_design = 1740000,
- .bat.constant_charge_voltage_max_uv = 4200000,
-};
-
-/* Values for the extended Droid Bionic battery bw8x. */
-static const struct cpcap_battery_config cpcap_battery_bw8x_data = {
+static struct cpcap_battery_config cpcap_battery_mot_data = {
.cd_factor = 0x3cc,
.info.technology = POWER_SUPPLY_TECHNOLOGY_LION,
- .info.voltage_max_design = 4200000,
- .info.voltage_min_design = 3200000,
- .info.charge_full_design = 2760000,
.bat.constant_charge_voltage_max_uv = 4200000,
};
@@ -431,39 +415,63 @@ static int cpcap_battery_match_nvmem(struct device *dev, const void *data)
static void cpcap_battery_detect_battery_type(struct cpcap_battery_ddata *ddata)
{
struct nvmem_device *nvmem;
- u8 battery_id = 0;
+ char buf[24];
+ u8 capacity;
+ u8 mul_idx;
+ u8 charge_voltage;
+ u32 v;
+ static const u32 multipliers[] = {20, 10, 10, 10, 10, 40, 10, 20, 40};
ddata->check_nvmem = false;
nvmem = nvmem_device_find(NULL, &cpcap_battery_match_nvmem);
if (IS_ERR_OR_NULL(nvmem)) {
- ddata->check_nvmem = true;
dev_info_once(ddata->dev, "Can not find battery nvmem device. Assuming generic lipo battery\n");
- } else {
- char buf[24];
-
- if (nvmem_device_read(nvmem, 96, 4, buf) < 0 ||
- strncmp(buf, "COPR", 4) != 0 ||
- nvmem_device_read(nvmem, 104, 24, buf) < 0 ||
- strncmp(buf, "MOTOROLA E.P CHARGE ONLY", 24) != 0 ||
- nvmem_device_read(nvmem, 2, 1, &battery_id) < 0) {
- battery_id = 0;
- ddata->check_nvmem = true;
- dev_warn(ddata->dev, "Can not read battery nvmem device. Assuming generic lipo battery\n");
- }
+ goto unknown;
+ }
+ if (nvmem_device_read(nvmem, 96, 4, buf) < 0 ||
+ strncmp(buf, "COPR", 4) != 0 ||
+ nvmem_device_read(nvmem, 104, 24, buf) < 0 ||
+ strncmp(buf, "MOTOROLA E.P CHARGE ONLY", 24) != 0) {
+ dev_warn(ddata->dev, "Unknown battery nvmem device. Assuming generic lipo battery\n");
+ goto unknown;
}
- switch (battery_id) {
- case CPCAP_BATTERY_EB41_HW4X_ID:
- ddata->config = cpcap_battery_eb41_data;
- break;
- case CPCAP_BATTERY_BW8X_ID:
- ddata->config = cpcap_battery_bw8x_data;
- break;
- default:
- ddata->config = cpcap_battery_unkown_data;
+ if (nvmem_device_read(nvmem, 49, 1, &mul_idx) < 0 ||
+ nvmem_device_read(nvmem, 34, 1, &capacity) < 0 ||
+ nvmem_device_read(nvmem, 65, 1, &charge_voltage) < 0) {
+ dev_warn(ddata->dev, "Can not read battery nvmem device. Assuming generic lipo battery\n");
+ goto unknown;
}
+
+ /* design capacity */
+ mul_idx -= 2;
+
+ if (mul_idx < ARRAY_SIZE(multipliers))
+ v = multipliers[mul_idx];
+ else
+ v = 10;
+
+ cpcap_battery_mot_data.info.charge_full_design = 1000 * v * capacity;
+
+ /* design max voltage */
+ v = 1000 * ((16702 * charge_voltage) / 1000 + 1260);
+ cpcap_battery_mot_data.info.voltage_max_design = v;
+
+ /* design min voltage */
+ if (v > 4200000)
+ cpcap_battery_mot_data.info.voltage_min_design = 3100000;
+ else
+ cpcap_battery_mot_data.info.voltage_min_design = 3200000;
+
+ ddata->config = cpcap_battery_mot_data;
+
+ return;
+
+unknown:
+ ddata->check_nvmem = true;
+ ddata->config = cpcap_battery_unkown_data;
}
/**