123 static int ds2760_battery_read_status(struct ds2760_device_info *di)  in ds2760_battery_read_status()  argument
127 	if (di->update_time && time_before(jiffies, di->update_time +  in ds2760_battery_read_status()
133 	if (di->update_time == 0) {  in ds2760_battery_read_status()
141 	ret = w1_ds2760_read(di->w1_dev, di->raw + start, start, count);  in ds2760_battery_read_status()
143 		dev_warn(di->dev, "call to w1_ds2760_read failed (0x%p)\n",  in ds2760_battery_read_status()
144 			 di->w1_dev);  in ds2760_battery_read_status()
148 	di->update_time = jiffies;  in ds2760_battery_read_status()
152 	di->voltage_raw = (di->raw[DS2760_VOLTAGE_MSB] << 3) |  in ds2760_battery_read_status()
153 			  (di->raw[DS2760_VOLTAGE_LSB] >> 5);  in ds2760_battery_read_status()
154 	di->voltage_uV = di->voltage_raw * 4880;  in ds2760_battery_read_status()
158 	di->current_raw =  in ds2760_battery_read_status()
159 	    (((signed char)di->raw[DS2760_CURRENT_MSB]) << 5) |  in ds2760_battery_read_status()
160 			  (di->raw[DS2760_CURRENT_LSB] >> 3);  in ds2760_battery_read_status()
161 	di->current_uA = di->current_raw * 625;  in ds2760_battery_read_status()
164 	di->accum_current_raw =  in ds2760_battery_read_status()
165 	    (((signed char)di->raw[DS2760_CURRENT_ACCUM_MSB]) << 8) |  in ds2760_battery_read_status()
166 			   di->raw[DS2760_CURRENT_ACCUM_LSB];  in ds2760_battery_read_status()
167 	di->accum_current_uAh = di->accum_current_raw * 250;  in ds2760_battery_read_status()
172 	di->temp_raw = (((signed char)di->raw[DS2760_TEMP_MSB]) << 3) |  in ds2760_battery_read_status()
173 				     (di->raw[DS2760_TEMP_LSB] >> 5);  in ds2760_battery_read_status()
174 	di->temp_C = di->temp_raw + (di->temp_raw / 4);  in ds2760_battery_read_status()
178 	if (di->raw[DS2760_RATED_CAPACITY] < ARRAY_SIZE(rated_capacities))  in ds2760_battery_read_status()
179 		di->rated_capacity = rated_capacities[  in ds2760_battery_read_status()
180 			(unsigned int)di->raw[DS2760_RATED_CAPACITY]];  in ds2760_battery_read_status()
182 		di->rated_capacity = di->raw[DS2760_RATED_CAPACITY] * 10;  in ds2760_battery_read_status()
184 	di->rated_capacity *= 1000; /* convert to µAh */  in ds2760_battery_read_status()
187 	di->full_active_uAh = di->raw[DS2760_ACTIVE_FULL] << 8 |  in ds2760_battery_read_status()
188 			      di->raw[DS2760_ACTIVE_FULL + 1];  in ds2760_battery_read_status()
193 	if (di->full_active_uAh == 0)  in ds2760_battery_read_status()
194 		di->full_active_uAh = di->rated_capacity / 1000L;  in ds2760_battery_read_status()
196 	scale[0] = di->full_active_uAh;  in ds2760_battery_read_status()
198 		scale[i] = scale[i - 1] + di->raw[DS2760_ACTIVE_FULL + 1 + i];  in ds2760_battery_read_status()
200 	di->full_active_uAh = battery_interpolate(scale, di->temp_C / 10);  in ds2760_battery_read_status()
201 	di->full_active_uAh *= 1000; /* convert to µAh */  in ds2760_battery_read_status()
204 	scale[4] = di->raw[DS2760_ACTIVE_EMPTY + 4];  in ds2760_battery_read_status()
206 		scale[i] = scale[i + 1] + di->raw[DS2760_ACTIVE_EMPTY + i];  in ds2760_battery_read_status()
208 	di->empty_uAh = battery_interpolate(scale, di->temp_C / 10);  in ds2760_battery_read_status()
209 	di->empty_uAh *= 1000; /* convert to µAh */  in ds2760_battery_read_status()
211 	if (di->full_active_uAh == di->empty_uAh)  in ds2760_battery_read_status()
212 		di->rem_capacity = 0;  in ds2760_battery_read_status()
216 		di->rem_capacity = ((di->accum_current_uAh - di->empty_uAh) * 100L) /  in ds2760_battery_read_status()
217 				    (di->full_active_uAh - di->empty_uAh);  in ds2760_battery_read_status()
219 	if (di->rem_capacity < 0)  in ds2760_battery_read_status()
220 		di->rem_capacity = 0;  in ds2760_battery_read_status()
221 	if (di->rem_capacity > 100)  in ds2760_battery_read_status()
222 		di->rem_capacity = 100;  in ds2760_battery_read_status()
224 	if (di->current_uA < -100L)  in ds2760_battery_read_status()
225 		di->life_sec = -((di->accum_current_uAh - di->empty_uAh) * 36L)  in ds2760_battery_read_status()
226 					/ (di->current_uA / 100L);  in ds2760_battery_read_status()
228 		di->life_sec = 0;  in ds2760_battery_read_status()
233 static void ds2760_battery_set_current_accum(struct ds2760_device_info *di,  in ds2760_battery_set_current_accum()  argument
245 	if (w1_ds2760_write(di->w1_dev, acr, DS2760_CURRENT_ACCUM_MSB, 2) < 2)  in ds2760_battery_set_current_accum()
246 		dev_warn(di->dev, "ACR write failed\n");  in ds2760_battery_set_current_accum()
249 static void ds2760_battery_update_status(struct ds2760_device_info *di)  in ds2760_battery_update_status()  argument
251 	int old_charge_status = di->charge_status;  in ds2760_battery_update_status()
253 	ds2760_battery_read_status(di);  in ds2760_battery_update_status()
255 	if (di->charge_status == POWER_SUPPLY_STATUS_UNKNOWN)  in ds2760_battery_update_status()
256 		di->full_counter = 0;  in ds2760_battery_update_status()
258 	if (power_supply_am_i_supplied(di->bat)) {  in ds2760_battery_update_status()
259 		if (di->current_uA > 10000) {  in ds2760_battery_update_status()
260 			di->charge_status = POWER_SUPPLY_STATUS_CHARGING;  in ds2760_battery_update_status()
261 			di->full_counter = 0;  in ds2760_battery_update_status()
262 		} else if (di->current_uA < -5000) {  in ds2760_battery_update_status()
263 			if (di->charge_status != POWER_SUPPLY_STATUS_NOT_CHARGING)  in ds2760_battery_update_status()
264 				dev_notice(di->dev, "not enough power to "  in ds2760_battery_update_status()
266 			di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;  in ds2760_battery_update_status()
267 			di->full_counter = 0;  in ds2760_battery_update_status()
268 		} else if (di->current_uA < 10000 &&  in ds2760_battery_update_status()
269 			    di->charge_status != POWER_SUPPLY_STATUS_FULL) {  in ds2760_battery_update_status()
275 			di->full_counter++;  in ds2760_battery_update_status()
277 			if (di->full_counter < 2) {  in ds2760_battery_update_status()
278 				di->charge_status = POWER_SUPPLY_STATUS_CHARGING;  in ds2760_battery_update_status()
280 				di->charge_status = POWER_SUPPLY_STATUS_FULL;  in ds2760_battery_update_status()
281 				ds2760_battery_set_current_accum(di,  in ds2760_battery_update_status()
282 						di->full_active_uAh);  in ds2760_battery_update_status()
286 		di->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;  in ds2760_battery_update_status()
287 		di->full_counter = 0;  in ds2760_battery_update_status()
290 	if (di->charge_status != old_charge_status)  in ds2760_battery_update_status()
291 		power_supply_changed(di->bat);  in ds2760_battery_update_status()
294 static void ds2760_battery_write_status(struct ds2760_device_info *di,  in ds2760_battery_write_status()  argument
297 	if (status == di->raw[DS2760_STATUS_REG])  in ds2760_battery_write_status()
300 	w1_ds2760_write(di->w1_dev, &status, DS2760_STATUS_WRITE_REG, 1);  in ds2760_battery_write_status()
301 	w1_ds2760_store_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK1);  in ds2760_battery_write_status()
302 	w1_ds2760_recall_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK1);  in ds2760_battery_write_status()
305 static void ds2760_battery_write_rated_capacity(struct ds2760_device_info *di,  in ds2760_battery_write_rated_capacity()  argument
308 	if (rated_capacity == di->raw[DS2760_RATED_CAPACITY])  in ds2760_battery_write_rated_capacity()
311 	w1_ds2760_write(di->w1_dev, &rated_capacity, DS2760_RATED_CAPACITY, 1);  in ds2760_battery_write_rated_capacity()
312 	w1_ds2760_store_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK1);  in ds2760_battery_write_rated_capacity()
313 	w1_ds2760_recall_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK1);  in ds2760_battery_write_rated_capacity()
316 static void ds2760_battery_write_active_full(struct ds2760_device_info *di,  in ds2760_battery_write_active_full()  argument
324 	if (tmp[0] == di->raw[DS2760_ACTIVE_FULL] &&  in ds2760_battery_write_active_full()
325 	    tmp[1] == di->raw[DS2760_ACTIVE_FULL + 1])  in ds2760_battery_write_active_full()
328 	w1_ds2760_write(di->w1_dev, tmp, DS2760_ACTIVE_FULL, sizeof(tmp));  in ds2760_battery_write_active_full()
329 	w1_ds2760_store_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK0);  in ds2760_battery_write_active_full()
330 	w1_ds2760_recall_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK0);  in ds2760_battery_write_active_full()
334 	di->raw[DS2760_ACTIVE_FULL] = tmp[0];  in ds2760_battery_write_active_full()
335 	di->raw[DS2760_ACTIVE_FULL + 1] = tmp[1];  in ds2760_battery_write_active_full()
340 	struct ds2760_device_info *di = container_of(work,  in ds2760_battery_work()  local
344 	dev_dbg(di->dev, "%s\n", __func__);  in ds2760_battery_work()
346 	ds2760_battery_update_status(di);  in ds2760_battery_work()
347 	queue_delayed_work(di->monitor_wqueue, &di->monitor_work, interval);  in ds2760_battery_work()
352 	struct ds2760_device_info *di = power_supply_get_drvdata(psy);  in ds2760_battery_external_power_changed()  local
354 	dev_dbg(di->dev, "%s\n", __func__);  in ds2760_battery_external_power_changed()
356 	mod_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ/10);  in ds2760_battery_external_power_changed()
363 	struct ds2760_device_info *di = container_of(work,  in ds2760_battery_set_charged_work()  local
366 	dev_dbg(di->dev, "%s\n", __func__);  in ds2760_battery_set_charged_work()
368 	ds2760_battery_read_status(di);  in ds2760_battery_set_charged_work()
378 	if (!power_supply_am_i_supplied(di->bat))  in ds2760_battery_set_charged_work()
381 	bias = (signed char) di->current_raw +  in ds2760_battery_set_charged_work()
382 		(signed char) di->raw[DS2760_CURRENT_OFFSET_BIAS];  in ds2760_battery_set_charged_work()
384 	dev_dbg(di->dev, "%s: bias = %d\n", __func__, bias);  in ds2760_battery_set_charged_work()
386 	w1_ds2760_write(di->w1_dev, &bias, DS2760_CURRENT_OFFSET_BIAS, 1);  in ds2760_battery_set_charged_work()
387 	w1_ds2760_store_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK1);  in ds2760_battery_set_charged_work()
388 	w1_ds2760_recall_eeprom(di->w1_dev, DS2760_EEPROM_BLOCK1);  in ds2760_battery_set_charged_work()
392 	di->raw[DS2760_CURRENT_OFFSET_BIAS] = bias;  in ds2760_battery_set_charged_work()
397 	struct ds2760_device_info *di = power_supply_get_drvdata(psy);  in ds2760_battery_set_charged()  local
401 	mod_delayed_work(di->monitor_wqueue, &di->set_charged_work, HZ * 20);  in ds2760_battery_set_charged()
408 	struct ds2760_device_info *di = power_supply_get_drvdata(psy);  in ds2760_battery_get_property()  local
412 		val->intval = di->charge_status;  in ds2760_battery_get_property()
418 	ds2760_battery_read_status(di);  in ds2760_battery_get_property()
422 		val->intval = di->voltage_uV;  in ds2760_battery_get_property()
425 		val->intval = di->current_uA;  in ds2760_battery_get_property()
428 		val->intval = di->rated_capacity;  in ds2760_battery_get_property()
431 		val->intval = di->full_active_uAh;  in ds2760_battery_get_property()
434 		val->intval = di->empty_uAh;  in ds2760_battery_get_property()
437 		val->intval = di->accum_current_uAh;  in ds2760_battery_get_property()
440 		val->intval = di->temp_C;  in ds2760_battery_get_property()
443 		val->intval = di->life_sec;  in ds2760_battery_get_property()
446 		val->intval = di->rem_capacity;  in ds2760_battery_get_property()
459 	struct ds2760_device_info *di = power_supply_get_drvdata(psy);  in ds2760_battery_set_property()  local
464 		ds2760_battery_write_active_full(di, val->intval / 1000L);  in ds2760_battery_set_property()
469 		ds2760_battery_set_current_accum(di, val->intval);  in ds2760_battery_set_property()
512 	struct ds2760_device_info *di;  in ds2760_battery_probe()  local
514 	di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);  in ds2760_battery_probe()
515 	if (!di) {  in ds2760_battery_probe()
520 	platform_set_drvdata(pdev, di);  in ds2760_battery_probe()
522 	di->dev				= &pdev->dev;  in ds2760_battery_probe()
523 	di->w1_dev			= pdev->dev.parent;  in ds2760_battery_probe()
524 	di->bat_desc.name		= dev_name(&pdev->dev);  in ds2760_battery_probe()
525 	di->bat_desc.type		= POWER_SUPPLY_TYPE_BATTERY;  in ds2760_battery_probe()
526 	di->bat_desc.properties		= ds2760_battery_props;  in ds2760_battery_probe()
527 	di->bat_desc.num_properties	= ARRAY_SIZE(ds2760_battery_props);  in ds2760_battery_probe()
528 	di->bat_desc.get_property	= ds2760_battery_get_property;  in ds2760_battery_probe()
529 	di->bat_desc.set_property	= ds2760_battery_set_property;  in ds2760_battery_probe()
530 	di->bat_desc.property_is_writeable =  in ds2760_battery_probe()
532 	di->bat_desc.set_charged	= ds2760_battery_set_charged;  in ds2760_battery_probe()
533 	di->bat_desc.external_power_changed =  in ds2760_battery_probe()
536 	psy_cfg.drv_data		= di;  in ds2760_battery_probe()
538 	di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;  in ds2760_battery_probe()
541 	ds2760_battery_read_status(di);  in ds2760_battery_probe()
542 	status = di->raw[DS2760_STATUS_REG];  in ds2760_battery_probe()
548 	ds2760_battery_write_status(di, status);  in ds2760_battery_probe()
552 		ds2760_battery_write_rated_capacity(di, rated_capacity);  in ds2760_battery_probe()
557 		ds2760_battery_set_current_accum(di, current_accum);  in ds2760_battery_probe()
559 	di->bat = power_supply_register(&pdev->dev, &di->bat_desc, &psy_cfg);  in ds2760_battery_probe()
560 	if (IS_ERR(di->bat)) {  in ds2760_battery_probe()
561 		dev_err(di->dev, "failed to register battery\n");  in ds2760_battery_probe()
562 		retval = PTR_ERR(di->bat);  in ds2760_battery_probe()
566 	INIT_DELAYED_WORK(&di->monitor_work, ds2760_battery_work);  in ds2760_battery_probe()
567 	INIT_DELAYED_WORK(&di->set_charged_work,  in ds2760_battery_probe()
569 	di->monitor_wqueue = create_singlethread_workqueue(dev_name(&pdev->dev));  in ds2760_battery_probe()
570 	if (!di->monitor_wqueue) {  in ds2760_battery_probe()
574 	queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ * 1);  in ds2760_battery_probe()
579 	power_supply_unregister(di->bat);  in ds2760_battery_probe()
588 	struct ds2760_device_info *di = platform_get_drvdata(pdev);  in ds2760_battery_remove()  local
590 	cancel_delayed_work_sync(&di->monitor_work);  in ds2760_battery_remove()
591 	cancel_delayed_work_sync(&di->set_charged_work);  in ds2760_battery_remove()
592 	destroy_workqueue(di->monitor_wqueue);  in ds2760_battery_remove()
593 	power_supply_unregister(di->bat);  in ds2760_battery_remove()
603 	struct ds2760_device_info *di = platform_get_drvdata(pdev);  in ds2760_battery_suspend()  local
605 	di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;  in ds2760_battery_suspend()
612 	struct ds2760_device_info *di = platform_get_drvdata(pdev);  in ds2760_battery_resume()  local
614 	di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;  in ds2760_battery_resume()
615 	power_supply_changed(di->bat);  in ds2760_battery_resume()
617 	mod_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ);  in ds2760_battery_resume()