2 * Copyright (C) 2012 Samsung Electronics
3 * Lukasz Majewski <l.majewski@samsung.com>
5 * SPDX-License-Identifier: GPL-2.0+
9 #include <power/pmic.h>
10 #include <power/max17042_fg.h>
12 #include <power/max8997_pmic.h>
13 #include <power/power_chrg.h>
14 #include <power/battery.h>
15 #include <power/fg_battery_cell_params.h>
18 static int fg_write_regs(struct pmic *p, u8 addr, u16 *data, int num)
23 for (i = 0; i < num; i++, addr++)
24 ret |= pmic_reg_write(p, addr, *(data + i));
29 static int fg_read_regs(struct pmic *p, u8 addr, u16 *data, int num)
34 for (i = 0; i < num; i++, addr++)
35 ret |= pmic_reg_read(p, addr, (u32 *) (data + i));
40 static int fg_write_and_verify(struct pmic *p, u8 addr, u16 data)
42 unsigned int val = data;
45 ret |= pmic_reg_write(p, addr, val);
46 ret |= pmic_reg_read(p, addr, &val);
51 if (((u16) val) == data)
57 static void por_fuelgauge_init(struct pmic *p)
59 u16 r_data0[16], r_data1[16], r_data2[16];
60 u32 rewrite_count = 5, i = 0;
66 /* Initilize Configuration */
67 pmic_reg_write(p, MAX17042_CONFIG, 0x2310);
70 /* Unlock Model Access */
71 pmic_reg_write(p, MAX17042_MLOCKReg1, MODEL_UNLOCK1);
72 pmic_reg_write(p, MAX17042_MLOCKReg2, MODEL_UNLOCK2);
74 /* Write/Read/Verify the Custom Model */
75 ret |= fg_write_regs(p, MAX17042_MODEL1, cell_character0,
76 ARRAY_SIZE(cell_character0));
77 ret |= fg_write_regs(p, MAX17042_MODEL2, cell_character1,
78 ARRAY_SIZE(cell_character1));
79 ret |= fg_write_regs(p, MAX17042_MODEL3, cell_character2,
80 ARRAY_SIZE(cell_character2));
83 printf("%s: Cell parameters write failed!\n", __func__);
87 ret |= fg_read_regs(p, MAX17042_MODEL1, r_data0, ARRAY_SIZE(r_data0));
88 ret |= fg_read_regs(p, MAX17042_MODEL2, r_data1, ARRAY_SIZE(r_data1));
89 ret |= fg_read_regs(p, MAX17042_MODEL3, r_data2, ARRAY_SIZE(r_data2));
92 printf("%s: Cell parameters read failed!\n", __func__);
94 for (i = 0; i < 16; i++) {
95 if ((cell_character0[i] != r_data0[i])
96 || (cell_character1[i] != r_data1[i])
97 || (cell_character2[i] != r_data2[i]))
101 /* Lock model access */
102 pmic_reg_write(p, MAX17042_MLOCKReg1, MODEL_LOCK1);
103 pmic_reg_write(p, MAX17042_MLOCKReg2, MODEL_LOCK2);
105 /* Verify the model access is locked */
106 ret |= fg_read_regs(p, MAX17042_MODEL1, r_data0, ARRAY_SIZE(r_data0));
107 ret |= fg_read_regs(p, MAX17042_MODEL2, r_data1, ARRAY_SIZE(r_data1));
108 ret |= fg_read_regs(p, MAX17042_MODEL3, r_data2, ARRAY_SIZE(r_data2));
111 printf("%s: Cell parameters read failed!\n", __func__);
115 for (i = 0; i < ARRAY_SIZE(r_data0); i++) {
116 /* Check if model locked */
117 if (r_data0[i] || r_data1[i] || r_data2[i]) {
118 /* Rewrite model data - prevent from endless loop */
119 if (rewrite_count--) {
120 puts("FG - Lock model access failed!\n");
126 /* Write Custom Parameters */
127 fg_write_and_verify(p, MAX17042_RCOMP0, RCOMP0);
128 fg_write_and_verify(p, MAX17042_TEMPCO, TempCo);
130 /* Delay at least 350mS */
133 /* Initialization Complete */
134 pmic_reg_read(p, MAX17042_STATUS, &val);
135 /* Write and Verify Status with POR bit Cleared */
136 fg_write_and_verify(p, MAX17042_STATUS, val & ~MAX17042_POR);
138 /* Delay at least 350 ms */
142 static int power_update_battery(struct pmic *p, struct pmic *bat)
144 struct power_battery *pb = bat->pbat;
149 puts("Can't find max17042 fuel gauge\n");
153 ret |= pmic_reg_read(p, MAX17042_VFSOC, &val);
154 pb->bat->state_of_chrg = (val >> 8);
156 pmic_reg_read(p, MAX17042_VCELL, &val);
157 debug("vfsoc: 0x%x\n", val);
158 pb->bat->voltage_uV = ((val & 0xFFUL) >> 3) + ((val & 0xFF00) >> 3);
159 pb->bat->voltage_uV = (pb->bat->voltage_uV * 625);
161 pmic_reg_read(p, 0x05, &val);
162 pb->bat->capacity = val >> 2;
167 static int power_check_battery(struct pmic *p, struct pmic *bat)
169 struct power_battery *pb = bat->pbat;
174 puts("Can't find max17042 fuel gauge\n");
178 ret |= pmic_reg_read(p, MAX17042_STATUS, &val);
179 debug("fg status: 0x%x\n", val);
181 if (val == MAX17042_POR)
182 por_fuelgauge_init(p);
184 ret |= pmic_reg_read(p, MAX17042_VERSION, &val);
185 pb->bat->version = val;
187 power_update_battery(p, bat);
188 debug("fg ver: 0x%x\n", pb->bat->version);
189 printf("BAT: state_of_charge(SOC):%d%%\n",
190 pb->bat->state_of_chrg);
192 printf(" voltage: %d.%6.6d [V] (expected to be %d [mAh])\n",
193 pb->bat->voltage_uV / 1000000,
194 pb->bat->voltage_uV % 1000000,
197 if (pb->bat->voltage_uV > 3850000)
198 pb->bat->state = EXT_SOURCE;
199 else if (pb->bat->voltage_uV < 3600000 || pb->bat->state_of_chrg < 5)
200 pb->bat->state = CHARGE;
202 pb->bat->state = NORMAL;
207 static struct power_fg power_fg_ops = {
208 .fg_battery_check = power_check_battery,
209 .fg_battery_update = power_update_battery,
212 int power_fg_init(unsigned char bus)
214 static const char name[] = "MAX17042_FG";
215 struct pmic *p = pmic_alloc();
218 printf("%s: POWER allocation error!\n", __func__);
222 debug("Board Fuel Gauge init\n");
225 p->interface = PMIC_I2C;
226 p->number_of_regs = FG_NUM_OF_REGS;
227 p->hw.i2c.addr = MAX17042_I2C_ADDR;
228 p->hw.i2c.tx_num = 2;
229 p->sensor_byte_order = PMIC_SENSOR_BYTE_ORDER_BIG;
232 p->fg = &power_fg_ops;