[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / power / power_supply_leds.c

/*
 *  LEDs triggers for power supply class
 *
 *  Copyright © 2007  Anton Vorontsov <cbou@mail.ru>
 *  Copyright © 2004  Szabolcs Gyurko
 *  Copyright © 2003  Ian Molton <spyro@f2s.com>
 *
 *  Modified: 2004, Oct     Szabolcs Gyurko
 *
 *  You may use this code as per GPL version 2
 */

#include <linux/kernel.h>
#include <linux/power_supply.h>

#include "power_supply.h"

/* Battery specific LEDs triggers. */

static void power_supply_update_bat_leds(struct power_supply *psy)
{
	union power_supply_propval status;

	if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
		return;

	dev_dbg(psy->dev, "%s %d\n", __func__, status.intval);

	switch (status.intval) {
	case POWER_SUPPLY_STATUS_FULL:
		led_trigger_event(psy->charging_full_trig, LED_FULL);
		led_trigger_event(psy->charging_trig, LED_OFF);
		led_trigger_event(psy->full_trig, LED_FULL);
		break;
	case POWER_SUPPLY_STATUS_CHARGING:
		led_trigger_event(psy->charging_full_trig, LED_FULL);
		led_trigger_event(psy->charging_trig, LED_FULL);
		led_trigger_event(psy->full_trig, LED_OFF);
		break;
	default:
		led_trigger_event(psy->charging_full_trig, LED_OFF);
		led_trigger_event(psy->charging_trig, LED_OFF);
		led_trigger_event(psy->full_trig, LED_OFF);
		break;
	}
}

static int power_supply_create_bat_triggers(struct power_supply *psy)
{
	int rc = 0;

	psy->charging_full_trig_name = kasprintf(GFP_KERNEL,
					"%s-charging-or-full", psy->name);
	if (!psy->charging_full_trig_name)
		goto charging_full_failed;

	psy->charging_trig_name = kasprintf(GFP_KERNEL,
					"%s-charging", psy->name);
	if (!psy->charging_trig_name)
		goto charging_failed;

	psy->full_trig_name = kasprintf(GFP_KERNEL, "%s-full", psy->name);
	if (!psy->full_trig_name)
		goto full_failed;

	led_trigger_register_simple(psy->charging_full_trig_name,
				    &psy->charging_full_trig);
	led_trigger_register_simple(psy->charging_trig_name,
				    &psy->charging_trig);
	led_trigger_register_simple(psy->full_trig_name,
				    &psy->full_trig);

	goto success;

full_failed:
	kfree(psy->charging_trig_name);
charging_failed:
	kfree(psy->charging_full_trig_name);
charging_full_failed:
	rc = -ENOMEM;
success:
	return rc;
}

static void power_supply_remove_bat_triggers(struct power_supply *psy)
{
	led_trigger_unregister_simple(psy->charging_full_trig);
	led_trigger_unregister_simple(psy->charging_trig);
	led_trigger_unregister_simple(psy->full_trig);
	kfree(psy->full_trig_name);
	kfree(psy->charging_trig_name);
	kfree(psy->charging_full_trig_name);
}

/* Generated power specific LEDs triggers. */

static void power_supply_update_gen_leds(struct power_supply *psy)
{
	union power_supply_propval online;

	if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
		return;

	dev_dbg(psy->dev, "%s %d\n", __func__, online.intval);

	if (online.intval)
		led_trigger_event(psy->online_trig, LED_FULL);
	else
		led_trigger_event(psy->online_trig, LED_OFF);
}

static int power_supply_create_gen_triggers(struct power_supply *psy)
{
	int rc = 0;

	psy->online_trig_name = kasprintf(GFP_KERNEL, "%s-online", psy->name);
	if (!psy->online_trig_name)
		goto online_failed;

	led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);

	goto success;

online_failed:
	rc = -ENOMEM;
success:
	return rc;
}

static void power_supply_remove_gen_triggers(struct power_supply *psy)
{
	led_trigger_unregister_simple(psy->online_trig);
	kfree(psy->online_trig_name);
}

/* Choice what triggers to create&update. */

void power_supply_update_leds(struct power_supply *psy)
{
	if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
		power_supply_update_bat_leds(psy);
	else
		power_supply_update_gen_leds(psy);
}

int power_supply_create_triggers(struct power_supply *psy)
{
	if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
		return power_supply_create_bat_triggers(psy);
	return power_supply_create_gen_triggers(psy);
}

void power_supply_remove_triggers(struct power_supply *psy)
{
	if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
		power_supply_remove_bat_triggers(psy);
	else
		power_supply_remove_gen_triggers(psy);
}
Commit	Line	Data
4a11b59d AV	1	/*
	2	* LEDs triggers for power supply class
	3	*
	4	* Copyright © 2007 Anton Vorontsov <cbou@mail.ru>
	5	* Copyright © 2004 Szabolcs Gyurko
	6	* Copyright © 2003 Ian Molton <spyro@f2s.com>
	7	*
	8	* Modified: 2004, Oct Szabolcs Gyurko
	9	*
	10	* You may use this code as per GPL version 2
	11	*/
	12
