84 static int cw_read_word(struct cw_battery *cw_bat, u8 reg, u16 *val)  in cw_read_word()  argument
89 	ret = regmap_bulk_read(cw_bat->regmap, reg, &value, sizeof(value));  in cw_read_word()
97 static int cw_update_profile(struct cw_battery *cw_bat)  in cw_update_profile()  argument
104 	ret = regmap_read(cw_bat->regmap, CW2015_REG_MODE, &reg_val);  in cw_update_profile()
110 		dev_err(cw_bat->dev,  in cw_update_profile()
116 	ret = regmap_raw_write(cw_bat->regmap, CW2015_REG_BATINFO,  in cw_update_profile()
117 			       cw_bat->bat_profile,  in cw_update_profile()
125 	reg_val |= CW2015_ATHD(cw_bat->alert_level);  in cw_update_profile()
126 	ret = regmap_write(cw_bat->regmap, CW2015_REG_CONFIG, reg_val);  in cw_update_profile()
133 	ret = regmap_write(cw_bat->regmap, CW2015_REG_MODE, reg_val);  in cw_update_profile()
141 	ret = regmap_write(cw_bat->regmap, CW2015_REG_MODE, reset_val);  in cw_update_profile()
146 	ret = regmap_read_poll_timeout(cw_bat->regmap, CW2015_REG_SOC,  in cw_update_profile()
150 		dev_err(cw_bat->dev,  in cw_update_profile()
153 		dev_dbg(cw_bat->dev, "Battery profile updated\n");  in cw_update_profile()
158 static int cw_init(struct cw_battery *cw_bat)  in cw_init()  argument
165 		ret = regmap_write(cw_bat->regmap, CW2015_REG_MODE, reg_val);  in cw_init()
170 	ret = regmap_read(cw_bat->regmap, CW2015_REG_CONFIG, &reg_val);  in cw_init()
174 	if ((reg_val & CW2015_MASK_ATHD) != CW2015_ATHD(cw_bat->alert_level)) {  in cw_init()
175 		dev_dbg(cw_bat->dev, "Setting new alert level\n");  in cw_init()
177 		reg_val |= ~CW2015_ATHD(cw_bat->alert_level);  in cw_init()
178 		ret = regmap_write(cw_bat->regmap, CW2015_REG_CONFIG, reg_val);  in cw_init()
183 	ret = regmap_read(cw_bat->regmap, CW2015_REG_CONFIG, &reg_val);  in cw_init()
188 		dev_dbg(cw_bat->dev,  in cw_init()
190 		if (cw_bat->bat_profile) {  in cw_init()
191 			ret = cw_update_profile(cw_bat);  in cw_init()
193 				dev_err(cw_bat->dev,  in cw_init()
198 			dev_warn(cw_bat->dev,  in cw_init()
201 	} else if (cw_bat->bat_profile) {  in cw_init()
204 		ret = regmap_raw_read(cw_bat->regmap, CW2015_REG_BATINFO,  in cw_init()
207 			dev_err(cw_bat->dev,  in cw_init()
212 		if (memcmp(bat_info, cw_bat->bat_profile, CW2015_SIZE_BATINFO)) {  in cw_init()
213 			dev_warn(cw_bat->dev, "Replacing stored battery profile\n");  in cw_init()
214 			ret = cw_update_profile(cw_bat);  in cw_init()
219 		dev_warn(cw_bat->dev,  in cw_init()
223 	dev_dbg(cw_bat->dev, "Battery profile configured\n");  in cw_init()
227 static int cw_power_on_reset(struct cw_battery *cw_bat)  in cw_power_on_reset()  argument
233 	ret = regmap_write(cw_bat->regmap, CW2015_REG_MODE, reset_val);  in cw_power_on_reset()
241 	ret = regmap_write(cw_bat->regmap, CW2015_REG_MODE, reset_val);  in cw_power_on_reset()
245 	ret = cw_init(cw_bat);  in cw_power_on_reset()
254 static int cw_get_soc(struct cw_battery *cw_bat)  in cw_get_soc()  argument
259 	ret = regmap_read(cw_bat->regmap, CW2015_REG_SOC, &soc);  in cw_get_soc()
265 			CW2015_BAT_SOC_ERROR_MS / cw_bat->poll_interval_ms;  in cw_get_soc()
267 		dev_err(cw_bat->dev, "Invalid SoC %d%%\n", soc);  in cw_get_soc()
268 		cw_bat->read_errors++;  in cw_get_soc()
269 		if (cw_bat->read_errors > max_error_cycles) {  in cw_get_soc()
270 			dev_warn(cw_bat->dev,  in cw_get_soc()
272 			cw_power_on_reset(cw_bat);  in cw_get_soc()
273 			cw_bat->read_errors = 0;  in cw_get_soc()
275 		return cw_bat->soc;  in cw_get_soc()
277 	cw_bat->read_errors = 0;  in cw_get_soc()
280 	if (cw_bat->status == POWER_SUPPLY_STATUS_CHARGING && soc == cw_bat->soc) {  in cw_get_soc()
282 			CW2015_BAT_CHARGING_STUCK_MS / cw_bat->poll_interval_ms;  in cw_get_soc()
284 		cw_bat->charge_stuck_cnt++;  in cw_get_soc()
285 		if (cw_bat->charge_stuck_cnt > max_stuck_cycles) {  in cw_get_soc()
286 			dev_warn(cw_bat->dev,  in cw_get_soc()
288 			cw_power_on_reset(cw_bat);  in cw_get_soc()
289 			cw_bat->charge_stuck_cnt = 0;  in cw_get_soc()
292 		cw_bat->charge_stuck_cnt = 0;  in cw_get_soc()
296 	if (cw_bat->charger_attached && HYSTERESIS(soc, cw_bat->soc, 0, 3))  in cw_get_soc()
297 		soc = cw_bat->soc;  in cw_get_soc()
300 	if (!cw_bat->charger_attached && HYSTERESIS(soc, cw_bat->soc, 3, 0))  in cw_get_soc()
301 		soc = cw_bat->soc;  in cw_get_soc()
306 static int cw_get_voltage(struct cw_battery *cw_bat)  in cw_get_voltage()  argument
313 		ret = cw_read_word(cw_bat, CW2015_REG_VCELL, &reg_val);  in cw_get_voltage()
328 	dev_dbg(cw_bat->dev, "Read voltage: %d mV, raw=0x%04x\n",  in cw_get_voltage()
333 static int cw_get_time_to_empty(struct cw_battery *cw_bat)  in cw_get_time_to_empty()  argument
338 	ret = cw_read_word(cw_bat, CW2015_REG_RRT_ALERT, &value16);  in cw_get_time_to_empty()
345 static void cw_update_charge_status(struct cw_battery *cw_bat)  in cw_update_charge_status()  argument
349 	ret = power_supply_am_i_supplied(cw_bat->rk_bat);  in cw_update_charge_status()
351 		dev_warn(cw_bat->dev, "Failed to get supply state: %d\n", ret);  in cw_update_charge_status()
356 		if (cw_bat->charger_attached != charger_attached) {  in cw_update_charge_status()
357 			cw_bat->battery_changed = true;  in cw_update_charge_status()
359 				cw_bat->charge_count++;  in cw_update_charge_status()
361 		cw_bat->charger_attached = charger_attached;  in cw_update_charge_status()
365 static void cw_update_soc(struct cw_battery *cw_bat)  in cw_update_soc()  argument
369 	soc = cw_get_soc(cw_bat);  in cw_update_soc()
371 		dev_err(cw_bat->dev, "Failed to get SoC from gauge: %d\n", soc);  in cw_update_soc()
372 	else if (cw_bat->soc != soc) {  in cw_update_soc()
373 		cw_bat->soc = soc;  in cw_update_soc()
374 		cw_bat->battery_changed = true;  in cw_update_soc()
378 static void cw_update_voltage(struct cw_battery *cw_bat)  in cw_update_voltage()  argument
382 	voltage_mv = cw_get_voltage(cw_bat);  in cw_update_voltage()
384 		dev_err(cw_bat->dev, "Failed to get voltage from gauge: %d\n",  in cw_update_voltage()
387 		cw_bat->voltage_mv = voltage_mv;  in cw_update_voltage()
390 static void cw_update_status(struct cw_battery *cw_bat)  in cw_update_status()  argument
394 	if (cw_bat->charger_attached) {  in cw_update_status()
395 		if (cw_bat->soc >= 100)  in cw_update_status()
401 	if (cw_bat->status != status)  in cw_update_status()
402 		cw_bat->battery_changed = true;  in cw_update_status()
403 	cw_bat->status = status;  in cw_update_status()
406 static void cw_update_time_to_empty(struct cw_battery *cw_bat)  in cw_update_time_to_empty()  argument
410 	time_to_empty = cw_get_time_to_empty(cw_bat);  in cw_update_time_to_empty()
412 		dev_err(cw_bat->dev, "Failed to get time to empty from gauge: %d\n",  in cw_update_time_to_empty()
414 	else if (cw_bat->time_to_empty != time_to_empty) {  in cw_update_time_to_empty()
415 		cw_bat->time_to_empty = time_to_empty;  in cw_update_time_to_empty()
416 		cw_bat->battery_changed = true;  in cw_update_time_to_empty()
423 	struct cw_battery *cw_bat;  in cw_bat_work()  local
428 	cw_bat = container_of(delay_work, struct cw_battery, battery_delay_work);  in cw_bat_work()
429 	ret = regmap_read(cw_bat->regmap, CW2015_REG_MODE, &reg_val);  in cw_bat_work()
431 		dev_err(cw_bat->dev, "Failed to read mode from gauge: %d\n", ret);  in cw_bat_work()
437 				if (!cw_power_on_reset(cw_bat))  in cw_bat_work()
441 		cw_update_soc(cw_bat);  in cw_bat_work()
442 		cw_update_voltage(cw_bat);  in cw_bat_work()
443 		cw_update_charge_status(cw_bat);  in cw_bat_work()
444 		cw_update_status(cw_bat);  in cw_bat_work()
445 		cw_update_time_to_empty(cw_bat);  in cw_bat_work()
447 	dev_dbg(cw_bat->dev, "charger_attached = %d\n", cw_bat->charger_attached);  in cw_bat_work()
448 	dev_dbg(cw_bat->dev, "status = %d\n", cw_bat->status);  in cw_bat_work()
449 	dev_dbg(cw_bat->dev, "soc = %d%%\n", cw_bat->soc);  in cw_bat_work()
450 	dev_dbg(cw_bat->dev, "voltage = %dmV\n", cw_bat->voltage_mv);  in cw_bat_work()
452 	if (cw_bat->battery_changed)  in cw_bat_work()
453 		power_supply_changed(cw_bat->rk_bat);  in cw_bat_work()
454 	cw_bat->battery_changed = false;  in cw_bat_work()
456 	queue_delayed_work(cw_bat->battery_workqueue,  in cw_bat_work()
457 			   &cw_bat->battery_delay_work,  in cw_bat_work()
458 			   msecs_to_jiffies(cw_bat->poll_interval_ms));  in cw_bat_work()
461 static bool cw_battery_valid_time_to_empty(struct cw_battery *cw_bat)  in cw_battery_valid_time_to_empty()  argument
463 	return	cw_bat->time_to_empty > 0 &&  in cw_battery_valid_time_to_empty()
464 		cw_bat->time_to_empty < CW2015_MASK_SOC &&  in cw_battery_valid_time_to_empty()
465 		cw_bat->status == POWER_SUPPLY_STATUS_DISCHARGING;  in cw_battery_valid_time_to_empty()
472 	struct cw_battery *cw_bat;  in cw_battery_get_property()  local
474 	cw_bat = power_supply_get_drvdata(psy);  in cw_battery_get_property()
477 		val->intval = cw_bat->soc;  in cw_battery_get_property()
481 		val->intval = cw_bat->status;  in cw_battery_get_property()
485 		val->intval = !!cw_bat->voltage_mv;  in cw_battery_get_property()
489 		val->intval = cw_bat->voltage_mv * 1000;  in cw_battery_get_property()
493 		if (cw_battery_valid_time_to_empty(cw_bat))  in cw_battery_get_property()
494 			val->intval = cw_bat->time_to_empty * 60;  in cw_battery_get_property()
504 		val->intval = cw_bat->charge_count;  in cw_battery_get_property()
509 		if (cw_bat->battery->charge_full_design_uah > 0)  in cw_battery_get_property()
510 			val->intval = cw_bat->battery->charge_full_design_uah;  in cw_battery_get_property()
516 		val->intval = cw_bat->battery->charge_full_design_uah;  in cw_battery_get_property()
517 		val->intval = val->intval * cw_bat->soc / 100;  in cw_battery_get_property()
521 		if (cw_battery_valid_time_to_empty(cw_bat) &&  in cw_battery_get_property()
522 		    cw_bat->battery->charge_full_design_uah > 0) {  in cw_battery_get_property()
524 			val->intval = cw_bat->battery->charge_full_design_uah;  in cw_battery_get_property()
525 			val->intval = val->intval * cw_bat->soc / 100;  in cw_battery_get_property()
528 			val->intval = 60 * val->intval / cw_bat->time_to_empty;  in cw_battery_get_property()
563 static int cw2015_parse_properties(struct cw_battery *cw_bat)  in cw2015_parse_properties()  argument
565 	struct device *dev = cw_bat->dev;  in cw2015_parse_properties()
571 		dev_warn(cw_bat->dev,  in cw2015_parse_properties()
574 		dev_err(cw_bat->dev, "battery-profile must be %d bytes\n",  in cw2015_parse_properties()
578 		cw_bat->bat_profile = devm_kzalloc(dev, length, GFP_KERNEL);  in cw2015_parse_properties()
579 		if (!cw_bat->bat_profile)  in cw2015_parse_properties()
584 						cw_bat->bat_profile,  in cw2015_parse_properties()
591 				       &cw_bat->poll_interval_ms);  in cw2015_parse_properties()
593 		dev_dbg(cw_bat->dev, "Using default poll interval\n");  in cw2015_parse_properties()
594 		cw_bat->poll_interval_ms = CW2015_DEFAULT_POLL_INTERVAL_MS;  in cw2015_parse_properties()
646 	struct cw_battery *cw_bat;  in cw_bat_probe()  local
649 	cw_bat = devm_kzalloc(&client->dev, sizeof(*cw_bat), GFP_KERNEL);  in cw_bat_probe()
650 	if (!cw_bat)  in cw_bat_probe()
653 	i2c_set_clientdata(client, cw_bat);  in cw_bat_probe()
654 	cw_bat->dev = &client->dev;  in cw_bat_probe()
655 	cw_bat->soc = 1;  in cw_bat_probe()
657 	ret = cw2015_parse_properties(cw_bat);  in cw_bat_probe()
659 		dev_err(cw_bat->dev, "Failed to parse cw2015 properties\n");  in cw_bat_probe()
663 	cw_bat->regmap = devm_regmap_init_i2c(client, &cw2015_regmap_config);  in cw_bat_probe()
664 	if (IS_ERR(cw_bat->regmap)) {  in cw_bat_probe()
665 		dev_err(cw_bat->dev, "Failed to allocate regmap: %ld\n",  in cw_bat_probe()
666 			PTR_ERR(cw_bat->regmap));  in cw_bat_probe()
667 		return PTR_ERR(cw_bat->regmap);  in cw_bat_probe()
670 	ret = cw_init(cw_bat);  in cw_bat_probe()
672 		dev_err(cw_bat->dev, "Init failed: %d\n", ret);  in cw_bat_probe()
676 	psy_cfg.drv_data = cw_bat;  in cw_bat_probe()
677 	psy_cfg.fwnode = dev_fwnode(cw_bat->dev);  in cw_bat_probe()
679 	cw_bat->rk_bat = devm_power_supply_register(&client->dev,  in cw_bat_probe()
682 	if (IS_ERR(cw_bat->rk_bat)) {  in cw_bat_probe()
684 		dev_err_probe(&client->dev, PTR_ERR(cw_bat->rk_bat),  in cw_bat_probe()
686 		return PTR_ERR(cw_bat->rk_bat);  in cw_bat_probe()
689 	ret = power_supply_get_battery_info(cw_bat->rk_bat, &cw_bat->battery);  in cw_bat_probe()
692 		cw_bat->battery = devm_kzalloc(&client->dev,  in cw_bat_probe()
693 					       sizeof(*cw_bat->battery),  in cw_bat_probe()
695 		if (!cw_bat->battery)  in cw_bat_probe()
697 		dev_warn(cw_bat->dev,  in cw_bat_probe()
701 	cw_bat->battery_workqueue = create_singlethread_workqueue("rk_battery");  in cw_bat_probe()
702 	if (!cw_bat->battery_workqueue)  in cw_bat_probe()
706 							  &cw_bat->battery_delay_work, cw_bat_work);  in cw_bat_probe()
707 	queue_delayed_work(cw_bat->battery_workqueue,  in cw_bat_probe()
708 			   &cw_bat->battery_delay_work, msecs_to_jiffies(10));  in cw_bat_probe()
715 	struct cw_battery *cw_bat = i2c_get_clientdata(client);  in cw_bat_suspend()  local
717 	cancel_delayed_work_sync(&cw_bat->battery_delay_work);  in cw_bat_suspend()
724 	struct cw_battery *cw_bat = i2c_get_clientdata(client);  in cw_bat_resume()  local
726 	queue_delayed_work(cw_bat->battery_workqueue,  in cw_bat_resume()
727 			   &cw_bat->battery_delay_work, 0);  in cw_bat_resume()