1 /******************************************************************************
3 * Copyright(c) 2003 - 2009 Intel Corporation. All rights reserved.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
21 * Contact Information:
22 * Intel Linux Wireless <ilw@linux.intel.com>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
25 *****************************************************************************/
28 #include <linux/kernel.h>
29 #include <linux/module.h>
30 #include <linux/init.h>
31 #include <linux/pci.h>
32 #include <linux/dma-mapping.h>
33 #include <linux/delay.h>
34 #include <linux/skbuff.h>
35 #include <linux/netdevice.h>
36 #include <linux/wireless.h>
37 #include <net/mac80211.h>
38 #include <linux/etherdevice.h>
39 #include <asm/unaligned.h>
45 /* default: IWL_LED_BLINK(0) using blinking index table */
47 module_param(led_mode, int, S_IRUGO);
48 MODULE_PARM_DESC(led_mode, "led mode: 0=blinking, 1=On(RF On)/Off(RF Off), "
69 {-1, IWL_LED_SOLID, 0}
72 #define IWL_1MB_RATE (128 * 1024)
73 #define IWL_LED_THRESHOLD (16)
74 #define IWL_MAX_BLINK_TBL (ARRAY_SIZE(blink_tbl) - 1) /* exclude SOLID_ON */
75 #define IWL_SOLID_BLINK_IDX (ARRAY_SIZE(blink_tbl) - 1)
78 * Adjust led blink rate to compensate on a MAC Clock difference on every HW
79 * Led blink rate analysis showed an average deviation of 0% on 3945,
80 * 5% on 4965 HW and 20% on 5000 series and up.
81 * Need to compensate on the led on/off time per HW according to the deviation
82 * to achieve the desired led frequency
83 * The calculation is: (100-averageDeviation)/100 * blinkTime
84 * For code efficiency the calculation will be:
85 * compensation = (100 - averageDeviation) * 64 / 100
86 * NewBlinkTime = (compensation * BlinkTime) / 64
88 static inline u8 iwl_blink_compensation(struct iwl_priv *priv,
89 u8 time, u16 compensation)
92 IWL_ERR(priv, "undefined blink compensation: "
93 "use pre-defined blinking time\n");
97 return (u8)((time * compensation) >> 6);
100 /* Set led pattern command */
101 static int iwl_led_pattern(struct iwl_priv *priv, unsigned int idx)
103 struct iwl_led_cmd led_cmd = {
105 .interval = IWL_DEF_LED_INTRVL
108 BUG_ON(idx > IWL_MAX_BLINK_TBL);
110 IWL_DEBUG_LED(priv, "Led blink time compensation= %u\n",
111 priv->cfg->led_compensation);
113 iwl_blink_compensation(priv, blink_tbl[idx].on_time,
114 priv->cfg->led_compensation);
116 iwl_blink_compensation(priv, blink_tbl[idx].off_time,
117 priv->cfg->led_compensation);
119 return priv->cfg->ops->led->cmd(priv, &led_cmd);
122 int iwl_led_start(struct iwl_priv *priv)
124 return priv->cfg->ops->led->on(priv);
126 EXPORT_SYMBOL(iwl_led_start);
128 int iwl_led_associate(struct iwl_priv *priv)
130 IWL_DEBUG_LED(priv, "Associated\n");
131 if (led_mode == IWL_LED_BLINK)
132 priv->allow_blinking = 1;
133 priv->last_blink_time = jiffies;
138 int iwl_led_disassociate(struct iwl_priv *priv)
140 priv->allow_blinking = 0;
146 * calculate blink rate according to last second Tx/Rx activities
148 static int iwl_get_blink_rate(struct iwl_priv *priv)
151 /* count both tx and rx traffic to be able to
152 * handle traffic in either direction
154 u64 current_tpt = priv->tx_stats.data_bytes +
155 priv->rx_stats.data_bytes;
156 s64 tpt = current_tpt - priv->led_tpt;
158 if (tpt < 0) /* wraparound */
161 IWL_DEBUG_LED(priv, "tpt %lld current_tpt %llu\n",
163 (unsigned long long)current_tpt);
164 priv->led_tpt = current_tpt;
166 if (!priv->allow_blinking)
167 i = IWL_MAX_BLINK_TBL;
169 for (i = 0; i < IWL_MAX_BLINK_TBL; i++)
170 if (tpt > (blink_tbl[i].tpt * IWL_1MB_RATE))
173 IWL_DEBUG_LED(priv, "LED BLINK IDX=%d\n", i);
178 * this function called from handler. Since setting Led command can
179 * happen very frequent we postpone led command to be called from
180 * REPLY handler so we know ucode is up
182 void iwl_leds_background(struct iwl_priv *priv)
186 if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
187 priv->last_blink_time = 0;
190 if (iwl_is_rfkill(priv)) {
191 priv->last_blink_time = 0;
195 if (!priv->allow_blinking) {
196 priv->last_blink_time = 0;
197 if (priv->last_blink_rate != IWL_SOLID_BLINK_IDX) {
198 priv->last_blink_rate = IWL_SOLID_BLINK_IDX;
199 iwl_led_pattern(priv, IWL_SOLID_BLINK_IDX);
203 if (!priv->last_blink_time ||
204 !time_after(jiffies, priv->last_blink_time +
205 msecs_to_jiffies(1000)))
208 blink_idx = iwl_get_blink_rate(priv);
210 /* call only if blink rate change */
211 if (blink_idx != priv->last_blink_rate)
212 iwl_led_pattern(priv, blink_idx);
214 priv->last_blink_time = jiffies;
215 priv->last_blink_rate = blink_idx;
217 EXPORT_SYMBOL(iwl_leds_background);
219 void iwl_leds_init(struct iwl_priv *priv)
221 priv->last_blink_rate = 0;
223 priv->last_blink_time = 0;
224 priv->allow_blinking = 0;
226 EXPORT_SYMBOL(iwl_leds_init);