4d24473c	13	#include <linux/kernel.h>
4a11b59d AV	14	#include <linux/power_supply.h>
4a11b59d AV	15
25f12141 AB	16	#include "power_supply.h"
25f12141 AB	17
4a11b59d AV	18	/* Battery specific LEDs triggers. */
	19
	20	static void power_supply_update_bat_leds(struct power_supply *psy)
	21	{
	22	union power_supply_propval status;
	23
	24	if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
	25	return;
	26
0cddc0a9	27	dev_dbg(psy->dev, "%s %d\n", __func__, status.intval);
4a11b59d AV	28
	29	switch (status.intval) {
	30	case POWER_SUPPLY_STATUS_FULL:
	31	led_trigger_event(psy->charging_full_trig, LED_FULL);
	32	led_trigger_event(psy->charging_trig, LED_OFF);
	33	led_trigger_event(psy->full_trig, LED_FULL);
	34	break;
	35	case POWER_SUPPLY_STATUS_CHARGING:
	36	led_trigger_event(psy->charging_full_trig, LED_FULL);
	37	led_trigger_event(psy->charging_trig, LED_FULL);
	38	led_trigger_event(psy->full_trig, LED_OFF);
	39	break;
	40	default:
	41	led_trigger_event(psy->charging_full_trig, LED_OFF);
	42	led_trigger_event(psy->charging_trig, LED_OFF);
	43	led_trigger_event(psy->full_trig, LED_OFF);
	44	break;
	45	}
4a11b59d AV	46	}
	47
	48	static int power_supply_create_bat_triggers(struct power_supply *psy)
	49	{
	50	int rc = 0;
	51
4d24473c AM	52	psy->charging_full_trig_name = kasprintf(GFP_KERNEL,
4d24473c AM	53	"%s-charging-or-full", psy->name);
4a11b59d AV	54	if (!psy->charging_full_trig_name)
	55	goto charging_full_failed;
	56
4d24473c AM	57	psy->charging_trig_name = kasprintf(GFP_KERNEL,
4d24473c AM	58	"%s-charging", psy->name);
4a11b59d AV	59	if (!psy->charging_trig_name)
	60	goto charging_failed;
	61
4d24473c	62	psy->full_trig_name = kasprintf(GFP_KERNEL, "%s-full", psy->name);
4a11b59d AV	63	if (!psy->full_trig_name)
	64	goto full_failed;
	65
4a11b59d AV	66	led_trigger_register_simple(psy->charging_full_trig_name,
	67	&psy->charging_full_trig);
	68	led_trigger_register_simple(psy->charging_trig_name,
	69	&psy->charging_trig);
	70	led_trigger_register_simple(psy->full_trig_name,
	71	&psy->full_trig);
	72
	73	goto success;
	74
	75	full_failed:
	76	kfree(psy->charging_trig_name);
	77	charging_failed:
	78	kfree(psy->charging_full_trig_name);
	79	charging_full_failed:
	80	rc = -ENOMEM;
	81	success:
	82	return rc;
	83	}
	84
	85	static void power_supply_remove_bat_triggers(struct power_supply *psy)
	86	{
	87	led_trigger_unregister_simple(psy->charging_full_trig);
	88	led_trigger_unregister_simple(psy->charging_trig);
	89	led_trigger_unregister_simple(psy->full_trig);
	90	kfree(psy->full_trig_name);
	91	kfree(psy->charging_trig_name);
	92	kfree(psy->charging_full_trig_name);
4a11b59d AV	93	}
	94
	95	/* Generated power specific LEDs triggers. */
	96
	97	static void power_supply_update_gen_leds(struct power_supply *psy)
	98	{
	99	union power_supply_propval online;
	100
	101	if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
	102	return;
	103
0cddc0a9	104	dev_dbg(psy->dev, "%s %d\n", __func__, online.intval);
4a11b59d AV	105
	106	if (online.intval)
	107	led_trigger_event(psy->online_trig, LED_FULL);
	108	else
	109	led_trigger_event(psy->online_trig, LED_OFF);
4a11b59d AV	110	}
	111
	112	static int power_supply_create_gen_triggers(struct power_supply *psy)
	113	{
	114	int rc = 0;
	115
4d24473c	116	psy->online_trig_name = kasprintf(GFP_KERNEL, "%s-online", psy->name);
4a11b59d AV	117	if (!psy->online_trig_name)
	118	goto online_failed;
	119
4a11b59d AV	120	led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
	121
	122	goto success;
	123
	124	online_failed:
	125	rc = -ENOMEM;
	126	success:
	127	return rc;
	128	}
	129
	130	static void power_supply_remove_gen_triggers(struct power_supply *psy)
	131	{
	132	led_trigger_unregister_simple(psy->online_trig);
	133	kfree(psy->online_trig_name);
4a11b59d AV	134	}
	135
	136	/* Choice what triggers to create&update. */
	137
	138	void power_supply_update_leds(struct power_supply *psy)
	139	{
	140	if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
	141	power_supply_update_bat_leds(psy);
	142	else
	143	power_supply_update_gen_leds(psy);
4a11b59d AV	144	}
	145
	146	int power_supply_create_triggers(struct power_supply *psy)
	147	{
	148	if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
	149	return power_supply_create_bat_triggers(psy);
	150	return power_supply_create_gen_triggers(psy);
	151	}
	152
	153	void power_supply_remove_triggers(struct power_supply *psy)
	154	{
	155	if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
	156	power_supply_remove_bat_triggers(psy);
	157	else
	158	power_supply_remove_gen_triggers(psy);
4a11b59d	159	}