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 | } |