[deliverable/linux.git] / drivers / power / ipaq_micro_battery.c

/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * h3xxx atmel micro companion support, battery subdevice
 * based on previous kernel 2.4 version
 * Author : Alessandro Gardich <gremlin@gremlin.it>
 * Author : Linus Walleij <linus.walleij@linaro.org>
 *
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/mfd/ipaq-micro.h>
#include <linux/power_supply.h>
#include <linux/workqueue.h>

#define BATT_PERIOD 100000 /* 100 seconds in milliseconds */

#define MICRO_BATT_CHEM_ALKALINE	0x01
#define MICRO_BATT_CHEM_NICD		0x02
#define MICRO_BATT_CHEM_NIMH		0x03
#define MICRO_BATT_CHEM_LION		0x04
#define MICRO_BATT_CHEM_LIPOLY		0x05
#define MICRO_BATT_CHEM_NOT_INSTALLED	0x06
#define MICRO_BATT_CHEM_UNKNOWN		0xff

#define MICRO_BATT_STATUS_HIGH		0x01
#define MICRO_BATT_STATUS_LOW		0x02
#define MICRO_BATT_STATUS_CRITICAL	0x04
#define MICRO_BATT_STATUS_CHARGING	0x08
#define MICRO_BATT_STATUS_CHARGEMAIN	0x10
#define MICRO_BATT_STATUS_DEAD		0x20 /* Battery will not charge */
#define MICRO_BATT_STATUS_NOTINSTALLED	0x20 /* For expansion pack batteries */
#define MICRO_BATT_STATUS_FULL		0x40 /* Battery fully charged */
#define MICRO_BATT_STATUS_NOBATTERY	0x80
#define MICRO_BATT_STATUS_UNKNOWN	0xff

struct micro_battery {
	struct ipaq_micro *micro;
	struct workqueue_struct *wq;
	struct delayed_work update;
	u8 ac;
	u8 chemistry;
	unsigned int voltage;
	u16 temperature;
	u8 flag;
};

static void micro_battery_work(struct work_struct *work)
{
	struct micro_battery *mb = container_of(work,
				struct micro_battery, update.work);
	struct ipaq_micro_msg msg_battery = {
		.id = MSG_BATTERY,
	};
	struct ipaq_micro_msg msg_sensor = {
		.id = MSG_THERMAL_SENSOR,
	};

	/* First send battery message */
	ipaq_micro_tx_msg_sync(mb->micro, &msg_battery);
	if (msg_battery.rx_len < 4)
		pr_info("ERROR");

	/*
	 * Returned message format:
	 * byte 0:   0x00 = Not plugged in
	 *           0x01 = AC adapter plugged in
	 * byte 1:   chemistry
	 * byte 2:   voltage LSB
	 * byte 3:   voltage MSB
	 * byte 4:   flags
	 * byte 5-9: same for battery 2
	 */
	mb->ac = msg_battery.rx_data[0];
	mb->chemistry = msg_battery.rx_data[1];
	mb->voltage = ((((unsigned short)msg_battery.rx_data[3] << 8) +
			msg_battery.rx_data[2]) * 5000L) * 1000 / 1024;
	mb->flag = msg_battery.rx_data[4];

	if (msg_battery.rx_len == 9)
		pr_debug("second battery ignored\n");

	/* Then read the sensor */
	ipaq_micro_tx_msg_sync(mb->micro, &msg_sensor);
	mb->temperature = msg_sensor.rx_data[1] << 8 | msg_sensor.rx_data[0];

	queue_delayed_work(mb->wq, &mb->update, msecs_to_jiffies(BATT_PERIOD));
}

static int get_capacity(struct power_supply *b)
{
	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);

	switch (mb->flag & 0x07) {
	case MICRO_BATT_STATUS_HIGH:
		return 100;
		break;
	case MICRO_BATT_STATUS_LOW:
		return 50;
		break;
	case MICRO_BATT_STATUS_CRITICAL:
		return 5;
		break;
	default:
		break;
	}
	return 0;
}

