92 static u32 da9150_fg_read_attr(struct da9150_fg *fg, u8 code, u8 size)  in da9150_fg_read_attr()  argument
103 	da9150_read_qif(fg->da9150, read_addr, size, buf);  in da9150_fg_read_attr()
110 static void da9150_fg_write_attr(struct da9150_fg *fg, u8 code, u8 size,  in da9150_fg_write_attr()  argument
125 	da9150_write_qif(fg->da9150, write_addr, size, buf);  in da9150_fg_write_attr()
129 static void da9150_fg_read_sync_start(struct da9150_fg *fg)  in da9150_fg_read_sync_start()  argument
134 	mutex_lock(&fg->io_lock);  in da9150_fg_read_sync_start()
137 	res = da9150_fg_read_attr(fg, DA9150_QIF_SYNC,  in da9150_fg_read_sync_start()
140 		da9150_fg_write_attr(fg, DA9150_QIF_SYNC,  in da9150_fg_read_sync_start()
148 		res = da9150_fg_read_attr(fg, DA9150_QIF_SYNC,  in da9150_fg_read_sync_start()
154 		dev_err(fg->dev, "Failed to perform QIF read sync!\n");  in da9150_fg_read_sync_start()
161 static inline void da9150_fg_read_sync_end(struct da9150_fg *fg)  in da9150_fg_read_sync_end()  argument
163 	mutex_unlock(&fg->io_lock);  in da9150_fg_read_sync_end()
167 static u32 da9150_fg_read_attr_sync(struct da9150_fg *fg, u8 code, u8 size)  in da9150_fg_read_attr_sync()  argument
171 	da9150_fg_read_sync_start(fg);  in da9150_fg_read_attr_sync()
172 	val = da9150_fg_read_attr(fg, code, size);  in da9150_fg_read_attr_sync()
173 	da9150_fg_read_sync_end(fg);  in da9150_fg_read_attr_sync()
179 static void da9150_fg_write_attr_sync(struct da9150_fg *fg, u8 code, u8 size,  in da9150_fg_write_attr_sync()  argument
185 	mutex_lock(&fg->io_lock);  in da9150_fg_write_attr_sync()
188 	res = da9150_fg_read_attr(fg, DA9150_QIF_SYNC,  in da9150_fg_write_attr_sync()
195 		res = da9150_fg_read_attr(fg, DA9150_QIF_SYNC,  in da9150_fg_write_attr_sync()
200 		dev_err(fg->dev, "Timeout waiting for existing QIF sync!\n");  in da9150_fg_write_attr_sync()
201 		mutex_unlock(&fg->io_lock);  in da9150_fg_write_attr_sync()
206 	da9150_fg_write_attr(fg, code, size, val);  in da9150_fg_write_attr_sync()
214 		res = da9150_fg_read_attr(fg, DA9150_QIF_SYNC,  in da9150_fg_write_attr_sync()
218 	mutex_unlock(&fg->io_lock);  in da9150_fg_write_attr_sync()
222 		dev_err(fg->dev, "Error performing QIF sync write for code %d\n",  in da9150_fg_write_attr_sync()
227 static int da9150_fg_capacity(struct da9150_fg *fg,  in da9150_fg_capacity()  argument
230 	val->intval = da9150_fg_read_attr_sync(fg, DA9150_QIF_SOC_PCT,  in da9150_fg_capacity()
239 static int da9150_fg_current_avg(struct da9150_fg *fg,  in da9150_fg_current_avg()  argument
245 	da9150_fg_read_sync_start(fg);  in da9150_fg_current_avg()
246 	iavg = da9150_fg_read_attr(fg, DA9150_QIF_IAVG,  in da9150_fg_current_avg()
248 	shunt_val = da9150_fg_read_attr(fg, DA9150_QIF_SHUNT_VAL,  in da9150_fg_current_avg()
250 	sd_gain = da9150_fg_read_attr(fg, DA9150_QIF_SD_GAIN,  in da9150_fg_current_avg()
252 	da9150_fg_read_sync_end(fg);  in da9150_fg_current_avg()
264 static int da9150_fg_voltage_avg(struct da9150_fg *fg,  in da9150_fg_voltage_avg()  argument
269 	val->intval = da9150_fg_read_attr_sync(fg, DA9150_QIF_UAVG,  in da9150_fg_voltage_avg()
279 static int da9150_fg_charge_full(struct da9150_fg *fg,  in da9150_fg_charge_full()  argument
282 	val->intval = da9150_fg_read_attr_sync(fg, DA9150_QIF_FCC_MAH,  in da9150_fg_charge_full()
294 static int da9150_fg_temp(struct da9150_fg *fg,  in da9150_fg_temp()  argument
297 	val->intval = da9150_fg_read_attr_sync(fg, DA9150_QIF_NTCAVG,  in da9150_fg_temp()
317 	struct da9150_fg *fg = dev_get_drvdata(psy->dev.parent);  in da9150_fg_get_prop()  local
322 		ret = da9150_fg_capacity(fg, val);  in da9150_fg_get_prop()
325 		ret = da9150_fg_current_avg(fg, val);  in da9150_fg_get_prop()
328 		ret = da9150_fg_voltage_avg(fg, val);  in da9150_fg_get_prop()
331 		ret = da9150_fg_charge_full(fg, val);  in da9150_fg_get_prop()
334 		ret = da9150_fg_temp(fg, val);  in da9150_fg_get_prop()
345 static bool da9150_fg_soc_changed(struct da9150_fg *fg)  in da9150_fg_soc_changed()  argument
349 	da9150_fg_capacity(fg, &val);  in da9150_fg_soc_changed()
350 	if (val.intval != fg->soc) {  in da9150_fg_soc_changed()
351 		fg->soc = val.intval;  in da9150_fg_soc_changed()
360 	struct da9150_fg *fg = container_of(work, struct da9150_fg, work.work);  in da9150_fg_work()  local
363 	if (da9150_fg_soc_changed(fg))  in da9150_fg_work()
364 		power_supply_changed(fg->battery);  in da9150_fg_work()
366 	schedule_delayed_work(&fg->work, msecs_to_jiffies(fg->interval));  in da9150_fg_work()
370 static void da9150_fg_soc_event_config(struct da9150_fg *fg)  in da9150_fg_soc_event_config()  argument
374 	soc = da9150_fg_read_attr_sync(fg, DA9150_QIF_SOC_PCT,  in da9150_fg_soc_event_config()
377 	if (soc > fg->warn_soc) {  in da9150_fg_soc_event_config()
379 		da9150_fg_write_attr_sync(fg, DA9150_QIF_DISCHARGE_LIMIT,  in da9150_fg_soc_event_config()
381 					  fg->warn_soc + 1);  in da9150_fg_soc_event_config()
382 	} else if ((soc <= fg->warn_soc) && (soc > fg->crit_soc)) {  in da9150_fg_soc_event_config()
387 		da9150_fg_write_attr_sync(fg, DA9150_QIF_DISCHARGE_LIMIT,  in da9150_fg_soc_event_config()
389 					  fg->crit_soc + 1);  in da9150_fg_soc_event_config()
391 		da9150_fg_write_attr_sync(fg, DA9150_QIF_CHARGE_LIMIT,  in da9150_fg_soc_event_config()
393 					  fg->warn_soc);  in da9150_fg_soc_event_config()
394 	} else if (soc <= fg->crit_soc) {  in da9150_fg_soc_event_config()
396 		da9150_fg_write_attr_sync(fg, DA9150_QIF_CHARGE_LIMIT,  in da9150_fg_soc_event_config()
398 					  fg->crit_soc);  in da9150_fg_soc_event_config()
404 	struct da9150_fg *fg = data;  in da9150_fg_irq()  local
408 	e_fg_status = da9150_fg_read_attr(fg, DA9150_QIF_E_FG_STATUS,  in da9150_fg_irq()
413 		da9150_fg_soc_event_config(fg);  in da9150_fg_irq()
416 	da9150_fg_write_attr(fg, DA9150_QIF_E_FG_STATUS,  in da9150_fg_irq()
454 	struct da9150_fg *fg;  in da9150_fg_probe()  local
457 	fg = devm_kzalloc(dev, sizeof(*fg), GFP_KERNEL);  in da9150_fg_probe()
458 	if (fg == NULL)  in da9150_fg_probe()
461 	platform_set_drvdata(pdev, fg);  in da9150_fg_probe()
462 	fg->da9150 = da9150;  in da9150_fg_probe()
463 	fg->dev = dev;  in da9150_fg_probe()
465 	mutex_init(&fg->io_lock);  in da9150_fg_probe()
471 	fg->battery = devm_power_supply_register(dev, &fg_desc, NULL);  in da9150_fg_probe()
472 	if (IS_ERR(fg->battery)) {  in da9150_fg_probe()
473 		ret = PTR_ERR(fg->battery);  in da9150_fg_probe()
477 	ver = da9150_fg_read_attr(fg, DA9150_QIF_FW_MAIN_VER,  in da9150_fg_probe()
489 		fg->interval = fg_pdata->update_interval;  in da9150_fg_probe()
494 			fg->warn_soc = fg_pdata->warn_soc_lvl;  in da9150_fg_probe()
500 			fg->crit_soc = fg_pdata->crit_soc_lvl;  in da9150_fg_probe()
506 	da9150_fg_soc_event_config(fg);  in da9150_fg_probe()
512 	if (fg->interval) {  in da9150_fg_probe()
513 		INIT_DELAYED_WORK(&fg->work, da9150_fg_work);  in da9150_fg_probe()
514 		schedule_delayed_work(&fg->work,  in da9150_fg_probe()
515 				      msecs_to_jiffies(fg->interval));  in da9150_fg_probe()
527 					IRQF_ONESHOT, "FG", fg);  in da9150_fg_probe()
536 	if (fg->interval)  in da9150_fg_probe()
537 		cancel_delayed_work(&fg->work);  in da9150_fg_probe()
544 	struct da9150_fg *fg = platform_get_drvdata(pdev);  in da9150_fg_remove()  local
546 	if (fg->interval)  in da9150_fg_remove()
547 		cancel_delayed_work(&fg->work);  in da9150_fg_remove()
554 	struct da9150_fg *fg = platform_get_drvdata(pdev);  in da9150_fg_resume()  local
560 	if (fg->interval)  in da9150_fg_resume()
561 		flush_delayed_work(&fg->work);  in da9150_fg_resume()