2 * Functions implementing wlan infrastructure and adhoc join routines,
3 * IOCTL handlers as well as command preperation and response routines
4 * for sending adhoc start, adhoc join, and association commands
7 #include <linux/netdevice.h>
8 #include <linux/if_arp.h>
9 #include <linux/wireless.h>
10 #include <linux/etherdevice.h>
12 #include <net/iw_handler.h>
20 #define AD_HOC_CAP_PRIVACY_ON 1
23 * @brief This function finds out the common rates between rate1 and rate2.
25 * It will fill common rates in rate1 as output if found.
27 * NOTE: Setting the MSB of the basic rates need to be taken
28 * care, either before or after calling this function
30 * @param adapter A pointer to wlan_adapter structure
31 * @param rate1 the buffer which keeps input and output
32 * @param rate1_size the size of rate1 buffer
33 * @param rate2 the buffer which keeps rate2
34 * @param rate2_size the size of rate2 buffer.
38 static int get_common_rates(wlan_adapter
* adapter
, u8
* rate1
,
39 int rate1_size
, u8
* rate2
, int rate2_size
)
46 memset(&tmp
, 0, sizeof(tmp
));
47 memcpy(&tmp
, rate1
, min_t(size_t, rate1_size
, sizeof(tmp
)));
48 memset(rate1
, 0, rate1_size
);
50 /* Mask the top bit of the original values */
51 for (i
= 0; tmp
[i
] && i
< sizeof(tmp
); i
++)
54 for (i
= 0; rate2
[i
] && i
< rate2_size
; i
++) {
55 /* Check for Card Rate in tmp, excluding the top bit */
56 if (strchr(tmp
, rate2
[i
] & 0x7F)) {
57 /* values match, so copy the Card Rate to rate1 */
62 lbs_dbg_hex("rate1 (AP) rates:", tmp
, sizeof(tmp
));
63 lbs_dbg_hex("rate2 (Card) rates:", rate2
, rate2_size
);
64 lbs_dbg_hex("Common rates:", ptr
, rate1_size
);
65 lbs_deb_join("Tx datarate is set to 0x%X\n", adapter
->datarate
);
67 if (!adapter
->is_datarate_auto
) {
69 if ((*ptr
& 0x7f) == adapter
->datarate
) {
75 lbs_pr_alert( "Previously set fixed data rate %#x isn't "
76 "compatible with the network.\n", adapter
->datarate
);
87 int libertas_send_deauth(wlan_private
* priv
)
89 wlan_adapter
*adapter
= priv
->adapter
;
92 if (adapter
->mode
== IW_MODE_INFRA
&&
93 adapter
->connect_status
== libertas_connected
)
94 ret
= libertas_send_deauthentication(priv
);
102 * @brief Associate to a specific BSS discovered in a scan
104 * @param priv A pointer to wlan_private structure
105 * @param pbssdesc Pointer to the BSS descriptor to associate with.
107 * @return 0-success, otherwise fail
109 int wlan_associate(wlan_private
* priv
, struct assoc_request
* assoc_req
)
111 wlan_adapter
*adapter
= priv
->adapter
;
114 lbs_deb_enter(LBS_DEB_JOIN
);
116 ret
= libertas_prepare_and_send_command(priv
, cmd_802_11_authenticate
,
117 0, cmd_option_waitforrsp
,
118 0, assoc_req
->bss
.bssid
);
123 /* set preamble to firmware */
124 if (adapter
->capinfo
.shortpreamble
&& assoc_req
->bss
.cap
.shortpreamble
)
125 adapter
->preamble
= cmd_type_short_preamble
;
127 adapter
->preamble
= cmd_type_long_preamble
;
129 libertas_set_radio_control(priv
);
131 ret
= libertas_prepare_and_send_command(priv
, cmd_802_11_associate
,
132 0, cmd_option_waitforrsp
, 0, assoc_req
);
135 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
140 * @brief Start an Adhoc Network
142 * @param priv A pointer to wlan_private structure
143 * @param adhocssid The ssid of the Adhoc Network
144 * @return 0--success, -1--fail
146 int libertas_start_adhoc_network(wlan_private
* priv
, struct assoc_request
* assoc_req
)
148 wlan_adapter
*adapter
= priv
->adapter
;
151 adapter
->adhoccreate
= 1;
153 if (!adapter
->capinfo
.shortpreamble
) {
154 lbs_deb_join("AdhocStart: Long preamble\n");
155 adapter
->preamble
= cmd_type_long_preamble
;
157 lbs_deb_join("AdhocStart: Short preamble\n");
158 adapter
->preamble
= cmd_type_short_preamble
;
161 libertas_set_radio_control(priv
);
163 lbs_deb_join("AdhocStart: channel = %d\n", assoc_req
->channel
);
164 lbs_deb_join("AdhocStart: band = %d\n", assoc_req
->band
);
166 ret
= libertas_prepare_and_send_command(priv
, cmd_802_11_ad_hoc_start
,
167 0, cmd_option_waitforrsp
, 0, assoc_req
);
173 * @brief Join an adhoc network found in a previous scan
175 * @param priv A pointer to wlan_private structure
176 * @param pbssdesc Pointer to a BSS descriptor found in a previous scan
179 * @return 0--success, -1--fail
181 int libertas_join_adhoc_network(wlan_private
* priv
, struct assoc_request
* assoc_req
)
183 wlan_adapter
*adapter
= priv
->adapter
;
184 struct bss_descriptor
* bss
= &assoc_req
->bss
;
187 lbs_deb_join("libertas_join_adhoc_network: CurBss.ssid =%s\n",
188 adapter
->curbssparams
.ssid
.ssid
);
189 lbs_deb_join("libertas_join_adhoc_network: CurBss.ssid_len =%u\n",
190 adapter
->curbssparams
.ssid
.ssidlength
);
191 lbs_deb_join("libertas_join_adhoc_network: ssid = '%s'\n",
193 lbs_deb_join("libertas_join_adhoc_network: ssid len = %u\n",
194 bss
->ssid
.ssidlength
);
196 /* check if the requested SSID is already joined */
197 if (adapter
->curbssparams
.ssid
.ssidlength
198 && !libertas_SSID_cmp(&bss
->ssid
, &adapter
->curbssparams
.ssid
)
199 && (adapter
->mode
== IW_MODE_ADHOC
)) {
201 "ADHOC_J_CMD: New ad-hoc SSID is the same as current, "
202 "not attempting to re-join");
206 /*Use shortpreamble only when both creator and card supports
208 if (!bss
->cap
.shortpreamble
|| !adapter
->capinfo
.shortpreamble
) {
209 lbs_deb_join("AdhocJoin: Long preamble\n");
210 adapter
->preamble
= cmd_type_long_preamble
;
212 lbs_deb_join("AdhocJoin: Short preamble\n");
213 adapter
->preamble
= cmd_type_short_preamble
;
216 libertas_set_radio_control(priv
);
218 lbs_deb_join("AdhocJoin: channel = %d\n", assoc_req
->channel
);
219 lbs_deb_join("AdhocJoin: band = %c\n", assoc_req
->band
);
221 adapter
->adhoccreate
= 0;
223 ret
= libertas_prepare_and_send_command(priv
, cmd_802_11_ad_hoc_join
,
224 0, cmd_option_waitforrsp
,
225 OID_802_11_SSID
, assoc_req
);
230 int libertas_stop_adhoc_network(wlan_private
* priv
)
232 return libertas_prepare_and_send_command(priv
, cmd_802_11_ad_hoc_stop
,
233 0, cmd_option_waitforrsp
, 0, NULL
);
237 * @brief Send Deauthentication Request
239 * @param priv A pointer to wlan_private structure
240 * @return 0--success, -1--fail
242 int libertas_send_deauthentication(wlan_private
* priv
)
244 return libertas_prepare_and_send_command(priv
, cmd_802_11_deauthenticate
,
245 0, cmd_option_waitforrsp
, 0, NULL
);
249 * @brief This function prepares command of authenticate.
251 * @param priv A pointer to wlan_private structure
252 * @param cmd A pointer to cmd_ds_command structure
253 * @param pdata_buf Void cast of pointer to a BSSID to authenticate with
257 int libertas_cmd_80211_authenticate(wlan_private
* priv
,
258 struct cmd_ds_command
*cmd
,
261 wlan_adapter
*adapter
= priv
->adapter
;
262 struct cmd_ds_802_11_authenticate
*pauthenticate
= &cmd
->params
.auth
;
264 u8
*bssid
= pdata_buf
;
266 lbs_deb_enter(LBS_DEB_JOIN
);
268 cmd
->command
= cpu_to_le16(cmd_802_11_authenticate
);
269 cmd
->size
= cpu_to_le16(sizeof(struct cmd_ds_802_11_authenticate
)
272 /* translate auth mode to 802.11 defined wire value */
273 switch (adapter
->secinfo
.auth_mode
) {
274 case IW_AUTH_ALG_OPEN_SYSTEM
:
275 pauthenticate
->authtype
= 0x00;
277 case IW_AUTH_ALG_SHARED_KEY
:
278 pauthenticate
->authtype
= 0x01;
280 case IW_AUTH_ALG_LEAP
:
281 pauthenticate
->authtype
= 0x80;
284 lbs_deb_join("AUTH_CMD: invalid auth alg 0x%X\n",
285 adapter
->secinfo
.auth_mode
);
289 memcpy(pauthenticate
->macaddr
, bssid
, ETH_ALEN
);
291 lbs_deb_join("AUTH_CMD: BSSID is : " MAC_FMT
" auth=0x%X\n",
292 MAC_ARG(bssid
), pauthenticate
->authtype
);
296 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
300 int libertas_cmd_80211_deauthenticate(wlan_private
* priv
,
301 struct cmd_ds_command
*cmd
)
303 wlan_adapter
*adapter
= priv
->adapter
;
304 struct cmd_ds_802_11_deauthenticate
*dauth
= &cmd
->params
.deauth
;
306 lbs_deb_enter(LBS_DEB_JOIN
);
308 cmd
->command
= cpu_to_le16(cmd_802_11_deauthenticate
);
309 cmd
->size
= cpu_to_le16(sizeof(struct cmd_ds_802_11_deauthenticate
) +
312 /* set AP MAC address */
313 memmove(dauth
->macaddr
, adapter
->curbssparams
.bssid
, ETH_ALEN
);
315 /* Reason code 3 = Station is leaving */
316 #define REASON_CODE_STA_LEAVING 3
317 dauth
->reasoncode
= cpu_to_le16(REASON_CODE_STA_LEAVING
);
319 lbs_deb_leave(LBS_DEB_JOIN
);
323 int libertas_cmd_80211_associate(wlan_private
* priv
,
324 struct cmd_ds_command
*cmd
, void *pdata_buf
)
326 wlan_adapter
*adapter
= priv
->adapter
;
327 struct cmd_ds_802_11_associate
*passo
= &cmd
->params
.associate
;
329 struct assoc_request
* assoc_req
= pdata_buf
;
330 struct bss_descriptor
* bss
= &assoc_req
->bss
;
335 struct mrvlietypes_ssidparamset
*ssid
;
336 struct mrvlietypes_phyparamset
*phy
;
337 struct mrvlietypes_ssparamset
*ss
;
338 struct mrvlietypes_ratesparamset
*rates
;
339 struct mrvlietypes_rsnparamset
*rsn
;
341 lbs_deb_enter(LBS_DEB_JOIN
);
350 cmd
->command
= cpu_to_le16(cmd_802_11_associate
);
352 memcpy(passo
->peerstaaddr
, bss
->bssid
, sizeof(passo
->peerstaaddr
));
353 pos
+= sizeof(passo
->peerstaaddr
);
355 /* set the listen interval */
356 passo
->listeninterval
= cpu_to_le16(adapter
->listeninterval
);
358 pos
+= sizeof(passo
->capinfo
);
359 pos
+= sizeof(passo
->listeninterval
);
360 pos
+= sizeof(passo
->bcnperiod
);
361 pos
+= sizeof(passo
->dtimperiod
);
363 ssid
= (struct mrvlietypes_ssidparamset
*) pos
;
364 ssid
->header
.type
= cpu_to_le16(TLV_TYPE_SSID
);
365 tmplen
= bss
->ssid
.ssidlength
;
366 ssid
->header
.len
= cpu_to_le16(tmplen
);
367 memcpy(ssid
->ssid
, bss
->ssid
.ssid
, tmplen
);
368 pos
+= sizeof(ssid
->header
) + tmplen
;
370 phy
= (struct mrvlietypes_phyparamset
*) pos
;
371 phy
->header
.type
= cpu_to_le16(TLV_TYPE_PHY_DS
);
372 tmplen
= sizeof(phy
->fh_ds
.dsparamset
);
373 phy
->header
.len
= cpu_to_le16(tmplen
);
374 memcpy(&phy
->fh_ds
.dsparamset
,
375 &bss
->phyparamset
.dsparamset
.currentchan
,
377 pos
+= sizeof(phy
->header
) + tmplen
;
379 ss
= (struct mrvlietypes_ssparamset
*) pos
;
380 ss
->header
.type
= cpu_to_le16(TLV_TYPE_CF
);
381 tmplen
= sizeof(ss
->cf_ibss
.cfparamset
);
382 ss
->header
.len
= cpu_to_le16(tmplen
);
383 pos
+= sizeof(ss
->header
) + tmplen
;
385 rates
= (struct mrvlietypes_ratesparamset
*) pos
;
386 rates
->header
.type
= cpu_to_le16(TLV_TYPE_RATES
);
388 memcpy(&rates
->rates
, &bss
->libertas_supported_rates
, WLAN_SUPPORTED_RATES
);
390 card_rates
= libertas_supported_rates
;
391 card_rates_size
= sizeof(libertas_supported_rates
);
393 if (get_common_rates(adapter
, rates
->rates
, WLAN_SUPPORTED_RATES
,
394 card_rates
, card_rates_size
)) {
399 tmplen
= min_t(size_t, strlen(rates
->rates
), WLAN_SUPPORTED_RATES
);
400 adapter
->curbssparams
.numofrates
= tmplen
;
402 pos
+= sizeof(rates
->header
) + tmplen
;
403 rates
->header
.len
= cpu_to_le16(tmplen
);
405 if (assoc_req
->secinfo
.WPAenabled
|| assoc_req
->secinfo
.WPA2enabled
) {
406 rsn
= (struct mrvlietypes_rsnparamset
*) pos
;
407 /* WPA_IE or WPA2_IE */
408 rsn
->header
.type
= cpu_to_le16((u16
) assoc_req
->wpa_ie
[0]);
409 tmplen
= (u16
) assoc_req
->wpa_ie
[1];
410 rsn
->header
.len
= cpu_to_le16(tmplen
);
411 memcpy(rsn
->rsnie
, &assoc_req
->wpa_ie
[2], tmplen
);
412 lbs_dbg_hex("ASSOC_CMD: RSN IE", (u8
*) rsn
,
413 sizeof(rsn
->header
) + tmplen
);
414 pos
+= sizeof(rsn
->header
) + tmplen
;
417 /* update curbssparams */
418 adapter
->curbssparams
.channel
= bss
->phyparamset
.dsparamset
.currentchan
;
420 /* Copy the infra. association rates into Current BSS state structure */
421 memcpy(&adapter
->curbssparams
.datarates
, &rates
->rates
,
422 min_t(size_t, sizeof(adapter
->curbssparams
.datarates
),
423 cpu_to_le16(rates
->header
.len
)));
425 lbs_deb_join("ASSOC_CMD: rates->header.len = %d\n",
426 cpu_to_le16(rates
->header
.len
));
429 if (bss
->mode
== IW_MODE_INFRA
) {
430 #define CAPINFO_ESS_MODE 1
431 passo
->capinfo
.ess
= CAPINFO_ESS_MODE
;
434 if (libertas_parse_dnld_countryinfo_11d(priv
, bss
)) {
439 cmd
->size
= cpu_to_le16((u16
) (pos
- (u8
*) passo
) + S_DS_GEN
);
441 /* set the capability info at last */
442 memcpy(&tmpcap
, &bss
->cap
, sizeof(passo
->capinfo
));
443 tmpcap
&= CAPINFO_MASK
;
444 lbs_deb_join("ASSOC_CMD: tmpcap=%4X CAPINFO_MASK=%4X\n",
445 tmpcap
, CAPINFO_MASK
);
446 memcpy(&passo
->capinfo
, &tmpcap
, sizeof(passo
->capinfo
));
449 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
453 int libertas_cmd_80211_ad_hoc_start(wlan_private
* priv
,
454 struct cmd_ds_command
*cmd
, void *pdata_buf
)
456 wlan_adapter
*adapter
= priv
->adapter
;
457 struct cmd_ds_802_11_ad_hoc_start
*adhs
= &cmd
->params
.ads
;
459 int cmdappendsize
= 0;
461 struct assoc_request
* assoc_req
= pdata_buf
;
463 lbs_deb_enter(LBS_DEB_JOIN
);
470 cmd
->command
= cpu_to_le16(cmd_802_11_ad_hoc_start
);
473 * Fill in the parameters for 2 data structures:
474 * 1. cmd_ds_802_11_ad_hoc_start command
475 * 2. adapter->scantable[i]
477 * Driver will fill up SSID, bsstype,IBSS param, Physical Param,
478 * probe delay, and cap info.
480 * Firmware will fill up beacon period, DTIM, Basic rates
481 * and operational rates.
484 memset(adhs
->SSID
, 0, IW_ESSID_MAX_SIZE
);
485 memcpy(adhs
->SSID
, assoc_req
->ssid
.ssid
, assoc_req
->ssid
.ssidlength
);
487 lbs_deb_join("ADHOC_S_CMD: SSID = %s\n", adhs
->SSID
);
489 /* set the BSS type */
490 adhs
->bsstype
= cmd_bss_type_ibss
;
491 adapter
->mode
= IW_MODE_ADHOC
;
492 adhs
->beaconperiod
= cpu_to_le16(adapter
->beaconperiod
);
494 /* set Physical param set */
495 #define DS_PARA_IE_ID 3
496 #define DS_PARA_IE_LEN 1
498 adhs
->phyparamset
.dsparamset
.elementid
= DS_PARA_IE_ID
;
499 adhs
->phyparamset
.dsparamset
.len
= DS_PARA_IE_LEN
;
501 WARN_ON(!assoc_req
->channel
);
503 lbs_deb_join("ADHOC_S_CMD: Creating ADHOC on channel %d\n",
506 adhs
->phyparamset
.dsparamset
.currentchan
= assoc_req
->channel
;
508 /* set IBSS param set */
509 #define IBSS_PARA_IE_ID 6
510 #define IBSS_PARA_IE_LEN 2
512 adhs
->ssparamset
.ibssparamset
.elementid
= IBSS_PARA_IE_ID
;
513 adhs
->ssparamset
.ibssparamset
.len
= IBSS_PARA_IE_LEN
;
514 adhs
->ssparamset
.ibssparamset
.atimwindow
= cpu_to_le16(adapter
->atimwindow
);
516 /* set capability info */
521 adhs
->probedelay
= cpu_to_le16(cmd_scan_probe_delay_time
);
523 /* set up privacy in adapter->scantable[i] */
524 if (assoc_req
->secinfo
.wep_enabled
) {
525 lbs_deb_join("ADHOC_S_CMD: WEP enabled, setting privacy on\n");
526 adhs
->cap
.privacy
= AD_HOC_CAP_PRIVACY_ON
;
528 lbs_deb_join("ADHOC_S_CMD: WEP disabled, setting privacy off\n");
531 memset(adhs
->datarate
, 0, sizeof(adhs
->datarate
));
533 if (adapter
->adhoc_grate_enabled
) {
534 memcpy(adhs
->datarate
, libertas_adhoc_rates_g
,
535 min(sizeof(adhs
->datarate
), sizeof(libertas_adhoc_rates_g
)));
537 memcpy(adhs
->datarate
, libertas_adhoc_rates_b
,
538 min(sizeof(adhs
->datarate
), sizeof(libertas_adhoc_rates_b
)));
541 /* Find the last non zero */
542 for (i
= 0; i
< sizeof(adhs
->datarate
) && adhs
->datarate
[i
]; i
++) ;
544 adapter
->curbssparams
.numofrates
= i
;
546 /* Copy the ad-hoc creating rates into Current BSS state structure */
547 memcpy(&adapter
->curbssparams
.datarates
,
548 &adhs
->datarate
, adapter
->curbssparams
.numofrates
);
550 lbs_deb_join("ADHOC_S_CMD: rates=%02x %02x %02x %02x \n",
551 adhs
->datarate
[0], adhs
->datarate
[1],
552 adhs
->datarate
[2], adhs
->datarate
[3]);
554 lbs_deb_join("ADHOC_S_CMD: AD HOC Start command is ready\n");
556 if (libertas_create_dnld_countryinfo_11d(priv
)) {
557 lbs_deb_join("ADHOC_S_CMD: dnld_countryinfo_11d failed\n");
562 cmd
->size
= cpu_to_le16(sizeof(struct cmd_ds_802_11_ad_hoc_start
) +
563 S_DS_GEN
+ cmdappendsize
);
567 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
571 int libertas_cmd_80211_ad_hoc_stop(wlan_private
* priv
,
572 struct cmd_ds_command
*cmd
)
574 cmd
->command
= cpu_to_le16(cmd_802_11_ad_hoc_stop
);
575 cmd
->size
= cpu_to_le16(S_DS_GEN
);
580 int libertas_cmd_80211_ad_hoc_join(wlan_private
* priv
,
581 struct cmd_ds_command
*cmd
, void *pdata_buf
)
583 wlan_adapter
*adapter
= priv
->adapter
;
584 struct cmd_ds_802_11_ad_hoc_join
*padhocjoin
= &cmd
->params
.adj
;
585 struct assoc_request
* assoc_req
= pdata_buf
;
586 struct bss_descriptor
*bss
= &assoc_req
->bss
;
587 int cmdappendsize
= 0;
594 lbs_deb_enter(LBS_DEB_JOIN
);
596 cmd
->command
= cpu_to_le16(cmd_802_11_ad_hoc_join
);
598 padhocjoin
->bssdescriptor
.bsstype
= cmd_bss_type_ibss
;
600 padhocjoin
->bssdescriptor
.beaconperiod
= cpu_to_le16(bss
->beaconperiod
);
602 memcpy(&padhocjoin
->bssdescriptor
.BSSID
, &bss
->bssid
, ETH_ALEN
);
603 memcpy(&padhocjoin
->bssdescriptor
.SSID
, &bss
->ssid
.ssid
, bss
->ssid
.ssidlength
);
605 memcpy(&padhocjoin
->bssdescriptor
.phyparamset
,
606 &bss
->phyparamset
, sizeof(union ieeetypes_phyparamset
));
608 memcpy(&padhocjoin
->bssdescriptor
.ssparamset
,
609 &bss
->ssparamset
, sizeof(union IEEEtypes_ssparamset
));
611 memcpy(&tmpcap
, &bss
->cap
, sizeof(struct ieeetypes_capinfo
));
612 tmpcap
&= CAPINFO_MASK
;
614 lbs_deb_join("ADHOC_J_CMD: tmpcap=%4X CAPINFO_MASK=%4X\n",
615 tmpcap
, CAPINFO_MASK
);
616 memcpy(&padhocjoin
->bssdescriptor
.cap
, &tmpcap
,
617 sizeof(struct ieeetypes_capinfo
));
619 /* information on BSSID descriptor passed to FW */
621 "ADHOC_J_CMD: BSSID = " MAC_FMT
", SSID = '%s'\n",
622 MAC_ARG(padhocjoin
->bssdescriptor
.BSSID
),
623 padhocjoin
->bssdescriptor
.SSID
);
626 padhocjoin
->failtimeout
= cpu_to_le16(MRVDRV_ASSOCIATION_TIME_OUT
);
629 padhocjoin
->probedelay
= cpu_to_le16(cmd_scan_probe_delay_time
);
631 /* Copy Data rates from the rates recorded in scan response */
632 memset(padhocjoin
->bssdescriptor
.datarates
, 0,
633 sizeof(padhocjoin
->bssdescriptor
.datarates
));
634 memcpy(padhocjoin
->bssdescriptor
.datarates
, bss
->datarates
,
635 min(sizeof(padhocjoin
->bssdescriptor
.datarates
),
636 sizeof(bss
->datarates
)));
638 card_rates
= libertas_supported_rates
;
639 card_rates_size
= sizeof(libertas_supported_rates
);
641 adapter
->curbssparams
.channel
= bss
->channel
;
643 if (get_common_rates(adapter
, padhocjoin
->bssdescriptor
.datarates
,
644 sizeof(padhocjoin
->bssdescriptor
.datarates
),
645 card_rates
, card_rates_size
)) {
646 lbs_deb_join("ADHOC_J_CMD: get_common_rates returns error.\n");
651 /* Find the last non zero */
652 for (i
= 0; i
< sizeof(padhocjoin
->bssdescriptor
.datarates
)
653 && padhocjoin
->bssdescriptor
.datarates
[i
]; i
++) ;
655 adapter
->curbssparams
.numofrates
= i
;
658 * Copy the adhoc joining rates to Current BSS State structure
660 memcpy(adapter
->curbssparams
.datarates
,
661 padhocjoin
->bssdescriptor
.datarates
,
662 adapter
->curbssparams
.numofrates
);
664 padhocjoin
->bssdescriptor
.ssparamset
.ibssparamset
.atimwindow
=
665 cpu_to_le16(bss
->atimwindow
);
667 if (assoc_req
->secinfo
.wep_enabled
) {
668 padhocjoin
->bssdescriptor
.cap
.privacy
= AD_HOC_CAP_PRIVACY_ON
;
671 if (adapter
->psmode
== wlan802_11powermodemax_psp
) {
675 Localpsmode
= cpu_to_le32(wlan802_11powermodecam
);
676 ret
= libertas_prepare_and_send_command(priv
,
687 if (libertas_parse_dnld_countryinfo_11d(priv
, bss
)) {
692 cmd
->size
= cpu_to_le16(sizeof(struct cmd_ds_802_11_ad_hoc_join
) +
693 S_DS_GEN
+ cmdappendsize
);
696 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
700 int libertas_ret_80211_associate(wlan_private
* priv
,
701 struct cmd_ds_command
*resp
)
703 wlan_adapter
*adapter
= priv
->adapter
;
705 union iwreq_data wrqu
;
706 struct ieeetypes_assocrsp
*passocrsp
;
707 struct bss_descriptor
* bss
;
709 lbs_deb_enter(LBS_DEB_JOIN
);
711 if (!adapter
->in_progress_assoc_req
) {
712 lbs_deb_join("ASSOC_RESP: no in-progress association request\n");
716 bss
= &adapter
->in_progress_assoc_req
->bss
;
718 passocrsp
= (struct ieeetypes_assocrsp
*) & resp
->params
;
720 if (le16_to_cpu(passocrsp
->statuscode
)) {
721 libertas_mac_event_disconnected(priv
);
723 lbs_deb_join("ASSOC_RESP: Association failed, status code = %d\n",
724 le16_to_cpu(passocrsp
->statuscode
));
730 lbs_dbg_hex("ASSOC_RESP:", (void *)&resp
->params
,
731 le16_to_cpu(resp
->size
) - S_DS_GEN
);
733 /* Send a Media Connected event, according to the Spec */
734 adapter
->connect_status
= libertas_connected
;
736 lbs_deb_join("ASSOC_RESP: %s\n", bss
->ssid
.ssid
);
738 /* Update current SSID and BSSID */
739 memcpy(&adapter
->curbssparams
.ssid
,
740 &bss
->ssid
, sizeof(struct WLAN_802_11_SSID
));
741 memcpy(adapter
->curbssparams
.bssid
, bss
->bssid
, ETH_ALEN
);
743 lbs_deb_join("ASSOC_RESP: currentpacketfilter is %x\n",
744 adapter
->currentpacketfilter
);
746 adapter
->SNR
[TYPE_RXPD
][TYPE_AVG
] = 0;
747 adapter
->NF
[TYPE_RXPD
][TYPE_AVG
] = 0;
749 memset(adapter
->rawSNR
, 0x00, sizeof(adapter
->rawSNR
));
750 memset(adapter
->rawNF
, 0x00, sizeof(adapter
->rawNF
));
751 adapter
->nextSNRNF
= 0;
752 adapter
->numSNRNF
= 0;
754 netif_carrier_on(priv
->dev
);
755 netif_wake_queue(priv
->dev
);
757 netif_carrier_on(priv
->mesh_dev
);
758 netif_wake_queue(priv
->mesh_dev
);
760 lbs_deb_join("ASSOC_RESP: Associated \n");
762 memcpy(wrqu
.ap_addr
.sa_data
, adapter
->curbssparams
.bssid
, ETH_ALEN
);
763 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
764 wireless_send_event(priv
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
767 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
771 int libertas_ret_80211_disassociate(wlan_private
* priv
,
772 struct cmd_ds_command
*resp
)
774 lbs_deb_enter(LBS_DEB_JOIN
);
776 libertas_mac_event_disconnected(priv
);
778 lbs_deb_leave(LBS_DEB_JOIN
);
782 int libertas_ret_80211_ad_hoc_start(wlan_private
* priv
,
783 struct cmd_ds_command
*resp
)
785 wlan_adapter
*adapter
= priv
->adapter
;
787 u16 command
= le16_to_cpu(resp
->command
);
788 u16 result
= le16_to_cpu(resp
->result
);
789 struct cmd_ds_802_11_ad_hoc_result
*padhocresult
;
790 union iwreq_data wrqu
;
791 struct bss_descriptor
*bss
;
793 lbs_deb_enter(LBS_DEB_JOIN
);
795 padhocresult
= &resp
->params
.result
;
797 lbs_deb_join("ADHOC_RESP: size = %d\n", le16_to_cpu(resp
->size
));
798 lbs_deb_join("ADHOC_RESP: command = %x\n", command
);
799 lbs_deb_join("ADHOC_RESP: result = %x\n", result
);
801 if (!adapter
->in_progress_assoc_req
) {
802 lbs_deb_join("ADHOC_RESP: no in-progress association request\n");
806 bss
= &adapter
->in_progress_assoc_req
->bss
;
809 * Join result code 0 --> SUCCESS
812 lbs_deb_join("ADHOC_RESP: failed\n");
813 if (adapter
->connect_status
== libertas_connected
) {
814 libertas_mac_event_disconnected(priv
);
821 * Now the join cmd should be successful
822 * If BSSID has changed use SSID to compare instead of BSSID
824 lbs_deb_join("ADHOC_RESP: %s\n", bss
->ssid
.ssid
);
826 /* Send a Media Connected event, according to the Spec */
827 adapter
->connect_status
= libertas_connected
;
829 if (command
== cmd_ret_802_11_ad_hoc_start
) {
830 /* Update the created network descriptor with the new BSSID */
831 memcpy(bss
->bssid
, padhocresult
->BSSID
, ETH_ALEN
);
834 /* Set the BSSID from the joined/started descriptor */
835 memcpy(&adapter
->curbssparams
.bssid
, bss
->bssid
, ETH_ALEN
);
837 /* Set the new SSID to current SSID */
838 memcpy(&adapter
->curbssparams
.ssid
, &bss
->ssid
,
839 sizeof(struct WLAN_802_11_SSID
));
841 netif_carrier_on(priv
->dev
);
842 netif_wake_queue(priv
->dev
);
844 netif_carrier_on(priv
->mesh_dev
);
845 netif_wake_queue(priv
->mesh_dev
);
847 memset(&wrqu
, 0, sizeof(wrqu
));
848 memcpy(wrqu
.ap_addr
.sa_data
, adapter
->curbssparams
.bssid
, ETH_ALEN
);
849 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
850 wireless_send_event(priv
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
852 lbs_deb_join("ADHOC_RESP: - Joined/Started Ad Hoc\n");
853 lbs_deb_join("ADHOC_RESP: channel = %d\n", adapter
->curbssparams
.channel
);
854 lbs_deb_join("ADHOC_RESP: BSSID = " MAC_FMT
"\n",
855 MAC_ARG(padhocresult
->BSSID
));
858 lbs_deb_leave_args(LBS_DEB_JOIN
, "ret %d", ret
);
862 int libertas_ret_80211_ad_hoc_stop(wlan_private
* priv
,
863 struct cmd_ds_command
*resp
)
865 lbs_deb_enter(LBS_DEB_JOIN
);
867 libertas_mac_event_disconnected(priv
);
869 lbs_deb_leave(LBS_DEB_JOIN
);