1 /******************************************************************************
3 (c) Copyright 2008, RealTEK Technologies Inc. All Rights Reserved.
5 Module: r819xusb_cmdpkt.c (RTL8190 TX/RX command packet handler Source C File)
7 Note: The module is responsible for handling TX and RX command packet.
8 1. TX : Send set and query configuration command packet.
9 2. RX : Receive tx feedback, beacon state, query configuration
21 05/06/2008 amy Create initial version porting from windows driver.
23 ******************************************************************************/
25 #include "r819xU_cmdpkt.h"
26 /*---------------------------Define Local Constant---------------------------*/
28 #define CMPK_DEBOUNCE_CNT 1
29 /* 2007/10/24 MH Add for printing a range of data. */
30 #define CMPK_PRINT(Address)\
35 memcpy(temp, Address, 40);\
36 for (i = 0; i <40; i+=4)\
37 printk("\r\n %08x", temp[i]);\
39 /*---------------------------Define functions---------------------------------*/
43 struct net_device
*dev
,
48 rt_status rtStatus
= RT_STATUS_SUCCESS
;
49 struct r8192_priv
*priv
= ieee80211_priv(dev
);
52 unsigned char *ptr_buf
;
53 //bool bLastInitPacket = false;
55 //PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK);
57 //Get TCB and local buffer from common pool. (It is shared by CmdQ, MgntQ, and USB coalesce DataQ)
58 skb
= dev_alloc_skb(USB_HWDESC_HEADER_LEN
+ DataLen
+ 4);
59 memcpy((unsigned char *)(skb
->cb
),&dev
,sizeof(dev
));
60 tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
61 tcb_desc
->queue_index
= TXCMD_QUEUE
;
62 tcb_desc
->bCmdOrInit
= DESC_PACKET_TYPE_NORMAL
;
63 tcb_desc
->bLastIniPkt
= 0;
64 skb_reserve(skb
, USB_HWDESC_HEADER_LEN
);
65 ptr_buf
= skb_put(skb
, DataLen
);
66 memset(ptr_buf
,0,DataLen
);
67 memcpy(ptr_buf
,pData
,DataLen
);
68 tcb_desc
->txbuf_size
= (u16
)DataLen
;
70 if(!priv
->ieee80211
->check_nic_enough_desc(dev
,tcb_desc
->queue_index
)||
71 (!skb_queue_empty(&priv
->ieee80211
->skb_waitQ
[tcb_desc
->queue_index
]))||\
72 (priv
->ieee80211
->queue_stop
) ) {
73 RT_TRACE(COMP_FIRMWARE
,"===================NULL packet==================================> tx full!\n");
74 skb_queue_tail(&priv
->ieee80211
->skb_waitQ
[tcb_desc
->queue_index
], skb
);
76 priv
->ieee80211
->softmac_hard_start_xmit(skb
,dev
);
79 //PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK);
83 /*-----------------------------------------------------------------------------
84 * Function: cmpk_message_handle_tx()
86 * Overview: Driver internal module can call the API to send message to
87 * firmware side. For example, you can send a debug command packet.
88 * Or you can send a request for FW to modify RLX4181 LBUS HW bank.
89 * Otherwise, you can change MAC/PHT/RF register by firmware at
90 * run time. We do not support message more than one segment now.
100 * 05/06/2008 amy porting from windows code.
102 *---------------------------------------------------------------------------*/
103 extern rt_status
cmpk_message_handle_tx(
104 struct net_device
*dev
,
105 u8
* codevirtualaddress
,
110 bool rt_status
= true;
114 struct r8192_priv
*priv
= ieee80211_priv(dev
);
116 u16 frag_length
, frag_offset
= 0;
120 rt_firmware
*pfirmware
= priv
->pFirmware
;
122 unsigned char *seg_ptr
;
126 firmware_init_param(dev
);
127 //Fragmentation might be required
128 frag_threshold
= pfirmware
->cmdpacket_frag_thresold
;
130 if((buffer_len
- frag_offset
) > frag_threshold
) {
131 frag_length
= frag_threshold
;
135 frag_length
= buffer_len
- frag_offset
;
140 /* Allocate skb buffer to contain firmware info and tx descriptor info
141 * add 4 to avoid packet appending overflow.
144 skb
= dev_alloc_skb(USB_HWDESC_HEADER_LEN
+ frag_length
+ 4);
146 skb
= dev_alloc_skb(frag_length
+ 4);
148 memcpy((unsigned char *)(skb
->cb
),&dev
,sizeof(dev
));
149 tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
150 tcb_desc
->queue_index
= TXCMD_QUEUE
;
151 tcb_desc
->bCmdOrInit
= packettype
;
152 tcb_desc
->bLastIniPkt
= bLastIniPkt
;
155 skb_reserve(skb
, USB_HWDESC_HEADER_LEN
);
158 seg_ptr
= skb_put(skb
, buffer_len
);
160 * Transform from little endian to big endian
163 memcpy(seg_ptr
,codevirtualaddress
,buffer_len
);
164 tcb_desc
->txbuf_size
= (u16
)buffer_len
;
167 if(!priv
->ieee80211
->check_nic_enough_desc(dev
,tcb_desc
->queue_index
)||
168 (!skb_queue_empty(&priv
->ieee80211
->skb_waitQ
[tcb_desc
->queue_index
]))||\
169 (priv
->ieee80211
->queue_stop
) ) {
170 RT_TRACE(COMP_FIRMWARE
,"=====================================================> tx full!\n");
171 skb_queue_tail(&priv
->ieee80211
->skb_waitQ
[tcb_desc
->queue_index
], skb
);
173 priv
->ieee80211
->softmac_hard_start_xmit(skb
,dev
);
176 codevirtualaddress
+= frag_length
;
177 frag_offset
+= frag_length
;
179 }while(frag_offset
< buffer_len
);
185 } /* CMPK_Message_Handle_Tx */
187 /*-----------------------------------------------------------------------------
188 * Function: cmpk_counttxstatistic()
192 * Input: PADAPTER pAdapter - .
193 * CMPK_TXFB_T *psTx_FB - .
201 * 05/12/2008 amy Create Version 0 porting from windows code.
203 *---------------------------------------------------------------------------*/
205 cmpk_count_txstatistic(
206 struct net_device
*dev
,
207 cmpk_txfb_t
*pstx_fb
)
209 struct r8192_priv
*priv
= ieee80211_priv(dev
);
211 RT_RF_POWER_STATE rtState
;
213 pAdapter
->HalFunc
.GetHwRegHandler(pAdapter
, HW_VAR_RF_STATE
, (pu1Byte
)(&rtState
));
215 // When RF is off, we should not count the packet for hw/sw synchronize
216 // reason, ie. there may be a duration while sw switch is changed and hw
217 // switch is being changed. 2006.12.04, by shien chang.
218 if (rtState
== eRfOff
)
225 if(pAdapter
->bInHctTest
)
228 /* We can not know the packet length and transmit type: broadcast or uni
229 or multicast. So the relative statistics must be collected in tx
233 priv
->stats
.txfeedbackok
++;
234 priv
->stats
.txoktotal
++;
235 priv
->stats
.txokbytestotal
+= pstx_fb
->pkt_length
;
236 priv
->stats
.txokinperiod
++;
238 /* We can not make sure broadcast/multicast or unicast mode. */
239 if (pstx_fb
->pkt_type
== PACKET_MULTICAST
)
241 priv
->stats
.txmulticast
++;
242 priv
->stats
.txbytesmulticast
+= pstx_fb
->pkt_length
;
244 else if (pstx_fb
->pkt_type
== PACKET_BROADCAST
)
246 priv
->stats
.txbroadcast
++;
247 priv
->stats
.txbytesbroadcast
+= pstx_fb
->pkt_length
;
251 priv
->stats
.txunicast
++;
252 priv
->stats
.txbytesunicast
+= pstx_fb
->pkt_length
;
257 priv
->stats
.txfeedbackfail
++;
258 priv
->stats
.txerrtotal
++;
259 priv
->stats
.txerrbytestotal
+= pstx_fb
->pkt_length
;
261 /* We can not make sure broadcast/multicast or unicast mode. */
262 if (pstx_fb
->pkt_type
== PACKET_MULTICAST
)
264 priv
->stats
.txerrmulticast
++;
266 else if (pstx_fb
->pkt_type
== PACKET_BROADCAST
)
268 priv
->stats
.txerrbroadcast
++;
272 priv
->stats
.txerrunicast
++;
276 priv
->stats
.txretrycount
+= pstx_fb
->retry_cnt
;
277 priv
->stats
.txfeedbackretry
+= pstx_fb
->retry_cnt
;
279 } /* cmpk_CountTxStatistic */
283 /*-----------------------------------------------------------------------------
284 * Function: cmpk_handle_tx_feedback()
286 * Overview: The function is responsible for extract the message inside TX
287 * feedbck message from firmware. It will contain dedicated info in
288 * ws-06-0063-rtl8190-command-packet-specification. Please
289 * refer to chapter "TX Feedback Element". We have to read 20 bytes
290 * in the command packet.
292 * Input: struct net_device * dev
293 * u8 * pmsg - Msg Ptr of the command packet.
301 * 05/08/2008 amy Create Version 0 porting from windows code.
303 *---------------------------------------------------------------------------*/
305 cmpk_handle_tx_feedback(
306 struct net_device
*dev
,
309 struct r8192_priv
*priv
= ieee80211_priv(dev
);
310 cmpk_txfb_t rx_tx_fb
; /* */
312 priv
->stats
.txfeedback
++;
314 /* 0. Display received message. */
315 //cmpk_Display_Message(CMPK_RX_TX_FB_SIZE, pMsg);
317 /* 1. Extract TX feedback info from RFD to temp structure buffer. */
318 /* It seems that FW use big endian(MIPS) and DRV use little endian in
319 windows OS. So we have to read the content byte by byte or transfer
320 endian type before copy the message copy. */
321 #if 0 // The TX FEEDBACK packet element address
322 //rx_tx_fb.Element_ID = pMsg[0];
323 //rx_tx_fb.Length = pMsg[1];
324 rx_tx_fb
.TOK
= pMsg
[2]>>7;
325 rx_tx_fb
.Fail_Reason
= (pMsg
[2] & 0x70) >> 4;
326 rx_tx_fb
.TID
= (pMsg
[2] & 0x0F);
327 rx_tx_fb
.Qos_Pkt
= pMsg
[3] >> 7;
328 rx_tx_fb
.Bandwidth
= (pMsg
[3] & 0x40) >> 6;
329 rx_tx_fb
.Retry_Cnt
= pMsg
[5];
330 rx_tx_fb
.Pkt_ID
= (pMsg
[6] << 8) | pMsg
[7];
331 rx_tx_fb
.Seq_Num
= (pMsg
[8] << 8) | pMsg
[9];
332 rx_tx_fb
.S_Rate
= pMsg
[10];
333 rx_tx_fb
.F_Rate
= pMsg
[11];
334 rx_tx_fb
.S_RTS_Rate
= pMsg
[12];
335 rx_tx_fb
.F_RTS_Rate
= pMsg
[13];
336 rx_tx_fb
.pkt_length
= (pMsg
[14] << 8) | pMsg
[15];
338 /* 2007/07/05 MH Use pointer to transfer structure memory. */
339 //memcpy((UINT8 *)&rx_tx_fb, pMsg, sizeof(CMPK_TXFB_T));
340 memcpy((u8
*)&rx_tx_fb
, pmsg
, sizeof(cmpk_txfb_t
));
341 /* 2. Use tx feedback info to count TX statistics. */
342 cmpk_count_txstatistic(dev
, &rx_tx_fb
);
344 /* 2007/07/11 MH Assign current operate rate. */
345 if (pAdapter
->RegWirelessMode
== WIRELESS_MODE_A
||
346 pAdapter
->RegWirelessMode
== WIRELESS_MODE_B
||
347 pAdapter
->RegWirelessMode
== WIRELESS_MODE_G
)
349 pMgntInfo
->CurrentOperaRate
= (rx_tx_fb
.F_Rate
& 0x7F);
351 else if (pAdapter
->RegWirelessMode
== WIRELESS_MODE_N_24G
||
352 pAdapter
->RegWirelessMode
== WIRELESS_MODE_N_5G
)
354 pMgntInfo
->HTCurrentOperaRate
= (rx_tx_fb
.F_Rate
& 0x8F);
357 /* 2007/01/17 MH Comment previous method for TX statistic function. */
358 /* Collect info TX feedback packet to fill TCB. */
359 /* We can not know the packet length and transmit type: broadcast or uni
361 //CountTxStatistics( pAdapter, &tcb );
363 } /* cmpk_Handle_Tx_Feedback */
366 cmdpkt_beacontimerinterrupt_819xusb(
367 struct net_device
*dev
370 struct r8192_priv
*priv
= ieee80211_priv(dev
);
374 // 070117, rcnjko: 87B have to S/W beacon for DTM encryption_cmn.
376 if(priv
->ieee80211
->current_network
.mode
== IEEE_A
||
377 priv
->ieee80211
->current_network
.mode
== IEEE_N_5G
||
378 (priv
->ieee80211
->current_network
.mode
== IEEE_N_24G
&& (!priv
->ieee80211
->pHTInfo
->bCurSuppCCK
)))
381 DMESG("send beacon frame tx rate is 6Mbpm\n");
386 DMESG("send beacon frame tx rate is 1Mbpm\n");
389 rtl819xusb_beacon_tx(dev
,tx_rate
); // HW Beacon
398 /*-----------------------------------------------------------------------------
399 * Function: cmpk_handle_interrupt_status()
401 * Overview: The function is responsible for extract the message from
402 * firmware. It will contain dedicated info in
403 * ws-07-0063-v06-rtl819x-command-packet-specification-070315.doc.
404 * Please refer to chapter "Interrupt Status Element".
406 * Input: struct net_device *dev,
407 * u8* pmsg - Message Pointer of the command packet.
415 * 05/12/2008 amy Add this for rtl8192 porting from windows code.
417 *---------------------------------------------------------------------------*/
419 cmpk_handle_interrupt_status(
420 struct net_device
*dev
,
423 cmpk_intr_sta_t rx_intr_status
; /* */
424 struct r8192_priv
*priv
= ieee80211_priv(dev
);
426 DMESG("---> cmpk_Handle_Interrupt_Status()\n");
428 /* 0. Display received message. */
429 //cmpk_Display_Message(CMPK_RX_BEACON_STATE_SIZE, pMsg);
431 /* 1. Extract TX feedback info from RFD to temp structure buffer. */
432 /* It seems that FW use big endian(MIPS) and DRV use little endian in
433 windows OS. So we have to read the content byte by byte or transfer
434 endian type before copy the message copy. */
435 //rx_bcn_state.Element_ID = pMsg[0];
436 //rx_bcn_state.Length = pMsg[1];
437 rx_intr_status
.length
= pmsg
[1];
438 if (rx_intr_status
.length
!= (sizeof(cmpk_intr_sta_t
) - 2))
440 DMESG("cmpk_Handle_Interrupt_Status: wrong length!\n");
445 // Statistics of beacon for ad-hoc mode.
446 if( priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
)
448 //2 maybe need endian transform?
449 rx_intr_status
.interrupt_status
= *((u32
*)(pmsg
+ 4));
450 //rx_intr_status.InterruptStatus = N2H4BYTE(*((UINT32 *)(pMsg + 4)));
452 DMESG("interrupt status = 0x%x\n", rx_intr_status
.interrupt_status
);
454 if (rx_intr_status
.interrupt_status
& ISR_TxBcnOk
)
456 priv
->ieee80211
->bibsscoordinator
= true;
457 priv
->stats
.txbeaconokint
++;
459 else if (rx_intr_status
.interrupt_status
& ISR_TxBcnErr
)
461 priv
->ieee80211
->bibsscoordinator
= false;
462 priv
->stats
.txbeaconerr
++;
465 if (rx_intr_status
.interrupt_status
& ISR_BcnTimerIntr
)
467 cmdpkt_beacontimerinterrupt_819xusb(dev
);
472 // Other informations in interrupt status we need?
475 DMESG("<---- cmpk_handle_interrupt_status()\n");
477 } /* cmpk_handle_interrupt_status */
480 /*-----------------------------------------------------------------------------
481 * Function: cmpk_handle_query_config_rx()
483 * Overview: The function is responsible for extract the message from
484 * firmware. It will contain dedicated info in
485 * ws-06-0063-rtl8190-command-packet-specification. Please
486 * refer to chapter "Beacon State Element".
488 * Input: u8 * pmsg - Message Pointer of the command packet.
496 * 05/12/2008 amy Create Version 0 porting from windows code.
498 *---------------------------------------------------------------------------*/
500 cmpk_handle_query_config_rx(
501 struct net_device
*dev
,
504 cmpk_query_cfg_t rx_query_cfg
; /* */
506 /* 0. Display received message. */
507 //cmpk_Display_Message(CMPK_RX_BEACON_STATE_SIZE, pMsg);
509 /* 1. Extract TX feedback info from RFD to temp structure buffer. */
510 /* It seems that FW use big endian(MIPS) and DRV use little endian in
511 windows OS. So we have to read the content byte by byte or transfer
512 endian type before copy the message copy. */
513 //rx_query_cfg.Element_ID = pMsg[0];
514 //rx_query_cfg.Length = pMsg[1];
515 rx_query_cfg
.cfg_action
= (pmsg
[4] & 0x80000000)>>31;
516 rx_query_cfg
.cfg_type
= (pmsg
[4] & 0x60) >> 5;
517 rx_query_cfg
.cfg_size
= (pmsg
[4] & 0x18) >> 3;
518 rx_query_cfg
.cfg_page
= (pmsg
[6] & 0x0F) >> 0;
519 rx_query_cfg
.cfg_offset
= pmsg
[7];
520 rx_query_cfg
.value
= (pmsg
[8] << 24) | (pmsg
[9] << 16) |
521 (pmsg
[10] << 8) | (pmsg
[11] << 0);
522 rx_query_cfg
.mask
= (pmsg
[12] << 24) | (pmsg
[13] << 16) |
523 (pmsg
[14] << 8) | (pmsg
[15] << 0);
525 } /* cmpk_Handle_Query_Config_Rx */
528 /*-----------------------------------------------------------------------------
529 * Function: cmpk_count_tx_status()
531 * Overview: Count aggregated tx status from firmwar of one type rx command
532 * packet element id = RX_TX_STATUS.
542 * 05/12/2008 amy Create Version 0 porting from windows code.
544 *---------------------------------------------------------------------------*/
545 static void cmpk_count_tx_status( struct net_device
*dev
,
546 cmpk_tx_status_t
*pstx_status
)
548 struct r8192_priv
*priv
= ieee80211_priv(dev
);
552 RT_RF_POWER_STATE rtstate
;
554 pAdapter
->HalFunc
.GetHwRegHandler(pAdapter
, HW_VAR_RF_STATE
, (pu1Byte
)(&rtState
));
556 // When RF is off, we should not count the packet for hw/sw synchronize
557 // reason, ie. there may be a duration while sw switch is changed and hw
558 // switch is being changed. 2006.12.04, by shien chang.
559 if (rtState
== eRfOff
)
565 priv
->stats
.txfeedbackok
+= pstx_status
->txok
;
566 priv
->stats
.txoktotal
+= pstx_status
->txok
;
568 priv
->stats
.txfeedbackfail
+= pstx_status
->txfail
;
569 priv
->stats
.txerrtotal
+= pstx_status
->txfail
;
571 priv
->stats
.txretrycount
+= pstx_status
->txretry
;
572 priv
->stats
.txfeedbackretry
+= pstx_status
->txretry
;
574 //pAdapter->TxStats.NumTxOkBytesTotal += psTx_FB->pkt_length;
575 //pAdapter->TxStats.NumTxErrBytesTotal += psTx_FB->pkt_length;
576 //pAdapter->MgntInfo.LinkDetectInfo.NumTxOkInPeriod++;
578 priv
->stats
.txmulticast
+= pstx_status
->txmcok
;
579 priv
->stats
.txbroadcast
+= pstx_status
->txbcok
;
580 priv
->stats
.txunicast
+= pstx_status
->txucok
;
582 priv
->stats
.txerrmulticast
+= pstx_status
->txmcfail
;
583 priv
->stats
.txerrbroadcast
+= pstx_status
->txbcfail
;
584 priv
->stats
.txerrunicast
+= pstx_status
->txucfail
;
586 priv
->stats
.txbytesmulticast
+= pstx_status
->txmclength
;
587 priv
->stats
.txbytesbroadcast
+= pstx_status
->txbclength
;
588 priv
->stats
.txbytesunicast
+= pstx_status
->txuclength
;
590 priv
->stats
.last_packet_rate
= pstx_status
->rate
;
591 } /* cmpk_CountTxStatus */
595 /*-----------------------------------------------------------------------------
596 * Function: cmpk_handle_tx_status()
598 * Overview: Firmware add a new tx feedback status to reduce rx command
599 * packet buffer operation load.
609 * 05/12/2008 amy Create Version 0 porting from windows code.
611 *---------------------------------------------------------------------------*/
613 cmpk_handle_tx_status(
614 struct net_device
*dev
,
617 cmpk_tx_status_t rx_tx_sts
; /* */
619 memcpy((void*)&rx_tx_sts
, (void*)pmsg
, sizeof(cmpk_tx_status_t
));
620 /* 2. Use tx feedback info to count TX statistics. */
621 cmpk_count_tx_status(dev
, &rx_tx_sts
);
623 } /* cmpk_Handle_Tx_Status */
626 /*-----------------------------------------------------------------------------
627 * Function: cmpk_handle_tx_rate_history()
629 * Overview: Firmware add a new tx rate history
639 * 05/12/2008 amy Create Version 0 porting from windows code.
641 *---------------------------------------------------------------------------*/
643 cmpk_handle_tx_rate_history(
644 struct net_device
*dev
,
647 cmpk_tx_rahis_t
*ptxrate
;
648 // RT_RF_POWER_STATE rtState;
650 u16 length
= sizeof(cmpk_tx_rahis_t
);
652 struct r8192_priv
*priv
= ieee80211_priv(dev
);
656 pAdapter
->HalFunc
.GetHwRegHandler(pAdapter
, HW_VAR_RF_STATE
, (pu1Byte
)(&rtState
));
658 // When RF is off, we should not count the packet for hw/sw synchronize
659 // reason, ie. there may be a duration while sw switch is changed and hw
660 // switch is being changed. 2006.12.04, by shien chang.
661 if (rtState
== eRfOff
)
670 // Do endian transfer to word alignment(16 bits) for windows system.
671 // You must do different endian transfer for linux and MAC OS
673 for (i
= 0; i
< (length
/4); i
++)
677 temp1
= ptemp
[i
]&0x0000FFFF;
678 temp2
= ptemp
[i
]>>16;
679 ptemp
[i
] = (temp1
<<16)|temp2
;
682 ptxrate
= (cmpk_tx_rahis_t
*)pmsg
;
684 if (ptxrate
== NULL
)
689 for (i
= 0; i
< 16; i
++)
691 // Collect CCK rate packet num
693 priv
->stats
.txrate
.cck
[i
] += ptxrate
->cck
[i
];
695 // Collect OFDM rate packet num
697 priv
->stats
.txrate
.ofdm
[i
] += ptxrate
->ofdm
[i
];
699 for (j
= 0; j
< 4; j
++)
700 priv
->stats
.txrate
.ht_mcs
[j
][i
] += ptxrate
->ht_mcs
[j
][i
];
703 } /* cmpk_Handle_Tx_Rate_History */
706 /*-----------------------------------------------------------------------------
707 * Function: cmpk_message_handle_rx()
709 * Overview: In the function, we will capture different RX command packet
710 * info. Every RX command packet element has different message
711 * length and meaning in content. We only support three type of RX
712 * command packet now. Please refer to document
713 * ws-06-0063-rtl8190-command-packet-specification.
723 * 05/06/2008 amy Create Version 0 porting from windows code.
725 *---------------------------------------------------------------------------*/
727 cmpk_message_handle_rx(
728 struct net_device
*dev
,
729 struct ieee80211_rx_stats
*pstats
)
731 // u32 debug_level = DBG_LOUD;
732 struct r8192_priv
*priv
= ieee80211_priv(dev
);
734 u8 cmd_length
, exe_cnt
= 0;
738 /* 0. Check inpt arguments. If is is a command queue message or pointer is
740 if (/*(prfd->queue_id != CMPK_RX_QUEUE_ID) || */(pstats
== NULL
))
742 /* Print error message. */
743 /*RT_TRACE(COMP_SEND, DebugLevel,
744 ("\n\r[CMPK]-->Err queue id or pointer"));*/
745 return 0; /* This is not a command packet. */
748 /* 1. Read received command packet message length from RFD. */
749 total_length
= pstats
->Length
;
751 /* 2. Read virtual address from RFD. */
752 pcmd_buff
= pstats
->virtual_address
;
754 /* 3. Read command pakcet element id and length. */
755 element_id
= pcmd_buff
[0];
756 /*RT_TRACE(COMP_SEND, DebugLevel,
757 ("\n\r[CMPK]-->element ID=%d Len=%d", element_id, total_length));*/
759 /* 4. Check every received command packet conent according to different
760 element type. Because FW may aggregate RX command packet to minimize
761 transmit time between DRV and FW.*/
762 // Add a counter to prevent to locked in the loop too long
763 while (total_length
> 0 || exe_cnt
++ >100)
765 /* 2007/01/17 MH We support aggregation of different cmd in the same packet. */
766 element_id
= pcmd_buff
[0];
771 cmpk_handle_tx_feedback (dev
, pcmd_buff
);
772 cmd_length
= CMPK_RX_TX_FB_SIZE
;
775 case RX_INTERRUPT_STATUS
:
776 cmpk_handle_interrupt_status(dev
, pcmd_buff
);
777 cmd_length
= sizeof(cmpk_intr_sta_t
);
780 case BOTH_QUERY_CONFIG
:
781 cmpk_handle_query_config_rx(dev
, pcmd_buff
);
782 cmd_length
= CMPK_BOTH_QUERY_CONFIG_SIZE
;
786 cmpk_handle_tx_status(dev
, pcmd_buff
);
787 cmd_length
= CMPK_RX_TX_STS_SIZE
;
790 case RX_TX_PER_PKT_FEEDBACK
:
791 // You must at lease add a switch case element here,
792 // Otherwise, we will jump to default case.
793 //DbgPrint("CCX Test\r\n");
794 cmd_length
= CMPK_RX_TX_FB_SIZE
;
797 case RX_TX_RATE_HISTORY
:
798 //DbgPrint(" rx tx rate history\r\n");
799 cmpk_handle_tx_rate_history(dev
, pcmd_buff
);
800 cmd_length
= CMPK_TX_RAHIS_SIZE
;
805 RT_TRACE(COMP_ERR
, "---->cmpk_message_handle_rx():unknow CMD Element\n");
806 return 1; /* This is a command packet. */
808 // 2007/01/22 MH Display received rx command packet info.
809 //cmpk_Display_Message(cmd_length, pcmd_buff);
811 // 2007/01/22 MH Add to display tx statistic.
812 //cmpk_DisplayTxStatistic(pAdapter);
814 /* 2007/03/09 MH Collect sidderent cmd element pkt num. */
815 priv
->stats
.rxcmdpkt
[element_id
]++;
817 total_length
-= cmd_length
;
818 pcmd_buff
+= cmd_length
;
819 } /* while (total_length > 0) */
820 return 1; /* This is a command packet. */
822 } /* CMPK_Message_Handle_Rx */