projects / deliverable / linux.git / blame
| Commit | Line | Data |
|---|---|---|
| cd864522 PH |
1 | #include <net/mac80211.h> |
| 2 | #include <linux/bcma/bcma_driver_chipcommon.h> | |
| 3 | #include <linux/gpio.h> | |
| 4 | ||
| 5 | #include "mac80211_if.h" | |
| 6 | #include "pub.h" | |
| 7 | #include "main.h" | |
| 8 | #include "led.h" | |
| 9 | ||
| 10 | /* number of leds */ | |
| 11 | #define BRCMS_LED_NO 4 | |
| 12 | /* behavior mask */ | |
| 13 | #define BRCMS_LED_BEH_MASK 0x7f | |
| 14 | /* activelow (polarity) bit */ | |
| 15 | #define BRCMS_LED_AL_MASK 0x80 | |
| 16 | /* radio enabled */ | |
| 17 | #define BRCMS_LED_RADIO 3 | |
| 18 | ||
| 19 | static void brcms_radio_led_ctrl(struct brcms_info *wl, bool state) | |
| 20 | { | |
| 21 | if (wl->radio_led.gpio == -1) | |
| 22 | return; | |
| 23 | ||
| 24 | if (wl->radio_led.active_low) | |
| 25 | state = !state; | |
| 26 | ||
| 27 | if (state) | |
| 28 | gpio_set_value(wl->radio_led.gpio, 1); | |
| 29 | else | |
| 30 | gpio_set_value(wl->radio_led.gpio, 0); | |
| 31 | } | |
| 32 | ||
| 33 | ||
| 34 | /* Callback from the LED subsystem. */ | |
| 35 | static void brcms_led_brightness_set(struct led_classdev *led_dev, | |
| 36 | enum led_brightness brightness) | |
| 37 | { | |
| 38 | struct brcms_info *wl = container_of(led_dev, | |
| 39 | struct brcms_info, led_dev); | |
| 40 | brcms_radio_led_ctrl(wl, brightness); | |
| 41 | } | |
| 42 | ||
| 43 | void brcms_led_unregister(struct brcms_info *wl) | |
| 44 | { | |
| 45 | if (wl->led_dev.dev) | |
| 46 | led_classdev_unregister(&wl->led_dev); | |
| 47 | if (wl->radio_led.gpio != -1) | |
| 48 | gpio_free(wl->radio_led.gpio); | |
| 49 | } | |
| 50 | ||
| 51 | int brcms_led_register(struct brcms_info *wl) | |
| 52 | { | |
| 53 | int i, err; | |
| 54 | struct brcms_led *radio_led = &wl->radio_led; | |
| 55 | /* get CC core */ | |
| 56 | struct bcma_drv_cc *cc_drv = &wl->wlc->hw->d11core->bus->drv_cc; | |
| 57 | struct gpio_chip *bcma_gpio = &cc_drv->gpio; | |
| 58 | struct ssb_sprom *sprom = &wl->wlc->hw->d11core->bus->sprom; | |
| 59 | u8 *leds[] = { &sprom->gpio0, | |
| 60 | &sprom->gpio1, | |
| 61 | &sprom->gpio2, | |
| 62 | &sprom->gpio3 }; | |
| 63 | unsigned gpio = -1; | |
| 64 | bool active_low = false; | |
| 65 | ||
| 66 | /* none by default */ | |
| 67 | radio_led->gpio = -1; | |
| 68 | radio_led->active_low = false; | |
| 69 | ||
| 70 | if (!bcma_gpio || !gpio_is_valid(bcma_gpio->base)) | |
| 71 | return -ENODEV; | |
| 72 | ||
| 73 | /* find radio enabled LED */ | |
| 74 | for (i = 0; i < BRCMS_LED_NO; i++) { | |
| 75 | u8 led = *leds[i]; | |
| 76 | if ((led & BRCMS_LED_BEH_MASK) == BRCMS_LED_RADIO) { | |
| 77 | gpio = bcma_gpio->base + i; | |
| 78 | if (led & BRCMS_LED_AL_MASK) | |
| 79 | active_low = true; | |
| 80 | break; | |
| 81 | } | |
| 82 | } | |
| 83 | ||
| 84 | if (gpio == -1 || !gpio_is_valid(gpio)) | |
| 85 | return -ENODEV; | |
| 86 | ||
| 87 | /* request and configure LED gpio */ | |
| 88 | err = gpio_request_one(gpio, | |
| 89 | active_low ? GPIOF_OUT_INIT_HIGH | |
| 90 | : GPIOF_OUT_INIT_LOW, | |
| 91 | "radio on"); | |
| 92 | if (err) { | |
| 93 | wiphy_err(wl->wiphy, "requesting led gpio %d failed (err: %d)\n", | |
| 94 | gpio, err); | |
| 95 | return err; | |
| 96 | } | |
| 97 | err = gpio_direction_output(gpio, 1); | |
| 98 | if (err) { | |
| 99 | wiphy_err(wl->wiphy, "cannot set led gpio %d to output (err: %d)\n", | |
| 100 | gpio, err); | |
| 101 | return err; | |
| 102 | } | |
| 103 | ||
| 104 | snprintf(wl->radio_led.name, sizeof(wl->radio_led.name), | |
| 105 | "brcmsmac-%s:radio", wiphy_name(wl->wiphy)); | |
| 106 | ||
| 107 | wl->led_dev.name = wl->radio_led.name; | |
| 108 | wl->led_dev.default_trigger = | |
| 109 | ieee80211_get_radio_led_name(wl->pub->ieee_hw); | |
| 110 | wl->led_dev.brightness_set = brcms_led_brightness_set; | |
| 111 | err = led_classdev_register(wiphy_dev(wl->wiphy), &wl->led_dev); | |
| 112 | ||
| 113 | if (err) { | |
| 114 | wiphy_err(wl->wiphy, "cannot register led device: %s (err: %d)\n", | |
| 115 | wl->radio_led.name, err); | |
| 116 | return err; | |
| 117 | } | |
| 118 | ||
| 119 | wiphy_info(wl->wiphy, "registered radio enabled led device: %s gpio: %d\n", | |
| 120 | wl->radio_led.name, | |
| 121 | gpio); | |
| 122 | radio_led->gpio = gpio; | |
| 123 | radio_led->active_low = active_low; | |
| 124 | ||
| 125 | return 0; | |
| 126 | } |