2 * Marvell Wireless LAN device driver: major functions
4 * Copyright (C) 2011, Marvell International Ltd.
6 * This software file (the "File") is distributed by Marvell International
7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
8 * (the "License"). You may use, redistribute and/or modify this File in
9 * accordance with the terms and conditions of the License, a copy of which
10 * is available by writing to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
14 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16 * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
17 * this warranty disclaimer.
27 const char driver_version
[] = "mwifiex " VERSION
" (%s) ";
28 static char *cal_data_cfg
;
29 module_param(cal_data_cfg
, charp
, 0);
31 static void scan_delay_timer_fn(unsigned long data
)
33 struct mwifiex_private
*priv
= (struct mwifiex_private
*)data
;
34 struct mwifiex_adapter
*adapter
= priv
->adapter
;
35 struct cmd_ctrl_node
*cmd_node
, *tmp_node
;
38 if (adapter
->surprise_removed
)
41 if (adapter
->scan_delay_cnt
== MWIFIEX_MAX_SCAN_DELAY_CNT
||
42 !adapter
->scan_processing
) {
44 * Abort scan operation by cancelling all pending scan
47 spin_lock_irqsave(&adapter
->scan_pending_q_lock
, flags
);
48 list_for_each_entry_safe(cmd_node
, tmp_node
,
49 &adapter
->scan_pending_q
, list
) {
50 list_del(&cmd_node
->list
);
51 mwifiex_insert_cmd_to_free_q(adapter
, cmd_node
);
53 spin_unlock_irqrestore(&adapter
->scan_pending_q_lock
, flags
);
55 spin_lock_irqsave(&adapter
->mwifiex_cmd_lock
, flags
);
56 adapter
->scan_processing
= false;
57 adapter
->scan_delay_cnt
= 0;
58 adapter
->empty_tx_q_cnt
= 0;
59 spin_unlock_irqrestore(&adapter
->mwifiex_cmd_lock
, flags
);
61 if (priv
->scan_request
) {
62 dev_dbg(adapter
->dev
, "info: aborting scan\n");
63 cfg80211_scan_done(priv
->scan_request
, 1);
64 priv
->scan_request
= NULL
;
66 priv
->scan_aborting
= false;
67 dev_dbg(adapter
->dev
, "info: scan already aborted\n");
72 if (!atomic_read(&priv
->adapter
->is_tx_received
)) {
73 adapter
->empty_tx_q_cnt
++;
74 if (adapter
->empty_tx_q_cnt
== MWIFIEX_MAX_EMPTY_TX_Q_CNT
) {
76 * No Tx traffic for 200msec. Get scan command from
77 * scan pending queue and put to cmd pending queue to
78 * resume scan operation
80 adapter
->scan_delay_cnt
= 0;
81 adapter
->empty_tx_q_cnt
= 0;
82 spin_lock_irqsave(&adapter
->scan_pending_q_lock
, flags
);
83 cmd_node
= list_first_entry(&adapter
->scan_pending_q
,
84 struct cmd_ctrl_node
, list
);
85 list_del(&cmd_node
->list
);
86 spin_unlock_irqrestore(&adapter
->scan_pending_q_lock
,
89 mwifiex_insert_cmd_to_pending_q(adapter
, cmd_node
,
91 queue_work(adapter
->workqueue
, &adapter
->main_work
);
95 adapter
->empty_tx_q_cnt
= 0;
98 /* Delay scan operation further by 20msec */
99 mod_timer(&priv
->scan_delay_timer
, jiffies
+
100 msecs_to_jiffies(MWIFIEX_SCAN_DELAY_MSEC
));
101 adapter
->scan_delay_cnt
++;
104 if (atomic_read(&priv
->adapter
->is_tx_received
))
105 atomic_set(&priv
->adapter
->is_tx_received
, false);
111 * This function registers the device and performs all the necessary
114 * The following initialization operations are performed -
115 * - Allocate adapter structure
116 * - Save interface specific operations table in adapter
117 * - Call interface specific initialization routine
118 * - Allocate private structures
119 * - Set default adapter structure parameters
122 * In case of any errors during inittialization, this function also ensures
123 * proper cleanup before exiting.
125 static int mwifiex_register(void *card
, struct mwifiex_if_ops
*if_ops
,
128 struct mwifiex_adapter
*adapter
;
131 adapter
= kzalloc(sizeof(struct mwifiex_adapter
), GFP_KERNEL
);
136 adapter
->card
= card
;
138 /* Save interface specific operations in adapter */
139 memmove(&adapter
->if_ops
, if_ops
, sizeof(struct mwifiex_if_ops
));
141 /* card specific initialization has been deferred until now .. */
142 if (adapter
->if_ops
.init_if
)
143 if (adapter
->if_ops
.init_if(adapter
))
146 adapter
->priv_num
= 0;
148 for (i
= 0; i
< MWIFIEX_MAX_BSS_NUM
; i
++) {
149 /* Allocate memory for private structure */
151 kzalloc(sizeof(struct mwifiex_private
), GFP_KERNEL
);
152 if (!adapter
->priv
[i
])
155 adapter
->priv
[i
]->adapter
= adapter
;
158 setup_timer(&adapter
->priv
[i
]->scan_delay_timer
,
160 (unsigned long)adapter
->priv
[i
]);
162 mwifiex_init_lock_list(adapter
);
164 init_timer(&adapter
->cmd_timer
);
165 adapter
->cmd_timer
.function
= mwifiex_cmd_timeout_func
;
166 adapter
->cmd_timer
.data
= (unsigned long) adapter
;
171 dev_dbg(adapter
->dev
, "info: leave mwifiex_register with error\n");
173 for (i
= 0; i
< adapter
->priv_num
; i
++)
174 kfree(adapter
->priv
[i
]);
182 * This function unregisters the device and performs all the necessary
185 * The following cleanup operations are performed -
187 * - Free beacon buffers
188 * - Free private structures
189 * - Free adapter structure
191 static int mwifiex_unregister(struct mwifiex_adapter
*adapter
)
195 if (adapter
->if_ops
.cleanup_if
)
196 adapter
->if_ops
.cleanup_if(adapter
);
198 del_timer_sync(&adapter
->cmd_timer
);
200 /* Free private structures */
201 for (i
= 0; i
< adapter
->priv_num
; i
++) {
202 if (adapter
->priv
[i
]) {
203 mwifiex_free_curr_bcn(adapter
->priv
[i
]);
204 del_timer_sync(&adapter
->priv
[i
]->scan_delay_timer
);
205 kfree(adapter
->priv
[i
]);
216 * This function is the main procedure of the driver and handles various driver
217 * operations. It runs in a loop and provides the core functionalities.
219 * The main responsibilities of this function are -
220 * - Ensure concurrency control
221 * - Handle pending interrupts and call interrupt handlers
222 * - Wake up the card if required
223 * - Handle command responses and call response handlers
224 * - Handle events and call event handlers
225 * - Execute pending commands
226 * - Transmit pending data packets
228 int mwifiex_main_process(struct mwifiex_adapter
*adapter
)
234 spin_lock_irqsave(&adapter
->main_proc_lock
, flags
);
236 /* Check if already processing */
237 if (adapter
->mwifiex_processing
) {
238 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
241 adapter
->mwifiex_processing
= true;
242 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
246 if ((adapter
->hw_status
== MWIFIEX_HW_STATUS_CLOSING
) ||
247 (adapter
->hw_status
== MWIFIEX_HW_STATUS_NOT_READY
))
250 /* Handle pending interrupt if any */
251 if (adapter
->int_status
) {
252 if (adapter
->hs_activated
)
253 mwifiex_process_hs_config(adapter
);
254 if (adapter
->if_ops
.process_int_status
)
255 adapter
->if_ops
.process_int_status(adapter
);
258 /* Need to wake up the card ? */
259 if ((adapter
->ps_state
== PS_STATE_SLEEP
) &&
260 (adapter
->pm_wakeup_card_req
&&
261 !adapter
->pm_wakeup_fw_try
) &&
262 (is_command_pending(adapter
) ||
263 !mwifiex_wmm_lists_empty(adapter
))) {
264 adapter
->pm_wakeup_fw_try
= true;
265 adapter
->if_ops
.wakeup(adapter
);
269 if (IS_CARD_RX_RCVD(adapter
)) {
270 adapter
->pm_wakeup_fw_try
= false;
271 if (adapter
->ps_state
== PS_STATE_SLEEP
)
272 adapter
->ps_state
= PS_STATE_AWAKE
;
274 /* We have tried to wakeup the card already */
275 if (adapter
->pm_wakeup_fw_try
)
277 if (adapter
->ps_state
!= PS_STATE_AWAKE
||
278 adapter
->tx_lock_flag
)
281 if ((adapter
->scan_processing
&&
282 !adapter
->scan_delay_cnt
) || adapter
->data_sent
||
283 mwifiex_wmm_lists_empty(adapter
)) {
284 if (adapter
->cmd_sent
|| adapter
->curr_cmd
||
285 (!is_command_pending(adapter
)))
290 /* Check Rx data for USB */
291 if (adapter
->iface_type
== MWIFIEX_USB
)
292 while ((skb
= skb_dequeue(&adapter
->usb_rx_data_q
)))
293 mwifiex_handle_rx_packet(adapter
, skb
);
295 /* Check for event */
296 if (adapter
->event_received
) {
297 adapter
->event_received
= false;
298 mwifiex_process_event(adapter
);
301 /* Check for Cmd Resp */
302 if (adapter
->cmd_resp_received
) {
303 adapter
->cmd_resp_received
= false;
304 mwifiex_process_cmdresp(adapter
);
306 /* call mwifiex back when init_fw is done */
307 if (adapter
->hw_status
== MWIFIEX_HW_STATUS_INIT_DONE
) {
308 adapter
->hw_status
= MWIFIEX_HW_STATUS_READY
;
309 mwifiex_init_fw_complete(adapter
);
313 /* Check if we need to confirm Sleep Request
314 received previously */
315 if (adapter
->ps_state
== PS_STATE_PRE_SLEEP
) {
316 if (!adapter
->cmd_sent
&& !adapter
->curr_cmd
)
317 mwifiex_check_ps_cond(adapter
);
320 /* * The ps_state may have been changed during processing of
321 * Sleep Request event.
323 if ((adapter
->ps_state
== PS_STATE_SLEEP
) ||
324 (adapter
->ps_state
== PS_STATE_PRE_SLEEP
) ||
325 (adapter
->ps_state
== PS_STATE_SLEEP_CFM
) ||
326 adapter
->tx_lock_flag
)
329 if (!adapter
->cmd_sent
&& !adapter
->curr_cmd
) {
330 if (mwifiex_exec_next_cmd(adapter
) == -1) {
336 if ((!adapter
->scan_processing
|| adapter
->scan_delay_cnt
) &&
337 !adapter
->data_sent
&& !mwifiex_wmm_lists_empty(adapter
)) {
338 mwifiex_wmm_process_tx(adapter
);
339 if (adapter
->hs_activated
) {
340 adapter
->is_hs_configured
= false;
341 mwifiex_hs_activated_event
343 (adapter
, MWIFIEX_BSS_ROLE_ANY
),
348 if (adapter
->delay_null_pkt
&& !adapter
->cmd_sent
&&
349 !adapter
->curr_cmd
&& !is_command_pending(adapter
) &&
350 mwifiex_wmm_lists_empty(adapter
)) {
351 if (!mwifiex_send_null_packet
352 (mwifiex_get_priv(adapter
, MWIFIEX_BSS_ROLE_STA
),
353 MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET
|
354 MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET
)) {
355 adapter
->delay_null_pkt
= false;
356 adapter
->ps_state
= PS_STATE_SLEEP
;
362 spin_lock_irqsave(&adapter
->main_proc_lock
, flags
);
363 if ((adapter
->int_status
) || IS_CARD_RX_RCVD(adapter
)) {
364 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
368 adapter
->mwifiex_processing
= false;
369 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
372 if (adapter
->hw_status
== MWIFIEX_HW_STATUS_CLOSING
)
373 mwifiex_shutdown_drv(adapter
);
376 EXPORT_SYMBOL_GPL(mwifiex_main_process
);
379 * This function frees the adapter structure.
381 * Additionally, this closes the netlink socket, frees the timers
382 * and private structures.
384 static void mwifiex_free_adapter(struct mwifiex_adapter
*adapter
)
387 pr_err("%s: adapter is NULL\n", __func__
);
391 mwifiex_unregister(adapter
);
392 pr_debug("info: %s: free adapter\n", __func__
);
396 * This function cancels all works in the queue and destroys
397 * the main workqueue.
399 static void mwifiex_terminate_workqueue(struct mwifiex_adapter
*adapter
)
401 flush_workqueue(adapter
->workqueue
);
402 destroy_workqueue(adapter
->workqueue
);
403 adapter
->workqueue
= NULL
;
407 * This function gets firmware and initializes it.
409 * The main initialization steps followed are -
410 * - Download the correct firmware to card
411 * - Issue the init commands to firmware
413 static void mwifiex_fw_dpc(const struct firmware
*firmware
, void *context
)
417 struct mwifiex_private
*priv
;
418 struct mwifiex_adapter
*adapter
= context
;
419 struct mwifiex_fw_image fw
;
420 struct semaphore
*sem
= adapter
->card_sem
;
421 bool init_failed
= false;
422 struct wireless_dev
*wdev
;
425 dev_err(adapter
->dev
,
426 "Failed to get firmware %s\n", adapter
->fw_name
);
430 memset(&fw
, 0, sizeof(struct mwifiex_fw_image
));
431 adapter
->firmware
= firmware
;
432 fw
.fw_buf
= (u8
*) adapter
->firmware
->data
;
433 fw
.fw_len
= adapter
->firmware
->size
;
435 if (adapter
->if_ops
.dnld_fw
)
436 ret
= adapter
->if_ops
.dnld_fw(adapter
, &fw
);
438 ret
= mwifiex_dnld_fw(adapter
, &fw
);
442 dev_notice(adapter
->dev
, "WLAN FW is active\n");
445 if ((request_firmware(&adapter
->cal_data
, cal_data_cfg
,
447 dev_err(adapter
->dev
,
448 "Cal data request_firmware() failed\n");
451 /* enable host interrupt after fw dnld is successful */
452 if (adapter
->if_ops
.enable_int
) {
453 if (adapter
->if_ops
.enable_int(adapter
))
457 adapter
->init_wait_q_woken
= false;
458 ret
= mwifiex_init_fw(adapter
);
462 adapter
->hw_status
= MWIFIEX_HW_STATUS_READY
;
465 /* Wait for mwifiex_init to complete */
466 wait_event_interruptible(adapter
->init_wait_q
,
467 adapter
->init_wait_q_woken
);
468 if (adapter
->hw_status
!= MWIFIEX_HW_STATUS_READY
)
471 priv
= adapter
->priv
[MWIFIEX_BSS_ROLE_STA
];
472 if (mwifiex_register_cfg80211(adapter
)) {
473 dev_err(adapter
->dev
, "cannot register with cfg80211\n");
478 /* Create station interface by default */
479 wdev
= mwifiex_add_virtual_intf(adapter
->wiphy
, "mlan%d",
480 NL80211_IFTYPE_STATION
, NULL
, NULL
);
482 dev_err(adapter
->dev
, "cannot create default STA interface\n");
488 mwifiex_drv_get_driver_version(adapter
, fmt
, sizeof(fmt
) - 1);
489 dev_notice(adapter
->dev
, "driver_version = %s\n", fmt
);
493 wiphy_unregister(adapter
->wiphy
);
494 wiphy_free(adapter
->wiphy
);
496 if (adapter
->if_ops
.disable_int
)
497 adapter
->if_ops
.disable_int(adapter
);
499 pr_debug("info: %s: unregister device\n", __func__
);
500 if (adapter
->if_ops
.unregister_dev
)
501 adapter
->if_ops
.unregister_dev(adapter
);
503 if ((adapter
->hw_status
== MWIFIEX_HW_STATUS_FW_READY
) ||
504 (adapter
->hw_status
== MWIFIEX_HW_STATUS_READY
)) {
505 pr_debug("info: %s: shutdown mwifiex\n", __func__
);
506 adapter
->init_wait_q_woken
= false;
508 if (mwifiex_shutdown_drv(adapter
) == -EINPROGRESS
)
509 wait_event_interruptible(adapter
->init_wait_q
,
510 adapter
->init_wait_q_woken
);
512 adapter
->surprise_removed
= true;
513 mwifiex_terminate_workqueue(adapter
);
516 if (adapter
->cal_data
) {
517 release_firmware(adapter
->cal_data
);
518 adapter
->cal_data
= NULL
;
520 if (adapter
->firmware
) {
521 release_firmware(adapter
->firmware
);
522 adapter
->firmware
= NULL
;
525 mwifiex_free_adapter(adapter
);
531 * This function initializes the hardware and gets firmware.
533 static int mwifiex_init_hw_fw(struct mwifiex_adapter
*adapter
)
537 ret
= request_firmware_nowait(THIS_MODULE
, 1, adapter
->fw_name
,
538 adapter
->dev
, GFP_KERNEL
, adapter
,
541 dev_err(adapter
->dev
,
542 "request_firmware_nowait() returned error %d\n", ret
);
547 * CFG802.11 network device handler for open.
549 * Starts the data queue.
552 mwifiex_open(struct net_device
*dev
)
554 netif_tx_start_all_queues(dev
);
559 * CFG802.11 network device handler for close.
562 mwifiex_close(struct net_device
*dev
)
564 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
566 if (priv
->scan_request
) {
567 dev_dbg(priv
->adapter
->dev
, "aborting scan on ndo_stop\n");
568 cfg80211_scan_done(priv
->scan_request
, 1);
569 priv
->scan_request
= NULL
;
570 priv
->scan_aborting
= true;
577 * Add buffer into wmm tx queue and queue work to transmit it.
579 int mwifiex_queue_tx_pkt(struct mwifiex_private
*priv
, struct sk_buff
*skb
)
581 struct netdev_queue
*txq
;
582 int index
= mwifiex_1d_to_wmm_queue
[skb
->priority
];
584 if (atomic_inc_return(&priv
->wmm_tx_pending
[index
]) >= MAX_TX_PENDING
) {
585 txq
= netdev_get_tx_queue(priv
->netdev
, index
);
586 if (!netif_tx_queue_stopped(txq
)) {
587 netif_tx_stop_queue(txq
);
588 dev_dbg(priv
->adapter
->dev
, "stop queue: %d\n", index
);
592 atomic_inc(&priv
->adapter
->tx_pending
);
593 mwifiex_wmm_add_buf_txqueue(priv
, skb
);
595 if (priv
->adapter
->scan_delay_cnt
)
596 atomic_set(&priv
->adapter
->is_tx_received
, true);
598 queue_work(priv
->adapter
->workqueue
, &priv
->adapter
->main_work
);
604 * CFG802.11 network device handler for data transmission.
607 mwifiex_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
609 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
610 struct sk_buff
*new_skb
;
611 struct mwifiex_txinfo
*tx_info
;
614 dev_dbg(priv
->adapter
->dev
, "data: %lu BSS(%d-%d): Data <= kernel\n",
615 jiffies
, priv
->bss_type
, priv
->bss_num
);
617 if (priv
->adapter
->surprise_removed
) {
619 priv
->stats
.tx_dropped
++;
622 if (!skb
->len
|| (skb
->len
> ETH_FRAME_LEN
)) {
623 dev_err(priv
->adapter
->dev
, "Tx: bad skb len %d\n", skb
->len
);
625 priv
->stats
.tx_dropped
++;
628 if (skb_headroom(skb
) < MWIFIEX_MIN_DATA_HEADER_LEN
) {
629 dev_dbg(priv
->adapter
->dev
,
630 "data: Tx: insufficient skb headroom %d\n",
632 /* Insufficient skb headroom - allocate a new skb */
634 skb_realloc_headroom(skb
, MWIFIEX_MIN_DATA_HEADER_LEN
);
635 if (unlikely(!new_skb
)) {
636 dev_err(priv
->adapter
->dev
, "Tx: cannot alloca new_skb\n");
638 priv
->stats
.tx_dropped
++;
643 dev_dbg(priv
->adapter
->dev
, "info: new skb headroomd %d\n",
647 tx_info
= MWIFIEX_SKB_TXCB(skb
);
648 tx_info
->bss_num
= priv
->bss_num
;
649 tx_info
->bss_type
= priv
->bss_type
;
650 tx_info
->pkt_len
= skb
->len
;
652 /* Record the current time the packet was queued; used to
653 * determine the amount of time the packet was queued in
654 * the driver before it was sent to the firmware.
655 * The delay is then sent along with the packet to the
656 * firmware for aggregate delay calculation for stats and
657 * MSDU lifetime expiry.
659 do_gettimeofday(&tv
);
660 skb
->tstamp
= timeval_to_ktime(tv
);
662 mwifiex_queue_tx_pkt(priv
, skb
);
668 * CFG802.11 network device handler for setting MAC address.
671 mwifiex_set_mac_address(struct net_device
*dev
, void *addr
)
673 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
674 struct sockaddr
*hw_addr
= addr
;
677 memcpy(priv
->curr_addr
, hw_addr
->sa_data
, ETH_ALEN
);
679 /* Send request to firmware */
680 ret
= mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_MAC_ADDRESS
,
681 HostCmd_ACT_GEN_SET
, 0, NULL
, true);
684 memcpy(priv
->netdev
->dev_addr
, priv
->curr_addr
, ETH_ALEN
);
686 dev_err(priv
->adapter
->dev
,
687 "set mac address failed: ret=%d\n", ret
);
689 memcpy(dev
->dev_addr
, priv
->curr_addr
, ETH_ALEN
);
695 * CFG802.11 network device handler for setting multicast list.
697 static void mwifiex_set_multicast_list(struct net_device
*dev
)
699 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
700 struct mwifiex_multicast_list mcast_list
;
702 if (dev
->flags
& IFF_PROMISC
) {
703 mcast_list
.mode
= MWIFIEX_PROMISC_MODE
;
704 } else if (dev
->flags
& IFF_ALLMULTI
||
705 netdev_mc_count(dev
) > MWIFIEX_MAX_MULTICAST_LIST_SIZE
) {
706 mcast_list
.mode
= MWIFIEX_ALL_MULTI_MODE
;
708 mcast_list
.mode
= MWIFIEX_MULTICAST_MODE
;
709 mcast_list
.num_multicast_addr
=
710 mwifiex_copy_mcast_addr(&mcast_list
, dev
);
712 mwifiex_request_set_multicast_list(priv
, &mcast_list
);
716 * CFG802.11 network device handler for transmission timeout.
719 mwifiex_tx_timeout(struct net_device
*dev
)
721 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
723 priv
->num_tx_timeout
++;
724 priv
->tx_timeout_cnt
++;
725 dev_err(priv
->adapter
->dev
,
726 "%lu : Tx timeout(#%d), bss_type-num = %d-%d\n",
727 jiffies
, priv
->tx_timeout_cnt
, priv
->bss_type
, priv
->bss_num
);
728 mwifiex_set_trans_start(dev
);
730 if (priv
->tx_timeout_cnt
> TX_TIMEOUT_THRESHOLD
&&
731 priv
->adapter
->if_ops
.card_reset
) {
732 dev_err(priv
->adapter
->dev
,
733 "tx_timeout_cnt exceeds threshold. Triggering card reset!\n");
734 priv
->adapter
->if_ops
.card_reset(priv
->adapter
);
739 * CFG802.11 network device handler for statistics retrieval.
741 static struct net_device_stats
*mwifiex_get_stats(struct net_device
*dev
)
743 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
749 mwifiex_netdev_select_wmm_queue(struct net_device
*dev
, struct sk_buff
*skb
,
750 void *accel_priv
, select_queue_fallback_t fallback
)
752 skb
->priority
= cfg80211_classify8021d(skb
, NULL
);
753 return mwifiex_1d_to_wmm_queue
[skb
->priority
];
756 /* Network device handlers */
757 static const struct net_device_ops mwifiex_netdev_ops
= {
758 .ndo_open
= mwifiex_open
,
759 .ndo_stop
= mwifiex_close
,
760 .ndo_start_xmit
= mwifiex_hard_start_xmit
,
761 .ndo_set_mac_address
= mwifiex_set_mac_address
,
762 .ndo_tx_timeout
= mwifiex_tx_timeout
,
763 .ndo_get_stats
= mwifiex_get_stats
,
764 .ndo_set_rx_mode
= mwifiex_set_multicast_list
,
765 .ndo_select_queue
= mwifiex_netdev_select_wmm_queue
,
769 * This function initializes the private structure parameters.
771 * The following wait queues are initialized -
773 * - Command wait queue
774 * - Statistics wait queue
776 * ...and the following default parameters are set -
777 * - Current key index : Set to 0
778 * - Rate index : Set to auto
779 * - Media connected : Set to disconnected
780 * - Adhoc link sensed : Set to false
781 * - Nick name : Set to null
782 * - Number of Tx timeout : Set to 0
783 * - Device address : Set to current address
785 * In addition, the CFG80211 work queue is also created.
787 void mwifiex_init_priv_params(struct mwifiex_private
*priv
,
788 struct net_device
*dev
)
790 dev
->netdev_ops
= &mwifiex_netdev_ops
;
791 dev
->destructor
= free_netdev
;
792 /* Initialize private structure */
793 priv
->current_key_index
= 0;
794 priv
->media_connected
= false;
795 memset(&priv
->nick_name
, 0, sizeof(priv
->nick_name
));
796 memset(priv
->mgmt_ie
, 0,
797 sizeof(struct mwifiex_ie
) * MAX_MGMT_IE_INDEX
);
798 priv
->beacon_idx
= MWIFIEX_AUTO_IDX_MASK
;
799 priv
->proberesp_idx
= MWIFIEX_AUTO_IDX_MASK
;
800 priv
->assocresp_idx
= MWIFIEX_AUTO_IDX_MASK
;
801 priv
->rsn_idx
= MWIFIEX_AUTO_IDX_MASK
;
802 priv
->num_tx_timeout
= 0;
803 memcpy(dev
->dev_addr
, priv
->curr_addr
, ETH_ALEN
);
807 * This function check if command is pending.
809 int is_command_pending(struct mwifiex_adapter
*adapter
)
812 int is_cmd_pend_q_empty
;
814 spin_lock_irqsave(&adapter
->cmd_pending_q_lock
, flags
);
815 is_cmd_pend_q_empty
= list_empty(&adapter
->cmd_pending_q
);
816 spin_unlock_irqrestore(&adapter
->cmd_pending_q_lock
, flags
);
818 return !is_cmd_pend_q_empty
;
822 * This is the main work queue function.
824 * It handles the main process, which in turn handles the complete
827 static void mwifiex_main_work_queue(struct work_struct
*work
)
829 struct mwifiex_adapter
*adapter
=
830 container_of(work
, struct mwifiex_adapter
, main_work
);
832 if (adapter
->surprise_removed
)
834 mwifiex_main_process(adapter
);
838 * This function adds the card.
840 * This function follows the following major steps to set up the device -
841 * - Initialize software. This includes probing the card, registering
842 * the interface operations table, and allocating/initializing the
844 * - Set up the netlink socket
845 * - Create and start the main work queue
846 * - Register the device
847 * - Initialize firmware and hardware
848 * - Add logical interfaces
851 mwifiex_add_card(void *card
, struct semaphore
*sem
,
852 struct mwifiex_if_ops
*if_ops
, u8 iface_type
)
854 struct mwifiex_adapter
*adapter
;
856 if (down_interruptible(sem
))
859 if (mwifiex_register(card
, if_ops
, (void **)&adapter
)) {
860 pr_err("%s: software init failed\n", __func__
);
864 adapter
->iface_type
= iface_type
;
865 adapter
->card_sem
= sem
;
867 adapter
->hw_status
= MWIFIEX_HW_STATUS_INITIALIZING
;
868 adapter
->surprise_removed
= false;
869 init_waitqueue_head(&adapter
->init_wait_q
);
870 adapter
->is_suspended
= false;
871 adapter
->hs_activated
= false;
872 init_waitqueue_head(&adapter
->hs_activate_wait_q
);
873 init_waitqueue_head(&adapter
->cmd_wait_q
.wait
);
874 adapter
->cmd_wait_q
.status
= 0;
875 adapter
->scan_wait_q_woken
= false;
878 alloc_workqueue("MWIFIEX_WORK_QUEUE",
879 WQ_HIGHPRI
| WQ_MEM_RECLAIM
| WQ_UNBOUND
, 1);
880 if (!adapter
->workqueue
)
883 INIT_WORK(&adapter
->main_work
, mwifiex_main_work_queue
);
885 /* Register the device. Fill up the private data structure with relevant
886 information from the card. */
887 if (adapter
->if_ops
.register_dev(adapter
)) {
888 pr_err("%s: failed to register mwifiex device\n", __func__
);
889 goto err_registerdev
;
892 if (mwifiex_init_hw_fw(adapter
)) {
893 pr_err("%s: firmware init failed\n", __func__
);
900 pr_debug("info: %s: unregister device\n", __func__
);
901 if (adapter
->if_ops
.unregister_dev
)
902 adapter
->if_ops
.unregister_dev(adapter
);
903 if ((adapter
->hw_status
== MWIFIEX_HW_STATUS_FW_READY
) ||
904 (adapter
->hw_status
== MWIFIEX_HW_STATUS_READY
)) {
905 pr_debug("info: %s: shutdown mwifiex\n", __func__
);
906 adapter
->init_wait_q_woken
= false;
908 if (mwifiex_shutdown_drv(adapter
) == -EINPROGRESS
)
909 wait_event_interruptible(adapter
->init_wait_q
,
910 adapter
->init_wait_q_woken
);
913 adapter
->surprise_removed
= true;
914 mwifiex_terminate_workqueue(adapter
);
916 mwifiex_free_adapter(adapter
);
924 EXPORT_SYMBOL_GPL(mwifiex_add_card
);
927 * This function removes the card.
929 * This function follows the following major steps to remove the device -
930 * - Stop data traffic
931 * - Shutdown firmware
932 * - Remove the logical interfaces
933 * - Terminate the work queue
934 * - Unregister the device
935 * - Free the adapter structure
937 int mwifiex_remove_card(struct mwifiex_adapter
*adapter
, struct semaphore
*sem
)
939 struct mwifiex_private
*priv
= NULL
;
942 if (down_interruptible(sem
))
948 /* We can no longer handle interrupts once we start doing the teardown
950 if (adapter
->if_ops
.disable_int
)
951 adapter
->if_ops
.disable_int(adapter
);
953 adapter
->surprise_removed
= true;
956 for (i
= 0; i
< adapter
->priv_num
; i
++) {
957 priv
= adapter
->priv
[i
];
958 if (priv
&& priv
->netdev
) {
959 mwifiex_stop_net_dev_queue(priv
->netdev
, adapter
);
960 if (netif_carrier_ok(priv
->netdev
))
961 netif_carrier_off(priv
->netdev
);
965 dev_dbg(adapter
->dev
, "cmd: calling mwifiex_shutdown_drv...\n");
966 adapter
->init_wait_q_woken
= false;
968 if (mwifiex_shutdown_drv(adapter
) == -EINPROGRESS
)
969 wait_event_interruptible(adapter
->init_wait_q
,
970 adapter
->init_wait_q_woken
);
971 dev_dbg(adapter
->dev
, "cmd: mwifiex_shutdown_drv done\n");
972 if (atomic_read(&adapter
->rx_pending
) ||
973 atomic_read(&adapter
->tx_pending
) ||
974 atomic_read(&adapter
->cmd_pending
)) {
975 dev_err(adapter
->dev
, "rx_pending=%d, tx_pending=%d, "
977 atomic_read(&adapter
->rx_pending
),
978 atomic_read(&adapter
->tx_pending
),
979 atomic_read(&adapter
->cmd_pending
));
982 for (i
= 0; i
< adapter
->priv_num
; i
++) {
983 priv
= adapter
->priv
[i
];
989 if (priv
->wdev
&& priv
->netdev
)
990 mwifiex_del_virtual_intf(adapter
->wiphy
, priv
->wdev
);
994 wiphy_unregister(adapter
->wiphy
);
995 wiphy_free(adapter
->wiphy
);
997 mwifiex_terminate_workqueue(adapter
);
999 /* Unregister device */
1000 dev_dbg(adapter
->dev
, "info: unregister device\n");
1001 if (adapter
->if_ops
.unregister_dev
)
1002 adapter
->if_ops
.unregister_dev(adapter
);
1003 /* Free adapter structure */
1004 dev_dbg(adapter
->dev
, "info: free adapter\n");
1005 mwifiex_free_adapter(adapter
);
1012 EXPORT_SYMBOL_GPL(mwifiex_remove_card
);
1015 * This function initializes the module.
1017 * The debug FS is also initialized if configured.
1020 mwifiex_init_module(void)
1022 #ifdef CONFIG_DEBUG_FS
1023 mwifiex_debugfs_init();
1029 * This function cleans up the module.
1031 * The debug FS is removed if available.
1034 mwifiex_cleanup_module(void)
1036 #ifdef CONFIG_DEBUG_FS
1037 mwifiex_debugfs_remove();
1041 module_init(mwifiex_init_module
);
1042 module_exit(mwifiex_cleanup_module
);
1044 MODULE_AUTHOR("Marvell International Ltd.");
1045 MODULE_DESCRIPTION("Marvell WiFi-Ex Driver version " VERSION
);
1046 MODULE_VERSION(VERSION
);
1047 MODULE_LICENSE("GPL v2");