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