brcm80211/brcmsmac/led.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 #include <net/mac80211.h>
0003 #include <linux/bcma/bcma_driver_chipcommon.h>
0004 #include <linux/gpio/driver.h>
0005 #include <linux/gpio/machine.h>
0006 #include <linux/gpio/consumer.h>
0007
0008 #include "mac80211_if.h"
0009 #include "pub.h"
0010 #include "main.h"
0011 #include "led.h"
0012
0013     /* number of leds */
0014 #define  BRCMS_LED_NO       4
0015     /* behavior mask */
0016 #define  BRCMS_LED_BEH_MASK 0x7f
0017     /* activelow (polarity) bit */
0018 #define  BRCMS_LED_AL_MASK  0x80
0019     /* radio enabled */
0020 #define  BRCMS_LED_RADIO    3
0021
0022 static void brcms_radio_led_ctrl(struct brcms_info *wl, bool state)
0023 {
0024     if (!wl->radio_led.gpiod)
0025         return;
0026
0027     if (state)
0028         gpiod_set_value(wl->radio_led.gpiod, 1);
0029     else
0030         gpiod_set_value(wl->radio_led.gpiod, 0);
0031 }
0032
0033
0034 /* Callback from the LED subsystem. */
0035 static void brcms_led_brightness_set(struct led_classdev *led_dev,
0036                    enum led_brightness brightness)
0037 {
0038     struct brcms_info *wl = container_of(led_dev,
0039         struct brcms_info, led_dev);
0040     brcms_radio_led_ctrl(wl, brightness);
0041 }
0042
0043 void brcms_led_unregister(struct brcms_info *wl)
0044 {
0045     if (wl->led_dev.dev)
0046         led_classdev_unregister(&wl->led_dev);
0047     if (wl->radio_led.gpiod)
0048         gpiochip_free_own_desc(wl->radio_led.gpiod);
0049 }
0050
0051 int brcms_led_register(struct brcms_info *wl)
0052 {
0053     int i, err;
0054     struct brcms_led *radio_led = &wl->radio_led;
0055     /* get CC core */
0056     struct bcma_drv_cc *cc_drv  = &wl->wlc->hw->d11core->bus->drv_cc;
0057     struct gpio_chip *bcma_gpio = &cc_drv->gpio;
0058     struct ssb_sprom *sprom = &wl->wlc->hw->d11core->bus->sprom;
0059     u8 *leds[] = { &sprom->gpio0,
0060         &sprom->gpio1,
0061         &sprom->gpio2,
0062         &sprom->gpio3 };
0063     int hwnum = -1;
0064     enum gpio_lookup_flags lflags = GPIO_ACTIVE_HIGH;
0065
0066     if (!bcma_gpio || !gpio_is_valid(bcma_gpio->base))
0067         return -ENODEV;
0068
0069     /* find radio enabled LED */
0070     for (i = 0; i < BRCMS_LED_NO; i++) {
0071         u8 led = *leds[i];
0072         if ((led & BRCMS_LED_BEH_MASK) == BRCMS_LED_RADIO) {
0073             hwnum = i;
0074             if (led & BRCMS_LED_AL_MASK)
0075                 lflags = GPIO_ACTIVE_LOW;
0076             break;
0077         }
0078     }
0079
0080     /* No LED, bail out */
0081     if (hwnum == -1)
0082         return -ENODEV;
0083
0084     /* Try to obtain this LED GPIO line */
0085     radio_led->gpiod = gpiochip_request_own_desc(bcma_gpio, hwnum,
0086                              "radio on", lflags,
0087                              GPIOD_OUT_LOW);
0088
0089     if (IS_ERR(radio_led->gpiod)) {
0090         err = PTR_ERR(radio_led->gpiod);
0091         wiphy_err(wl->wiphy, "requesting led GPIO failed (err: %d)\n",
0092               err);
0093         return err;
0094     }
0095
0096     snprintf(wl->radio_led.name, sizeof(wl->radio_led.name),
0097          "brcmsmac-%s:radio", wiphy_name(wl->wiphy));
0098
0099     wl->led_dev.name = wl->radio_led.name;
0100     wl->led_dev.default_trigger =
0101         ieee80211_get_radio_led_name(wl->pub->ieee_hw);
0102     wl->led_dev.brightness_set = brcms_led_brightness_set;
0103     err = led_classdev_register(wiphy_dev(wl->wiphy), &wl->led_dev);
0104
0105     if (err) {
0106         wiphy_err(wl->wiphy, "cannot register led device: %s (err: %d)\n",
0107               wl->radio_led.name, err);
0108         return err;
0109     }
0110
0111     wiphy_info(wl->wiphy, "registered radio enabled led device: %s\n",
0112            wl->radio_led.name);
0113
0114     return 0;
0115 }