1 /* Helpers for managing scan queues
3 * See copyright notice in main.c
7 #include <linux/kernel.h>
8 #include <linux/string.h>
9 #include <linux/ieee80211.h>
10 #include <net/cfg80211.h>
18 #define ZERO_DBM_OFFSET 0x95
19 #define MAX_SIGNAL_LEVEL 0x8A
20 #define MIN_SIGNAL_LEVEL 0x2F
22 #define SIGNAL_TO_DBM(x) \
23 (clamp_t(s32, (x), MIN_SIGNAL_LEVEL, MAX_SIGNAL_LEVEL) \
25 #define SIGNAL_TO_MBM(x) (SIGNAL_TO_DBM(x) * 100)
27 static int symbol_build_supp_rates(u8 *buf, const __le16 *rates)
32 buf[0] = WLAN_EID_SUPP_RATES;
33 for (i = 0; i < 5; i++) {
34 rate = le16_to_cpu(rates[i]);
45 static int prism_build_supp_rates(u8 *buf, const u8 *rates)
49 buf[0] = WLAN_EID_SUPP_RATES;
50 for (i = 0; i < 8; i++) {
54 buf[i + 2] = rates[i];
58 /* We might still have another 2 rates, which need to go in
59 * extended supported rates */
60 if (i == 8 && rates[i] > 0) {
61 buf[10] = WLAN_EID_EXT_SUPP_RATES;
66 buf[i + 2] = rates[i];
71 return (i < 8) ? i + 2 : i + 4;
74 static void orinoco_add_hostscan_result(struct orinoco_private *priv,
75 const union hermes_scan_info *bss)
77 struct wiphy *wiphy = priv_to_wiphy(priv);
78 struct ieee80211_channel *channel;
79 struct cfg80211_bss *cbss;
90 len = le16_to_cpu(bss->a.essid_len);
92 /* Reconstruct SSID and bitrate IEs to pass up */
93 ie_buf[0] = WLAN_EID_SSID;
95 memcpy(&ie_buf[2], bss->a.essid, len);
97 ie = ie_buf + len + 2;
98 ie_len = ie_buf[1] + 2;
99 switch (priv->firmware_type) {
100 case FIRMWARE_TYPE_SYMBOL:
101 ie_len += symbol_build_supp_rates(ie, bss->s.rates);
104 case FIRMWARE_TYPE_INTERSIL:
105 ie_len += prism_build_supp_rates(ie, bss->p.rates);
108 case FIRMWARE_TYPE_AGERE:
113 freq = ieee80211_dsss_chan_to_freq(le16_to_cpu(bss->a.channel));
114 channel = ieee80211_get_channel(wiphy, freq);
116 printk(KERN_DEBUG "Invalid channel designation %04X(%04X)",
117 bss->a.channel, freq);
118 return; /* Then ignore it for now */
121 capability = le16_to_cpu(bss->a.capabilities);
122 beacon_interval = le16_to_cpu(bss->a.beacon_interv);
123 signal = SIGNAL_TO_MBM(le16_to_cpu(bss->a.level));
125 cbss = cfg80211_inform_bss(wiphy, channel, bss->a.bssid, timestamp,
126 capability, beacon_interval, ie_buf, ie_len,
128 cfg80211_put_bss(wiphy, cbss);
131 void orinoco_add_extscan_result(struct orinoco_private *priv,
132 struct agere_ext_scan_info *bss,
135 struct wiphy *wiphy = priv_to_wiphy(priv);
136 struct ieee80211_channel *channel;
137 struct cfg80211_bss *cbss;
146 ie_len = len - sizeof(*bss);
147 ie = cfg80211_find_ie(WLAN_EID_DS_PARAMS, bss->data, ie_len);
148 chan = ie ? ie[2] : 0;
149 freq = ieee80211_dsss_chan_to_freq(chan);
150 channel = ieee80211_get_channel(wiphy, freq);
152 timestamp = le64_to_cpu(bss->timestamp);
153 capability = le16_to_cpu(bss->capabilities);
154 beacon_interval = le16_to_cpu(bss->beacon_interval);
156 signal = SIGNAL_TO_MBM(bss->level);
158 cbss = cfg80211_inform_bss(wiphy, channel, bss->bssid, timestamp,
159 capability, beacon_interval, ie, ie_len,
161 cfg80211_put_bss(wiphy, cbss);
164 void orinoco_add_hostscan_results(struct orinoco_private *priv,
168 int offset; /* In the scan data */
172 switch (priv->firmware_type) {
173 case FIRMWARE_TYPE_AGERE:
174 atom_len = sizeof(struct agere_scan_apinfo);
178 case FIRMWARE_TYPE_SYMBOL:
179 /* Lack of documentation necessitates this hack.
180 * Different firmwares have 68 or 76 byte long atoms.
181 * We try modulo first. If the length divides by both,
182 * we check what would be the channel in the second
183 * frame for a 68-byte atom. 76-byte atoms have 0 there.
184 * Valid channel cannot be 0. */
189 else if (len >= 1292 && buf[68] == 0)
196 case FIRMWARE_TYPE_INTERSIL:
198 if (priv->has_hostscan) {
199 atom_len = le16_to_cpup((__le16 *)buf);
200 /* Sanity check for atom_len */
201 if (atom_len < sizeof(struct prism2_scan_apinfo)) {
202 printk(KERN_ERR "%s: Invalid atom_len in scan "
203 "data: %zu\n", priv->ndev->name,
209 atom_len = offsetof(struct prism2_scan_apinfo, atim);
217 /* Check that we got an whole number of atoms */
218 if ((len - offset) % atom_len) {
219 printk(KERN_ERR "%s: Unexpected scan data length %zu, "
220 "atom_len %zu, offset %d\n", priv->ndev->name, len,
226 /* Process the entries one by one */
227 for (; offset + atom_len <= len; offset += atom_len) {
228 union hermes_scan_info *atom;
230 atom = (union hermes_scan_info *) (buf + offset);
232 orinoco_add_hostscan_result(priv, atom);
236 if (priv->scan_request) {
237 cfg80211_scan_done(priv->scan_request, abort);
238 priv->scan_request = NULL;
242 void orinoco_scan_done(struct orinoco_private *priv, bool abort)
244 if (priv->scan_request) {
245 cfg80211_scan_done(priv->scan_request, abort);
246 priv->scan_request = NULL;