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
) {
43 * Abort scan operation by cancelling all pending scan
46 spin_lock_irqsave(&adapter
->scan_pending_q_lock
, flags
);
47 list_for_each_entry_safe(cmd_node
, tmp_node
,
48 &adapter
->scan_pending_q
, list
) {
49 list_del(&cmd_node
->list
);
50 mwifiex_insert_cmd_to_free_q(adapter
, cmd_node
);
52 spin_unlock_irqrestore(&adapter
->scan_pending_q_lock
, flags
);
54 spin_lock_irqsave(&adapter
->mwifiex_cmd_lock
, flags
);
55 adapter
->scan_processing
= false;
56 adapter
->scan_delay_cnt
= 0;
57 adapter
->empty_tx_q_cnt
= 0;
58 spin_unlock_irqrestore(&adapter
->mwifiex_cmd_lock
, flags
);
60 if (priv
->scan_request
) {
61 dev_dbg(adapter
->dev
, "info: aborting scan\n");
62 cfg80211_scan_done(priv
->scan_request
, 1);
63 priv
->scan_request
= NULL
;
65 priv
->scan_aborting
= false;
66 dev_dbg(adapter
->dev
, "info: scan already aborted\n");
71 if (!atomic_read(&priv
->adapter
->is_tx_received
)) {
72 adapter
->empty_tx_q_cnt
++;
73 if (adapter
->empty_tx_q_cnt
== MWIFIEX_MAX_EMPTY_TX_Q_CNT
) {
75 * No Tx traffic for 200msec. Get scan command from
76 * scan pending queue and put to cmd pending queue to
77 * resume scan operation
79 adapter
->scan_delay_cnt
= 0;
80 adapter
->empty_tx_q_cnt
= 0;
81 spin_lock_irqsave(&adapter
->scan_pending_q_lock
, flags
);
82 cmd_node
= list_first_entry(&adapter
->scan_pending_q
,
83 struct cmd_ctrl_node
, list
);
84 list_del(&cmd_node
->list
);
85 spin_unlock_irqrestore(&adapter
->scan_pending_q_lock
,
88 mwifiex_insert_cmd_to_pending_q(adapter
, cmd_node
,
90 queue_work(adapter
->workqueue
, &adapter
->main_work
);
94 adapter
->empty_tx_q_cnt
= 0;
97 /* Delay scan operation further by 20msec */
98 mod_timer(&priv
->scan_delay_timer
, jiffies
+
99 msecs_to_jiffies(MWIFIEX_SCAN_DELAY_MSEC
));
100 adapter
->scan_delay_cnt
++;
103 if (atomic_read(&priv
->adapter
->is_tx_received
))
104 atomic_set(&priv
->adapter
->is_tx_received
, false);
110 * This function registers the device and performs all the necessary
113 * The following initialization operations are performed -
114 * - Allocate adapter structure
115 * - Save interface specific operations table in adapter
116 * - Call interface specific initialization routine
117 * - Allocate private structures
118 * - Set default adapter structure parameters
121 * In case of any errors during inittialization, this function also ensures
122 * proper cleanup before exiting.
124 static int mwifiex_register(void *card
, struct mwifiex_if_ops
*if_ops
,
127 struct mwifiex_adapter
*adapter
;
130 adapter
= kzalloc(sizeof(struct mwifiex_adapter
), GFP_KERNEL
);
135 adapter
->card
= card
;
137 /* Save interface specific operations in adapter */
138 memmove(&adapter
->if_ops
, if_ops
, sizeof(struct mwifiex_if_ops
));
140 /* card specific initialization has been deferred until now .. */
141 if (adapter
->if_ops
.init_if
)
142 if (adapter
->if_ops
.init_if(adapter
))
145 adapter
->priv_num
= 0;
147 for (i
= 0; i
< MWIFIEX_MAX_BSS_NUM
; i
++) {
148 /* Allocate memory for private structure */
150 kzalloc(sizeof(struct mwifiex_private
), GFP_KERNEL
);
151 if (!adapter
->priv
[i
])
154 adapter
->priv
[i
]->adapter
= adapter
;
157 setup_timer(&adapter
->priv
[i
]->scan_delay_timer
,
159 (unsigned long)adapter
->priv
[i
]);
161 mwifiex_init_lock_list(adapter
);
163 init_timer(&adapter
->cmd_timer
);
164 adapter
->cmd_timer
.function
= mwifiex_cmd_timeout_func
;
165 adapter
->cmd_timer
.data
= (unsigned long) adapter
;
170 dev_dbg(adapter
->dev
, "info: leave mwifiex_register with error\n");
172 for (i
= 0; i
< adapter
->priv_num
; i
++)
173 kfree(adapter
->priv
[i
]);
181 * This function unregisters the device and performs all the necessary
184 * The following cleanup operations are performed -
186 * - Free beacon buffers
187 * - Free private structures
188 * - Free adapter structure
190 static int mwifiex_unregister(struct mwifiex_adapter
*adapter
)
194 if (adapter
->if_ops
.cleanup_if
)
195 adapter
->if_ops
.cleanup_if(adapter
);
197 del_timer(&adapter
->cmd_timer
);
199 /* Free private structures */
200 for (i
= 0; i
< adapter
->priv_num
; i
++) {
201 if (adapter
->priv
[i
]) {
202 mwifiex_free_curr_bcn(adapter
->priv
[i
]);
203 del_timer_sync(&adapter
->priv
[i
]->scan_delay_timer
);
204 kfree(adapter
->priv
[i
]);
215 * This function is the main procedure of the driver and handles various driver
216 * operations. It runs in a loop and provides the core functionalities.
218 * The main responsibilities of this function are -
219 * - Ensure concurrency control
220 * - Handle pending interrupts and call interrupt handlers
221 * - Wake up the card if required
222 * - Handle command responses and call response handlers
223 * - Handle events and call event handlers
224 * - Execute pending commands
225 * - Transmit pending data packets
227 int mwifiex_main_process(struct mwifiex_adapter
*adapter
)
233 spin_lock_irqsave(&adapter
->main_proc_lock
, flags
);
235 /* Check if already processing */
236 if (adapter
->mwifiex_processing
) {
237 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
240 adapter
->mwifiex_processing
= true;
241 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
245 if ((adapter
->hw_status
== MWIFIEX_HW_STATUS_CLOSING
) ||
246 (adapter
->hw_status
== MWIFIEX_HW_STATUS_NOT_READY
))
249 /* Handle pending interrupt if any */
250 if (adapter
->int_status
) {
251 if (adapter
->hs_activated
)
252 mwifiex_process_hs_config(adapter
);
253 if (adapter
->if_ops
.process_int_status
)
254 adapter
->if_ops
.process_int_status(adapter
);
257 /* Need to wake up the card ? */
258 if ((adapter
->ps_state
== PS_STATE_SLEEP
) &&
259 (adapter
->pm_wakeup_card_req
&&
260 !adapter
->pm_wakeup_fw_try
) &&
261 (is_command_pending(adapter
) ||
262 !mwifiex_wmm_lists_empty(adapter
))) {
263 adapter
->pm_wakeup_fw_try
= true;
264 adapter
->if_ops
.wakeup(adapter
);
268 if (IS_CARD_RX_RCVD(adapter
)) {
269 adapter
->pm_wakeup_fw_try
= false;
270 if (adapter
->ps_state
== PS_STATE_SLEEP
)
271 adapter
->ps_state
= PS_STATE_AWAKE
;
273 /* We have tried to wakeup the card already */
274 if (adapter
->pm_wakeup_fw_try
)
276 if (adapter
->ps_state
!= PS_STATE_AWAKE
||
277 adapter
->tx_lock_flag
)
280 if ((adapter
->scan_processing
&&
281 !adapter
->scan_delay_cnt
) || adapter
->data_sent
||
282 mwifiex_wmm_lists_empty(adapter
)) {
283 if (adapter
->cmd_sent
|| adapter
->curr_cmd
||
284 (!is_command_pending(adapter
)))
289 /* Check Rx data for USB */
290 if (adapter
->iface_type
== MWIFIEX_USB
)
291 while ((skb
= skb_dequeue(&adapter
->usb_rx_data_q
)))
292 mwifiex_handle_rx_packet(adapter
, skb
);
294 /* Check for Cmd Resp */
295 if (adapter
->cmd_resp_received
) {
296 adapter
->cmd_resp_received
= false;
297 mwifiex_process_cmdresp(adapter
);
299 /* call mwifiex back when init_fw is done */
300 if (adapter
->hw_status
== MWIFIEX_HW_STATUS_INIT_DONE
) {
301 adapter
->hw_status
= MWIFIEX_HW_STATUS_READY
;
302 mwifiex_init_fw_complete(adapter
);
306 /* Check for event */
307 if (adapter
->event_received
) {
308 adapter
->event_received
= false;
309 mwifiex_process_event(adapter
);
312 /* Check if we need to confirm Sleep Request
313 received previously */
314 if (adapter
->ps_state
== PS_STATE_PRE_SLEEP
) {
315 if (!adapter
->cmd_sent
&& !adapter
->curr_cmd
)
316 mwifiex_check_ps_cond(adapter
);
319 /* * The ps_state may have been changed during processing of
320 * Sleep Request event.
322 if ((adapter
->ps_state
== PS_STATE_SLEEP
) ||
323 (adapter
->ps_state
== PS_STATE_PRE_SLEEP
) ||
324 (adapter
->ps_state
== PS_STATE_SLEEP_CFM
) ||
325 adapter
->tx_lock_flag
)
328 if (!adapter
->cmd_sent
&& !adapter
->curr_cmd
) {
329 if (mwifiex_exec_next_cmd(adapter
) == -1) {
335 if ((!adapter
->scan_processing
|| adapter
->scan_delay_cnt
) &&
336 !adapter
->data_sent
&& !mwifiex_wmm_lists_empty(adapter
)) {
337 mwifiex_wmm_process_tx(adapter
);
338 if (adapter
->hs_activated
) {
339 adapter
->is_hs_configured
= false;
340 mwifiex_hs_activated_event
342 (adapter
, MWIFIEX_BSS_ROLE_ANY
),
347 if (adapter
->delay_null_pkt
&& !adapter
->cmd_sent
&&
348 !adapter
->curr_cmd
&& !is_command_pending(adapter
) &&
349 mwifiex_wmm_lists_empty(adapter
)) {
350 if (!mwifiex_send_null_packet
351 (mwifiex_get_priv(adapter
, MWIFIEX_BSS_ROLE_STA
),
352 MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET
|
353 MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET
)) {
354 adapter
->delay_null_pkt
= false;
355 adapter
->ps_state
= PS_STATE_SLEEP
;
361 if ((adapter
->int_status
) || IS_CARD_RX_RCVD(adapter
))
364 spin_lock_irqsave(&adapter
->main_proc_lock
, flags
);
365 adapter
->mwifiex_processing
= false;
366 spin_unlock_irqrestore(&adapter
->main_proc_lock
, flags
);
369 if (adapter
->hw_status
== MWIFIEX_HW_STATUS_CLOSING
)
370 mwifiex_shutdown_drv(adapter
);
373 EXPORT_SYMBOL_GPL(mwifiex_main_process
);
376 * This function frees the adapter structure.
378 * Additionally, this closes the netlink socket, frees the timers
379 * and private structures.
381 static void mwifiex_free_adapter(struct mwifiex_adapter
*adapter
)
384 pr_err("%s: adapter is NULL\n", __func__
);
388 mwifiex_unregister(adapter
);
389 pr_debug("info: %s: free adapter\n", __func__
);
393 * This function cancels all works in the queue and destroys
394 * the main workqueue.
396 static void mwifiex_terminate_workqueue(struct mwifiex_adapter
*adapter
)
398 flush_workqueue(adapter
->workqueue
);
399 destroy_workqueue(adapter
->workqueue
);
400 adapter
->workqueue
= NULL
;
404 * This function gets firmware and initializes it.
406 * The main initialization steps followed are -
407 * - Download the correct firmware to card
408 * - Issue the init commands to firmware
410 static void mwifiex_fw_dpc(const struct firmware
*firmware
, void *context
)
414 struct mwifiex_private
*priv
;
415 struct mwifiex_adapter
*adapter
= context
;
416 struct mwifiex_fw_image fw
;
417 struct semaphore
*sem
= adapter
->card_sem
;
418 bool init_failed
= false;
421 dev_err(adapter
->dev
,
422 "Failed to get firmware %s\n", adapter
->fw_name
);
426 memset(&fw
, 0, sizeof(struct mwifiex_fw_image
));
427 adapter
->firmware
= firmware
;
428 fw
.fw_buf
= (u8
*) adapter
->firmware
->data
;
429 fw
.fw_len
= adapter
->firmware
->size
;
431 if (adapter
->if_ops
.dnld_fw
)
432 ret
= adapter
->if_ops
.dnld_fw(adapter
, &fw
);
434 ret
= mwifiex_dnld_fw(adapter
, &fw
);
438 dev_notice(adapter
->dev
, "WLAN FW is active\n");
441 if ((request_firmware(&adapter
->cal_data
, cal_data_cfg
,
443 dev_err(adapter
->dev
,
444 "Cal data request_firmware() failed\n");
447 /* enable host interrupt after fw dnld is successful */
448 if (adapter
->if_ops
.enable_int
) {
449 if (adapter
->if_ops
.enable_int(adapter
))
453 adapter
->init_wait_q_woken
= false;
454 ret
= mwifiex_init_fw(adapter
);
458 adapter
->hw_status
= MWIFIEX_HW_STATUS_READY
;
461 /* Wait for mwifiex_init to complete */
462 wait_event_interruptible(adapter
->init_wait_q
,
463 adapter
->init_wait_q_woken
);
464 if (adapter
->hw_status
!= MWIFIEX_HW_STATUS_READY
)
467 priv
= adapter
->priv
[MWIFIEX_BSS_ROLE_STA
];
468 if (mwifiex_register_cfg80211(adapter
)) {
469 dev_err(adapter
->dev
, "cannot register with cfg80211\n");
470 goto err_register_cfg80211
;
474 /* Create station interface by default */
475 if (!mwifiex_add_virtual_intf(adapter
->wiphy
, "mlan%d",
476 NL80211_IFTYPE_STATION
, NULL
, NULL
)) {
477 dev_err(adapter
->dev
, "cannot create default STA interface\n");
482 mwifiex_drv_get_driver_version(adapter
, fmt
, sizeof(fmt
) - 1);
483 dev_notice(adapter
->dev
, "driver_version = %s\n", fmt
);
487 for (i
= 0; i
< adapter
->priv_num
; i
++) {
488 priv
= adapter
->priv
[i
];
493 if (priv
->wdev
&& priv
->netdev
)
494 mwifiex_del_virtual_intf(adapter
->wiphy
, priv
->wdev
);
497 err_register_cfg80211
:
498 wiphy_unregister(adapter
->wiphy
);
499 wiphy_free(adapter
->wiphy
);
501 if (adapter
->if_ops
.disable_int
)
502 adapter
->if_ops
.disable_int(adapter
);
504 pr_debug("info: %s: unregister device\n", __func__
);
505 if (adapter
->if_ops
.unregister_dev
)
506 adapter
->if_ops
.unregister_dev(adapter
);
508 if ((adapter
->hw_status
== MWIFIEX_HW_STATUS_FW_READY
) ||
509 (adapter
->hw_status
== MWIFIEX_HW_STATUS_READY
)) {
510 pr_debug("info: %s: shutdown mwifiex\n", __func__
);
511 adapter
->init_wait_q_woken
= false;
513 if (mwifiex_shutdown_drv(adapter
) == -EINPROGRESS
)
514 wait_event_interruptible(adapter
->init_wait_q
,
515 adapter
->init_wait_q_woken
);
517 adapter
->surprise_removed
= true;
518 mwifiex_terminate_workqueue(adapter
);
521 if (adapter
->cal_data
) {
522 release_firmware(adapter
->cal_data
);
523 adapter
->cal_data
= NULL
;
525 if (adapter
->firmware
) {
526 release_firmware(adapter
->firmware
);
527 adapter
->firmware
= NULL
;
529 complete(&adapter
->fw_load
);
531 mwifiex_free_adapter(adapter
);
537 * This function initializes the hardware and gets firmware.
539 static int mwifiex_init_hw_fw(struct mwifiex_adapter
*adapter
)
543 init_completion(&adapter
->fw_load
);
544 ret
= request_firmware_nowait(THIS_MODULE
, 1, adapter
->fw_name
,
545 adapter
->dev
, GFP_KERNEL
, adapter
,
548 dev_err(adapter
->dev
,
549 "request_firmware_nowait() returned error %d\n", ret
);
554 * CFG802.11 network device handler for open.
556 * Starts the data queue.
559 mwifiex_open(struct net_device
*dev
)
561 netif_tx_start_all_queues(dev
);
566 * CFG802.11 network device handler for close.
569 mwifiex_close(struct net_device
*dev
)
571 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
573 if (priv
->scan_request
) {
574 dev_dbg(priv
->adapter
->dev
, "aborting scan on ndo_stop\n");
575 cfg80211_scan_done(priv
->scan_request
, 1);
576 priv
->scan_request
= NULL
;
577 priv
->scan_aborting
= true;
584 * Add buffer into wmm tx queue and queue work to transmit it.
586 int mwifiex_queue_tx_pkt(struct mwifiex_private
*priv
, struct sk_buff
*skb
)
588 struct netdev_queue
*txq
;
589 int index
= mwifiex_1d_to_wmm_queue
[skb
->priority
];
591 if (atomic_inc_return(&priv
->wmm_tx_pending
[index
]) >= MAX_TX_PENDING
) {
592 txq
= netdev_get_tx_queue(priv
->netdev
, index
);
593 if (!netif_tx_queue_stopped(txq
)) {
594 netif_tx_stop_queue(txq
);
595 dev_dbg(priv
->adapter
->dev
, "stop queue: %d\n", index
);
599 atomic_inc(&priv
->adapter
->tx_pending
);
600 mwifiex_wmm_add_buf_txqueue(priv
, skb
);
602 if (priv
->adapter
->scan_delay_cnt
)
603 atomic_set(&priv
->adapter
->is_tx_received
, true);
605 queue_work(priv
->adapter
->workqueue
, &priv
->adapter
->main_work
);
611 * CFG802.11 network device handler for data transmission.
614 mwifiex_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
616 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
617 struct sk_buff
*new_skb
;
618 struct mwifiex_txinfo
*tx_info
;
621 dev_dbg(priv
->adapter
->dev
, "data: %lu BSS(%d-%d): Data <= kernel\n",
622 jiffies
, priv
->bss_type
, priv
->bss_num
);
624 if (priv
->adapter
->surprise_removed
) {
626 priv
->stats
.tx_dropped
++;
629 if (!skb
->len
|| (skb
->len
> ETH_FRAME_LEN
)) {
630 dev_err(priv
->adapter
->dev
, "Tx: bad skb len %d\n", skb
->len
);
632 priv
->stats
.tx_dropped
++;
635 if (skb_headroom(skb
) < MWIFIEX_MIN_DATA_HEADER_LEN
) {
636 dev_dbg(priv
->adapter
->dev
,
637 "data: Tx: insufficient skb headroom %d\n",
639 /* Insufficient skb headroom - allocate a new skb */
641 skb_realloc_headroom(skb
, MWIFIEX_MIN_DATA_HEADER_LEN
);
642 if (unlikely(!new_skb
)) {
643 dev_err(priv
->adapter
->dev
, "Tx: cannot alloca new_skb\n");
645 priv
->stats
.tx_dropped
++;
650 dev_dbg(priv
->adapter
->dev
, "info: new skb headroomd %d\n",
654 tx_info
= MWIFIEX_SKB_TXCB(skb
);
655 tx_info
->bss_num
= priv
->bss_num
;
656 tx_info
->bss_type
= priv
->bss_type
;
658 /* Record the current time the packet was queued; used to
659 * determine the amount of time the packet was queued in
660 * the driver before it was sent to the firmware.
661 * The delay is then sent along with the packet to the
662 * firmware for aggregate delay calculation for stats and
663 * MSDU lifetime expiry.
665 do_gettimeofday(&tv
);
666 skb
->tstamp
= timeval_to_ktime(tv
);
668 mwifiex_queue_tx_pkt(priv
, skb
);
674 * CFG802.11 network device handler for setting MAC address.
677 mwifiex_set_mac_address(struct net_device
*dev
, void *addr
)
679 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
680 struct sockaddr
*hw_addr
= addr
;
683 memcpy(priv
->curr_addr
, hw_addr
->sa_data
, ETH_ALEN
);
685 /* Send request to firmware */
686 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_802_11_MAC_ADDRESS
,
687 HostCmd_ACT_GEN_SET
, 0, NULL
);
690 memcpy(priv
->netdev
->dev_addr
, priv
->curr_addr
, ETH_ALEN
);
692 dev_err(priv
->adapter
->dev
,
693 "set mac address failed: ret=%d\n", ret
);
695 memcpy(dev
->dev_addr
, priv
->curr_addr
, ETH_ALEN
);
701 * CFG802.11 network device handler for setting multicast list.
703 static void mwifiex_set_multicast_list(struct net_device
*dev
)
705 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
706 struct mwifiex_multicast_list mcast_list
;
708 if (dev
->flags
& IFF_PROMISC
) {
709 mcast_list
.mode
= MWIFIEX_PROMISC_MODE
;
710 } else if (dev
->flags
& IFF_ALLMULTI
||
711 netdev_mc_count(dev
) > MWIFIEX_MAX_MULTICAST_LIST_SIZE
) {
712 mcast_list
.mode
= MWIFIEX_ALL_MULTI_MODE
;
714 mcast_list
.mode
= MWIFIEX_MULTICAST_MODE
;
715 mcast_list
.num_multicast_addr
=
716 mwifiex_copy_mcast_addr(&mcast_list
, dev
);
718 mwifiex_request_set_multicast_list(priv
, &mcast_list
);
722 * CFG802.11 network device handler for transmission timeout.
725 mwifiex_tx_timeout(struct net_device
*dev
)
727 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
729 priv
->num_tx_timeout
++;
730 priv
->tx_timeout_cnt
++;
731 dev_err(priv
->adapter
->dev
,
732 "%lu : Tx timeout(#%d), bss_type-num = %d-%d\n",
733 jiffies
, priv
->tx_timeout_cnt
, priv
->bss_type
, priv
->bss_num
);
734 mwifiex_set_trans_start(dev
);
736 if (priv
->tx_timeout_cnt
> TX_TIMEOUT_THRESHOLD
&&
737 priv
->adapter
->if_ops
.card_reset
) {
738 dev_err(priv
->adapter
->dev
,
739 "tx_timeout_cnt exceeds threshold. Triggering card reset!\n");
740 priv
->adapter
->if_ops
.card_reset(priv
->adapter
);
745 * CFG802.11 network device handler for statistics retrieval.
747 static struct net_device_stats
*mwifiex_get_stats(struct net_device
*dev
)
749 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
755 mwifiex_netdev_select_wmm_queue(struct net_device
*dev
, struct sk_buff
*skb
)
757 skb
->priority
= cfg80211_classify8021d(skb
);
758 return mwifiex_1d_to_wmm_queue
[skb
->priority
];
761 /* Network device handlers */
762 static const struct net_device_ops mwifiex_netdev_ops
= {
763 .ndo_open
= mwifiex_open
,
764 .ndo_stop
= mwifiex_close
,
765 .ndo_start_xmit
= mwifiex_hard_start_xmit
,
766 .ndo_set_mac_address
= mwifiex_set_mac_address
,
767 .ndo_tx_timeout
= mwifiex_tx_timeout
,
768 .ndo_get_stats
= mwifiex_get_stats
,
769 .ndo_set_rx_mode
= mwifiex_set_multicast_list
,
770 .ndo_select_queue
= mwifiex_netdev_select_wmm_queue
,
774 * This function initializes the private structure parameters.
776 * The following wait queues are initialized -
778 * - Command wait queue
779 * - Statistics wait queue
781 * ...and the following default parameters are set -
782 * - Current key index : Set to 0
783 * - Rate index : Set to auto
784 * - Media connected : Set to disconnected
785 * - Adhoc link sensed : Set to false
786 * - Nick name : Set to null
787 * - Number of Tx timeout : Set to 0
788 * - Device address : Set to current address
790 * In addition, the CFG80211 work queue is also created.
792 void mwifiex_init_priv_params(struct mwifiex_private
*priv
,
793 struct net_device
*dev
)
795 dev
->netdev_ops
= &mwifiex_netdev_ops
;
796 dev
->destructor
= free_netdev
;
797 /* Initialize private structure */
798 priv
->current_key_index
= 0;
799 priv
->media_connected
= false;
800 memset(&priv
->nick_name
, 0, sizeof(priv
->nick_name
));
801 memset(priv
->mgmt_ie
, 0,
802 sizeof(struct mwifiex_ie
) * MAX_MGMT_IE_INDEX
);
803 priv
->beacon_idx
= MWIFIEX_AUTO_IDX_MASK
;
804 priv
->proberesp_idx
= MWIFIEX_AUTO_IDX_MASK
;
805 priv
->assocresp_idx
= MWIFIEX_AUTO_IDX_MASK
;
806 priv
->rsn_idx
= MWIFIEX_AUTO_IDX_MASK
;
807 priv
->num_tx_timeout
= 0;
808 memcpy(dev
->dev_addr
, priv
->curr_addr
, ETH_ALEN
);
812 * This function check if command is pending.
814 int is_command_pending(struct mwifiex_adapter
*adapter
)
817 int is_cmd_pend_q_empty
;
819 spin_lock_irqsave(&adapter
->cmd_pending_q_lock
, flags
);
820 is_cmd_pend_q_empty
= list_empty(&adapter
->cmd_pending_q
);
821 spin_unlock_irqrestore(&adapter
->cmd_pending_q_lock
, flags
);
823 return !is_cmd_pend_q_empty
;
827 * This is the main work queue function.
829 * It handles the main process, which in turn handles the complete
832 static void mwifiex_main_work_queue(struct work_struct
*work
)
834 struct mwifiex_adapter
*adapter
=
835 container_of(work
, struct mwifiex_adapter
, main_work
);
837 if (adapter
->surprise_removed
)
839 mwifiex_main_process(adapter
);
843 * This function adds the card.
845 * This function follows the following major steps to set up the device -
846 * - Initialize software. This includes probing the card, registering
847 * the interface operations table, and allocating/initializing the
849 * - Set up the netlink socket
850 * - Create and start the main work queue
851 * - Register the device
852 * - Initialize firmware and hardware
853 * - Add logical interfaces
856 mwifiex_add_card(void *card
, struct semaphore
*sem
,
857 struct mwifiex_if_ops
*if_ops
, u8 iface_type
)
859 struct mwifiex_adapter
*adapter
;
861 if (down_interruptible(sem
))
864 if (mwifiex_register(card
, if_ops
, (void **)&adapter
)) {
865 pr_err("%s: software init failed\n", __func__
);
869 adapter
->iface_type
= iface_type
;
870 adapter
->card_sem
= sem
;
872 adapter
->hw_status
= MWIFIEX_HW_STATUS_INITIALIZING
;
873 adapter
->surprise_removed
= false;
874 init_waitqueue_head(&adapter
->init_wait_q
);
875 adapter
->is_suspended
= false;
876 adapter
->hs_activated
= false;
877 init_waitqueue_head(&adapter
->hs_activate_wait_q
);
878 adapter
->cmd_wait_q_required
= false;
879 init_waitqueue_head(&adapter
->cmd_wait_q
.wait
);
880 adapter
->cmd_wait_q
.status
= 0;
881 adapter
->scan_wait_q_woken
= false;
884 alloc_workqueue("MWIFIEX_WORK_QUEUE",
885 WQ_HIGHPRI
| WQ_MEM_RECLAIM
| WQ_UNBOUND
, 1);
886 if (!adapter
->workqueue
)
889 INIT_WORK(&adapter
->main_work
, mwifiex_main_work_queue
);
891 /* Register the device. Fill up the private data structure with relevant
892 information from the card. */
893 if (adapter
->if_ops
.register_dev(adapter
)) {
894 pr_err("%s: failed to register mwifiex device\n", __func__
);
895 goto err_registerdev
;
898 if (mwifiex_init_hw_fw(adapter
)) {
899 pr_err("%s: firmware init failed\n", __func__
);
906 pr_debug("info: %s: unregister device\n", __func__
);
907 if (adapter
->if_ops
.unregister_dev
)
908 adapter
->if_ops
.unregister_dev(adapter
);
909 if ((adapter
->hw_status
== MWIFIEX_HW_STATUS_FW_READY
) ||
910 (adapter
->hw_status
== MWIFIEX_HW_STATUS_READY
)) {
911 pr_debug("info: %s: shutdown mwifiex\n", __func__
);
912 adapter
->init_wait_q_woken
= false;
914 if (mwifiex_shutdown_drv(adapter
) == -EINPROGRESS
)
915 wait_event_interruptible(adapter
->init_wait_q
,
916 adapter
->init_wait_q_woken
);
919 adapter
->surprise_removed
= true;
920 mwifiex_terminate_workqueue(adapter
);
922 mwifiex_free_adapter(adapter
);
930 EXPORT_SYMBOL_GPL(mwifiex_add_card
);
933 * This function removes the card.
935 * This function follows the following major steps to remove the device -
936 * - Stop data traffic
937 * - Shutdown firmware
938 * - Remove the logical interfaces
939 * - Terminate the work queue
940 * - Unregister the device
941 * - Free the adapter structure
943 int mwifiex_remove_card(struct mwifiex_adapter
*adapter
, struct semaphore
*sem
)
945 struct mwifiex_private
*priv
= NULL
;
948 if (down_interruptible(sem
))
954 /* We can no longer handle interrupts once we start doing the teardown
956 if (adapter
->if_ops
.disable_int
)
957 adapter
->if_ops
.disable_int(adapter
);
959 adapter
->surprise_removed
= true;
962 for (i
= 0; i
< adapter
->priv_num
; i
++) {
963 priv
= adapter
->priv
[i
];
964 if (priv
&& priv
->netdev
) {
965 mwifiex_stop_net_dev_queue(priv
->netdev
, adapter
);
966 if (netif_carrier_ok(priv
->netdev
))
967 netif_carrier_off(priv
->netdev
);
971 dev_dbg(adapter
->dev
, "cmd: calling mwifiex_shutdown_drv...\n");
972 adapter
->init_wait_q_woken
= false;
974 if (mwifiex_shutdown_drv(adapter
) == -EINPROGRESS
)
975 wait_event_interruptible(adapter
->init_wait_q
,
976 adapter
->init_wait_q_woken
);
977 dev_dbg(adapter
->dev
, "cmd: mwifiex_shutdown_drv done\n");
978 if (atomic_read(&adapter
->rx_pending
) ||
979 atomic_read(&adapter
->tx_pending
) ||
980 atomic_read(&adapter
->cmd_pending
)) {
981 dev_err(adapter
->dev
, "rx_pending=%d, tx_pending=%d, "
983 atomic_read(&adapter
->rx_pending
),
984 atomic_read(&adapter
->tx_pending
),
985 atomic_read(&adapter
->cmd_pending
));
988 for (i
= 0; i
< adapter
->priv_num
; i
++) {
989 priv
= adapter
->priv
[i
];
995 if (priv
->wdev
&& priv
->netdev
)
996 mwifiex_del_virtual_intf(adapter
->wiphy
, priv
->wdev
);
1000 priv
= adapter
->priv
[0];
1001 if (!priv
|| !priv
->wdev
)
1004 wiphy_unregister(priv
->wdev
->wiphy
);
1005 wiphy_free(priv
->wdev
->wiphy
);
1007 for (i
= 0; i
< adapter
->priv_num
; i
++) {
1008 priv
= adapter
->priv
[i
];
1013 mwifiex_terminate_workqueue(adapter
);
1015 /* Unregister device */
1016 dev_dbg(adapter
->dev
, "info: unregister device\n");
1017 if (adapter
->if_ops
.unregister_dev
)
1018 adapter
->if_ops
.unregister_dev(adapter
);
1019 /* Free adapter structure */
1020 dev_dbg(adapter
->dev
, "info: free adapter\n");
1021 mwifiex_free_adapter(adapter
);
1028 EXPORT_SYMBOL_GPL(mwifiex_remove_card
);
1031 * This function initializes the module.
1033 * The debug FS is also initialized if configured.
1036 mwifiex_init_module(void)
1038 #ifdef CONFIG_DEBUG_FS
1039 mwifiex_debugfs_init();
1045 * This function cleans up the module.
1047 * The debug FS is removed if available.
1050 mwifiex_cleanup_module(void)
1052 #ifdef CONFIG_DEBUG_FS
1053 mwifiex_debugfs_remove();
1057 module_init(mwifiex_init_module
);
1058 module_exit(mwifiex_cleanup_module
);
1060 MODULE_AUTHOR("Marvell International Ltd.");
1061 MODULE_DESCRIPTION("Marvell WiFi-Ex Driver version " VERSION
);
1062 MODULE_VERSION(VERSION
);
1063 MODULE_LICENSE("GPL v2");