static int get_status(struct power_supply *b)
{
	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);

	if (mb->flag == MICRO_BATT_STATUS_UNKNOWN)
		return POWER_SUPPLY_STATUS_UNKNOWN;

	if (mb->flag & MICRO_BATT_STATUS_FULL)
		return POWER_SUPPLY_STATUS_FULL;

	if ((mb->flag & MICRO_BATT_STATUS_CHARGING) ||
		(mb->flag & MICRO_BATT_STATUS_CHARGEMAIN))
		return POWER_SUPPLY_STATUS_CHARGING;

	return POWER_SUPPLY_STATUS_DISCHARGING;
}

static int micro_batt_get_property(struct power_supply *b,
					enum power_supply_property psp,
					union power_supply_propval *val)
{
	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);

	switch (psp) {
	case POWER_SUPPLY_PROP_TECHNOLOGY:
		switch (mb->chemistry) {
		case MICRO_BATT_CHEM_NICD:
			val->intval = POWER_SUPPLY_TECHNOLOGY_NiCd;
			break;
		case MICRO_BATT_CHEM_NIMH:
			val->intval = POWER_SUPPLY_TECHNOLOGY_NiMH;
			break;
		case MICRO_BATT_CHEM_LION:
			val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
			break;
		case MICRO_BATT_CHEM_LIPOLY:
			val->intval = POWER_SUPPLY_TECHNOLOGY_LIPO;
			break;
		default:
			val->intval = POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
			break;
		};
		break;
	case POWER_SUPPLY_PROP_STATUS:
		val->intval = get_status(b);
		break;
	case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
		val->intval = 4700000;
		break;
	case POWER_SUPPLY_PROP_CAPACITY:
		val->intval = get_capacity(b);
		break;
	case POWER_SUPPLY_PROP_TEMP:
		val->intval = mb->temperature;
		break;
	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
		val->intval = mb->voltage;
		break;
	default:
		return -EINVAL;
	};

	return 0;
}

static int micro_ac_get_property(struct power_supply *b,
				 enum power_supply_property psp,
				 union power_supply_propval *val)
{
	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);

	switch (psp) {
	case POWER_SUPPLY_PROP_ONLINE:
		val->intval = mb->ac;
		break;
	default:
		return -EINVAL;
	};

	return 0;
}

static enum power_supply_property micro_batt_power_props[] = {
	POWER_SUPPLY_PROP_TECHNOLOGY,
	POWER_SUPPLY_PROP_STATUS,
	POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
	POWER_SUPPLY_PROP_CAPACITY,
	POWER_SUPPLY_PROP_TEMP,
	POWER_SUPPLY_PROP_VOLTAGE_NOW,
};

static const struct power_supply_desc micro_batt_power_desc = {
	.name			= "main-battery",
	.type			= POWER_SUPPLY_TYPE_BATTERY,
	.properties		= micro_batt_power_props,
	.num_properties		= ARRAY_SIZE(micro_batt_power_props),
	.get_property		= micro_batt_get_property,
	.use_for_apm		= 1,
};

static enum power_supply_property micro_ac_power_props[] = {
	POWER_SUPPLY_PROP_ONLINE,
};

static const struct power_supply_desc micro_ac_power_desc = {
	.name			= "ac",
	.type			= POWER_SUPPLY_TYPE_MAINS,
	.properties		= micro_ac_power_props,
	.num_properties		= ARRAY_SIZE(micro_ac_power_props),
	.get_property		= micro_ac_get_property,
};

static struct power_supply *micro_batt_power, *micro_ac_power;

