1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2012 Samsung Electronics
4 * Lukasz Majewski <l.majewski@samsung.com>
8 #include <power/pmic.h>
9 #include <power/max17042_fg.h>
11 #include <power/max8997_pmic.h>
12 #include <power/power_chrg.h>
13 #include <power/battery.h>
14 #include <power/fg_battery_cell_params.h>
17 static int fg_write_regs(struct pmic *p, u8 addr, u16 *data, int num)
22 for (i = 0; i < num; i++, addr++) {
23 ret = pmic_reg_write(p, addr, *(data + i));
31 static int fg_read_regs(struct pmic *p, u8 addr, u16 *data, int num)
37 for (i = 0; i < num; i++, addr++) {
38 ret = pmic_reg_read(p, addr, &dat);
42 *(data + i) = (u16)dat;
48 static int fg_write_and_verify(struct pmic *p, u8 addr, u16 data)
50 unsigned int val = data;
53 ret |= pmic_reg_write(p, addr, val);
54 ret |= pmic_reg_read(p, addr, &val);
59 if (((u16) val) == data)
65 static void por_fuelgauge_init(struct pmic *p)
67 u16 r_data0[16], r_data1[16], r_data2[16];
68 u32 rewrite_count = 5;
78 /* Initilize Configuration */
79 pmic_reg_write(p, MAX17042_CONFIG, 0x2310);
85 if (!rewrite_count--) {
86 status_msg = "init failed!";
90 /* Unlock Model Access */
91 pmic_reg_write(p, MAX17042_MLOCKReg1, MODEL_UNLOCK1);
92 pmic_reg_write(p, MAX17042_MLOCKReg2, MODEL_UNLOCK2);
94 /* Write/Read/Verify the Custom Model */
95 ret = fg_write_regs(p, MAX17042_MODEL1, cell_character0,
96 ARRAY_SIZE(cell_character0));
100 ret = fg_write_regs(p, MAX17042_MODEL2, cell_character1,
101 ARRAY_SIZE(cell_character1));
105 ret = fg_write_regs(p, MAX17042_MODEL3, cell_character2,
106 ARRAY_SIZE(cell_character2));
111 if (!check_count--) {
115 status_msg = "check failed!";
120 ret = fg_read_regs(p, MAX17042_MODEL1, r_data0, ARRAY_SIZE(r_data0));
124 ret = fg_read_regs(p, MAX17042_MODEL2, r_data1, ARRAY_SIZE(r_data1));
128 ret = fg_read_regs(p, MAX17042_MODEL3, r_data2, ARRAY_SIZE(r_data2));
132 for (i = 0; i < 16; i++) {
133 if ((cell_character0[i] != r_data0[i])
134 || (cell_character1[i] != r_data1[i])
135 || (cell_character2[i] != r_data2[i]))
144 status_msg = "lock failed!";
149 /* Lock model access */
150 pmic_reg_write(p, MAX17042_MLOCKReg1, MODEL_LOCK1);
151 pmic_reg_write(p, MAX17042_MLOCKReg2, MODEL_LOCK2);
153 /* Verify the model access is locked */
154 ret = fg_read_regs(p, MAX17042_MODEL1, r_data0, ARRAY_SIZE(r_data0));
158 ret = fg_read_regs(p, MAX17042_MODEL2, r_data1, ARRAY_SIZE(r_data1));
162 ret = fg_read_regs(p, MAX17042_MODEL3, r_data2, ARRAY_SIZE(r_data2));
166 for (i = 0; i < ARRAY_SIZE(r_data0); i++) {
167 /* Check if model locked */
168 if (r_data0[i] || r_data1[i] || r_data2[i])
172 /* Write Custom Parameters */
173 fg_write_and_verify(p, MAX17042_RCOMP0, RCOMP0);
174 fg_write_and_verify(p, MAX17042_TEMPCO, TempCo);
176 /* Delay at least 350mS */
179 /* Initialization Complete */
180 pmic_reg_read(p, MAX17042_STATUS, &val);
181 /* Write and Verify Status with POR bit Cleared */
182 fg_write_and_verify(p, MAX17042_STATUS, val & ~MAX17042_POR);
184 /* Delay at least 350 ms */
189 debug("%s: model init status: %s\n", p->name, status_msg);
193 static int power_update_battery(struct pmic *p, struct pmic *bat)
195 struct power_battery *pb = bat->pbat;
200 puts("Can't find max17042 fuel gauge\n");
204 ret |= pmic_reg_read(p, MAX17042_VFSOC, &val);
205 pb->bat->state_of_chrg = (val >> 8);
207 pmic_reg_read(p, MAX17042_VCELL, &val);
208 debug("vfsoc: 0x%x\n", val);
209 pb->bat->voltage_uV = ((val & 0xFFUL) >> 3) + ((val & 0xFF00) >> 3);
210 pb->bat->voltage_uV = (pb->bat->voltage_uV * 625);
212 pmic_reg_read(p, 0x05, &val);
213 pb->bat->capacity = val >> 2;
218 static int power_check_battery(struct pmic *p, struct pmic *bat)
220 struct power_battery *pb = bat->pbat;
225 puts("Can't find max17042 fuel gauge\n");
229 ret |= pmic_reg_read(p, MAX17042_STATUS, &val);
230 debug("fg status: 0x%x\n", val);
232 if (val & MAX17042_POR)
233 por_fuelgauge_init(p);
235 ret |= pmic_reg_read(p, MAX17042_VERSION, &val);
236 pb->bat->version = val;
238 power_update_battery(p, bat);
239 debug("fg ver: 0x%x\n", pb->bat->version);
240 printf("BAT: state_of_charge(SOC):%d%%\n",
241 pb->bat->state_of_chrg);
243 printf(" voltage: %d.%6.6d [V] (expected to be %d [mAh])\n",
244 pb->bat->voltage_uV / 1000000,
245 pb->bat->voltage_uV % 1000000,
248 if (pb->bat->voltage_uV > 3850000)
249 pb->bat->state = EXT_SOURCE;
250 else if (pb->bat->voltage_uV < 3600000 || pb->bat->state_of_chrg < 5)
251 pb->bat->state = CHARGE;
253 pb->bat->state = NORMAL;
258 static struct power_fg power_fg_ops = {
259 .fg_battery_check = power_check_battery,
260 .fg_battery_update = power_update_battery,
263 int power_fg_init(unsigned char bus)
265 static const char name[] = "MAX17042_FG";
266 struct pmic *p = pmic_alloc();
269 printf("%s: POWER allocation error!\n", __func__);
273 debug("Board Fuel Gauge init\n");
276 p->interface = PMIC_I2C;
277 p->number_of_regs = FG_NUM_OF_REGS;
278 p->hw.i2c.addr = MAX17042_I2C_ADDR;
279 p->hw.i2c.tx_num = 2;
280 p->sensor_byte_order = PMIC_SENSOR_BYTE_ORDER_BIG;
283 p->fg = &power_fg_ops;