SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/power/power_supply_leds.c

   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
  13 #include <linux/power_supply.h>
  14
  15 #include "power_supply.h"
  16
  17 /* Battery specific LEDs triggers. */
  18
  19 static void power_supply_update_bat_leds(struct power_supply *psy)
  20 {
  21         union power_supply_propval status;
  22
  23         if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
  24                 return;
  25
  26         dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, status.intval);
  27
  28         switch (status.intval) {
  29         case POWER_SUPPLY_STATUS_FULL:
  30                 led_trigger_event(psy->charging_full_trig, LED_FULL);
  31                 led_trigger_event(psy->charging_trig, LED_OFF);
  32                 led_trigger_event(psy->full_trig, LED_FULL);
  33                 break;
  34         case POWER_SUPPLY_STATUS_CHARGING:
  35                 led_trigger_event(psy->charging_full_trig, LED_FULL);
  36                 led_trigger_event(psy->charging_trig, LED_FULL);
  37                 led_trigger_event(psy->full_trig, LED_OFF);
  38                 break;
  39         default:
  40                 led_trigger_event(psy->charging_full_trig, LED_OFF);
  41                 led_trigger_event(psy->charging_trig, LED_OFF);
  42                 led_trigger_event(psy->full_trig, LED_OFF);
  43                 break;
  44         }
  45 }
  46
  47 static int power_supply_create_bat_triggers(struct power_supply *psy)
  48 {
  49         int rc = 0;
  50
  51         psy->charging_full_trig_name = kmalloc(strlen(psy->name) +
  52                                   sizeof("-charging-or-full"), GFP_KERNEL);
  53         if (!psy->charging_full_trig_name)
  54                 goto charging_full_failed;
  55
  56         psy->charging_trig_name = kmalloc(strlen(psy->name) +
  57                                           sizeof("-charging"), GFP_KERNEL);
  58         if (!psy->charging_trig_name)
  59                 goto charging_failed;
  60
  61         psy->full_trig_name = kmalloc(strlen(psy->name) +
  62                                       sizeof("-full"), GFP_KERNEL);
  63         if (!psy->full_trig_name)
  64                 goto full_failed;
  65
  66         strcpy(psy->charging_full_trig_name, psy->name);
  67         strcat(psy->charging_full_trig_name, "-charging-or-full");
  68         strcpy(psy->charging_trig_name, psy->name);
  69         strcat(psy->charging_trig_name, "-charging");
  70         strcpy(psy->full_trig_name, psy->name);
  71         strcat(psy->full_trig_name, "-full");
  72
  73         led_trigger_register_simple(psy->charging_full_trig_name,
  74                                     &psy->charging_full_trig);
  75         led_trigger_register_simple(psy->charging_trig_name,
  76                                     &psy->charging_trig);
  77         led_trigger_register_simple(psy->full_trig_name,
  78                                     &psy->full_trig);
  79
  80         goto success;
  81
  82 full_failed:
  83         kfree(psy->charging_trig_name);
  84 charging_failed:
  85         kfree(psy->charging_full_trig_name);
  86 charging_full_failed:
  87         rc = -ENOMEM;
  88 success:
  89         return rc;
  90 }
  91
  92 static void power_supply_remove_bat_triggers(struct power_supply *psy)
  93 {
  94         led_trigger_unregister_simple(psy->charging_full_trig);
  95         led_trigger_unregister_simple(psy->charging_trig);
  96         led_trigger_unregister_simple(psy->full_trig);
  97         kfree(psy->full_trig_name);
  98         kfree(psy->charging_trig_name);
  99         kfree(psy->charging_full_trig_name);
 100 }
 101
 102 /* Generated power specific LEDs triggers. */
 103
 104 static void power_supply_update_gen_leds(struct power_supply *psy)
 105 {
 106         union power_supply_propval online;
 107
 108         if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
 109                 return;
 110
 111         dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, online.intval);
 112
 113         if (online.intval)
 114                 led_trigger_event(psy->online_trig, LED_FULL);
 115         else
 116                 led_trigger_event(psy->online_trig, LED_OFF);
 117 }
 118
 119 static int power_supply_create_gen_triggers(struct power_supply *psy)
 120 {
 121         int rc = 0;
 122
 123         psy->online_trig_name = kmalloc(strlen(psy->name) + sizeof("-online"),
 124                                         GFP_KERNEL);
 125         if (!psy->online_trig_name)
 126                 goto online_failed;
 127
 128         strcpy(psy->online_trig_name, psy->name);
 129         strcat(psy->online_trig_name, "-online");
 130
 131         led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
 132
 133         goto success;
 134
 135 online_failed:
 136         rc = -ENOMEM;
 137 success:
 138         return rc;
 139 }
 140
 141 static void power_supply_remove_gen_triggers(struct power_supply *psy)
 142 {
 143         led_trigger_unregister_simple(psy->online_trig);
 144         kfree(psy->online_trig_name);
 145 }
 146
 147 /* Choice what triggers to create&update. */
 148
 149 void power_supply_update_leds(struct power_supply *psy)
 150 {
 151         if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
 152                 power_supply_update_bat_leds(psy);
 153         else
 154                 power_supply_update_gen_leds(psy);
 155 }
 156
 157 int power_supply_create_triggers(struct power_supply *psy)
 158 {
 159         if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
 160                 return power_supply_create_bat_triggers(psy);
 161         return power_supply_create_gen_triggers(psy);
 162 }
 163
 164 void power_supply_remove_triggers(struct power_supply *psy)
 165 {
 166         if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
 167                 power_supply_remove_bat_triggers(psy);
 168         else
 169                 power_supply_remove_gen_triggers(psy);
 170 }