Branch data     Line data    Source code

       1                 :            : // SPDX-License-Identifier: GPL-2.0-only
       2                 :            : /*
       3                 :            :  * LED Triggers Core
       4                 :            :  *
       5                 :            :  * Copyright 2005-2007 Openedhand Ltd.
       6                 :            :  *
       7                 :            :  * Author: Richard Purdie <rpurdie@openedhand.com>
       8                 :            :  */
       9                 :            : 
      10                 :            : #include <linux/export.h>
      11                 :            : #include <linux/kernel.h>
      12                 :            : #include <linux/list.h>
      13                 :            : #include <linux/spinlock.h>
      14                 :            : #include <linux/device.h>
      15                 :            : #include <linux/timer.h>
      16                 :            : #include <linux/rwsem.h>
      17                 :            : #include <linux/leds.h>
      18                 :            : #include <linux/slab.h>
      19                 :            : #include <linux/mm.h>
      20                 :            : #include "leds.h"
      21                 :            : 
      22                 :            : /*
      23                 :            :  * Nests outside led_cdev->trigger_lock
      24                 :            :  */
      25                 :            : static DECLARE_RWSEM(triggers_list_lock);
      26                 :            : LIST_HEAD(trigger_list);
      27                 :            : 
      28                 :            :  /* Used by LED Class */
      29                 :            : 
      30                 :          0 : ssize_t led_trigger_write(struct file *filp, struct kobject *kobj,
      31                 :            :                           struct bin_attribute *bin_attr, char *buf,
      32                 :            :                           loff_t pos, size_t count)
      33                 :            : {
      34                 :          0 :         struct device *dev = kobj_to_dev(kobj);
      35                 :          0 :         struct led_classdev *led_cdev = dev_get_drvdata(dev);
      36                 :          0 :         struct led_trigger *trig;
      37                 :          0 :         int ret = count;
      38                 :            : 
      39                 :          0 :         mutex_lock(&led_cdev->led_access);
      40                 :            : 
      41         [ #  # ]:          0 :         if (led_sysfs_is_disabled(led_cdev)) {
      42                 :          0 :                 ret = -EBUSY;
      43                 :          0 :                 goto unlock;
      44                 :            :         }
      45                 :            : 
      46         [ #  # ]:          0 :         if (sysfs_streq(buf, "none")) {
      47                 :          0 :                 led_trigger_remove(led_cdev);
      48                 :          0 :                 goto unlock;
      49                 :            :         }
      50                 :            : 
      51                 :          0 :         down_read(&triggers_list_lock);
      52         [ #  # ]:          0 :         list_for_each_entry(trig, &trigger_list, next_trig) {
      53         [ #  # ]:          0 :                 if (sysfs_streq(buf, trig->name)) {
      54                 :          0 :                         down_write(&led_cdev->trigger_lock);
      55                 :          0 :                         led_trigger_set(led_cdev, trig);
      56                 :          0 :                         up_write(&led_cdev->trigger_lock);
      57                 :            : 
      58                 :          0 :                         up_read(&triggers_list_lock);
      59                 :          0 :                         goto unlock;
      60                 :            :                 }
      61                 :            :         }
      62                 :            :         /* we come here only if buf matches no trigger */
      63                 :          0 :         ret = -EINVAL;
      64                 :          0 :         up_read(&triggers_list_lock);
      65                 :            : 
      66                 :          0 : unlock:
      67                 :          0 :         mutex_unlock(&led_cdev->led_access);
      68                 :          0 :         return ret;
      69                 :            : }
      70                 :            : EXPORT_SYMBOL_GPL(led_trigger_write);
      71                 :            : 
      72                 :            : __printf(3, 4)
      73                 :          0 : static int led_trigger_snprintf(char *buf, ssize_t size, const char *fmt, ...)
      74                 :            : {
      75                 :          0 :         va_list args;
      76                 :          0 :         int i;
      77                 :            : 
      78                 :          0 :         va_start(args, fmt);
      79         [ #  # ]:          0 :         if (size <= 0)
      80                 :          0 :                 i = vsnprintf(NULL, 0, fmt, args);
      81                 :            :         else
      82                 :          0 :                 i = vscnprintf(buf, size, fmt, args);
      83                 :          0 :         va_end(args);
      84                 :            : 
      85                 :          0 :         return i;
      86                 :            : }
      87                 :            : 
      88                 :            : static int led_trigger_format(char *buf, size_t size,
      89                 :            :                               struct led_classdev *led_cdev)
      90                 :            : {
      91                 :            :         struct led_trigger *trig;
      92                 :            :         int len = led_trigger_snprintf(buf, size, "%s",
      93                 :            :                                        led_cdev->trigger ? "none" : "[none]");
      94                 :            : 
      95                 :            :         list_for_each_entry(trig, &trigger_list, next_trig) {
      96                 :            :                 bool hit = led_cdev->trigger &&
      97                 :            :                         !strcmp(led_cdev->trigger->name, trig->name);
      98                 :            : 
      99                 :            :                 len += led_trigger_snprintf(buf + len, size - len,
     100                 :            :                                             " %s%s%s", hit ? "[" : "",
     101                 :            :                                             trig->name, hit ? "]" : "");
     102                 :            :         }
     103                 :            : 
     104                 :            :         len += led_trigger_snprintf(buf + len, size - len, "\n");
     105                 :            : 
     106                 :            :         return len;
     107                 :            : }
     108                 :            : 
     109                 :            : /*
     110                 :            :  * It was stupid to create 10000 cpu triggers, but we are stuck with it now.
     111                 :            :  * Don't make that mistake again. We work around it here by creating binary
     112                 :            :  * attribute, which is not limited by length. This is _not_ good design, do not
     113                 :            :  * copy it.
     114                 :            :  */
     115                 :          0 : ssize_t led_trigger_read(struct file *filp, struct kobject *kobj,
     116                 :            :                         struct bin_attribute *attr, char *buf,
     117                 :            :                         loff_t pos, size_t count)
     118                 :            : {
     119                 :          0 :         struct device *dev = kobj_to_dev(kobj);
     120                 :          0 :         struct led_classdev *led_cdev = dev_get_drvdata(dev);
     121                 :          0 :         void *data;
     122                 :          0 :         int len;
     123                 :            : 
     124                 :          0 :         down_read(&triggers_list_lock);
     125                 :          0 :         down_read(&led_cdev->trigger_lock);
     126                 :            : 
     127                 :          0 :         len = led_trigger_format(NULL, 0, led_cdev);
     128                 :          0 :         data = kvmalloc(len + 1, GFP_KERNEL);
     129         [ #  # ]:          0 :         if (!data) {
     130                 :          0 :                 up_read(&led_cdev->trigger_lock);
     131                 :          0 :                 up_read(&triggers_list_lock);
     132                 :          0 :                 return -ENOMEM;
     133                 :            :         }
     134                 :          0 :         len = led_trigger_format(data, len + 1, led_cdev);
     135                 :            : 
     136                 :          0 :         up_read(&led_cdev->trigger_lock);
     137                 :          0 :         up_read(&triggers_list_lock);
     138                 :            : 
     139                 :          0 :         len = memory_read_from_buffer(buf, count, &pos, data, len);
     140                 :            : 
     141                 :          0 :         kvfree(data);
     142                 :            : 
     143                 :          0 :         return len;
     144                 :            : }
     145                 :            : EXPORT_SYMBOL_GPL(led_trigger_read);
     146                 :            : 
     147                 :            : /* Caller must ensure led_cdev->trigger_lock held */
     148                 :         96 : int led_trigger_set(struct led_classdev *led_cdev, struct led_trigger *trig)
     149                 :            : {
     150                 :         96 :         unsigned long flags;
     151                 :         96 :         char *event = NULL;
     152                 :         96 :         char *envp[2];
     153                 :         96 :         const char *name;
     154                 :         96 :         int ret;
     155                 :            : 
     156   [ +  -  +  - ]:         96 :         if (!led_cdev->trigger && !trig)
     157                 :            :                 return 0;
     158                 :            : 
     159         [ +  - ]:         96 :         name = trig ? trig->name : "none";
     160                 :         96 :         event = kasprintf(GFP_KERNEL, "TRIGGER=%s", name);
     161                 :            : 
     162                 :            :         /* Remove any existing trigger */
     163         [ -  + ]:         96 :         if (led_cdev->trigger) {
     164                 :          0 :                 write_lock_irqsave(&led_cdev->trigger->leddev_list_lock, flags);
     165                 :          0 :                 list_del(&led_cdev->trig_list);
     166                 :          0 :                 write_unlock_irqrestore(&led_cdev->trigger->leddev_list_lock,
     167                 :            :                         flags);
     168                 :          0 :                 cancel_work_sync(&led_cdev->set_brightness_work);
     169                 :          0 :                 led_stop_software_blink(led_cdev);
     170         [ #  # ]:          0 :                 if (led_cdev->trigger->deactivate)
     171                 :          0 :                         led_cdev->trigger->deactivate(led_cdev);
     172                 :          0 :                 device_remove_groups(led_cdev->dev, led_cdev->trigger->groups);
     173                 :          0 :                 led_cdev->trigger = NULL;
     174                 :          0 :                 led_cdev->trigger_data = NULL;
     175                 :          0 :                 led_cdev->activated = false;
     176                 :          0 :                 led_set_brightness(led_cdev, LED_OFF);
     177                 :            :         }
     178         [ +  - ]:         96 :         if (trig) {
     179                 :         96 :                 write_lock_irqsave(&trig->leddev_list_lock, flags);
     180                 :         96 :                 list_add_tail(&led_cdev->trig_list, &trig->led_cdevs);
     181                 :         96 :                 write_unlock_irqrestore(&trig->leddev_list_lock, flags);
     182                 :         96 :                 led_cdev->trigger = trig;
     183                 :            : 
     184         [ +  - ]:         96 :                 if (trig->activate)
     185                 :         96 :                         ret = trig->activate(led_cdev);
     186                 :            :                 else
     187                 :            :                         ret = 0;
     188                 :            : 
     189         [ -  + ]:         96 :                 if (ret)
     190                 :          0 :                         goto err_activate;
     191                 :            : 
     192                 :         96 :                 ret = device_add_groups(led_cdev->dev, trig->groups);
     193         [ -  + ]:         96 :                 if (ret) {
     194                 :          0 :                         dev_err(led_cdev->dev, "Failed to add trigger attributes\n");
     195                 :          0 :                         goto err_add_groups;
     196                 :            :                 }
     197                 :            :         }
     198                 :            : 
     199         [ +  - ]:         96 :         if (event) {
     200                 :         96 :                 envp[0] = event;
     201                 :         96 :                 envp[1] = NULL;
     202         [ -  + ]:         96 :                 if (kobject_uevent_env(&led_cdev->dev->kobj, KOBJ_CHANGE, envp))
     203                 :          0 :                         dev_err(led_cdev->dev,
     204                 :            :                                 "%s: Error sending uevent\n", __func__);
     205                 :         96 :                 kfree(event);
     206                 :            :         }
     207                 :            : 
     208                 :            :         return 0;
     209                 :            : 
     210                 :            : err_add_groups:
     211                 :            : 
     212         [ #  # ]:          0 :         if (trig->deactivate)
     213                 :          0 :                 trig->deactivate(led_cdev);
     214                 :          0 : err_activate:
     215                 :            : 
     216                 :          0 :         write_lock_irqsave(&led_cdev->trigger->leddev_list_lock, flags);
     217                 :          0 :         list_del(&led_cdev->trig_list);
     218                 :          0 :         write_unlock_irqrestore(&led_cdev->trigger->leddev_list_lock, flags);
     219                 :          0 :         led_cdev->trigger = NULL;
     220                 :          0 :         led_cdev->trigger_data = NULL;
     221                 :          0 :         led_set_brightness(led_cdev, LED_OFF);
     222                 :          0 :         kfree(event);
     223                 :            : 
     224                 :          0 :         return ret;
     225                 :            : }
     226                 :            : EXPORT_SYMBOL_GPL(led_trigger_set);
     227                 :            : 
     228                 :          0 : void led_trigger_remove(struct led_classdev *led_cdev)
     229                 :            : {
     230                 :          0 :         down_write(&led_cdev->trigger_lock);
     231                 :          0 :         led_trigger_set(led_cdev, NULL);
     232                 :          0 :         up_write(&led_cdev->trigger_lock);
     233                 :          0 : }
     234                 :            : EXPORT_SYMBOL_GPL(led_trigger_remove);
     235                 :            : 
     236                 :         96 : void led_trigger_set_default(struct led_classdev *led_cdev)
     237                 :            : {
     238                 :         96 :         struct led_trigger *trig;
     239                 :            : 
     240         [ +  - ]:         96 :         if (!led_cdev->default_trigger)
     241                 :            :                 return;
     242                 :            : 
     243                 :         96 :         down_read(&triggers_list_lock);
     244                 :         96 :         down_write(&led_cdev->trigger_lock);
     245         [ +  - ]:        474 :         list_for_each_entry(trig, &trigger_list, next_trig) {
     246         [ +  + ]:        474 :                 if (!strcmp(led_cdev->default_trigger, trig->name)) {
     247                 :         96 :                         led_cdev->flags |= LED_INIT_DEFAULT_TRIGGER;
     248                 :         96 :                         led_trigger_set(led_cdev, trig);
     249                 :         96 :                         break;
     250                 :            :                 }
     251                 :            :         }
     252                 :         96 :         up_write(&led_cdev->trigger_lock);
     253                 :         96 :         up_read(&triggers_list_lock);
     254                 :            : }
     255                 :            : EXPORT_SYMBOL_GPL(led_trigger_set_default);
     256                 :            : 
     257                 :          0 : void led_trigger_rename_static(const char *name, struct led_trigger *trig)
     258                 :            : {
     259                 :            :         /* new name must be on a temporary string to prevent races */
     260         [ #  # ]:          0 :         BUG_ON(name == trig->name);
     261                 :            : 
     262                 :          0 :         down_write(&triggers_list_lock);
     263                 :            :         /* this assumes that trig->name was originaly allocated to
     264                 :            :          * non constant storage */
     265                 :          0 :         strcpy((char *)trig->name, name);
     266                 :          0 :         up_write(&triggers_list_lock);
     267                 :          0 : }
     268                 :            : EXPORT_SYMBOL_GPL(led_trigger_rename_static);
     269                 :            : 
     270                 :            : /* LED Trigger Interface */
     271                 :            : 
     272                 :        456 : int led_trigger_register(struct led_trigger *trig)
     273                 :            : {
     274                 :        456 :         struct led_classdev *led_cdev;
     275                 :        456 :         struct led_trigger *_trig;
     276                 :            : 
     277                 :        456 :         rwlock_init(&trig->leddev_list_lock);
     278                 :        456 :         INIT_LIST_HEAD(&trig->led_cdevs);
     279                 :            : 
     280                 :        456 :         down_write(&triggers_list_lock);
     281                 :            :         /* Make sure the trigger's name isn't already in use */
     282         [ +  + ]:       3780 :         list_for_each_entry(_trig, &trigger_list, next_trig) {
     283         [ -  + ]:       3324 :                 if (!strcmp(_trig->name, trig->name)) {
     284                 :          0 :                         up_write(&triggers_list_lock);
     285                 :          0 :                         return -EEXIST;
     286                 :            :                 }
     287                 :            :         }
     288                 :            :         /* Add to the list of led triggers */
     289                 :        456 :         list_add_tail(&trig->next_trig, &trigger_list);
     290                 :        456 :         up_write(&triggers_list_lock);
     291                 :            : 
     292                 :            :         /* Register with any LEDs that have this as a default trigger */
     293                 :        456 :         down_read(&leds_list_lock);
     294         [ +  + ]:        564 :         list_for_each_entry(led_cdev, &leds_list, node) {
     295                 :        108 :                 down_write(&led_cdev->trigger_lock);
     296   [ -  +  -  - ]:        108 :                 if (!led_cdev->trigger && led_cdev->default_trigger &&
     297         [ #  # ]:          0 :                             !strcmp(led_cdev->default_trigger, trig->name)) {
     298                 :          0 :                         led_cdev->flags |= LED_INIT_DEFAULT_TRIGGER;
     299                 :          0 :                         led_trigger_set(led_cdev, trig);
     300                 :            :                 }
     301                 :        108 :                 up_write(&led_cdev->trigger_lock);
     302                 :            :         }
     303                 :        456 :         up_read(&leds_list_lock);
     304                 :            : 
     305                 :        456 :         return 0;
     306                 :            : }
     307                 :            : EXPORT_SYMBOL_GPL(led_trigger_register);
     308                 :            : 
     309                 :          0 : void led_trigger_unregister(struct led_trigger *trig)
     310                 :            : {
     311                 :          0 :         struct led_classdev *led_cdev;
     312                 :            : 
     313         [ #  # ]:          0 :         if (list_empty_careful(&trig->next_trig))
     314                 :            :                 return;
     315                 :            : 
     316                 :            :         /* Remove from the list of led triggers */
     317                 :          0 :         down_write(&triggers_list_lock);
     318                 :          0 :         list_del_init(&trig->next_trig);
     319                 :          0 :         up_write(&triggers_list_lock);
     320                 :            : 
     321                 :            :         /* Remove anyone actively using this trigger */
     322                 :          0 :         down_read(&leds_list_lock);
     323         [ #  # ]:          0 :         list_for_each_entry(led_cdev, &leds_list, node) {
     324                 :          0 :                 down_write(&led_cdev->trigger_lock);
     325         [ #  # ]:          0 :                 if (led_cdev->trigger == trig)
     326                 :          0 :                         led_trigger_set(led_cdev, NULL);
     327                 :          0 :                 up_write(&led_cdev->trigger_lock);
     328                 :            :         }
     329                 :          0 :         up_read(&leds_list_lock);
     330                 :            : }
     331                 :            : EXPORT_SYMBOL_GPL(led_trigger_unregister);
     332                 :            : 
     333                 :          0 : static void devm_led_trigger_release(struct device *dev, void *res)
     334                 :            : {
     335                 :          0 :         led_trigger_unregister(*(struct led_trigger **)res);
     336                 :          0 : }
     337                 :            : 
     338                 :          0 : int devm_led_trigger_register(struct device *dev,
     339                 :            :                               struct led_trigger *trig)
     340                 :            : {
     341                 :          0 :         struct led_trigger **dr;
     342                 :          0 :         int rc;
     343                 :            : 
     344                 :          0 :         dr = devres_alloc(devm_led_trigger_release, sizeof(*dr),
     345                 :            :                           GFP_KERNEL);
     346         [ #  # ]:          0 :         if (!dr)
     347                 :            :                 return -ENOMEM;
     348                 :            : 
     349                 :          0 :         *dr = trig;
     350                 :            : 
     351                 :          0 :         rc = led_trigger_register(trig);
     352         [ #  # ]:          0 :         if (rc)
     353                 :          0 :                 devres_free(dr);
     354                 :            :         else
     355                 :          0 :                 devres_add(dev, dr);
     356                 :            : 
     357                 :            :         return rc;
     358                 :            : }
     359                 :            : EXPORT_SYMBOL_GPL(devm_led_trigger_register);
     360                 :            : 
     361                 :            : /* Simple LED Tigger Interface */
     362                 :            : 
     363                 :        906 : void led_trigger_event(struct led_trigger *trig,
     364                 :            :                         enum led_brightness brightness)
     365                 :            : {
     366                 :        906 :         struct led_classdev *led_cdev;
     367                 :            : 
     368         [ +  - ]:        906 :         if (!trig)
     369                 :            :                 return;
     370                 :            : 
     371                 :        906 :         read_lock(&trig->leddev_list_lock);
     372         [ +  + ]:       1002 :         list_for_each_entry(led_cdev, &trig->led_cdevs, trig_list)
     373                 :         96 :                 led_set_brightness(led_cdev, brightness);
     374                 :        906 :         read_unlock(&trig->leddev_list_lock);
     375                 :            : }
     376                 :            : EXPORT_SYMBOL_GPL(led_trigger_event);
     377                 :            : 
     378                 :          0 : static void led_trigger_blink_setup(struct led_trigger *trig,
     379                 :            :                              unsigned long *delay_on,
     380                 :            :                              unsigned long *delay_off,
     381                 :            :                              int oneshot,
     382                 :            :                              int invert)
     383                 :            : {
     384                 :          0 :         struct led_classdev *led_cdev;
     385                 :            : 
     386         [ #  # ]:          0 :         if (!trig)
     387                 :            :                 return;
     388                 :            : 
     389                 :          0 :         read_lock(&trig->leddev_list_lock);
     390         [ #  # ]:          0 :         list_for_each_entry(led_cdev, &trig->led_cdevs, trig_list) {
     391         [ #  # ]:          0 :                 if (oneshot)
     392                 :          0 :                         led_blink_set_oneshot(led_cdev, delay_on, delay_off,
     393                 :            :                                               invert);
     394                 :            :                 else
     395                 :          0 :                         led_blink_set(led_cdev, delay_on, delay_off);
     396                 :            :         }
     397                 :          0 :         read_unlock(&trig->leddev_list_lock);
     398                 :            : }
     399                 :            : 
     400                 :          0 : void led_trigger_blink(struct led_trigger *trig,
     401                 :            :                        unsigned long *delay_on,
     402                 :            :                        unsigned long *delay_off)
     403                 :            : {
     404                 :          0 :         led_trigger_blink_setup(trig, delay_on, delay_off, 0, 0);
     405                 :          0 : }
     406                 :            : EXPORT_SYMBOL_GPL(led_trigger_blink);
     407                 :            : 
     408                 :          0 : void led_trigger_blink_oneshot(struct led_trigger *trig,
     409                 :            :                                unsigned long *delay_on,
     410                 :            :                                unsigned long *delay_off,
     411                 :            :                                int invert)
     412                 :            : {
     413                 :          0 :         led_trigger_blink_setup(trig, delay_on, delay_off, 1, invert);
     414                 :          0 : }
     415                 :            : EXPORT_SYMBOL_GPL(led_trigger_blink_oneshot);
     416                 :            : 
     417                 :          0 : void led_trigger_register_simple(const char *name, struct led_trigger **tp)
     418                 :            : {
     419                 :          0 :         struct led_trigger *trig;
     420                 :          0 :         int err;
     421                 :            : 
     422                 :          0 :         trig = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
     423                 :            : 
     424         [ #  # ]:          0 :         if (trig) {
     425                 :          0 :                 trig->name = name;
     426                 :          0 :                 err = led_trigger_register(trig);
     427         [ #  # ]:          0 :                 if (err < 0) {
     428                 :          0 :                         kfree(trig);
     429                 :          0 :                         trig = NULL;
     430                 :          0 :                         pr_warn("LED trigger %s failed to register (%d)\n",
     431                 :            :                                 name, err);
     432                 :            :                 }
     433                 :            :         } else {
     434                 :          0 :                 pr_warn("LED trigger %s failed to register (no memory)\n",
     435                 :            :                         name);
     436                 :            :         }
     437                 :          0 :         *tp = trig;
     438                 :          0 : }
     439                 :            : EXPORT_SYMBOL_GPL(led_trigger_register_simple);
     440                 :            : 
     441                 :          0 : void led_trigger_unregister_simple(struct led_trigger *trig)
     442                 :            : {
     443         [ #  # ]:          0 :         if (trig)
     444                 :          0 :                 led_trigger_unregister(trig);
     445                 :          0 :         kfree(trig);
     446                 :          0 : }
     447                 :            : EXPORT_SYMBOL_GPL(led_trigger_unregister_simple);