Branch data     Line data    Source code

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