[go: nahoru, domu]

1f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger/******************************************************************************
2f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *
3f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
4f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *
5f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * This program is free software; you can redistribute it and/or modify it
6f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * under the terms of version 2 of the GNU General Public License as
7f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * published by the Free Software Foundation.
8f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *
9f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * This program is distributed in the hope that it will be useful, but WITHOUT
10f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * more details.
13f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *
14f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ******************************************************************************/
15f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#define _HCI_OPS_OS_C_
16f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
17f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <osdep_service.h>
18f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <drv_types.h>
19f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <osdep_intf.h>
20f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <usb_ops.h>
21f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <recv_osdep.h>
22f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <rtl8723a_hal.h>
23f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <rtl8723a_recv.h>
24f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
252786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenu8 rtl8723au_read8(struct rtw_adapter *padapter, u16 addr)
26f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
27f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
28f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct usb_device *udev = pdvobjpriv->pusbdev;
292786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	int len;
302786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	u8 data;
31f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
32f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	mutex_lock(&pdvobjpriv->usb_vendor_req_mutex);
332786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
342786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ, REALTEK_USB_VENQT_READ,
352786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, &pdvobjpriv->usb_buf.val8, sizeof(data),
362786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      RTW_USB_CONTROL_MSG_TIMEOUT);
37f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
382786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	data = pdvobjpriv->usb_buf.val8;
39f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex);
40f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
41f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return data;
42f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
43f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
442786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenu16 rtl8723au_read16(struct rtw_adapter *padapter, u16 addr)
45f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
462786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
472786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct usb_device *udev = pdvobjpriv->pusbdev;
482786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	int len;
492786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	u16 data;
50f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
512786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_lock(&pdvobjpriv->usb_vendor_req_mutex);
522786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
532786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ, REALTEK_USB_VENQT_READ,
542786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, &pdvobjpriv->usb_buf.val16, sizeof(data),
552786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      RTW_USB_CONTROL_MSG_TIMEOUT);
56f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
572786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	data = le16_to_cpu(pdvobjpriv->usb_buf.val16);
582786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex);
59f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
602786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	return data;
61f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
62f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
632786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenu32 rtl8723au_read32(struct rtw_adapter *padapter, u16 addr)
64f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
652786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
662786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct usb_device *udev = pdvobjpriv->pusbdev;
672786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	int len;
682786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	u32 data;
69f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
702786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_lock(&pdvobjpriv->usb_vendor_req_mutex);
712786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
722786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ, REALTEK_USB_VENQT_READ,
732786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, &pdvobjpriv->usb_buf.val32, sizeof(data),
742786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      RTW_USB_CONTROL_MSG_TIMEOUT);
75f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
762786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	data = le32_to_cpu(pdvobjpriv->usb_buf.val32);
772786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex);
78f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
792786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	return data;
80f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
81f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
822786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_write8(struct rtw_adapter *padapter, u16 addr, u8 val)
83f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
842786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
852786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct usb_device *udev = pdvobjpriv->pusbdev;
86f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int ret;
87f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
882786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_lock(&pdvobjpriv->usb_vendor_req_mutex);
892786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	pdvobjpriv->usb_buf.val8 = val;
90f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
912786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
922786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ,
932786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_WRITE,
942786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, &pdvobjpriv->usb_buf.val8, sizeof(val),
952786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      RTW_USB_CONTROL_MSG_TIMEOUT);
96f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
972786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	if (ret != sizeof(val))
982786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		ret = _FAIL;
992786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	else
1002786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		ret = _SUCCESS;
101f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1022786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex);
103f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return ret;
104f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
105f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1062786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_write16(struct rtw_adapter *padapter, u16 addr, u16 val)
107f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
1082786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
1092786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct usb_device *udev = pdvobjpriv->pusbdev;
110f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int ret;
111f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1122786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_lock(&pdvobjpriv->usb_vendor_req_mutex);
1132786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	pdvobjpriv->usb_buf.val16 = cpu_to_le16(val);
114f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1152786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1162786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ,
1172786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_WRITE,
1182786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, &pdvobjpriv->usb_buf.val16, sizeof(val),
1192786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      RTW_USB_CONTROL_MSG_TIMEOUT);
120f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1212786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	if (ret != sizeof(val))
1222786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		ret = _FAIL;
1232786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	else
1242786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		ret = _SUCCESS;
125f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1262786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex);
127f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return ret;
128f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
129f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1302786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_write32(struct rtw_adapter *padapter, u16 addr, u32 val)
131f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
1322786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
1332786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct usb_device *udev = pdvobjpriv->pusbdev;
134f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int ret;
135f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1362786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_lock(&pdvobjpriv->usb_vendor_req_mutex);
1372786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	pdvobjpriv->usb_buf.val32 = cpu_to_le32(val);
138f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1392786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1402786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ,
1412786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_WRITE,
1422786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, &pdvobjpriv->usb_buf.val32, sizeof(val),
1432786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      RTW_USB_CONTROL_MSG_TIMEOUT);
144f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1452786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	if (ret != sizeof(val))
1462786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		ret = _FAIL;
1472786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	else
1482786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		ret = _SUCCESS;
149f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1502786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex);
151f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return ret;
152f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
153f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1542786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_writeN(struct rtw_adapter *padapter, u16 addr, u16 len, u8 *buf)
155f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
1562786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
1572786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	struct usb_device *udev = pdvobjpriv->pusbdev;
158f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int ret;
159f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1602786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1612786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_CMD_REQ,
1622786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      REALTEK_USB_VENQT_WRITE,
1632786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen			      addr, 0, buf, len, RTW_USB_CONTROL_MSG_TIMEOUT);
164f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
1652786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	if (ret != len)
1662786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen		return _FAIL;
1672786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen	return _SUCCESS;
168f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
169f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
170f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger/*
171f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Description:
172f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	Recognize the interrupt content by reading the interrupt
173f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	register or content and masking interrupt mask (IMR)
174f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	if it is our NIC's interrupt. After recognizing, we may clear
175f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	the all interrupts (ISR).
176f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Arguments:
177f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	[in] Adapter -
178f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		The adapter context.
179f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	[in] pContent -
180f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		Under PCI interface, this field is ignord.
181f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		Under USB interface, the content is the interrupt
182f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		content pointer.
183f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		Under SDIO interface, this is the interrupt type which
184f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		is Local interrupt or system interrupt.
185f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	[in] ContentLen -
186f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *		The length in byte of pContent.
187f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Return:
188f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	If any interrupt matches the mask (IMR), return true, and
189f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger *	return false otherwise.
190f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger */
191f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingerstatic bool
192f7c92d2cc2beb3367f244480300eaecdd9502932Larry FingerInterruptRecognized8723AU(struct rtw_adapter *Adapter, void *pContent,
193f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  u32 ContentLen)
194f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
195f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct hal_data_8723a	*pHalData = GET_HAL_DATA(Adapter);
196f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	u8 *buffer = (u8 *)pContent;
197f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct reportpwrstate_parm report;
198f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
199f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	memcpy(&pHalData->IntArray[0], &buffer[USB_INTR_CONTENT_HISR_OFFSET],
200f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	       4);
201f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	pHalData->IntArray[0] &= pHalData->IntrMask[0];
202f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
203f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	/* For HISR extension. Added by tynli. 2009.10.07. */
204f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	memcpy(&pHalData->IntArray[1],
205f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	       &buffer[USB_INTR_CONTENT_HISRE_OFFSET], 4);
206f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	pHalData->IntArray[1] &= pHalData->IntrMask[1];
207f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
208f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	/* We sholud remove this function later because DDK suggest
209f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	 * not to executing too many operations in MPISR  */
210f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
211f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	memcpy(&report.state, &buffer[USB_INTR_CPWM_OFFSET], 1);
212f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
2137438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	return (pHalData->IntArray[0] & pHalData->IntrMask[0]) != 0 ||
2147438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		(pHalData->IntArray[1] & pHalData->IntrMask[1]) != 0;
215f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
216f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
2172296fd2d928c2cb9d601cdeef5e41eea4c120b88Jes Sorensenstatic void usb_read_interrupt_complete(struct urb *purb)
218f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
219f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int err;
220f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct rtw_adapter *padapter = (struct rtw_adapter *)purb->context;
221f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
222f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (padapter->bSurpriseRemoved || padapter->bDriverStopped ||
223f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	    padapter->bReadPortCancel) {
224f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		DBG_8723A("%s() RX Warning! bDriverStopped(%d) OR "
225f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "bSurpriseRemoved(%d) bReadPortCancel(%d)\n",
226f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches			  __func__, padapter->bDriverStopped,
227f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  padapter->bSurpriseRemoved,
228f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  padapter->bReadPortCancel);
229f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		return;
230f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
231f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
232f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (purb->status == 0) {
233f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		struct c2h_evt_hdr *c2h_evt;
234f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
235f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		c2h_evt = (struct c2h_evt_hdr *)purb->transfer_buffer;
236f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
237f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (purb->actual_length > USB_INTR_CONTENT_LENGTH) {
238f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("usb_read_interrupt_complete: purb->actual_"
239f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "length > USB_INTR_CONTENT_LENGTH\n");
240f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			goto urb_submit;
241f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
242f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
243f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		InterruptRecognized8723AU(padapter, purb->transfer_buffer,
244f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger					  purb->actual_length);
245f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
246f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (c2h_evt_exist(c2h_evt)) {
247f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			if (c2h_id_filter_ccx_8723a(c2h_evt->id)) {
248f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				/* Handle CCX report here */
2497438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen				handle_txrpt_ccx_8723a(padapter, (void *)
2507438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen						       c2h_evt->payload);
251980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				schedule_work(&padapter->evtpriv.irq_wk);
252f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			} else {
253980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				struct evt_work *c2w;
254980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				int res;
255980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen
256f9de4a30a5e647bff71509d6f5d419f6967ba291Sachin Kamat				c2w = kmalloc(sizeof(struct evt_work),
257980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen						GFP_ATOMIC);
258980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen
259980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				if (!c2w) {
260980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					printk(KERN_WARNING "%s: unable to "
261980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					       "allocate work buffer\n",
262980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					       __func__);
263980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					goto urb_submit;
264980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				}
265980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen
266980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				c2w->adapter = padapter;
267980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				INIT_WORK(&c2w->work, rtw_evt_work);
268980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				memcpy(c2w->u.buf, purb->transfer_buffer, 16);
269980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen
270980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				res = queue_work(padapter->evtpriv.wq,
271980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen						 &c2w->work);
272980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen
273980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				if (!res) {
274980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					printk(KERN_ERR "%s: Call to "
275980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					       "queue_work() failed\n",
276980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					       __func__);
277980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					kfree(c2w);
278980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen					goto urb_submit;
279980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen				}
280f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			}
281f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
282f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
283f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingerurb_submit:
284f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		err = usb_submit_urb(purb, GFP_ATOMIC);
285f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (err && (err != -EPERM)) {
286f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("cannot submit interrupt in-token(err = "
287f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "0x%08x), urb_status = %d\n",
288f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  err, purb->status);
289f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
290f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	} else {
291f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		DBG_8723A("###=> usb_read_interrupt_complete => urb "
292f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "status(%d)\n", purb->status);
293f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
294f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		switch (purb->status) {
295f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EINVAL:
296f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EPIPE:
297f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -ENODEV:
298f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -ESHUTDOWN:
299f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
300f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("usb_read_port_complete:bSurpriseRemoved ="
301f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "true\n"));
302f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			/* Fall Through here */
303f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -ENOENT:
304f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			padapter->bDriverStopped = true;
305f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
306f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("usb_read_port_complete:bDriverStopped ="
307f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "true\n"));
308f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
309f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EPROTO:
310f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
311f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EINPROGRESS:
31248039e70b647424ee9cf529af7846effb270f417Joe Perches			DBG_8723A("ERROR: URB IS IN PROGRESS!\n");
313f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
314f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		default:
315f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
316f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
317f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
318f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
319f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
32068552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensenint rtl8723au_read_interrupt(struct rtw_adapter *adapter, u32 addr)
321f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
322f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int err;
323f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	unsigned int pipe;
324ad899b12192ef2fa0cf81a88a320d5a0de4d5151Jes Sorensen	int ret = _SUCCESS;
325f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter);
326f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct recv_priv *precvpriv = &adapter->recvpriv;
327f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct usb_device *pusbd = pdvobj->pusbdev;
328f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
329f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	/* translate DMA FIFO addr to pipehandle */
33097ccc3a6bead88e637c0150b19aaea27387ba6f7Jes Sorensen	pipe = usb_rcvintpipe(pusbd, pdvobj->RtInPipe[1]);
331f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
332f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	usb_fill_int_urb(precvpriv->int_in_urb, pusbd, pipe,
333f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 precvpriv->int_in_buf, USB_INTR_CONTENT_LENGTH,
334f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 usb_read_interrupt_complete, adapter, 1);
335f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
336f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	err = usb_submit_urb(precvpriv->int_in_urb, GFP_ATOMIC);
337f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (err && (err != -EPERM)) {
338f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		DBG_8723A("cannot submit interrupt in-token(err = 0x%08x),"
339f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "urb_status = %d\n", err,
340f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  precvpriv->int_in_urb->status);
341f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		ret = _FAIL;
342f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
343f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
344f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return ret;
345f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
346f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
347f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingerstatic int recvbuf2recvframe(struct rtw_adapter *padapter, struct sk_buff *pskb)
348f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
349f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	u8	*pbuf;
350f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	u8	shift_sz = 0;
351f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	u16	pkt_cnt;
352f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	u32	pkt_offset, skb_len, alloc_sz;
3537438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	int	transfer_len;
3547438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct recv_stat *prxstat;
3557438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct phy_stat	*pphy_info;
3567438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct sk_buff *pkt_copy;
3577438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct recv_frame *precvframe;
3587438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct rx_pkt_attrib *pattrib;
3597438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct recv_priv *precvpriv = &padapter->recvpriv;
3607438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct rtw_queue *pfree_recv_queue = &precvpriv->free_recv_queue;
3617438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen
3627438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	transfer_len = (int)pskb->len;
363f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	pbuf = pskb->data;
364f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
365f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	prxstat = (struct recv_stat *)pbuf;
366f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	pkt_cnt = (le32_to_cpu(prxstat->rxdw2) >> 16) & 0xff;
367f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
368f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	do {
369f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		RT_TRACE(_module_rtl871x_recv_c_, _drv_info_,
370f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 ("recvbuf2recvframe: rxdesc = offsset 0:0x%08x, "
371f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "4:0x%08x, 8:0x%08x, C:0x%08x\n", prxstat->rxdw0,
372f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  prxstat->rxdw1, prxstat->rxdw2, prxstat->rxdw4));
373f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
374f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		prxstat = (struct recv_stat *)pbuf;
375f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
376f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		precvframe = rtw_alloc_recvframe23a(pfree_recv_queue);
377f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (!precvframe) {
378f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_rtl871x_recv_c_, _drv_err_,
379f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("recvbuf2recvframe: precvframe == NULL\n"));
380f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("%s()-%d: rtw_alloc_recvframe23a() failed! RX "
381f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches				  "Drop!\n", __func__, __LINE__);
382f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			goto _exit_recvbuf2recvframe;
383f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
384f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
385f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		INIT_LIST_HEAD(&precvframe->list);
386f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
387f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		update_recvframe_attrib(precvframe, prxstat);
388f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
389f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pattrib = &precvframe->attrib;
390f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
391f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (pattrib->crc_err) {
392f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("%s()-%d: RX Warning! rx CRC ERROR !!\n",
393f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches				  __func__, __LINE__);
394c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen			rtw_free_recvframe23a(precvframe);
395f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			goto _exit_recvbuf2recvframe;
396f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
397f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
398f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pkt_offset = RXDESC_SIZE + pattrib->drvinfo_sz +
399f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			pattrib->shift_sz + pattrib->pkt_len;
400f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
4017438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		if (pattrib->pkt_len <= 0 || pkt_offset > transfer_len) {
402f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_rtl871x_recv_c_, _drv_info_,
403f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("recvbuf2recvframe: pkt_len<= 0\n"));
404f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("%s()-%d: RX Warning!\n",
405f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches				  __func__, __LINE__);
406c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen			rtw_free_recvframe23a(precvframe);
407f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			goto _exit_recvbuf2recvframe;
408f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
409f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
410f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		/*	Modified by Albert 20101213 */
411f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		/*	For 8 bytes IP header alignment. */
412f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		/*	Qos data, wireless lan header length is 26 */
4137438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		if (pattrib->qos)
414f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			shift_sz = 6;
4157438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		else
416f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			shift_sz = 0;
417f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
418f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		skb_len = pattrib->pkt_len;
419f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
420f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		/* for first fragment packet, driver need allocate
421f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		 * 1536+drvinfo_sz+RXDESC_SIZE to defrag packet.
422f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		 * modify alloc_sz for recvive crc error packet
423f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		 * by thomas 2011-06-02 */
4247438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		if (pattrib->mfrag == 1 && pattrib->frag_num == 0) {
425f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			/* alloc_sz = 1664;	1664 is 128 alignment. */
426f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			if (skb_len <= 1650)
427f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				alloc_sz = 1664;
428f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			else
429f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				alloc_sz = skb_len + 14;
430f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		} else {
431f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			alloc_sz = skb_len;
432f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		/*  6 is for IP header 8 bytes alignment in QoS packet case. */
433f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		/*  8 is for skb->data 4 bytes alignment. */
434f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			alloc_sz += 14;
435f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
436f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
437f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pkt_copy = netdev_alloc_skb(padapter->pnetdev, alloc_sz);
438f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (pkt_copy) {
439f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			pkt_copy->dev = padapter->pnetdev;
440f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			precvframe->pkt = pkt_copy;
4417438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			/* force pkt_copy->data at 8-byte alignment address */
4427438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			skb_reserve(pkt_copy, 8 -
4437438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen				    ((unsigned long)(pkt_copy->data) & 7));
4447438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			/*force ip_hdr at 8-byte alignment address
4457438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			  according to shift_sz. */
446f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			skb_reserve(pkt_copy, shift_sz);
4477438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			memcpy(pkt_copy->data, pbuf + pattrib->shift_sz +
4487438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			       pattrib->drvinfo_sz + RXDESC_SIZE, skb_len);
449f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			skb_put(pkt_copy, skb_len);
450f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		} else {
4517438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen			if (pattrib->mfrag == 1 && pattrib->frag_num == 0) {
452f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				DBG_8723A("recvbuf2recvframe: alloc_skb fail, "
453f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger					  "drop frag frame \n");
454c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen				rtw_free_recvframe23a(precvframe);
455f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				goto _exit_recvbuf2recvframe;
456f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			}
457f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
458f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			precvframe->pkt = skb_clone(pskb, GFP_ATOMIC);
459f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			if (!precvframe->pkt) {
460f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				DBG_8723A("recvbuf2recvframe: skb_clone "
461f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger					  "fail\n");
462c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen				rtw_free_recvframe23a(precvframe);
463f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				goto _exit_recvbuf2recvframe;
464f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			}
465f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
466f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
467f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (pattrib->physt) {
468f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			pphy_info = (struct phy_stat *)(pbuf + RXDESC_OFFSET);
469f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			update_recvframe_phyinfo(precvframe, pphy_info);
470f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
471f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
472f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (rtw_recv_entry23a(precvframe) != _SUCCESS)
473f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_rtl871x_recv_c_, _drv_err_,
474f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("recvbuf2recvframe: rtw_recv_entry23a"
475f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "(precvframe) != _SUCCESS\n"));
476f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
477f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pkt_cnt--;
478f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		transfer_len -= pkt_offset;
479f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pbuf += pkt_offset;
480f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		precvframe = NULL;
481f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pkt_copy = NULL;
482f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
483f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (transfer_len > 0 && pkt_cnt == 0)
484f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			pkt_cnt = (le32_to_cpu(prxstat->rxdw2)>>16) & 0xff;
485f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
4867438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	} while (transfer_len > 0 && pkt_cnt > 0);
487f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
488f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger_exit_recvbuf2recvframe:
489f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
490f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return _SUCCESS;
491f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
492f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
493f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingervoid rtl8723au_recv_tasklet(void *priv)
494f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
495f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct sk_buff *pskb;
496f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct rtw_adapter *padapter = (struct rtw_adapter *)priv;
497f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct recv_priv *precvpriv = &padapter->recvpriv;
498f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
499f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	while (NULL != (pskb = skb_dequeue(&precvpriv->rx_skb_queue))) {
5007438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		if (padapter->bDriverStopped || padapter->bSurpriseRemoved) {
501f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("recv_tasklet => bDriverStopped or "
502f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "bSurpriseRemoved \n");
503f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			dev_kfree_skb_any(pskb);
504f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
505f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
506f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
507f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		recvbuf2recvframe(padapter, pskb);
508f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		skb_reset_tail_pointer(pskb);
509f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
510f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		pskb->len = 0;
511f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
512f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb);
513f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
514f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
515f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
5162296fd2d928c2cb9d601cdeef5e41eea4c120b88Jes Sorensenstatic void usb_read_port_complete(struct urb *purb)
517f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
518f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct recv_buf *precvbuf = (struct recv_buf *)purb->context;
519f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct rtw_adapter *padapter = (struct rtw_adapter *)precvbuf->adapter;
520f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct recv_priv *precvpriv = &padapter->recvpriv;
521f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
522f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
523f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		 ("usb_read_port_complete!!!\n"));
524f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
525f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	precvpriv->rx_pending_cnt--;
526f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
527f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (padapter->bSurpriseRemoved || padapter->bDriverStopped ||
528f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	    padapter->bReadPortCancel) {
529f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
530f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 ("usb_read_port_complete:bDriverStopped(%d) OR "
531f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "bSurpriseRemoved(%d)\n", padapter->bDriverStopped,
532f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  padapter->bSurpriseRemoved));
533f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
534f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		DBG_8723A("%s()-%d: RX Warning! bDriverStopped(%d) OR "
535f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "bSurpriseRemoved(%d) bReadPortCancel(%d)\n",
536f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches			  __func__, __LINE__, padapter->bDriverStopped,
537f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  padapter->bSurpriseRemoved, padapter->bReadPortCancel);
538f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		return;
539f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
540f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
541f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (purb->status == 0) {
5427438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		if (purb->actual_length > MAX_RECVBUF_SZ ||
5437438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		    purb->actual_length < RXDESC_SIZE) {
544f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
545f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("usb_read_port_complete: (purb->actual_"
546f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "length > MAX_RECVBUF_SZ) || (purb->actual_"
547f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "length < RXDESC_SIZE)\n"));
54868552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen			rtl8723au_read_port(padapter, RECV_BULK_IN_ADDR, 0,
54968552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen					    precvbuf);
550f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("%s()-%d: RX Warning!\n",
551f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches				  __func__, __LINE__);
552f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		} else {
553f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			rtw_reset_continual_urb_error(
554f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				adapter_to_dvobj(padapter));
555f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
556f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			skb_put(precvbuf->pskb, purb->actual_length);
557f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			skb_queue_tail(&precvpriv->rx_skb_queue,
558f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				       precvbuf->pskb);
559f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
560f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			if (skb_queue_len(&precvpriv->rx_skb_queue) <= 1)
561f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				tasklet_schedule(&precvpriv->recv_tasklet);
562f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
563f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			precvbuf->pskb = NULL;
56468552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen			rtl8723au_read_port(padapter, RECV_BULK_IN_ADDR, 0,
56568552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen					    precvbuf);
566f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
567f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	} else {
568f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
569f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 ("usb_read_port_complete : purb->status(%d) != 0 \n",
570f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  purb->status));
571f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		skb_put(precvbuf->pskb, purb->actual_length);
572f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		precvbuf->pskb = NULL;
573f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
574f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		DBG_8723A("###=> usb_read_port_complete => urb status(%d)\n",
575f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  purb->status);
576f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
577f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (rtw_inc_and_chk_continual_urb_error(
578f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			    adapter_to_dvobj(padapter))) {
579f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			padapter->bSurpriseRemoved = true;
580f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
581f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
582f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		switch (purb->status) {
583f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EINVAL:
584f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EPIPE:
585f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -ENODEV:
586f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -ESHUTDOWN:
587f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
588f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("usb_read_port_complete:bSurprise"
589f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "Removed = true\n"));
590f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			/* Intentional fall through here */
591f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -ENOENT:
592f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			padapter->bDriverStopped = true;
593f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
594f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				 ("usb_read_port_complete:"
595f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "bDriverStopped = true\n"));
596f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
597f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EPROTO:
598f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EOVERFLOW:
59968552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen			rtl8723au_read_port(padapter, RECV_BULK_IN_ADDR, 0,
60068552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen					    precvbuf);
601f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
602f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		case -EINPROGRESS:
60348039e70b647424ee9cf529af7846effb270f417Joe Perches			DBG_8723A("ERROR: URB IS IN PROGRESS!\n");
604f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
605f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		default:
606f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
607f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
608f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
609f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
610f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
61168552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensenint rtl8723au_read_port(struct rtw_adapter *adapter, u32 addr, u32 cnt,
61268552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen			struct recv_buf *precvbuf)
613f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
614f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	int err;
615f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	unsigned int pipe;
6167438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	unsigned long tmpaddr;
6177438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	unsigned long alignment;
618ad899b12192ef2fa0cf81a88a320d5a0de4d5151Jes Sorensen	int ret = _SUCCESS;
6197438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct urb *purb;
6207438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter);
6217438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct recv_priv *precvpriv = &adapter->recvpriv;
6227438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen	struct usb_device *pusbd = pdvobj->pusbdev;
623f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
624e976cf6f135713cb6f4c904bf24fadfbbf325160Jes Sorensen	if (adapter->bDriverStopped || adapter->bSurpriseRemoved) {
625f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
626f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 ("usb_read_port:(padapter->bDriverStopped ||"
627e976cf6f135713cb6f4c904bf24fadfbbf325160Jes Sorensen			  "padapter->bSurpriseRemoved)!!!\n"));
628f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		return _FAIL;
629f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
630f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
631f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (!precvbuf) {
632f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
633f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 ("usb_read_port:precvbuf == NULL\n"));
634f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		return _FAIL;
635f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
636f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
637f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (!precvbuf->pskb)
638f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		precvbuf->pskb = skb_dequeue(&precvpriv->free_recv_skb_queue);
639f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
640f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	/* re-assign for linux based on skb */
641f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (!precvbuf->pskb) {
642f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		precvbuf->pskb = netdev_alloc_skb(adapter->pnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ);
643f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (precvbuf->pskb == NULL) {
644f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			RT_TRACE(_module_hci_ops_os_c_, _drv_err_, ("init_recvbuf(): alloc_skb fail!\n"));
645f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			return _FAIL;
646f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
647f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
648f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		tmpaddr = (unsigned long)precvbuf->pskb->data;
649f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1);
650f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment));
651f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
652f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
653f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	precvpriv->rx_pending_cnt++;
654f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
655f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	purb = precvbuf->purb;
656f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
657f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	/* translate DMA FIFO addr to pipehandle */
65897ccc3a6bead88e637c0150b19aaea27387ba6f7Jes Sorensen	pipe = usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[0]);
659f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
660f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	usb_fill_bulk_urb(purb, pusbd, pipe, precvbuf->pskb->data,
661f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  MAX_RECVBUF_SZ, usb_read_port_complete,
662f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  precvbuf);/* context is precvbuf */
663f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
664f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	err = usb_submit_urb(purb, GFP_ATOMIC);
665f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if ((err) && (err != -EPERM)) {
666f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		RT_TRACE(_module_hci_ops_os_c_, _drv_err_,
667f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			 ("cannot submit rx in-token(err = 0x%.8x), URB_STATUS "
668f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "= 0x%.8x", err, purb->status));
669f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		DBG_8723A("cannot submit rx in-token(err = 0x%08x), urb_status "
670f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			  "= %d\n", err, purb->status);
671f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		ret = _FAIL;
672f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
673f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	return ret;
674f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
675f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
676f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingervoid rtl8723au_xmit_tasklet(void *priv)
677f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
67824ed8e4575cdd9bf59750755fadbef67af427c88Jes Sorensen	int ret;
679f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct rtw_adapter *padapter = (struct rtw_adapter *)priv;
680f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
681f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
682f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	if (check_fwstate(&padapter->mlmepriv, _FW_UNDER_SURVEY))
683f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		return;
684f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
685f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	while (1) {
6867438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		if (padapter->bDriverStopped || padapter->bSurpriseRemoved ||
6877438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen		    padapter->bWritePortCancel) {
688f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			DBG_8723A("xmit_tasklet => bDriverStopped or "
689f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger				  "bSurpriseRemoved or bWritePortCancel\n");
690f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
691f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		}
692f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
693f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		ret = rtl8723au_xmitframe_complete(padapter, pxmitpriv, NULL);
694f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
695f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger		if (!ret)
696f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger			break;
697f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	}
698f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
699f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger
700f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingervoid rtl8723au_set_hw_type(struct rtw_adapter *padapter)
701f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{
702f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	padapter->chip_type = RTL8723A;
703f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	padapter->HardwareType = HARDWARE_TYPE_RTL8723AU;
704f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger	DBG_8723A("CHIP TYPE: RTL8723A\n");
705f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger}
706