static int micro_batt_probe(struct platform_device *pdev)
{
	struct micro_battery *mb;
	int ret;

	mb = devm_kzalloc(&pdev->dev, sizeof(*mb), GFP_KERNEL);
	if (!mb)
		return -ENOMEM;

	mb->micro = dev_get_drvdata(pdev->dev.parent);
	mb->wq = create_singlethread_workqueue("ipaq-battery-wq");
	if (!mb->wq)
		return -ENOMEM;

	INIT_DELAYED_WORK(&mb->update, micro_battery_work);
	platform_set_drvdata(pdev, mb);
	queue_delayed_work(mb->wq, &mb->update, 1);

	micro_batt_power = power_supply_register(&pdev->dev,
						 &micro_batt_power_desc, NULL);
	if (IS_ERR(micro_batt_power)) {
		ret = PTR_ERR(micro_batt_power);
		goto batt_err;
	}

	micro_ac_power = power_supply_register(&pdev->dev,
					       &micro_ac_power_desc, NULL);
	if (IS_ERR(micro_ac_power)) {
		ret = PTR_ERR(micro_ac_power);
		goto ac_err;
	}

	dev_info(&pdev->dev, "iPAQ micro battery driver\n");
	return 0;

ac_err:
	power_supply_unregister(micro_ac_power);
batt_err:
	cancel_delayed_work_sync(&mb->update);
	destroy_workqueue(mb->wq);
	return ret;
}

static int micro_batt_remove(struct platform_device *pdev)

{
	struct micro_battery *mb = platform_get_drvdata(pdev);

	power_supply_unregister(micro_ac_power);
	power_supply_unregister(micro_batt_power);
	cancel_delayed_work_sync(&mb->update);
	destroy_workqueue(mb->wq);

	return 0;
}

static int __maybe_unused micro_batt_suspend(struct device *dev)
{
	struct micro_battery *mb = dev_get_drvdata(dev);

	cancel_delayed_work_sync(&mb->update);
	return 0;
}

static int __maybe_unused micro_batt_resume(struct device *dev)
{
	struct micro_battery *mb = dev_get_drvdata(dev);

	queue_delayed_work(mb->wq, &mb->update, msecs_to_jiffies(BATT_PERIOD));
	return 0;
}

static const struct dev_pm_ops micro_batt_dev_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(micro_batt_suspend, micro_batt_resume)
};

