net/bluetooth/leds.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright 2015, Heiner Kallweit <hkallweit1@gmail.com>
   4  */
   5
   6 #include <net/bluetooth/bluetooth.h>
   7 #include <net/bluetooth/hci_core.h>
   8
   9 #include "leds.h"
  10
  11 DEFINE_LED_TRIGGER(bt_power_led_trigger);
  12
  13 struct hci_basic_led_trigger {
  14         struct led_trigger      led_trigger;
  15         struct hci_dev          *hdev;
  16 };
  17
  18 #define to_hci_basic_led_trigger(arg) container_of(arg, \
  19                         struct hci_basic_led_trigger, led_trigger)
  20
  21 void hci_leds_update_powered(struct hci_dev *hdev, bool enabled)
  22 {
  23         if (hdev->power_led)
  24                 led_trigger_event(hdev->power_led,
  25                                   enabled ? LED_FULL : LED_OFF);
  26
  27         if (!enabled) {
  28                 struct hci_dev *d;
  29
  30                 read_lock(&hci_dev_list_lock);
  31
  32                 list_for_each_entry(d, &hci_dev_list, list) {
  33                         if (test_bit(HCI_UP, &d->flags))
  34                                 enabled = true;
  35                 }
  36
  37                 read_unlock(&hci_dev_list_lock);
  38         }
  39
  40         led_trigger_event(bt_power_led_trigger, enabled ? LED_FULL : LED_OFF);
  41 }
  42
  43 static int power_activate(struct led_classdev *led_cdev)
  44 {
  45         struct hci_basic_led_trigger *htrig;
  46         bool powered;
  47
  48         htrig = to_hci_basic_led_trigger(led_cdev->trigger);
  49         powered = test_bit(HCI_UP, &htrig->hdev->flags);
  50
  51         led_trigger_event(led_cdev->trigger, powered ? LED_FULL : LED_OFF);
  52
  53         return 0;
  54 }
  55
  56 static struct led_trigger *led_allocate_basic(struct hci_dev *hdev,
  57                         int (*activate)(struct led_classdev *led_cdev),
  58                         const char *name)
  59 {
  60         struct hci_basic_led_trigger *htrig;
  61
  62         htrig = devm_kzalloc(&hdev->dev, sizeof(*htrig), GFP_KERNEL);
  63         if (!htrig)
  64                 return NULL;
  65
  66         htrig->hdev = hdev;
  67         htrig->led_trigger.activate = activate;
  68         htrig->led_trigger.name = devm_kasprintf(&hdev->dev, GFP_KERNEL,
  69                                                  "%s-%s", hdev->name,
  70                                                  name);
  71         if (!htrig->led_trigger.name)
  72                 goto err_alloc;
  73
  74         if (devm_led_trigger_register(&hdev->dev, &htrig->led_trigger))
  75                 goto err_register;
  76
  77         return &htrig->led_trigger;
  78
  79 err_register:
  80         devm_kfree(&hdev->dev, (void *)htrig->led_trigger.name);
  81 err_alloc:
  82         devm_kfree(&hdev->dev, htrig);
  83         return NULL;
  84 }
  85
  86 void hci_leds_init(struct hci_dev *hdev)
  87 {
  88         /* initialize power_led */
  89         hdev->power_led = led_allocate_basic(hdev, power_activate, "power");
  90 }
  91
  92 void bt_leds_init(void)
  93 {
  94         led_trigger_register_simple("bluetooth-power", &bt_power_led_trigger);
  95 }
  96
  97 void bt_leds_cleanup(void)
  98 {
  99         led_trigger_unregister_simple(bt_power_led_trigger);
 100 }