/drivers/staging/rtl8712/rtl871x_xmit.c

https://bitbucket.org/wisechild/galaxy-nexus · C · 1051 lines · 883 code · 63 blank · 105 comment · 190 complexity · 8923f7aa2a43b2e4df037fa538649e15 MD5 · raw file 

    

  1. /******************************************************************************
    2. 

  2.  * rtl871x_xmit.c
    3. 

  3.  *
    4. 

  4.  * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
    5. 

  5.  * Linux device driver for RTL8192SU
    6. 

  6.  *
    7. 

  7.  * This program is free software; you can redistribute it and/or modify it
    8. 

  8.  * under the terms of version 2 of the GNU General Public License as
    9. 

  9.  * published by the Free Software Foundation.
    10. 

  10.  *
    11. 

  11.  * This program is distributed in the hope that it will be useful, but WITHOUT
    12. 

  12.  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
    13. 

  13.  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
    14. 

  14.  * more details.
    15. 

  15.  *
    16. 

  16.  * You should have received a copy of the GNU General Public License along with
    17. 

  17.  * this program; if not, write to the Free Software Foundation, Inc.,
    18. 

  18.  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
    19. 

  19.  *
    20. 

  20.  * Modifications for inclusion into the Linux staging tree are
    21. 

  21.  * Copyright(c) 2010 Larry Finger. All rights reserved.
    22. 

  22.  *
    23. 

  23.  * Contact information:
    24. 

  24.  * WLAN FAE <wlanfae@realtek.com>
    25. 

  25.  * Larry Finger <Larry.Finger@lwfinger.net>
    26. 

  26.  *
    27. 

  27.  ******************************************************************************/
    28. 

  28. 

  29. #define _RTL871X_XMIT_C_
    30. 

  30. 

  31. #include "osdep_service.h"
    32. 

  32. #include "drv_types.h"
    33. 

  33. #include "rtl871x_byteorder.h"
    34. 

  34. #include "wifi.h"
    35. 

  35. #include "osdep_intf.h"
    36. 

  36. #include "usb_ops.h"
    37. 

  37. 

  38. 

  39. static const u8 P802_1H_OUI[P80211_OUI_LEN] = {0x00, 0x00, 0xf8};
    40. 

  40. static const u8 RFC1042_OUI[P80211_OUI_LEN] = {0x00, 0x00, 0x00};
    41. 

  41. static void init_hwxmits(struct hw_xmit *phwxmit, sint entry);
    42. 

  42. static void alloc_hwxmits(struct _adapter *padapter);
    43. 

  43. static void free_hwxmits(struct _adapter *padapter);
    44. 

  44. 

  45. static void _init_txservq(struct tx_servq *ptxservq)
    46. 

  46. {
    47. 

  47. 	_init_listhead(&ptxservq->tx_pending);
    48. 

  48. 	_init_queue(&ptxservq->sta_pending);
    49. 

  49. 	ptxservq->qcnt = 0;
    50. 

  50. }
    51. 

  51. 

  52. void _r8712_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv)
    53. 

  53. {
    54. 

  54. 	memset((unsigned char *)psta_xmitpriv, 0,
    55. 

  55. 		 sizeof(struct sta_xmit_priv));
    56. 

  56. 	spin_lock_init(&psta_xmitpriv->lock);
    57. 

  57. 	_init_txservq(&psta_xmitpriv->be_q);
    58. 

  58. 	_init_txservq(&psta_xmitpriv->bk_q);
    59. 

  59. 	_init_txservq(&psta_xmitpriv->vi_q);
    60. 

  60. 	_init_txservq(&psta_xmitpriv->vo_q);
    61. 

  61. 	_init_listhead(&psta_xmitpriv->legacy_dz);
    62. 

  62. 	_init_listhead(&psta_xmitpriv->apsd);
    63. 

  63. }
    64. 

  64. 

  65. sint _r8712_init_xmit_priv(struct xmit_priv *pxmitpriv,
    66. 

  66. 			   struct _adapter *padapter)
    67. 

  67. {
    68. 

  68. 	sint i;
    69. 

  69. 	struct xmit_buf *pxmitbuf;
    70. 

  70. 	struct xmit_frame *pxframe;
    71. 

  71. 

  72. 	memset((unsigned char *)pxmitpriv, 0, sizeof(struct xmit_priv));
    73. 

  73. 	spin_lock_init(&pxmitpriv->lock);
    74. 

  74. 	sema_init(&pxmitpriv->xmit_sema, 0);
    75. 

  75. 	sema_init(&pxmitpriv->terminate_xmitthread_sema, 0);
    76. 

  76. 	/*
    77. 

  77. 	Please insert all the queue initializaiton using _init_queue below
    78. 

  78. 	*/
    79. 

  79. 	pxmitpriv->adapter = padapter;
    80. 

  80. 	_init_queue(&pxmitpriv->be_pending);
    81. 

  81. 	_init_queue(&pxmitpriv->bk_pending);
    82. 

  82. 	_init_queue(&pxmitpriv->vi_pending);
    83. 

  83. 	_init_queue(&pxmitpriv->vo_pending);
    84. 

  84. 	_init_queue(&pxmitpriv->bm_pending);
    85. 

  85. 	_init_queue(&pxmitpriv->legacy_dz_queue);
    86. 

  86. 	_init_queue(&pxmitpriv->apsd_queue);
    87. 

  87. 	_init_queue(&pxmitpriv->free_xmit_queue);
    88. 

  88. 	/*
    89. 

  89. 	Please allocate memory with the sz = (struct xmit_frame) * NR_XMITFRAME,
    90. 

  90. 	and initialize free_xmit_frame below.
    91. 

  91. 	Please also apply  free_txobj to link_up all the xmit_frames...
    92. 

  92. 	*/
    93. 

  93. 	pxmitpriv->pallocated_frame_buf = _malloc(NR_XMITFRAME *
    94. 

  94. 					  sizeof(struct xmit_frame) + 4);
    95. 

  95. 	if (pxmitpriv->pallocated_frame_buf == NULL) {
    96. 

  96. 		pxmitpriv->pxmit_frame_buf = NULL;
    97. 

  97. 		return _FAIL;
    98. 

  98. 	}
    99. 

  99. 	pxmitpriv->pxmit_frame_buf = pxmitpriv->pallocated_frame_buf + 4 -
    100. 

  100. 			((addr_t) (pxmitpriv->pallocated_frame_buf) & 3);
    101. 

  101. 	pxframe = (struct xmit_frame *) pxmitpriv->pxmit_frame_buf;
    102. 

  102. 	for (i = 0; i < NR_XMITFRAME; i++) {
    103. 

  103. 		_init_listhead(&(pxframe->list));
    104. 

  104. 		pxframe->padapter = padapter;
    105. 

  105. 		pxframe->frame_tag = DATA_FRAMETAG;
    106. 

  106. 		pxframe->pkt = NULL;
    107. 

  107. 		pxframe->buf_addr = NULL;
    108. 

  108. 		pxframe->pxmitbuf = NULL;
    109. 

  109. 		list_insert_tail(&(pxframe->list),
    110. 

  110. 				 &(pxmitpriv->free_xmit_queue.queue));
    111. 

  111. 		pxframe++;
    112. 

  112. 	}
    113. 

  113. 	pxmitpriv->free_xmitframe_cnt = NR_XMITFRAME;
    114. 

  114. 	/*
    115. 

  115. 		init xmit hw_txqueue
    116. 

  116. 	*/
    117. 

  117. 	_r8712_init_hw_txqueue(&pxmitpriv->be_txqueue, BE_QUEUE_INX);
    118. 

  118. 	_r8712_init_hw_txqueue(&pxmitpriv->bk_txqueue, BK_QUEUE_INX);
    119. 

  119. 	_r8712_init_hw_txqueue(&pxmitpriv->vi_txqueue, VI_QUEUE_INX);
    120. 

  120. 	_r8712_init_hw_txqueue(&pxmitpriv->vo_txqueue, VO_QUEUE_INX);
    121. 

  121. 	_r8712_init_hw_txqueue(&pxmitpriv->bmc_txqueue, BMC_QUEUE_INX);
    122. 

  122. 	pxmitpriv->frag_len = MAX_FRAG_THRESHOLD;
    123. 

  123. 	pxmitpriv->txirp_cnt = 1;
    124. 

  124. 	sema_init(&(pxmitpriv->tx_retevt), 0);
    125. 

  125. 	/*per AC pending irp*/
    126. 

  126. 	pxmitpriv->beq_cnt = 0;
    127. 

  127. 	pxmitpriv->bkq_cnt = 0;
    128. 

  128. 	pxmitpriv->viq_cnt = 0;
    129. 

  129. 	pxmitpriv->voq_cnt = 0;
    130. 

  130. 	/*init xmit_buf*/
    131. 

  131. 	_init_queue(&pxmitpriv->free_xmitbuf_queue);
    132. 

  132. 	_init_queue(&pxmitpriv->pending_xmitbuf_queue);
    133. 

  133. 	pxmitpriv->pallocated_xmitbuf = _malloc(NR_XMITBUFF *
    134. 

  134. 					sizeof(struct xmit_buf) + 4);
    135. 

  135. 	if (pxmitpriv->pallocated_xmitbuf  == NULL)
    136. 

  136. 		return _FAIL;
    137. 

  137. 	pxmitpriv->pxmitbuf = pxmitpriv->pallocated_xmitbuf + 4 -
    138. 

  138. 			      ((addr_t)(pxmitpriv->pallocated_xmitbuf) & 3);
    139. 

  139. 	pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf;
    140. 

  140. 	for (i = 0; i < NR_XMITBUFF; i++) {
    141. 

  141. 		_init_listhead(&pxmitbuf->list);
    142. 

  142. 		pxmitbuf->pallocated_buf = _malloc(MAX_XMITBUF_SZ +
    143. 

  143. 					   XMITBUF_ALIGN_SZ);
    144. 

  144. 		if (pxmitbuf->pallocated_buf == NULL)
    145. 

  145. 			return _FAIL;
    146. 

  146. 		pxmitbuf->pbuf = pxmitbuf->pallocated_buf + XMITBUF_ALIGN_SZ -
    147. 

  147. 				 ((addr_t) (pxmitbuf->pallocated_buf) &
    148. 

  148. 				 (XMITBUF_ALIGN_SZ - 1));
    149. 

  149. 		r8712_xmit_resource_alloc(padapter, pxmitbuf);
    150. 

  150. 		list_insert_tail(&pxmitbuf->list,
    151. 

  151. 				 &(pxmitpriv->free_xmitbuf_queue.queue));
    152. 

  152. 		pxmitbuf++;
    153. 

  153. 	}
    154. 

  154. 	pxmitpriv->free_xmitbuf_cnt = NR_XMITBUFF;
    155. 

  155. 	alloc_hwxmits(padapter);
    156. 

  156. 	init_hwxmits(pxmitpriv->hwxmits, pxmitpriv->hwxmit_entry);
    157. 

  157. 	tasklet_init(&pxmitpriv->xmit_tasklet,
    158. 

  158. 	     (void(*)(addr_t))r8712_xmit_bh,
    159. 

  159. 	     (addr_t)padapter);
    160. 

  160. 	return _SUCCESS;
    161. 

  161. }
    162. 

  162. 

  163. void _free_xmit_priv(struct xmit_priv *pxmitpriv)
    164. 

  164. {
    165. 

  165. 	int i;
    166. 

  166. 	struct _adapter *padapter = pxmitpriv->adapter;
    167. 

  167. 	struct xmit_frame *pxmitframe = (struct xmit_frame *)
    168. 

  168. 					pxmitpriv->pxmit_frame_buf;
    169. 

  169. 	struct xmit_buf *pxmitbuf = (struct xmit_buf *)pxmitpriv->pxmitbuf;
    170. 

  170. 

  171. 	if (pxmitpriv->pxmit_frame_buf == NULL)
    172. 

  172. 		return;
    173. 

  173. 	for (i = 0; i < NR_XMITFRAME; i++) {
    174. 

  174. 		r8712_xmit_complete(padapter, pxmitframe);
    175. 

  175. 		pxmitframe++;
    176. 

  176. 	}
    177. 

  177. 	for (i = 0; i < NR_XMITBUFF; i++) {
    178. 

  178. 		r8712_xmit_resource_free(padapter, pxmitbuf);
    179. 

  179. 		kfree(pxmitbuf->pallocated_buf);
    180. 

  180. 		pxmitbuf++;
    181. 

  181. 	}
    182. 

  182. 	kfree(pxmitpriv->pallocated_frame_buf);
    183. 

  183. 	kfree(pxmitpriv->pallocated_xmitbuf);
    184. 

  184. 	free_hwxmits(padapter);
    185. 

  185. }
    186. 

  186. 

  187. sint r8712_update_attrib(struct _adapter *padapter, _pkt *pkt,
    188. 

  188. 		   struct pkt_attrib *pattrib)
    189. 

  189. {
    190. 

  190. 	uint i;
    191. 

  191. 	struct pkt_file pktfile;
    192. 

  192. 	struct sta_info *psta = NULL;
    193. 

  193. 	struct ethhdr etherhdr;
    194. 

  194. 

  195. 	struct tx_cmd txdesc;
    196. 

  196. 

  197. 	sint bmcast;
    198. 

  198. 	struct sta_priv		*pstapriv = &padapter->stapriv;
    199. 

  199. 	struct security_priv	*psecuritypriv = &padapter->securitypriv;
    200. 

  200. 	struct mlme_priv	*pmlmepriv = &padapter->mlmepriv;
    201. 

  201. 	struct qos_priv		*pqospriv = &pmlmepriv->qospriv;
    202. 

  202. 

  203. 	_r8712_open_pktfile(pkt, &pktfile);
    204. 

  204. 

  205. 	i = _r8712_pktfile_read(&pktfile, (unsigned char *)&etherhdr, ETH_HLEN);
    206. 

  206. 

  207. 	pattrib->ether_type = ntohs(etherhdr.h_proto);
    208. 

  208. 

  209. {
    210. 

  210. 	u8 bool;
    211. 

  211. 	/*If driver xmit ARP packet, driver can set ps mode to initial
    212. 

  212. 	 * setting. It stands for getting DHCP or fix IP.*/
    213. 

  213. 	if (pattrib->ether_type == 0x0806) {
    214. 

  214. 		if (padapter->pwrctrlpriv.pwr_mode !=
    215. 

  215. 		    padapter->registrypriv.power_mgnt) {
    216. 

  216. 			_cancel_timer(&(pmlmepriv->dhcp_timer), &bool);
    217. 

  217. 			r8712_set_ps_mode(padapter, padapter->registrypriv.
    218. 

  218. 				power_mgnt, padapter->registrypriv.smart_ps);
    219. 

  219. 		}
    220. 

  220. 	}
    221. 

  221. }
    222. 

  222. 	memcpy(pattrib->dst, &etherhdr.h_dest, ETH_ALEN);
    223. 

  223. 	memcpy(pattrib->src, &etherhdr.h_source, ETH_ALEN);
    224. 

  224. 	pattrib->pctrl = 0;
    225. 

  225. 	if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) ||
    226. 

  226. 	    (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) {
    227. 

  227. 		memcpy(pattrib->ra, pattrib->dst, ETH_ALEN);
    228. 

  228. 		memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
    229. 

  229. 	} else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
    230. 

  230. 		memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN);
    231. 

  231. 		memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
    232. 

  232. 	} else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
    233. 

  233. 		memcpy(pattrib->ra, pattrib->dst, ETH_ALEN);
    234. 

  234. 		memcpy(pattrib->ta, get_bssid(pmlmepriv), ETH_ALEN);
    235. 

  235. 	} else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) {
    236. 

  236. 		/*firstly, filter packet not belongs to mp*/
    237. 

  237. 		if (pattrib->ether_type != 0x8712)
    238. 

  238. 			return _FAIL;
    239. 

  239. 		/* for mp storing the txcmd per packet,
    240. 

  240. 		 * according to the info of txcmd to update pattrib */
    241. 

  241. 		/*get MP_TXDESC_SIZE bytes txcmd per packet*/
    242. 

  242. 		i = _r8712_pktfile_read(&pktfile, (u8 *)&txdesc, TXDESC_SIZE);
    243. 

  243. 		memcpy(pattrib->ra, pattrib->dst, ETH_ALEN);
    244. 

  244. 		memcpy(pattrib->ta, pattrib->src, ETH_ALEN);
    245. 

  245. 		pattrib->pctrl = 1;
    246. 

  246. 	}
    247. 

  247. 	/* r8712_xmitframe_coalesce() overwrite this!*/
    248. 

  248. 	pattrib->pktlen = pktfile.pkt_len;
    249. 

  249. 	if (ETH_P_IP == pattrib->ether_type) {
    250. 

  250. 		/* The following is for DHCP and ARP packet, we use cck1M to
    251. 

  251. 		 * tx these packets and let LPS awake some time
    252. 

  252. 		 * to prevent DHCP protocol fail */
    253. 

  253. 		u8 tmp[24];
    254. 

  254. 		_r8712_pktfile_read(&pktfile, &tmp[0], 24);
    255. 

  255. 		pattrib->dhcp_pkt = 0;
    256. 

  256. 		if (pktfile.pkt_len > 282) {/*MINIMUM_DHCP_PACKET_SIZE)*/
    257. 

  257. 			if (ETH_P_IP == pattrib->ether_type) {/* IP header*/
    258. 

  258. 				if (((tmp[21] == 68) && (tmp[23] == 67)) ||
    259. 

  259. 					((tmp[21] == 67) && (tmp[23] == 68))) {
    260. 

  260. 					/* 68 : UDP BOOTP client
    261. 

  261. 					 * 67 : UDP BOOTP server
    262. 

  262. 					 * Use low rate to send DHCP packet.*/
    263. 

  263. 					pattrib->dhcp_pkt = 1;
    264. 

  264. 				}
    265. 

  265. 			}
    266. 

  266. 		}
    267. 

  267. 	}
    268. 

  268. 	bmcast = IS_MCAST(pattrib->ra);
    269. 

  269. 	/* get sta_info*/
    270. 

  270. 	if (bmcast) {
    271. 

  271. 		psta = r8712_get_bcmc_stainfo(padapter);
    272. 

  272. 		pattrib->mac_id = 4;
    273. 

  273. 	} else {
    274. 

  274. 		if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) {
    275. 

  275. 			psta = r8712_get_stainfo(pstapriv,
    276. 

  276. 						 get_bssid(pmlmepriv));
    277. 

  277. 			pattrib->mac_id = 5;
    278. 

  278. 		} else {
    279. 

  279. 			psta = r8712_get_stainfo(pstapriv, pattrib->ra);
    280. 

  280. 			if (psta == NULL)  /* drop the pkt */
    281. 

  281. 				return _FAIL;
    282. 

  282. 			if (check_fwstate(pmlmepriv, WIFI_STATION_STATE))
    283. 

  283. 				pattrib->mac_id = 5;
    284. 

  284. 			else
    285. 

  285. 				pattrib->mac_id = psta->mac_id;
    286. 

  286. 		}
    287. 

  287. 	}
    288. 

  288. 

  289. 	if (psta) {
    290. 

  290. 		pattrib->psta = psta;
    291. 

  291. 	} else {
    292. 

  292. 		/* if we cannot get psta => drrp the pkt */
    293. 

  293. 		return _FAIL;
    294. 

  294. 	}
    295. 

  295. 

  296. 	pattrib->ack_policy = 0;
    297. 

  297. 	/* get ether_hdr_len */
    298. 

  298. 	pattrib->pkt_hdrlen = ETH_HLEN;
    299. 

  299. 

  300. 	if (pqospriv->qos_option)
    301. 

  301. 		r8712_set_qos(&pktfile, pattrib);
    302. 

  302. 	else {
    303. 

  303. 		pattrib->hdrlen = WLAN_HDR_A3_LEN;
    304. 

  304. 		pattrib->subtype = WIFI_DATA_TYPE;
    305. 

  305. 		pattrib->priority = 0;
    306. 

  306. 	}
    307. 

  307. 	if (psta->ieee8021x_blocked == true) {
    308. 

  308. 		pattrib->encrypt = 0;
    309. 

  309. 		if ((pattrib->ether_type != 0x888e) &&
    310. 

  310. 		    (check_fwstate(pmlmepriv, WIFI_MP_STATE) == false))
    311. 

  311. 			return _FAIL;
    312. 

  312. 	} else
    313. 

  313. 		GET_ENCRY_ALGO(psecuritypriv, psta, pattrib->encrypt, bmcast);
    314. 

  314. 	switch (pattrib->encrypt) {
    315. 

  315. 	case _WEP40_:
    316. 

  316. 	case _WEP104_:
    317. 

  317. 		pattrib->iv_len = 4;
    318. 

  318. 		pattrib->icv_len = 4;
    319. 

  319. 		break;
    320. 

  320. 	case _TKIP_:
    321. 

  321. 		pattrib->iv_len = 8;
    322. 

  322. 		pattrib->icv_len = 4;
    323. 

  323. 		if (padapter->securitypriv.busetkipkey == _FAIL)
    324. 

  324. 			return _FAIL;
    325. 

  325. 		break;
    326. 

  326. 	case _AES_:
    327. 

  327. 		pattrib->iv_len = 8;
    328. 

  328. 		pattrib->icv_len = 8;
    329. 

  329. 		break;
    330. 

  330. 	default:
    331. 

  331. 		pattrib->iv_len = 0;
    332. 

  332. 		pattrib->icv_len = 0;
    333. 

  333. 		break;
    334. 

  334. 	}
    335. 

  335. 

  336. 	if (pattrib->encrypt &&
    337. 

  337. 	    ((padapter->securitypriv.sw_encrypt == true) ||
    338. 

  338. 	     (psecuritypriv->hw_decrypted == false)))
    339. 

  339. 		pattrib->bswenc = true;
    340. 

  340. 	else
    341. 

  341. 		pattrib->bswenc = false;
    342. 

  342. 	/* if in MP_STATE, update pkt_attrib from mp_txcmd, and overwrite
    343. 

  343. 	 * some settings above.*/
    344. 

  344. 	if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true)
    345. 

  345. 		pattrib->priority = (txdesc.txdw1 >> QSEL_SHT) & 0x1f;
    346. 

  346. 	return _SUCCESS;
    347. 

  347. }
    348. 

  348. 

  349. static sint xmitframe_addmic(struct _adapter *padapter,
    350. 

  350. 			     struct xmit_frame *pxmitframe)
    351. 

  351. {
    352. 

  352. 	u32	curfragnum, length, datalen;
    353. 

  353. 	u8	*pframe, *payload, mic[8];
    354. 

  354. 	struct	mic_data micdata;
    355. 

  355. 	struct	sta_info *stainfo;
    356. 

  356. 	struct	qos_priv *pqospriv = &(padapter->mlmepriv.qospriv);
    357. 

  357. 	struct	pkt_attrib  *pattrib = &pxmitframe->attrib;
    358. 

  358. 	struct	security_priv *psecuritypriv = &padapter->securitypriv;
    359. 

  359. 	struct	xmit_priv *pxmitpriv = &padapter->xmitpriv;
    360. 

  360. 	u8 priority[4] = {0x0, 0x0, 0x0, 0x0};
    361. 

  361. 	sint bmcst = IS_MCAST(pattrib->ra);
    362. 

  362. 

  363. 	if (pattrib->psta)
    364. 

  364. 		stainfo = pattrib->psta;
    365. 

  365. 	else
    366. 

  366. 		stainfo = r8712_get_stainfo(&padapter->stapriv,
    367. 

  367. 					    &pattrib->ra[0]);
    368. 

  368. 	if (pattrib->encrypt == _TKIP_) {
    369. 

  369. 		/*encode mic code*/
    370. 

  370. 		if (stainfo != NULL) {
    371. 

  371. 			u8 null_key[16] = {0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
    372. 

  372. 					   0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
    373. 

  373. 					   0x0, 0x0};
    374. 

  374. 			datalen = pattrib->pktlen - pattrib->hdrlen;
    375. 

  375. 			pframe = pxmitframe->buf_addr + TXDESC_OFFSET;
    376. 

  376. 			if (bmcst) {
    377. 

  377. 				if (!memcmp(psecuritypriv->XGrptxmickey
    378. 

  378. 				   [psecuritypriv->XGrpKeyid].skey,
    379. 

  379. 				   null_key, 16))
    380. 

  380. 					return _FAIL;
    381. 

  381. 				/*start to calculate the mic code*/
    382. 

  382. 				r8712_secmicsetkey(&micdata,
    383. 

  383. 					 psecuritypriv->
    384. 

  384. 					 XGrptxmickey[psecuritypriv->
    385. 

  385. 					XGrpKeyid].skey);
    386. 

  386. 			} else {
    387. 

  387. 				if (!memcmp(&stainfo->tkiptxmickey.skey[0],
    388. 

  388. 					    null_key, 16))
    389. 

  389. 					return _FAIL;
    390. 

  390. 				/* start to calculate the mic code */
    391. 

  391. 				r8712_secmicsetkey(&micdata,
    392. 

  392. 					     &stainfo->tkiptxmickey.skey[0]);
    393. 

  393. 			}
    394. 

  394. 			if (pframe[1] & 1) {   /* ToDS==1 */
    395. 

  395. 				r8712_secmicappend(&micdata,
    396. 

  396. 						   &pframe[16], 6); /*DA*/
    397. 

  397. 				if (pframe[1]&2)  /* From Ds==1 */
    398. 

  398. 					r8712_secmicappend(&micdata,
    399. 

  399. 							   &pframe[24], 6);
    400. 

  400. 				else
    401. 

  401. 					r8712_secmicappend(&micdata,
    402. 

  402. 							   &pframe[10], 6);
    403. 

  403. 			} else {	/* ToDS==0 */
    404. 

  404. 				r8712_secmicappend(&micdata,
    405. 

  405. 						   &pframe[4], 6); /* DA */
    406. 

  406. 				if (pframe[1]&2)  /* From Ds==1 */
    407. 

  407. 					r8712_secmicappend(&micdata,
    408. 

  408. 							   &pframe[16], 6);
    409. 

  409. 				else
    410. 

  410. 					r8712_secmicappend(&micdata,
    411. 

  411. 							   &pframe[10], 6);
    412. 

  412. 			}
    413. 

  413. 			if (pqospriv->qos_option == 1)
    414. 

  414. 					priority[0] = (u8)pxmitframe->
    415. 

  415. 						      attrib.priority;
    416. 

  416. 			r8712_secmicappend(&micdata, &priority[0], 4);
    417. 

  417. 			payload = pframe;
    418. 

  418. 			for (curfragnum = 0; curfragnum < pattrib->nr_frags;
    419. 

  419. 			     curfragnum++) {
    420. 

  420. 				payload = (u8 *)RND4((addr_t)(payload));
    421. 

  421. 				payload = payload+pattrib->
    422. 

  422. 					  hdrlen+pattrib->iv_len;
    423. 

  423. 				if ((curfragnum + 1) == pattrib->nr_frags) {
    424. 

  424. 					length = pattrib->last_txcmdsz -
    425. 

  425. 						  pattrib->hdrlen -
    426. 

  426. 						  pattrib->iv_len -
    427. 

  427. 						  ((psecuritypriv->sw_encrypt)
    428. 

  428. 						  ? pattrib->icv_len : 0);
    429. 

  429. 					r8712_secmicappend(&micdata, payload,
    430. 

  430. 							   length);
    431. 

  431. 					payload = payload+length;
    432. 

  432. 				} else{
    433. 

  433. 					length = pxmitpriv->frag_len -
    434. 

  434. 					    pattrib->hdrlen-pattrib->iv_len -
    435. 

  435. 					    ((psecuritypriv->sw_encrypt) ?
    436. 

  436. 					    pattrib->icv_len : 0);
    437. 

  437. 					r8712_secmicappend(&micdata, payload,
    438. 

  438. 							   length);
    439. 

  439. 					payload = payload + length +
    440. 

  440. 						  pattrib->icv_len;
    441. 

  441. 				}
    442. 

  442. 			}
    443. 

  443. 			r8712_secgetmic(&micdata, &(mic[0]));
    444. 

  444. 			/* add mic code  and add the mic code length in
    445. 

  445. 			 * last_txcmdsz */
    446. 

  446. 			memcpy(payload, &(mic[0]), 8);
    447. 

  447. 			pattrib->last_txcmdsz += 8;
    448. 

  448. 			payload = payload-pattrib->last_txcmdsz + 8;
    449. 

  449. 		}
    450. 

  450. 	}
    451. 

  451. 	return _SUCCESS;
    452. 

  452. }
    453. 

  453. 

  454. static sint xmitframe_swencrypt(struct _adapter *padapter,
    455. 

  455. 				struct xmit_frame *pxmitframe)
    456. 

  456. {
    457. 

  457. 	struct pkt_attrib	*pattrib = &pxmitframe->attrib;
    458. 

  458. 

  459. 	if (pattrib->bswenc) {
    460. 

  460. 		switch (pattrib->encrypt) {
    461. 

  461. 		case _WEP40_:
    462. 

  462. 		case _WEP104_:
    463. 

  463. 			r8712_wep_encrypt(padapter, (u8 *)pxmitframe);
    464. 

  464. 			break;
    465. 

  465. 		case _TKIP_:
    466. 

  466. 			r8712_tkip_encrypt(padapter, (u8 *)pxmitframe);
    467. 

  467. 			break;
    468. 

  468. 		case _AES_:
    469. 

  469. 			r8712_aes_encrypt(padapter, (u8 *)pxmitframe);
    470. 

  470. 			break;
    471. 

  471. 		default:
    472. 

  472. 				break;
    473. 

  473. 		}
    474. 

  474. 	}
    475. 

  475. 	return _SUCCESS;
    476. 

  476. }
    477. 

  477. 

  478. static sint make_wlanhdr(struct _adapter *padapter , u8 *hdr,
    479. 

  479. 			 struct pkt_attrib *pattrib)
    480. 

  480. {
    481. 

  481. 	u16 *qc;
    482. 

  482. 

  483. 	struct ieee80211_hdr *pwlanhdr = (struct ieee80211_hdr *)hdr;
    484. 

  484. 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
    485. 

  485. 	struct qos_priv *pqospriv = &pmlmepriv->qospriv;
    486. 

  486. 	u16 *fctrl = &pwlanhdr->frame_ctl;
    487. 

  487. 	memset(hdr, 0, WLANHDR_OFFSET);
    488. 

  488. 	SetFrameSubType(fctrl, pattrib->subtype);
    489. 

  489. 	if (pattrib->subtype & WIFI_DATA_TYPE) {
    490. 

  490. 		if ((check_fwstate(pmlmepriv,  WIFI_STATION_STATE) == true)) {
    491. 

  491. 			/* to_ds = 1, fr_ds = 0; */
    492. 

  492. 			SetToDs(fctrl);
    493. 

  493. 			memcpy(pwlanhdr->addr1, get_bssid(pmlmepriv),
    494. 

  494. 				ETH_ALEN);
    495. 

  495. 			memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN);
    496. 

  496. 			memcpy(pwlanhdr->addr3, pattrib->dst, ETH_ALEN);
    497. 

  497. 		} else if ((check_fwstate(pmlmepriv, WIFI_AP_STATE) == true)) {
    498. 

  498. 			/* to_ds = 0, fr_ds = 1; */
    499. 

  499. 			SetFrDs(fctrl);
    500. 

  500. 			memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN);
    501. 

  501. 			memcpy(pwlanhdr->addr2, get_bssid(pmlmepriv),
    502. 

  502. 				ETH_ALEN);
    503. 

  503. 			memcpy(pwlanhdr->addr3, pattrib->src, ETH_ALEN);
    504. 

  504. 		} else if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true)
    505. 

  505. 			   || (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)
    506. 

  506. 			   == true)) {
    507. 

  507. 			memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN);
    508. 

  508. 			memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN);
    509. 

  509. 			memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv),
    510. 

  510. 				ETH_ALEN);
    511. 

  511. 		} else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) {
    512. 

  512. 			memcpy(pwlanhdr->addr1, pattrib->dst, ETH_ALEN);
    513. 

  513. 			memcpy(pwlanhdr->addr2, pattrib->src, ETH_ALEN);
    514. 

  514. 			memcpy(pwlanhdr->addr3, get_bssid(pmlmepriv),
    515. 

  515. 				ETH_ALEN);
    516. 

  516. 		} else
    517. 

  517. 			return _FAIL;
    518. 

  518. 

  519. 		if (pattrib->encrypt)
    520. 

  520. 			SetPrivacy(fctrl);
    521. 

  521. 		if (pqospriv->qos_option) {
    522. 

  522. 			qc = (unsigned short *)(hdr + pattrib->hdrlen - 2);
    523. 

  523. 			if (pattrib->priority)
    524. 

  524. 				SetPriority(qc, pattrib->priority);
    525. 

  525. 			SetAckpolicy(qc, pattrib->ack_policy);
    526. 

  526. 		}
    527. 

  527. 		/* TODO: fill HT Control Field */
    528. 

  528. 		/* Update Seq Num will be handled by f/w */
    529. 

  529. 		{
    530. 

  530. 			struct sta_info *psta;
    531. 

  531. 

  532. 			sint bmcst = IS_MCAST(pattrib->ra);
    533. 

  533. 			if (pattrib->psta)
    534. 

  534. 				psta = pattrib->psta;
    535. 

  535. 			else {
    536. 

  536. 				if (bmcst)
    537. 

  537. 					psta = r8712_get_bcmc_stainfo(padapter);
    538. 

  538. 				else
    539. 

  539. 					psta =
    540. 

  540. 					 r8712_get_stainfo(&padapter->stapriv,
    541. 

  541. 					 pattrib->ra);
    542. 

  542. 			}
    543. 

  543. 			if (psta) {
    544. 

  544. 				psta->sta_xmitpriv.txseq_tid
    545. 

  545. 						  [pattrib->priority]++;
    546. 

  546. 				psta->sta_xmitpriv.txseq_tid[pattrib->priority]
    547. 

  547. 						   &= 0xFFF;
    548. 

  548. 				pattrib->seqnum = psta->sta_xmitpriv.
    549. 

  549. 						  txseq_tid[pattrib->priority];
    550. 

  550. 				SetSeqNum(hdr, pattrib->seqnum);
    551. 

  551. 			}
    552. 

  552. 		}
    553. 

  553. 	}
    554. 

  554. 	return _SUCCESS;
    555. 

  555. }
    556. 

  556. 

  557. static sint r8712_put_snap(u8 *data, u16 h_proto)
    558. 

  558. {
    559. 

  559. 	struct ieee80211_snap_hdr *snap;
    560. 

  560. 	const u8 *oui;
    561. 

  561. 

  562. 	snap = (struct ieee80211_snap_hdr *)data;
    563. 

  563. 	snap->dsap = 0xaa;
    564. 

  564. 	snap->ssap = 0xaa;
    565. 

  565. 	snap->ctrl = 0x03;
    566. 

  566. 	if (h_proto == 0x8137 || h_proto == 0x80f3)
    567. 

  567. 		oui = P802_1H_OUI;
    568. 

  568. 	else
    569. 

  569. 		oui = RFC1042_OUI;
    570. 

  570. 	snap->oui[0] = oui[0];
    571. 

  571. 	snap->oui[1] = oui[1];
    572. 

  572. 	snap->oui[2] = oui[2];
    573. 

  573. 	*(u16 *)(data + SNAP_SIZE) = htons(h_proto);
    574. 

  574. 	return SNAP_SIZE + sizeof(u16);
    575. 

  575. }
    576. 

  576. 

  577. /*
    578. 

  578.  * This sub-routine will perform all the following:
    579. 

  579.  * 1. remove 802.3 header.
    580. 

  580.  * 2. create wlan_header, based on the info in pxmitframe
    581. 

  581.  * 3. append sta's iv/ext-iv
    582. 

  582.  * 4. append LLC
    583. 

  583.  * 5. move frag chunk from pframe to pxmitframe->mem
    584. 

  584.  * 6. apply sw-encrypt, if necessary.
    585. 

  585.  */
    586. 

  586. sint r8712_xmitframe_coalesce(struct _adapter *padapter, _pkt *pkt,
    587. 

  587. 			struct xmit_frame *pxmitframe)
    588. 

  588. {
    589. 

  589. 	struct pkt_file pktfile;
    590. 

  590. 

  591. 	sint	frg_len, mpdu_len, llc_sz;
    592. 

  592. 	u32	mem_sz;
    593. 

  593. 	u8	frg_inx;
    594. 

  594. 	addr_t addr;
    595. 

  595. 	u8 *pframe, *mem_start, *ptxdesc;
    596. 

  596. 	struct sta_info		*psta;
    597. 

  597. 	struct security_priv	*psecuritypriv = &padapter->securitypriv;
    598. 

  598. 	struct mlme_priv	*pmlmepriv = &padapter->mlmepriv;
    599. 

  599. 	struct xmit_priv	*pxmitpriv = &padapter->xmitpriv;
    600. 

  600. 	struct pkt_attrib	*pattrib = &pxmitframe->attrib;
    601. 

  601. 	u8 *pbuf_start;
    602. 

  602. 	sint bmcst = IS_MCAST(pattrib->ra);
    603. 

  603. 

  604. 	if (pattrib->psta == NULL)
    605. 

  605. 		return _FAIL;
    606. 

  606. 	psta = pattrib->psta;
    607. 

  607. 	if (pxmitframe->buf_addr == NULL)
    608. 

  608. 		return _FAIL;
    609. 

  609. 	pbuf_start = pxmitframe->buf_addr;
    610. 

  610. 	ptxdesc = pbuf_start;
    611. 

  611. 	mem_start = pbuf_start + TXDESC_OFFSET;
    612. 

  612. 	if (make_wlanhdr(padapter, mem_start, pattrib) == _FAIL)
    613. 

  613. 		return _FAIL;
    614. 

  614. 	_r8712_open_pktfile(pkt, &pktfile);
    615. 

  615. 	_r8712_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen);
    616. 

  616. 	if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true) {
    617. 

  617. 		/* truncate TXDESC_SIZE bytes txcmd if at mp mode for 871x */
    618. 

  618. 		if (pattrib->ether_type == 0x8712) {
    619. 

  619. 			/* take care -  update_txdesc overwrite this */
    620. 

  620. 			_r8712_pktfile_read(&pktfile, ptxdesc, TXDESC_SIZE);
    621. 

  621. 		}
    622. 

  622. 	}
    623. 

  623. 	pattrib->pktlen = pktfile.pkt_len;
    624. 

  624. 	frg_inx = 0;
    625. 

  625. 	frg_len = pxmitpriv->frag_len - 4;
    626. 

  626. 	while (1) {
    627. 

  627. 		llc_sz = 0;
    628. 

  628. 		mpdu_len = frg_len;
    629. 

  629. 		pframe = mem_start;
    630. 

  630. 		SetMFrag(mem_start);
    631. 

  631. 		pframe += pattrib->hdrlen;
    632. 

  632. 		mpdu_len -= pattrib->hdrlen;
    633. 

  633. 		/* adding icv, if necessary...*/
    634. 

  634. 		if (pattrib->iv_len) {
    635. 

  635. 			if (psta != NULL) {
    636. 

  636. 				switch (pattrib->encrypt) {
    637. 

  637. 				case _WEP40_:
    638. 

  638. 				case _WEP104_:
    639. 

  639. 					WEP_IV(pattrib->iv, psta->txpn,
    640. 

  640. 					       (u8)psecuritypriv->
    641. 

  641. 					       PrivacyKeyIndex);
    642. 

  642. 					break;
    643. 

  643. 				case _TKIP_:
    644. 

  644. 					if (bmcst)
    645. 

  645. 						TKIP_IV(pattrib->iv,
    646. 

  646. 						    psta->txpn,
    647. 

  647. 						    (u8)psecuritypriv->
    648. 

  648. 						    XGrpKeyid);
    649. 

  649. 					else
    650. 

  650. 						TKIP_IV(pattrib->iv, psta->txpn,
    651. 

  651. 							0);
    652. 

  652. 					break;
    653. 

  653. 				case _AES_:
    654. 

  654. 					if (bmcst)
    655. 

  655. 						AES_IV(pattrib->iv, psta->txpn,
    656. 

  656. 						    (u8)psecuritypriv->
    657. 

  657. 						    XGrpKeyid);
    658. 

  658. 					else
    659. 

  659. 						AES_IV(pattrib->iv, psta->txpn,
    660. 

  660. 						       0);
    661. 

  661. 					break;
    662. 

  662. 				}
    663. 

  663. 			}
    664. 

  664. 			memcpy(pframe, pattrib->iv, pattrib->iv_len);
    665. 

  665. 			pframe += pattrib->iv_len;
    666. 

  666. 			mpdu_len -= pattrib->iv_len;
    667. 

  667. 		}
    668. 

  668. 		if (frg_inx == 0) {
    669. 

  669. 			llc_sz = r8712_put_snap(pframe, pattrib->ether_type);
    670. 

  670. 			pframe += llc_sz;
    671. 

  671. 			mpdu_len -= llc_sz;
    672. 

  672. 		}
    673. 

  673. 		if ((pattrib->icv_len > 0) && (pattrib->bswenc))
    674. 

  674. 			mpdu_len -= pattrib->icv_len;
    675. 

  675. 		if (bmcst)
    676. 

  676. 			mem_sz = _r8712_pktfile_read(&pktfile, pframe,
    677. 

  677. 				 pattrib->pktlen);
    678. 

  678. 		else
    679. 

  679. 			mem_sz = _r8712_pktfile_read(&pktfile, pframe,
    680. 

  680. 				 mpdu_len);
    681. 

  681. 		pframe += mem_sz;
    682. 

  682. 		if ((pattrib->icv_len > 0) && (pattrib->bswenc)) {
    683. 

  683. 			memcpy(pframe, pattrib->icv, pattrib->icv_len);
    684. 

  684. 			pframe += pattrib->icv_len;
    685. 

  685. 		}
    686. 

  686. 		frg_inx++;
    687. 

  687. 		if (bmcst || (r8712_endofpktfile(&pktfile) == true)) {
    688. 

  688. 			pattrib->nr_frags = frg_inx;
    689. 

  689. 			pattrib->last_txcmdsz = pattrib->hdrlen +
    690. 

  690. 						pattrib->iv_len +
    691. 

  691. 						((pattrib->nr_frags == 1) ?
    692. 

  692. 						llc_sz : 0) +
    693. 

  693. 						((pattrib->bswenc) ?
    694. 

  694. 						pattrib->icv_len : 0) + mem_sz;
    695. 

  695. 			ClearMFrag(mem_start);
    696. 

  696. 			break;
    697. 

  697. 		}
    698. 

  698. 		addr = (addr_t)(pframe);
    699. 

  699. 		mem_start = (unsigned char *)RND4(addr) + TXDESC_OFFSET;
    700. 

  700. 		memcpy(mem_start, pbuf_start + TXDESC_OFFSET, pattrib->hdrlen);
    701. 

  701. 	}
    702. 

  702. 

  703. 	if (xmitframe_addmic(padapter, pxmitframe) == _FAIL)
    704. 

  704. 		return _FAIL;
    705. 

  705. 	xmitframe_swencrypt(padapter, pxmitframe);
    706. 

  706. 	return _SUCCESS;
    707. 

  707. }
    708. 

  708. 

  709. void r8712_update_protection(struct _adapter *padapter, u8 *ie, uint ie_len)
    710. 

  710. {
    711. 

  711. 	uint	protection;
    712. 

  712. 	u8	*perp;
    713. 

  713. 	sint	 erp_len;
    714. 

  714. 	struct	xmit_priv *pxmitpriv = &padapter->xmitpriv;
    715. 

  715. 	struct	registry_priv *pregistrypriv = &padapter->registrypriv;
    716. 

  716. 

  717. 	switch (pxmitpriv->vcs_setting) {
    718. 

  718. 	case DISABLE_VCS:
    719. 

  719. 		pxmitpriv->vcs = NONE_VCS;
    720. 

  720. 		break;
    721. 

  721. 	case ENABLE_VCS:
    722. 

  722. 		break;
    723. 

  723. 	case AUTO_VCS:
    724. 

  724. 	default:
    725. 

  725. 		perp = r8712_get_ie(ie, _ERPINFO_IE_, &erp_len, ie_len);
    726. 

  726. 		if (perp == NULL)
    727. 

  727. 			pxmitpriv->vcs = NONE_VCS;
    728. 

  728. 		else {
    729. 

  729. 			protection = (*(perp + 2)) & BIT(1);
    730. 

  730. 			if (protection) {
    731. 

  731. 				if (pregistrypriv->vcs_type == RTS_CTS)
    732. 

  732. 					pxmitpriv->vcs = RTS_CTS;
    733. 

  733. 				else
    734. 

  734. 					pxmitpriv->vcs = CTS_TO_SELF;
    735. 

  735. 			} else
    736. 

  736. 				pxmitpriv->vcs = NONE_VCS;
    737. 

  737. 		}
    738. 

  738. 		break;
    739. 

  739. 	}
    740. 

  740. }
    741. 

  741. 

  742. struct xmit_buf *r8712_alloc_xmitbuf(struct xmit_priv *pxmitpriv)
    743. 

  743. {
    744. 

  744. 	unsigned long irqL;
    745. 

  745. 	struct xmit_buf *pxmitbuf =  NULL;
    746. 

  746. 	struct list_head *plist, *phead;
    747. 

  747. 	struct  __queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue;
    748. 

  748. 

  749. 	spin_lock_irqsave(&pfree_xmitbuf_queue->lock, irqL);
    750. 

  750. 	if (_queue_empty(pfree_xmitbuf_queue) == true)
    751. 

  751. 		pxmitbuf = NULL;
    752. 

  752. 	else {
    753. 

  753. 		phead = get_list_head(pfree_xmitbuf_queue);
    754. 

  754. 		plist = get_next(phead);
    755. 

  755. 		pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list);
    756. 

  756. 		list_delete(&(pxmitbuf->list));
    757. 

  757. 	}
    758. 

  758. 	if (pxmitbuf !=  NULL)
    759. 

  759. 		pxmitpriv->free_xmitbuf_cnt--;
    760. 

  760. 	spin_unlock_irqrestore(&pfree_xmitbuf_queue->lock, irqL);
    761. 

  761. 	return pxmitbuf;
    762. 

  762. }
    763. 

  763. 

  764. int r8712_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf)
    765. 

  765. {
    766. 

  766. 	unsigned long irqL;
    767. 

  767. 	struct  __queue *pfree_xmitbuf_queue = &pxmitpriv->free_xmitbuf_queue;
    768. 

  768. 

  769. 	if (pxmitbuf == NULL)
    770. 

  770. 		return _FAIL;
    771. 

  771. 	spin_lock_irqsave(&pfree_xmitbuf_queue->lock, irqL);
    772. 

  772. 	list_delete(&pxmitbuf->list);
    773. 

  773. 	list_insert_tail(&(pxmitbuf->list), get_list_head(pfree_xmitbuf_queue));
    774. 

  774. 	pxmitpriv->free_xmitbuf_cnt++;
    775. 

  775. 	spin_unlock_irqrestore(&pfree_xmitbuf_queue->lock, irqL);
    776. 

  776. 	return _SUCCESS;
    777. 

  777. }
    778. 

  778. 

  779. /*
    780. 

  780. Calling context:
    781. 

  781. 1. OS_TXENTRY
    782. 

  782. 2. RXENTRY (rx_thread or RX_ISR/RX_CallBack)
    783. 

    784. 

  784. If we turn on USE_RXTHREAD, then, no need for critical section.
    785. 

  785. Otherwise, we must use _enter/_exit critical to protect free_xmit_queue...
    786. 

    787. 

  787. Must be very very cautious...
    788. 

    789. 

  789. */
    790. 

  790. 

  791. struct xmit_frame *r8712_alloc_xmitframe(struct xmit_priv *pxmitpriv)
    792. 

  792. {
    793. 

  793. 	/*
    794. 

  794. 		Please remember to use all the osdep_service api,
    795. 

  795. 		and lock/unlock or _enter/_exit critical to protect
    796. 

  796. 		pfree_xmit_queue
    797. 

  797. 	*/
    798. 

  798. 	unsigned long irqL;
    799. 

  799. 	struct xmit_frame *pxframe = NULL;
    800. 

  800. 	struct list_head *plist, *phead;
    801. 

  801. 	struct  __queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue;
    802. 

  802. 

  803. 	spin_lock_irqsave(&pfree_xmit_queue->lock, irqL);
    804. 

  804. 	if (_queue_empty(pfree_xmit_queue) == true)
    805. 

  805. 		pxframe =  NULL;
    806. 

  806. 	else {
    807. 

  807. 		phead = get_list_head(pfree_xmit_queue);
    808. 

  808. 		plist = get_next(phead);
    809. 

  809. 		pxframe = LIST_CONTAINOR(plist, struct xmit_frame, list);
    810. 

  810. 		list_delete(&(pxframe->list));
    811. 

  811. 	}
    812. 

  812. 	if (pxframe !=  NULL) {
    813. 

  813. 		pxmitpriv->free_xmitframe_cnt--;
    814. 

  814. 		pxframe->buf_addr = NULL;
    815. 

  815. 		pxframe->pxmitbuf = NULL;
    816. 

  816. 		pxframe->attrib.psta = NULL;
    817. 

  817. 		pxframe->pkt = NULL;
    818. 

  818. 	}
    819. 

  819. 	spin_unlock_irqrestore(&pfree_xmit_queue->lock, irqL);
    820. 

  820. 	return pxframe;
    821. 

  821. }
    822. 

  822. 

  823. void r8712_free_xmitframe(struct xmit_priv *pxmitpriv,
    824. 

  824. 			  struct xmit_frame *pxmitframe)
    825. 

  825. {
    826. 

  826. 	unsigned long irqL;
    827. 

  827. 	struct  __queue *pfree_xmit_queue = &pxmitpriv->free_xmit_queue;
    828. 

  828. 	struct _adapter *padapter = pxmitpriv->adapter;
    829. 

  829. 

  830. 	if (pxmitframe == NULL)
    831. 

  831. 		return;
    832. 

  832. 	if (pxmitframe->pkt)
    833. 

  833. 		r8712_xmit_complete(padapter, pxmitframe);
    834. 

  834. 	spin_lock_irqsave(&pfree_xmit_queue->lock, irqL);
    835. 

  835. 	list_delete(&pxmitframe->list);
    836. 

  836. 	list_insert_tail(&pxmitframe->list, get_list_head(pfree_xmit_queue));
    837. 

  837. 	pxmitpriv->free_xmitframe_cnt++;
    838. 

  838. 	spin_unlock_irqrestore(&pfree_xmit_queue->lock, irqL);
    839. 

  839. 	if (netif_queue_stopped(padapter->pnetdev))
    840. 

  840. 		netif_wake_queue(padapter->pnetdev);
    841. 

  841. }
    842. 

  842. 

  843. void r8712_free_xmitframe_ex(struct xmit_priv *pxmitpriv,
    844. 

  844. 		      struct xmit_frame *pxmitframe)
    845. 

  845. {
    846. 

  846. 	if (pxmitframe == NULL)
    847. 

  847. 		return;
    848. 

  848. 	if (pxmitframe->frame_tag == DATA_FRAMETAG)
    849. 

  849. 		r8712_free_xmitframe(pxmitpriv, pxmitframe);
    850. 

  850. }
    851. 

  851. 

  852. void r8712_free_xmitframe_queue(struct xmit_priv *pxmitpriv,
    853. 

  853. 				struct  __queue *pframequeue)
    854. 

  854. {
    855. 

  855. 	unsigned long irqL;
    856. 

  856. 	struct list_head *plist, *phead;
    857. 

  857. 	struct	xmit_frame	*pxmitframe;
    858. 

  858. 

  859. 	spin_lock_irqsave(&(pframequeue->lock), irqL);
    860. 

  860. 	phead = get_list_head(pframequeue);
    861. 

  861. 	plist = get_next(phead);
    862. 

  862. 	while (end_of_queue_search(phead, plist) == false) {
    863. 

  863. 		pxmitframe = LIST_CONTAINOR(plist, struct xmit_frame, list);
    864. 

  864. 		plist = get_next(plist);
    865. 

  865. 		r8712_free_xmitframe(pxmitpriv, pxmitframe);
    866. 

  866. 	}
    867. 

  867. 	spin_unlock_irqrestore(&(pframequeue->lock), irqL);
    868. 

  868. }
    869. 

  869. 

  870. static inline struct tx_servq *get_sta_pending(struct _adapter *padapter,
    871. 

  871. 					       struct  __queue **ppstapending,
    872. 

  872. 					       struct sta_info *psta, sint up)
    873. 

  873. {
    874. 

  874. 

  875. 	struct tx_servq *ptxservq;
    876. 

  876. 	struct hw_xmit *phwxmits =  padapter->xmitpriv.hwxmits;
    877. 

  877. 

  878. 	switch (up) {
    879. 

  879. 	case 1:
    880. 

  880. 	case 2:
    881. 

  881. 		ptxservq = &(psta->sta_xmitpriv.bk_q);
    882. 

  882. 		*ppstapending = &padapter->xmitpriv.bk_pending;
    883. 

  883. 		(phwxmits+3)->accnt++;
    884. 

  884. 		break;
    885. 

  885. 	case 4:
    886. 

  886. 	case 5:
    887. 

  887. 		ptxservq = &(psta->sta_xmitpriv.vi_q);
    888. 

  888. 		*ppstapending = &padapter->xmitpriv.vi_pending;
    889. 

  889. 		(phwxmits+1)->accnt++;
    890. 

  890. 		break;
    891. 

  891. 	case 6:
    892. 

  892. 	case 7:
    893. 

  893. 		ptxservq = &(psta->sta_xmitpriv.vo_q);
    894. 

  894. 		*ppstapending = &padapter->xmitpriv.vo_pending;
    895. 

  895. 		(phwxmits+0)->accnt++;
    896. 

  896. 		break;
    897. 

  897. 	case 0:
    898. 

  898. 	case 3:
    899. 

  899. 	default:
    900. 

  900. 		ptxservq = &(psta->sta_xmitpriv.be_q);
    901. 

  901. 		*ppstapending = &padapter->xmitpriv.be_pending;
    902. 

  902. 		(phwxmits + 2)->accnt++;
    903. 

  903. 		break;
    904. 

  904. 	}
    905. 

  905. 	return ptxservq;
    906. 

  906. }
    907. 

  907. 

  908. /*
    909. 

  909.  * Will enqueue pxmitframe to the proper queue, and indicate it
    910. 

  910.  * to xx_pending list.....
    911. 

  911.  */
    912. 

  912. sint r8712_xmit_classifier(struct _adapter *padapter,
    913. 

  913. 			   struct xmit_frame *pxmitframe)
    914. 

  914. {
    915. 

  915. 	unsigned long irqL0;
    916. 

  916. 	struct  __queue *pstapending;
    917. 

  917. 	struct sta_info	*psta;
    918. 

  918. 	struct tx_servq	*ptxservq;
    919. 

  919. 	struct pkt_attrib *pattrib = &pxmitframe->attrib;
    920. 

  920. 	struct sta_priv *pstapriv = &padapter->stapriv;
    921. 

  921. 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
    922. 

  922. 	sint bmcst = IS_MCAST(pattrib->ra);
    923. 

  923. 

  924. 	if (pattrib->psta)
    925. 

  925. 		psta = pattrib->psta;
    926. 

  926. 	else {
    927. 

  927. 		if (bmcst)
    928. 

  928. 			psta = r8712_get_bcmc_stainfo(padapter);
    929. 

  929. 		else {
    930. 

  930. 			if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == true)
    931. 

  931. 				psta = r8712_get_stainfo(pstapriv,
    932. 

  932. 				       get_bssid(pmlmepriv));
    933. 

  933. 			else
    934. 

  934. 				psta = r8712_get_stainfo(pstapriv, pattrib->ra);
    935. 

  935. 		}
    936. 

  936. 	}
    937. 

  937. 	if (psta == NULL)
    938. 

  938. 		return _FAIL;
    939. 

  939. 	ptxservq = get_sta_pending(padapter, &pstapending,
    940. 

  940. 		   psta, pattrib->priority);
    941. 

  941. 	spin_lock_irqsave(&pstapending->lock, irqL0);
    942. 

  942. 	if (is_list_empty(&ptxservq->tx_pending))
    943. 

  943. 		list_insert_tail(&ptxservq->tx_pending,
    944. 

  944. 				 get_list_head(pstapending));
    945. 

  945. 	list_insert_tail(&pxmitframe->list,
    946. 

  946. 			 get_list_head(&ptxservq->sta_pending));
    947. 

  947. 	ptxservq->qcnt++;
    948. 

  948. 	spin_unlock_irqrestore(&pstapending->lock, irqL0);
    949. 

  949. 	return _SUCCESS;
    950. 

  950. }
    951. 

  951. 

  952. static void alloc_hwxmits(struct _adapter *padapter)
    953. 

  953. {
    954. 

  954. 	struct hw_xmit *hwxmits;
    955. 

  955. 	struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
    956. 

  956. 

  957. 	pxmitpriv->hwxmit_entry = HWXMIT_ENTRY;
    958. 

  958. 	pxmitpriv->hwxmits = (struct hw_xmit *)_malloc(sizeof(struct hw_xmit) *
    959. 

  959. 			     pxmitpriv->hwxmit_entry);
    960. 

  960. 	if (pxmitpriv->hwxmits == NULL)
    961. 

  961. 		return;
    962. 

  962. 	hwxmits = pxmitpriv->hwxmits;
    963. 

  963. 	if (pxmitpriv->hwxmit_entry == 5) {
    964. 

  964. 		pxmitpriv->bmc_txqueue.head = 0;
    965. 

  965. 		hwxmits[0] .phwtxqueue = &pxmitpriv->bmc_txqueue;
    966. 

  966. 		hwxmits[0] .sta_queue = &pxmitpriv->bm_pending;
    967. 

  967. 		pxmitpriv->vo_txqueue.head = 0;
    968. 

  968. 		hwxmits[1] .phwtxqueue = &pxmitpriv->vo_txqueue;
    969. 

  969. 		hwxmits[1] .sta_queue = &pxmitpriv->vo_pending;
    970. 

  970. 	pxmitpriv->vi_txqueue.head = 0;
    971. 

  971. 		hwxmits[2] .phwtxqueue = &pxmitpriv->vi_txqueue;
    972. 

  972. 		hwxmits[2] .sta_queue = &pxmitpriv->vi_pending;
    973. 

  973. 		pxmitpriv->bk_txqueue.head = 0;
    974. 

  974. 		hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue;
    975. 

  975. 		hwxmits[3] .sta_queue = &pxmitpriv->bk_pending;
    976. 

  976. 		pxmitpriv->be_txqueue.head = 0;
    977. 

  977. 		hwxmits[4] .phwtxqueue = &pxmitpriv->be_txqueue;
    978. 

  978. 		hwxmits[4] .sta_queue = &pxmitpriv->be_pending;
    979. 

  979. 	} else if (pxmitpriv->hwxmit_entry == 4) {
    980. 

  980. 		pxmitpriv->vo_txqueue.head = 0;
    981. 

  981. 		hwxmits[0] .phwtxqueue = &pxmitpriv->vo_txqueue;
    982. 

  982. 		hwxmits[0] .sta_queue = &pxmitpriv->vo_pending;
    983. 

  983. 		pxmitpriv->vi_txqueue.head = 0;
    984. 

  984. 		hwxmits[1] .phwtxqueue = &pxmitpriv->vi_txqueue;
    985. 

  985. 		hwxmits[1] .sta_queue = &pxmitpriv->vi_pending;
    986. 

  986. 		pxmitpriv->be_txqueue.head = 0;
    987. 

  987. 		hwxmits[2] .phwtxqueue = &pxmitpriv->be_txqueue;
    988. 

  988. 		hwxmits[2] .sta_queue = &pxmitpriv->be_pending;
    989. 

  989. 		pxmitpriv->bk_txqueue.head = 0;
    990. 

  990. 		hwxmits[3] .phwtxqueue = &pxmitpriv->bk_txqueue;
    991. 

  991. 		hwxmits[3] .sta_queue = &pxmitpriv->bk_pending;
    992. 

  992. 	}
    993. 

  993. }
    994. 

  994. 

  995. static void free_hwxmits(struct _adapter *padapter)
    996. 

  996. {
    997. 

  997. 	struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
    998. 

  998. 

  999. 	kfree(pxmitpriv->hwxmits);
    1000. 

  1000. }
    1001. 

  1001. 

  1002. static void init_hwxmits(struct hw_xmit *phwxmit, sint entry)
    1003. 

  1003. {
    1004. 

  1004. 	sint i;
    1005. 

  1005. 

  1006. 	for (i = 0; i < entry; i++, phwxmit++) {
    1007. 

  1007. 		spin_lock_init(&phwxmit->xmit_lock);
    1008. 

  1008. 		_init_listhead(&phwxmit->pending);
    1009. 

  1009. 		phwxmit->txcmdcnt = 0;
    1010. 

  1010. 		phwxmit->accnt = 0;
    1011. 

  1011. 	}
    1012. 

  1012. }
    1013. 

  1013. 

  1014. /*
    1015. 

  1015.  * tx_action == 0 == no frames to transmit
    1016. 

  1016.  * tx_action > 0 ==> we have frames to transmit
    1017. 

  1017.  * tx_action < 0 ==> we have frames to transmit, but TXFF is not even enough
    1018. 

  1018.  *						 to transmit 1 frame.
    1019. 

  1019.  */
    1020. 

  1020. 

  1021. int r8712_pre_xmit(struct _adapter *padapter, struct xmit_frame *pxmitframe)
    1022. 

  1022. {
    1023. 

  1023. 	unsigned long irqL;
    1024. 

  1024. 	int ret;
    1025. 

  1025. 	struct xmit_buf *pxmitbuf = NULL;
    1026. 

  1026. 	struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
    1027. 

  1027. 	struct pkt_attrib *pattrib = &pxmitframe->attrib;
    1028. 

  1028. 

  1029. 	r8712_do_queue_select(padapter, pattrib);
    1030. 

  1030. 	spin_lock_irqsave(&pxmitpriv->lock, irqL);
    1031. 

  1031. 	if (r8712_txframes_sta_ac_pending(padapter, pattrib) > 0) {
    1032. 

  1032. 		ret = false;
    1033. 

  1033. 		r8712_xmit_enqueue(padapter, pxmitframe);
    1034. 

  1034. 		spin_unlock_irqrestore(&pxmitpriv->lock, irqL);
    1035. 

  1035. 		return ret;
    1036. 

  1036. 	}
    1037. 

  1037. 	pxmitbuf = r8712_alloc_xmitbuf(pxmitpriv);
    1038. 

  1038. 	if (pxmitbuf == NULL) { /*enqueue packet*/
    1039. 

  1039. 		ret = false;
    1040. 

  1040. 		r8712_xmit_enqueue(padapter, pxmitframe);
    1041. 

  1041. 		spin_unlock_irqrestore(&pxmitpriv->lock, irqL);
    1042. 

  1042. 	} else { /*dump packet directly*/
    1043. 

  1043. 		spin_unlock_irqrestore(&pxmitpriv->lock, irqL);
    1044. 

  1044. 		ret = true;
    1045. 

  1045. 		pxmitframe->pxmitbuf = pxmitbuf;
    1046. 

  1046. 		pxmitframe->pxmit_urb[0] = pxmitbuf->pxmit_urb[0];
    1047. 

  1047. 		pxmitframe->buf_addr = pxmitbuf->pbuf;
    1048. 

  1048. 		r8712_xmit_direct(padapter, pxmitframe);
    1049. 

  1049. 	}
    1050. 

  1050. 	return ret;
    1051. 

  1051. }
    1052.