static struct platform_driver micro_batt_device_driver = {
	.driver		= {
		.name	= "ipaq-micro-battery",
		.pm	= &micro_batt_dev_pm_ops,
	},
	.probe		= micro_batt_probe,
	.remove		= micro_batt_remove,
};
module_platform_driver(micro_batt_device_driver);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("driver for iPAQ Atmel micro battery");
MODULE_ALIAS("platform:battery-ipaq-micro");
Commit	Line	Data
00a588f9 DA	1	/*
	2	* This program is free software; you can redistribute it and/or modify
	3	* it under the terms of the GNU General Public License version 2 as
	4	* published by the Free Software Foundation.
	5	*
	6	* h3xxx atmel micro companion support, battery subdevice
	7	* based on previous kernel 2.4 version
	8	* Author : Alessandro Gardich <gremlin@gremlin.it>
	9	* Author : Linus Walleij <linus.walleij@linaro.org>
	10	*
	11	*/
	12
	13	#include <linux/module.h>
	14	#include <linux/init.h>
	15	#include <linux/platform_device.h>
	16	#include <linux/mfd/ipaq-micro.h>
	17	#include <linux/power_supply.h>
	18	#include <linux/workqueue.h>
	19
	20	#define BATT_PERIOD 100000 /* 100 seconds in milliseconds */
	21
	22	#define MICRO_BATT_CHEM_ALKALINE 0x01
	23	#define MICRO_BATT_CHEM_NICD 0x02
	24	#define MICRO_BATT_CHEM_NIMH 0x03
	25	#define MICRO_BATT_CHEM_LION 0x04
	26	#define MICRO_BATT_CHEM_LIPOLY 0x05
	27	#define MICRO_BATT_CHEM_NOT_INSTALLED 0x06
	28	#define MICRO_BATT_CHEM_UNKNOWN 0xff
	29
	30	#define MICRO_BATT_STATUS_HIGH 0x01
	31	#define MICRO_BATT_STATUS_LOW 0x02
	32	#define MICRO_BATT_STATUS_CRITICAL 0x04
	33	#define MICRO_BATT_STATUS_CHARGING 0x08
	34	#define MICRO_BATT_STATUS_CHARGEMAIN 0x10
	35	#define MICRO_BATT_STATUS_DEAD 0x20 /* Battery will not charge */
	36	#define MICRO_BATT_STATUS_NOTINSTALLED 0x20 /* For expansion pack batteries */
	37	#define MICRO_BATT_STATUS_FULL 0x40 /* Battery fully charged */
	38	#define MICRO_BATT_STATUS_NOBATTERY 0x80
	39	#define MICRO_BATT_STATUS_UNKNOWN 0xff
	40
	41	struct micro_battery {
	42	struct ipaq_micro *micro;
	43	struct workqueue_struct *wq;
	44	struct delayed_work update;
	45	u8 ac;
	46	u8 chemistry;
	47	unsigned int voltage;
	48	u16 temperature;
	49	u8 flag;
	50	};
	51
	52	static void micro_battery_work(struct work_struct *work)
	53	{
	54	struct micro_battery *mb = container_of(work,
	55	struct micro_battery, update.work);
	56	struct ipaq_micro_msg msg_battery = {
	57	.id = MSG_BATTERY,
	58	};
	59	struct ipaq_micro_msg msg_sensor = {
	60	.id = MSG_THERMAL_SENSOR,
	61	};
	62
	63	/* First send battery message */
	64	ipaq_micro_tx_msg_sync(mb->micro, &msg_battery);
65	if (msg_battery.rx_len < 4)
66	pr_info("ERROR");
67
68	/*
69	* Returned message format:
70	* byte 0: 0x00 = Not plugged in
71	* 0x01 = AC adapter plugged in
72	* byte 1: chemistry
73	* byte 2: voltage LSB
74	* byte 3: voltage MSB
75	* byte 4: flags
76	* byte 5-9: same for battery 2
77	*/
78	mb->ac = msg_battery.rx_data[0];
79	mb->chemistry = msg_battery.rx_data[1];
80	mb->voltage = ((((unsigned short)msg_battery.rx_data[3] << 8) +
81	msg_battery.rx_data[2]) * 5000L) * 1000 / 1024;
82	mb->flag = msg_battery.rx_data[4];
83
84	if (msg_battery.rx_len == 9)
85	pr_debug("second battery ignored\n");
86
87	/* Then read the sensor */
88	ipaq_micro_tx_msg_sync(mb->micro, &msg_sensor);
89	mb->temperature = msg_sensor.rx_data[1] << 8 \| msg_sensor.rx_data[0];
90
91	queue_delayed_work(mb->wq, &mb->update, msecs_to_jiffies(BATT_PERIOD));
92	}
93
94	static int get_capacity(struct power_supply *b)
95	{
297d716f	96	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);
00a588f9 DA	97
	98	switch (mb->flag & 0x07) {
	99	case MICRO_BATT_STATUS_HIGH:
	100	return 100;
	101	break;
	102	case MICRO_BATT_STATUS_LOW:
	103	return 50;
	104	break;
	105	case MICRO_BATT_STATUS_CRITICAL:
	106	return 5;
	107	break;
	108	default:
	109	break;
	110	}
	111	return 0;
	112	}
	113
	114	static int get_status(struct power_supply *b)
	115	{
297d716f	116	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);
00a588f9 DA	117
	118	if (mb->flag == MICRO_BATT_STATUS_UNKNOWN)
	119	return POWER_SUPPLY_STATUS_UNKNOWN;
	120
	121	if (mb->flag & MICRO_BATT_STATUS_FULL)
	122	return POWER_SUPPLY_STATUS_FULL;
	123
	124	if ((mb->flag & MICRO_BATT_STATUS_CHARGING) \|\|
	125	(mb->flag & MICRO_BATT_STATUS_CHARGEMAIN))
	126	return POWER_SUPPLY_STATUS_CHARGING;
	127
	128	return POWER_SUPPLY_STATUS_DISCHARGING;
	129	}
	130
	131	static int micro_batt_get_property(struct power_supply *b,
	132	enum power_supply_property psp,
	133	union power_supply_propval *val)
	134	{
297d716f	135	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);
00a588f9 DA	136
	137	switch (psp) {
	138	case POWER_SUPPLY_PROP_TECHNOLOGY:
	139	switch (mb->chemistry) {
	140	case MICRO_BATT_CHEM_NICD:
	141	val->intval = POWER_SUPPLY_TECHNOLOGY_NiCd;
	142	break;
	143	case MICRO_BATT_CHEM_NIMH:
	144	val->intval = POWER_SUPPLY_TECHNOLOGY_NiMH;
	145	break;
	146	case MICRO_BATT_CHEM_LION:
	147	val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
	148	break;
	149	case MICRO_BATT_CHEM_LIPOLY:
	150	val->intval = POWER_SUPPLY_TECHNOLOGY_LIPO;
	151	break;
	152	default:
	153	val->intval = POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
	154	break;
	155	};
	156	break;
	157	case POWER_SUPPLY_PROP_STATUS:
	158	val->intval = get_status(b);
	159	break;
	160	case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
	161	val->intval = 4700000;
	162	break;
	163	case POWER_SUPPLY_PROP_CAPACITY:
	164	val->intval = get_capacity(b);
	165	break;
	166	case POWER_SUPPLY_PROP_TEMP:
	167	val->intval = mb->temperature;
	168	break;
	169	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
	170	val->intval = mb->voltage;
	171	break;
	172	default:
	173	return -EINVAL;
	174	};
	175
	176	return 0;
	177	}
	178
	179	static int micro_ac_get_property(struct power_supply *b,
	180	enum power_supply_property psp,
	181	union power_supply_propval *val)
	182	{
297d716f	183	struct micro_battery *mb = dev_get_drvdata(b->dev.parent);
00a588f9 DA	184
	185	switch (psp) {
	186	case POWER_SUPPLY_PROP_ONLINE:
	187	val->intval = mb->ac;
	188	break;
	189	default:
	190	return -EINVAL;
	191	};
	192
	193	return 0;
	194	}
	195
	196	static enum power_supply_property micro_batt_power_props[] = {
	197	POWER_SUPPLY_PROP_TECHNOLOGY,
	198	POWER_SUPPLY_PROP_STATUS,
	199	POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
	200	POWER_SUPPLY_PROP_CAPACITY,
	201	POWER_SUPPLY_PROP_TEMP,
	202	POWER_SUPPLY_PROP_VOLTAGE_NOW,
	203	};
	204
