| 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); |