| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Copyright 2006, Johannes Berg <johannes@sipsolutions.net> | 
|  | 3 | * | 
|  | 4 | * This program is free software; you can redistribute it and/or modify | 
|  | 5 | * it under the terms of the GNU General Public License version 2 as | 
|  | 6 | * published by the Free Software Foundation. | 
|  | 7 | */ | 
|  | 8 |  | 
|  | 9 | /* just for IFNAMSIZ */ | 
|  | 10 | #include <linux/if.h> | 
| Johannes Berg | 2c8dccc | 2008-04-08 15:14:40 -0400 | [diff] [blame] | 11 | #include "led.h" | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 12 |  | 
|  | 13 | void ieee80211_led_rx(struct ieee80211_local *local) | 
|  | 14 | { | 
|  | 15 | if (unlikely(!local->rx_led)) | 
|  | 16 | return; | 
|  | 17 | if (local->rx_led_counter++ % 2 == 0) | 
|  | 18 | led_trigger_event(local->rx_led, LED_OFF); | 
|  | 19 | else | 
|  | 20 | led_trigger_event(local->rx_led, LED_FULL); | 
|  | 21 | } | 
|  | 22 |  | 
|  | 23 | /* q is 1 if a packet was enqueued, 0 if it has been transmitted */ | 
|  | 24 | void ieee80211_led_tx(struct ieee80211_local *local, int q) | 
|  | 25 | { | 
|  | 26 | if (unlikely(!local->tx_led)) | 
|  | 27 | return; | 
|  | 28 | /* not sure how this is supposed to work ... */ | 
|  | 29 | local->tx_led_counter += 2*q-1; | 
|  | 30 | if (local->tx_led_counter % 2 == 0) | 
|  | 31 | led_trigger_event(local->tx_led, LED_OFF); | 
|  | 32 | else | 
|  | 33 | led_trigger_event(local->tx_led, LED_FULL); | 
|  | 34 | } | 
|  | 35 |  | 
| Michael Buesch | 47f0c50 | 2007-09-27 15:10:44 +0200 | [diff] [blame] | 36 | void ieee80211_led_assoc(struct ieee80211_local *local, bool associated) | 
|  | 37 | { | 
|  | 38 | if (unlikely(!local->assoc_led)) | 
|  | 39 | return; | 
|  | 40 | if (associated) | 
|  | 41 | led_trigger_event(local->assoc_led, LED_FULL); | 
|  | 42 | else | 
|  | 43 | led_trigger_event(local->assoc_led, LED_OFF); | 
|  | 44 | } | 
|  | 45 |  | 
| Ivo van Doorn | cdcb006 | 2008-01-07 19:45:24 +0100 | [diff] [blame] | 46 | void ieee80211_led_radio(struct ieee80211_local *local, bool enabled) | 
|  | 47 | { | 
|  | 48 | if (unlikely(!local->radio_led)) | 
|  | 49 | return; | 
|  | 50 | if (enabled) | 
|  | 51 | led_trigger_event(local->radio_led, LED_FULL); | 
|  | 52 | else | 
|  | 53 | led_trigger_event(local->radio_led, LED_OFF); | 
|  | 54 | } | 
|  | 55 |  | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 56 | void ieee80211_led_init(struct ieee80211_local *local) | 
|  | 57 | { | 
|  | 58 | local->rx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL); | 
| Michael Buesch | 47f0c50 | 2007-09-27 15:10:44 +0200 | [diff] [blame] | 59 | if (local->rx_led) { | 
|  | 60 | snprintf(local->rx_led_name, sizeof(local->rx_led_name), | 
|  | 61 | "%srx", wiphy_name(local->hw.wiphy)); | 
|  | 62 | local->rx_led->name = local->rx_led_name; | 
|  | 63 | if (led_trigger_register(local->rx_led)) { | 
|  | 64 | kfree(local->rx_led); | 
|  | 65 | local->rx_led = NULL; | 
|  | 66 | } | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 67 | } | 
|  | 68 |  | 
|  | 69 | local->tx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL); | 
| Michael Buesch | 47f0c50 | 2007-09-27 15:10:44 +0200 | [diff] [blame] | 70 | if (local->tx_led) { | 
|  | 71 | snprintf(local->tx_led_name, sizeof(local->tx_led_name), | 
|  | 72 | "%stx", wiphy_name(local->hw.wiphy)); | 
|  | 73 | local->tx_led->name = local->tx_led_name; | 
|  | 74 | if (led_trigger_register(local->tx_led)) { | 
|  | 75 | kfree(local->tx_led); | 
|  | 76 | local->tx_led = NULL; | 
|  | 77 | } | 
|  | 78 | } | 
|  | 79 |  | 
|  | 80 | local->assoc_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL); | 
|  | 81 | if (local->assoc_led) { | 
|  | 82 | snprintf(local->assoc_led_name, sizeof(local->assoc_led_name), | 
|  | 83 | "%sassoc", wiphy_name(local->hw.wiphy)); | 
|  | 84 | local->assoc_led->name = local->assoc_led_name; | 
|  | 85 | if (led_trigger_register(local->assoc_led)) { | 
|  | 86 | kfree(local->assoc_led); | 
|  | 87 | local->assoc_led = NULL; | 
|  | 88 | } | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 89 | } | 
| Ivo van Doorn | cdcb006 | 2008-01-07 19:45:24 +0100 | [diff] [blame] | 90 |  | 
|  | 91 | local->radio_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL); | 
|  | 92 | if (local->radio_led) { | 
|  | 93 | snprintf(local->radio_led_name, sizeof(local->radio_led_name), | 
|  | 94 | "%sradio", wiphy_name(local->hw.wiphy)); | 
|  | 95 | local->radio_led->name = local->radio_led_name; | 
|  | 96 | if (led_trigger_register(local->radio_led)) { | 
|  | 97 | kfree(local->radio_led); | 
|  | 98 | local->radio_led = NULL; | 
|  | 99 | } | 
|  | 100 | } | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 101 | } | 
|  | 102 |  | 
|  | 103 | void ieee80211_led_exit(struct ieee80211_local *local) | 
|  | 104 | { | 
| Ivo van Doorn | cdcb006 | 2008-01-07 19:45:24 +0100 | [diff] [blame] | 105 | if (local->radio_led) { | 
|  | 106 | led_trigger_unregister(local->radio_led); | 
|  | 107 | kfree(local->radio_led); | 
|  | 108 | } | 
| Michael Buesch | 47f0c50 | 2007-09-27 15:10:44 +0200 | [diff] [blame] | 109 | if (local->assoc_led) { | 
|  | 110 | led_trigger_unregister(local->assoc_led); | 
|  | 111 | kfree(local->assoc_led); | 
|  | 112 | } | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 113 | if (local->tx_led) { | 
|  | 114 | led_trigger_unregister(local->tx_led); | 
|  | 115 | kfree(local->tx_led); | 
|  | 116 | } | 
|  | 117 | if (local->rx_led) { | 
|  | 118 | led_trigger_unregister(local->rx_led); | 
|  | 119 | kfree(local->rx_led); | 
|  | 120 | } | 
|  | 121 | } | 
|  | 122 |  | 
| Ivo van Doorn | cdcb006 | 2008-01-07 19:45:24 +0100 | [diff] [blame] | 123 | char *__ieee80211_get_radio_led_name(struct ieee80211_hw *hw) | 
|  | 124 | { | 
|  | 125 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 126 |  | 
|  | 127 | if (local->radio_led) | 
|  | 128 | return local->radio_led_name; | 
|  | 129 | return NULL; | 
|  | 130 | } | 
|  | 131 | EXPORT_SYMBOL(__ieee80211_get_radio_led_name); | 
|  | 132 |  | 
| Michael Buesch | 47f0c50 | 2007-09-27 15:10:44 +0200 | [diff] [blame] | 133 | char *__ieee80211_get_assoc_led_name(struct ieee80211_hw *hw) | 
|  | 134 | { | 
|  | 135 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 136 |  | 
|  | 137 | if (local->assoc_led) | 
|  | 138 | return local->assoc_led_name; | 
|  | 139 | return NULL; | 
|  | 140 | } | 
|  | 141 | EXPORT_SYMBOL(__ieee80211_get_assoc_led_name); | 
|  | 142 |  | 
| Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 143 | char *__ieee80211_get_tx_led_name(struct ieee80211_hw *hw) | 
|  | 144 | { | 
|  | 145 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 146 |  | 
|  | 147 | if (local->tx_led) | 
|  | 148 | return local->tx_led_name; | 
|  | 149 | return NULL; | 
|  | 150 | } | 
|  | 151 | EXPORT_SYMBOL(__ieee80211_get_tx_led_name); | 
|  | 152 |  | 
|  | 153 | char *__ieee80211_get_rx_led_name(struct ieee80211_hw *hw) | 
|  | 154 | { | 
|  | 155 | struct ieee80211_local *local = hw_to_local(hw); | 
|  | 156 |  | 
|  | 157 | if (local->rx_led) | 
|  | 158 | return local->rx_led_name; | 
|  | 159 | return NULL; | 
|  | 160 | } | 
|  | 161 | EXPORT_SYMBOL(__ieee80211_get_rx_led_name); |