297d716f	205	static const struct power_supply_desc micro_batt_power_desc = {
00a588f9 DA	206	.name = "main-battery",
	207	.type = POWER_SUPPLY_TYPE_BATTERY,
	208	.properties = micro_batt_power_props,
	209	.num_properties = ARRAY_SIZE(micro_batt_power_props),
	210	.get_property = micro_batt_get_property,
	211	.use_for_apm = 1,
	212	};
	213
	214	static enum power_supply_property micro_ac_power_props[] = {
	215	POWER_SUPPLY_PROP_ONLINE,
	216	};
	217
297d716f	218	static const struct power_supply_desc micro_ac_power_desc = {
00a588f9 DA	219	.name = "ac",
	220	.type = POWER_SUPPLY_TYPE_MAINS,
	221	.properties = micro_ac_power_props,
	222	.num_properties = ARRAY_SIZE(micro_ac_power_props),
	223	.get_property = micro_ac_get_property,
	224	};
	225
297d716f KK	226	static struct power_supply micro_batt_power, micro_ac_power;
297d716f KK	227
00a588f9 DA	228	static int micro_batt_probe(struct platform_device *pdev)
	229	{
	230	struct micro_battery *mb;
a2c1d531	231	int ret;
00a588f9 DA	232
	233	mb = devm_kzalloc(&pdev->dev, sizeof(*mb), GFP_KERNEL);
	234	if (!mb)
	235	return -ENOMEM;
	236
	237	mb->micro = dev_get_drvdata(pdev->dev.parent);
	238	mb->wq = create_singlethread_workqueue("ipaq-battery-wq");
a2c1d531 KK	239	if (!mb->wq)
	240	return -ENOMEM;
	241
00a588f9 DA	242	INIT_DELAYED_WORK(&mb->update, micro_battery_work);
	243	platform_set_drvdata(pdev, mb);
	244	queue_delayed_work(mb->wq, &mb->update, 1);
a2c1d531	245
297d716f KK	246	micro_batt_power = power_supply_register(&pdev->dev,
	247	&micro_batt_power_desc, NULL);
	248	if (IS_ERR(micro_batt_power)) {
	249	ret = PTR_ERR(micro_batt_power);
a2c1d531	250	goto batt_err;
297d716f	251	}
a2c1d531	252
297d716f KK	253	micro_ac_power = power_supply_register(&pdev->dev,
	254	&micro_ac_power_desc, NULL);
	255	if (IS_ERR(micro_ac_power)) {
	256	ret = PTR_ERR(micro_ac_power);
a2c1d531	257	goto ac_err;
297d716f	258	}
00a588f9 DA	259
	260	dev_info(&pdev->dev, "iPAQ micro battery driver\n");
	261	return 0;
a2c1d531 KK	262
a2c1d531 KK	263	ac_err:
297d716f	264	power_supply_unregister(micro_ac_power);
a2c1d531 KK	265	batt_err:
	266	cancel_delayed_work_sync(&mb->update);
	267	destroy_workqueue(mb->wq);
	268	return ret;
00a588f9 DA	269	}
	270
	271	static int micro_batt_remove(struct platform_device *pdev)
	272
	273	{
	274	struct micro_battery *mb = platform_get_drvdata(pdev);
	275
297d716f KK	276	power_supply_unregister(micro_ac_power);
297d716f KK	277	power_supply_unregister(micro_batt_power);
00a588f9	278	cancel_delayed_work_sync(&mb->update);
f852ec46	279	destroy_workqueue(mb->wq);
00a588f9 DA	280
	281	return 0;
	282	}
	283
