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