298cb0f1	284	static int __maybe_unused micro_batt_suspend(struct device *dev)
00a588f9 DA	285	{
	286	struct micro_battery *mb = dev_get_drvdata(dev);
	287
	288	cancel_delayed_work_sync(&mb->update);
	289	return 0;
	290	}
	291
298cb0f1	292	static int __maybe_unused micro_batt_resume(struct device *dev)
00a588f9 DA	293	{
	294	struct micro_battery *mb = dev_get_drvdata(dev);
	295
	296	queue_delayed_work(mb->wq, &mb->update, msecs_to_jiffies(BATT_PERIOD));
	297	return 0;
	298	}
	299
	300	static const struct dev_pm_ops micro_batt_dev_pm_ops = {
	301	SET_SYSTEM_SLEEP_PM_OPS(micro_batt_suspend, micro_batt_resume)
	302	};
	303
5e37195f	304	static struct platform_driver micro_batt_device_driver = {
00a588f9 DA	305	.driver = {
	306	.name = "ipaq-micro-battery",
	307	.pm = &micro_batt_dev_pm_ops,
	308	},
	309	.probe = micro_batt_probe,
	310	.remove = micro_batt_remove,
	311	};
	312	module_platform_driver(micro_batt_device_driver);
	313
	314	MODULE_LICENSE("GPL");
	315	MODULE_DESCRIPTION("driver for iPAQ Atmel micro battery");
	316	MODULE_ALIAS("platform:battery-ipaq-micro");