2 *************************************************************************
4 * 5F., No.36, Taiyuan St., Jhubei City,
8 * (c) Copyright 2002-2007, Ralink Technology, Inc.
10 * This program is free software; you can redistribute it and/or modify *
11 * it under the terms of the GNU General Public License as published by *
12 * the Free Software Foundation; either version 2 of the License, or *
13 * (at your option) any later version. *
15 * This program is distributed in the hope that it will be useful, *
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
18 * GNU General Public License for more details. *
20 * You should have received a copy of the GNU General Public License *
21 * along with this program; if not, write to the *
22 * Free Software Foundation, Inc., *
23 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
25 *************************************************************************
28 #include <linux/firmware.h>
29 #include <linux/sched.h>
30 #include <linux/slab.h>
31 #include "rt_config.h"
33 unsigned long RTDebugLevel
= RT_DEBUG_ERROR
;
35 /* for wireless system event message */
36 char const *pWirelessSysEventText
[IW_SYS_EVENT_TYPE_NUM
] = {
37 /* system status event */
38 "had associated successfully", /* IW_ASSOC_EVENT_FLAG */
39 "had disassociated", /* IW_DISASSOC_EVENT_FLAG */
40 "had deauthenticated", /* IW_DEAUTH_EVENT_FLAG */
41 "had been aged-out and disassociated", /* IW_AGEOUT_EVENT_FLAG */
42 "occurred CounterMeasures attack", /* IW_COUNTER_MEASURES_EVENT_FLAG */
43 "occurred replay counter different in Key Handshaking", /* IW_REPLAY_COUNTER_DIFF_EVENT_FLAG */
44 "occurred RSNIE different in Key Handshaking", /* IW_RSNIE_DIFF_EVENT_FLAG */
45 "occurred MIC different in Key Handshaking", /* IW_MIC_DIFF_EVENT_FLAG */
46 "occurred ICV error in RX", /* IW_ICV_ERROR_EVENT_FLAG */
47 "occurred MIC error in RX", /* IW_MIC_ERROR_EVENT_FLAG */
48 "Group Key Handshaking timeout", /* IW_GROUP_HS_TIMEOUT_EVENT_FLAG */
49 "Pairwise Key Handshaking timeout", /* IW_PAIRWISE_HS_TIMEOUT_EVENT_FLAG */
50 "RSN IE sanity check failure", /* IW_RSNIE_SANITY_FAIL_EVENT_FLAG */
51 "set key done in WPA/WPAPSK", /* IW_SET_KEY_DONE_WPA1_EVENT_FLAG */
52 "set key done in WPA2/WPA2PSK", /* IW_SET_KEY_DONE_WPA2_EVENT_FLAG */
53 "connects with our wireless client", /* IW_STA_LINKUP_EVENT_FLAG */
54 "disconnects with our wireless client", /* IW_STA_LINKDOWN_EVENT_FLAG */
55 "scan completed" /* IW_SCAN_COMPLETED_EVENT_FLAG */
56 "scan terminate! Busy! Enqueue fail!" /* IW_SCAN_ENQUEUE_FAIL_EVENT_FLAG */
59 /* for wireless IDS_spoof_attack event message */
60 char const *pWirelessSpoofEventText
[IW_SPOOF_EVENT_TYPE_NUM
] = {
61 "detected conflict SSID", /* IW_CONFLICT_SSID_EVENT_FLAG */
62 "detected spoofed association response", /* IW_SPOOF_ASSOC_RESP_EVENT_FLAG */
63 "detected spoofed reassociation responses", /* IW_SPOOF_REASSOC_RESP_EVENT_FLAG */
64 "detected spoofed probe response", /* IW_SPOOF_PROBE_RESP_EVENT_FLAG */
65 "detected spoofed beacon", /* IW_SPOOF_BEACON_EVENT_FLAG */
66 "detected spoofed disassociation", /* IW_SPOOF_DISASSOC_EVENT_FLAG */
67 "detected spoofed authentication", /* IW_SPOOF_AUTH_EVENT_FLAG */
68 "detected spoofed deauthentication", /* IW_SPOOF_DEAUTH_EVENT_FLAG */
69 "detected spoofed unknown management frame", /* IW_SPOOF_UNKNOWN_MGMT_EVENT_FLAG */
70 "detected replay attack" /* IW_REPLAY_ATTACK_EVENT_FLAG */
73 /* for wireless IDS_flooding_attack event message */
74 char const *pWirelessFloodEventText
[IW_FLOOD_EVENT_TYPE_NUM
] = {
75 "detected authentication flooding", /* IW_FLOOD_AUTH_EVENT_FLAG */
76 "detected association request flooding", /* IW_FLOOD_ASSOC_REQ_EVENT_FLAG */
77 "detected reassociation request flooding", /* IW_FLOOD_REASSOC_REQ_EVENT_FLAG */
78 "detected probe request flooding", /* IW_FLOOD_PROBE_REQ_EVENT_FLAG */
79 "detected disassociation flooding", /* IW_FLOOD_DISASSOC_EVENT_FLAG */
80 "detected deauthentication flooding", /* IW_FLOOD_DEAUTH_EVENT_FLAG */
81 "detected 802.1x eap-request flooding" /* IW_FLOOD_EAP_REQ_EVENT_FLAG */
85 void RTMP_SetPeriodicTimer(struct timer_list
*pTimer
,
86 IN
unsigned long timeout
)
88 timeout
= ((timeout
* OS_HZ
) / 1000);
89 pTimer
->expires
= jiffies
+ timeout
;
93 /* convert NdisMInitializeTimer --> RTMP_OS_Init_Timer */
94 void RTMP_OS_Init_Timer(struct rt_rtmp_adapter
*pAd
,
95 struct timer_list
*pTimer
,
96 IN TIMER_FUNCTION function
, void *data
)
99 pTimer
->data
= (unsigned long)data
;
100 pTimer
->function
= function
;
103 void RTMP_OS_Add_Timer(struct timer_list
*pTimer
,
104 IN
unsigned long timeout
)
106 if (timer_pending(pTimer
))
109 timeout
= ((timeout
* OS_HZ
) / 1000);
110 pTimer
->expires
= jiffies
+ timeout
;
114 void RTMP_OS_Mod_Timer(struct timer_list
*pTimer
,
115 IN
unsigned long timeout
)
117 timeout
= ((timeout
* OS_HZ
) / 1000);
118 mod_timer(pTimer
, jiffies
+ timeout
);
121 void RTMP_OS_Del_Timer(struct timer_list
*pTimer
,
122 OUT BOOLEAN
* pCancelled
)
124 if (timer_pending(pTimer
)) {
125 *pCancelled
= del_timer_sync(pTimer
);
132 void RTMP_OS_Release_Packet(struct rt_rtmp_adapter
*pAd
, struct rt_queue_entry
*pEntry
)
134 /*RTMPFreeNdisPacket(pAd, (struct sk_buff *)pEntry); */
137 /* Unify all delay routine by using udelay */
138 void RTMPusecDelay(unsigned long usec
)
142 for (i
= 0; i
< (usec
/ 50); i
++)
149 void RTMP_GetCurrentSystemTime(LARGE_INTEGER
*time
)
151 time
->u
.LowPart
= jiffies
;
154 /* pAd MUST allow to be NULL */
155 int os_alloc_mem(struct rt_rtmp_adapter
*pAd
, u8
** mem
, unsigned long size
)
157 *mem
= kmalloc(size
, GFP_ATOMIC
);
159 return NDIS_STATUS_SUCCESS
;
161 return NDIS_STATUS_FAILURE
;
164 /* pAd MUST allow to be NULL */
165 int os_free_mem(struct rt_rtmp_adapter
*pAd
, void *mem
)
170 return NDIS_STATUS_SUCCESS
;
173 void *RtmpOSNetPktAlloc(struct rt_rtmp_adapter
*pAd
, IN
int size
)
176 /* Add 2 more bytes for ip header alignment */
177 skb
= dev_alloc_skb(size
+ 2);
182 void *RTMP_AllocateFragPacketBuffer(struct rt_rtmp_adapter
*pAd
,
183 unsigned long Length
)
187 pkt
= dev_alloc_skb(Length
);
190 DBGPRINT(RT_DEBUG_ERROR
,
191 ("can't allocate frag rx %ld size packet\n", Length
));
195 RTMP_SET_PACKET_SOURCE(OSPKT_TO_RTPKT(pkt
), PKTSRC_NDIS
);
201 void *RTMP_AllocateTxPacketBuffer(struct rt_rtmp_adapter
*pAd
,
202 unsigned long Length
,
204 void **VirtualAddress
)
208 pkt
= dev_alloc_skb(Length
);
211 DBGPRINT(RT_DEBUG_ERROR
,
212 ("can't allocate tx %ld size packet\n", Length
));
216 RTMP_SET_PACKET_SOURCE(OSPKT_TO_RTPKT(pkt
), PKTSRC_NDIS
);
217 *VirtualAddress
= (void *)pkt
->data
;
219 *VirtualAddress
= (void *)NULL
;
225 void build_tx_packet(struct rt_rtmp_adapter
*pAd
,
227 u8
*pFrame
, unsigned long FrameLen
)
230 struct sk_buff
*pTxPkt
;
233 pTxPkt
= RTPKT_TO_OSPKT(pPacket
);
235 NdisMoveMemory(skb_put(pTxPkt
, FrameLen
), pFrame
, FrameLen
);
238 void RTMPFreeAdapter(struct rt_rtmp_adapter
*pAd
)
240 struct os_cookie
*os_cookie
;
243 os_cookie
= (struct os_cookie
*)pAd
->OS_Cookie
;
246 kfree(pAd
->BeaconBuf
);
248 NdisFreeSpinLock(&pAd
->MgmtRingLock
);
251 NdisFreeSpinLock(&pAd
->RxRingLock
);
253 NdisFreeSpinLock(&pAd
->McuCmdLock
);
254 #endif /* RT3090 // */
255 #endif /* RTMP_MAC_PCI // */
257 for (index
= 0; index
< NUM_OF_TX_RING
; index
++) {
258 NdisFreeSpinLock(&pAd
->TxSwQueueLock
[index
]);
259 NdisFreeSpinLock(&pAd
->DeQueueLock
[index
]);
260 pAd
->DeQueueRunning
[index
] = FALSE
;
263 NdisFreeSpinLock(&pAd
->irq_lock
);
265 release_firmware(pAd
->firmware
);
267 vfree(pAd
); /* pci_free_consistent(os_cookie->pci_dev,sizeof(struct rt_rtmp_adapter),pAd,os_cookie->pAd_pa); */
272 BOOLEAN
OS_Need_Clone_Packet(void)
278 ========================================================================
281 clone an input NDIS PACKET to another one. The new internally created NDIS PACKET
282 must have only one NDIS BUFFER
283 return - byte copied. 0 means can't create NDIS PACKET
284 NOTE: internally created char should be destroyed by RTMPFreeNdisPacket
287 pAd Pointer to our adapter
288 pInsAMSDUHdr EWC A-MSDU format has extra 14-bytes header. if TRUE, insert this 14-byte hdr in front of MSDU.
289 *pSrcTotalLen return total packet length. This lenght is calculated with 802.3 format packet.
297 ========================================================================
299 int RTMPCloneNdisPacket(struct rt_rtmp_adapter
*pAd
,
300 IN BOOLEAN pInsAMSDUHdr
,
310 /* 1. Allocate a packet */
311 pkt
= dev_alloc_skb(2048);
314 return NDIS_STATUS_FAILURE
;
317 skb_put(pkt
, GET_OS_PKT_LEN(pInPacket
));
318 NdisMoveMemory(pkt
->data
, GET_OS_PKT_DATAPTR(pInPacket
),
319 GET_OS_PKT_LEN(pInPacket
));
320 *ppOutPacket
= OSPKT_TO_RTPKT(pkt
);
322 RTMP_SET_PACKET_SOURCE(OSPKT_TO_RTPKT(pkt
), PKTSRC_NDIS
);
324 printk("###Clone###\n");
326 return NDIS_STATUS_SUCCESS
;
329 /* the allocated NDIS PACKET must be freed via RTMPFreeNdisPacket() */
330 int RTMPAllocateNdisPacket(struct rt_rtmp_adapter
*pAd
,
334 u8
*pData
, u32 DataLen
)
340 /* 1. Allocate a packet */
342 (void **) dev_alloc_skb(HeaderLen
+ DataLen
+
343 RTMP_PKT_TAIL_PADDING
);
344 if (pPacket
== NULL
) {
347 printk("RTMPAllocateNdisPacket Fail\n");
349 return NDIS_STATUS_FAILURE
;
351 /* 2. clone the frame content */
353 NdisMoveMemory(GET_OS_PKT_DATAPTR(pPacket
), pHeader
, HeaderLen
);
355 NdisMoveMemory(GET_OS_PKT_DATAPTR(pPacket
) + HeaderLen
, pData
,
358 /* 3. update length of packet */
359 skb_put(GET_OS_PKT_TYPE(pPacket
), HeaderLen
+ DataLen
);
361 RTMP_SET_PACKET_SOURCE(pPacket
, PKTSRC_NDIS
);
362 /* printk("%s : pPacket = %p, len = %d\n", __func__, pPacket, GET_OS_PKT_LEN(pPacket)); */
364 return NDIS_STATUS_SUCCESS
;
368 ========================================================================
370 This routine frees a miniport internally allocated char and its
371 corresponding NDIS_BUFFER and allocated memory.
372 ========================================================================
374 void RTMPFreeNdisPacket(struct rt_rtmp_adapter
*pAd
, void *pPacket
)
376 dev_kfree_skb_any(RTPKT_TO_OSPKT(pPacket
));
379 /* IRQL = DISPATCH_LEVEL */
380 /* NOTE: we do have an assumption here, that Byte0 and Byte1 always reasid at the same */
381 /* scatter gather buffer */
382 int Sniff2BytesFromNdisBuffer(char *pFirstBuffer
,
384 u8
*pByte0
, u8
*pByte1
)
386 *pByte0
= *(u8
*)(pFirstBuffer
+ DesiredOffset
);
387 *pByte1
= *(u8
*)(pFirstBuffer
+ DesiredOffset
+ 1);
389 return NDIS_STATUS_SUCCESS
;
392 void RTMP_QueryPacketInfo(void *pPacket
,
393 struct rt_packet_info
*pPacketInfo
,
394 u8
**pSrcBufVA
, u32
* pSrcBufLen
)
396 pPacketInfo
->BufferCount
= 1;
397 pPacketInfo
->pFirstBuffer
= (char *)GET_OS_PKT_DATAPTR(pPacket
);
398 pPacketInfo
->PhysicalBufferCount
= 1;
399 pPacketInfo
->TotalPacketLength
= GET_OS_PKT_LEN(pPacket
);
401 *pSrcBufVA
= GET_OS_PKT_DATAPTR(pPacket
);
402 *pSrcBufLen
= GET_OS_PKT_LEN(pPacket
);
405 void RTMP_QueryNextPacketInfo(void **ppPacket
,
406 struct rt_packet_info
*pPacketInfo
,
407 u8
**pSrcBufVA
, u32
* pSrcBufLen
)
409 void *pPacket
= NULL
;
412 pPacket
= GET_OS_PKT_NEXT(*ppPacket
);
415 pPacketInfo
->BufferCount
= 1;
416 pPacketInfo
->pFirstBuffer
=
417 (char *)GET_OS_PKT_DATAPTR(pPacket
);
418 pPacketInfo
->PhysicalBufferCount
= 1;
419 pPacketInfo
->TotalPacketLength
= GET_OS_PKT_LEN(pPacket
);
421 *pSrcBufVA
= GET_OS_PKT_DATAPTR(pPacket
);
422 *pSrcBufLen
= GET_OS_PKT_LEN(pPacket
);
423 *ppPacket
= GET_OS_PKT_NEXT(pPacket
);
425 pPacketInfo
->BufferCount
= 0;
426 pPacketInfo
->pFirstBuffer
= NULL
;
427 pPacketInfo
->PhysicalBufferCount
= 0;
428 pPacketInfo
->TotalPacketLength
= 0;
436 void *DuplicatePacket(struct rt_rtmp_adapter
*pAd
,
437 void *pPacket
, u8 FromWhichBSSID
)
440 void *pRetPacket
= NULL
;
444 DataSize
= (u16
)GET_OS_PKT_LEN(pPacket
);
445 pData
= (u8
*)GET_OS_PKT_DATAPTR(pPacket
);
447 skb
= skb_clone(RTPKT_TO_OSPKT(pPacket
), MEM_ALLOC_FLAG
);
449 skb
->dev
= get_netdev_from_bssid(pAd
, FromWhichBSSID
);
450 pRetPacket
= OSPKT_TO_RTPKT(skb
);
457 void *duplicate_pkt(struct rt_rtmp_adapter
*pAd
,
461 unsigned long DataSize
, u8 FromWhichBSSID
)
464 void *pPacket
= NULL
;
466 skb
= __dev_alloc_skb(HdrLen
+ DataSize
+ 2, MEM_ALLOC_FLAG
);
469 NdisMoveMemory(skb_tail_pointer(skb
), pHeader802_3
, HdrLen
);
470 skb_put(skb
, HdrLen
);
471 NdisMoveMemory(skb_tail_pointer(skb
), pData
, DataSize
);
472 skb_put(skb
, DataSize
);
473 skb
->dev
= get_netdev_from_bssid(pAd
, FromWhichBSSID
);
474 pPacket
= OSPKT_TO_RTPKT(skb
);
480 #define TKIP_TX_MIC_SIZE 8
481 void *duplicate_pkt_with_TKIP_MIC(struct rt_rtmp_adapter
*pAd
,
484 struct sk_buff
*skb
, *newskb
;
486 skb
= RTPKT_TO_OSPKT(pPacket
);
487 if (skb_tailroom(skb
) < TKIP_TX_MIC_SIZE
) {
488 /* alloc a new skb and copy the packet */
490 skb_copy_expand(skb
, skb_headroom(skb
), TKIP_TX_MIC_SIZE
,
492 dev_kfree_skb_any(skb
);
493 if (newskb
== NULL
) {
494 DBGPRINT(RT_DEBUG_ERROR
,
495 ("Extend Tx.MIC for packet failed!, dropping packet!\n"));
501 return OSPKT_TO_RTPKT(skb
);
504 void *ClonePacket(struct rt_rtmp_adapter
*pAd
,
506 u8
*pData
, unsigned long DataSize
)
508 struct sk_buff
*pRxPkt
;
509 struct sk_buff
*pClonedPkt
;
512 pRxPkt
= RTPKT_TO_OSPKT(pPacket
);
514 /* clone the packet */
515 pClonedPkt
= skb_clone(pRxPkt
, MEM_ALLOC_FLAG
);
518 /* set the correct dataptr and data len */
519 pClonedPkt
->dev
= pRxPkt
->dev
;
520 pClonedPkt
->data
= pData
;
521 pClonedPkt
->len
= DataSize
;
522 skb_set_tail_pointer(pClonedPkt
, DataSize
)
523 ASSERT(DataSize
< 1530);
529 /* change OS packet DataPtr and DataLen */
531 void update_os_packet_info(struct rt_rtmp_adapter
*pAd
,
532 struct rt_rx_blk
*pRxBlk
, u8 FromWhichBSSID
)
534 struct sk_buff
*pOSPkt
;
536 ASSERT(pRxBlk
->pRxPacket
);
537 pOSPkt
= RTPKT_TO_OSPKT(pRxBlk
->pRxPacket
);
539 pOSPkt
->dev
= get_netdev_from_bssid(pAd
, FromWhichBSSID
);
540 pOSPkt
->data
= pRxBlk
->pData
;
541 pOSPkt
->len
= pRxBlk
->DataSize
;
542 skb_set_tail_pointer(pOSPkt
, pOSPkt
->len
);
545 void wlan_802_11_to_802_3_packet(struct rt_rtmp_adapter
*pAd
,
546 struct rt_rx_blk
*pRxBlk
,
550 struct sk_buff
*pOSPkt
;
552 ASSERT(pRxBlk
->pRxPacket
);
553 ASSERT(pHeader802_3
);
555 pOSPkt
= RTPKT_TO_OSPKT(pRxBlk
->pRxPacket
);
557 pOSPkt
->dev
= get_netdev_from_bssid(pAd
, FromWhichBSSID
);
558 pOSPkt
->data
= pRxBlk
->pData
;
559 pOSPkt
->len
= pRxBlk
->DataSize
;
560 skb_set_tail_pointer(pOSPkt
, pOSPkt
->len
);
563 /* copy 802.3 header */
567 NdisMoveMemory(skb_push(pOSPkt
, LENGTH_802_3
), pHeader802_3
,
571 void announce_802_3_packet(struct rt_rtmp_adapter
*pAd
, void *pPacket
)
574 struct sk_buff
*pRxPkt
;
578 pRxPkt
= RTPKT_TO_OSPKT(pPacket
);
580 /* Push up the protocol stack */
581 pRxPkt
->protocol
= eth_type_trans(pRxPkt
, pRxPkt
->dev
);
586 struct rt_rtmp_sg_list
*
587 rt_get_sg_list_from_packet(void *pPacket
, struct rt_rtmp_sg_list
*sg
)
589 sg
->NumberOfElements
= 1;
590 sg
->Elements
[0].Address
= GET_OS_PKT_DATAPTR(pPacket
);
591 sg
->Elements
[0].Length
= GET_OS_PKT_LEN(pPacket
);
595 void hex_dump(char *str
, unsigned char *pSrcBufVA
, unsigned int SrcBufLen
)
600 if (RTDebugLevel
< RT_DEBUG_TRACE
)
604 printk("%s: %p, len = %d\n", str
, pSrcBufVA
, SrcBufLen
);
605 for (x
= 0; x
< SrcBufLen
; x
++) {
607 printk("0x%04x : ", x
);
608 printk("%02x ", ((unsigned char)pt
[x
]));
616 ========================================================================
619 Send log message through wireless event
621 Support standard iw_event with IWEVCUSTOM. It is used below.
623 iwreq_data.data.flags is used to store event_flag that is defined by user.
624 iwreq_data.data.length is the length of the event log.
626 The format of the event log is composed of the entry's MAC address and
627 the desired log message (refer to pWirelessEventText).
629 ex: 11:22:33:44:55:66 has associated successfully
631 p.s. The requirement of Wireless Extension is v15 or newer.
633 ========================================================================
635 void RTMPSendWirelessEvent(struct rt_rtmp_adapter
*pAd
,
637 u8
*pAddr
, u8 BssIdx
, char Rssi
)
640 /*union iwreq_data wrqu; */
641 char *pBuf
= NULL
, *pBufPtr
= NULL
;
642 u16 event
, type
, BufLen
;
643 u8 event_table_len
= 0;
645 type
= Event_flag
& 0xFF00;
646 event
= Event_flag
& 0x00FF;
649 case IW_SYS_EVENT_FLAG_START
:
650 event_table_len
= IW_SYS_EVENT_TYPE_NUM
;
653 case IW_SPOOF_EVENT_FLAG_START
:
654 event_table_len
= IW_SPOOF_EVENT_TYPE_NUM
;
657 case IW_FLOOD_EVENT_FLAG_START
:
658 event_table_len
= IW_FLOOD_EVENT_TYPE_NUM
;
662 if (event_table_len
== 0) {
663 DBGPRINT(RT_DEBUG_ERROR
,
664 ("%s : The type(%0x02x) is not valid.\n", __func__
,
669 if (event
>= event_table_len
) {
670 DBGPRINT(RT_DEBUG_ERROR
,
671 ("%s : The event(%0x02x) is not valid.\n", __func__
,
675 /*Allocate memory and copy the msg. */
676 pBuf
= kmalloc(IW_CUSTOM_MAX_LEN
, GFP_ATOMIC
);
678 /*Prepare the payload */
679 memset(pBuf
, 0, IW_CUSTOM_MAX_LEN
);
686 "(RT2860) STA(%02x:%02x:%02x:%02x:%02x:%02x) ",
688 else if (BssIdx
< MAX_MBSSID_NUM
)
690 sprintf(pBufPtr
, "(RT2860) BSS(wlan%d) ", BssIdx
);
692 pBufPtr
+= sprintf(pBufPtr
, "(RT2860) ");
694 if (type
== IW_SYS_EVENT_FLAG_START
)
696 sprintf(pBufPtr
, "%s",
697 pWirelessSysEventText
[event
]);
698 else if (type
== IW_SPOOF_EVENT_FLAG_START
)
700 sprintf(pBufPtr
, "%s (RSSI=%d)",
701 pWirelessSpoofEventText
[event
], Rssi
);
702 else if (type
== IW_FLOOD_EVENT_FLAG_START
)
704 sprintf(pBufPtr
, "%s",
705 pWirelessFloodEventText
[event
]);
707 pBufPtr
+= sprintf(pBufPtr
, "%s", "unknown event");
709 pBufPtr
[pBufPtr
- pBuf
] = '\0';
710 BufLen
= pBufPtr
- pBuf
;
712 RtmpOSWrielessEventSend(pAd
, IWEVCUSTOM
, Event_flag
, NULL
,
714 /*DBGPRINT(RT_DEBUG_TRACE, ("%s : %s\n", __func__, pBuf)); */
718 DBGPRINT(RT_DEBUG_ERROR
,
719 ("%s : Can't allocate memory for wireless event.\n",
723 void send_monitor_packets(struct rt_rtmp_adapter
*pAd
, struct rt_rx_blk
*pRxBlk
)
725 struct sk_buff
*pOSPkt
;
726 struct rt_wlan_ng_prism2_header
*ph
;
729 u8 temp_header
[40] = { 0 };
731 u_int32_t ralinkrate
[256] = { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108, 109, 110, 111, 112, 13, 26, 39, 52, 78, 104, 117, 130, 26, 52, 78, 104, 156, 208, 234, 260, 27, 54, 81, 108, 162, 216, 243, 270, /* Last 38 */
732 54, 108, 162, 216, 324, 432, 486, 540, 14, 29, 43, 57, 87, 115,
733 130, 144, 29, 59, 87, 115, 173, 230, 260, 288, 30, 60, 90,
734 120, 180, 240, 270, 300, 60, 120, 180, 240, 360, 480, 540,
735 600, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10,
736 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26,
737 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41,
738 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56,
739 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71,
740 72, 73, 74, 75, 76, 77, 78, 79, 80
743 ASSERT(pRxBlk
->pRxPacket
);
744 if (pRxBlk
->DataSize
< 10) {
745 DBGPRINT(RT_DEBUG_ERROR
,
746 ("%s : Size is too small! (%d)\n", __func__
,
748 goto err_free_sk_buff
;
751 if (pRxBlk
->DataSize
+ sizeof(struct rt_wlan_ng_prism2_header
) >
752 RX_BUFFER_AGGRESIZE
) {
753 DBGPRINT(RT_DEBUG_ERROR
,
754 ("%s : Size is too large! (%zu)\n", __func__
,
755 pRxBlk
->DataSize
+ sizeof(struct rt_wlan_ng_prism2_header
)));
756 goto err_free_sk_buff
;
759 pOSPkt
= RTPKT_TO_OSPKT(pRxBlk
->pRxPacket
);
760 pOSPkt
->dev
= get_netdev_from_bssid(pAd
, BSS0
);
761 if (pRxBlk
->pHeader
->FC
.Type
== BTYPE_DATA
) {
762 pRxBlk
->DataSize
-= LENGTH_802_11
;
763 if ((pRxBlk
->pHeader
->FC
.ToDs
== 1) &&
764 (pRxBlk
->pHeader
->FC
.FrDs
== 1))
765 header_len
= LENGTH_802_11_WITH_ADDR4
;
767 header_len
= LENGTH_802_11
;
770 if (pRxBlk
->pHeader
->FC
.SubType
& 0x08) {
772 /* Data skip QOS contorl field */
773 pRxBlk
->DataSize
-= 2;
775 /* Order bit: A-Ralink or HTC+ */
776 if (pRxBlk
->pHeader
->FC
.Order
) {
778 /* Data skip HTC contorl field */
779 pRxBlk
->DataSize
-= 4;
782 if (header_len
<= 40)
783 NdisMoveMemory(temp_header
, pRxBlk
->pData
, header_len
);
785 /* skip HW padding */
786 if (pRxBlk
->RxD
.L2PAD
)
787 pRxBlk
->pData
+= (header_len
+ 2);
789 pRxBlk
->pData
+= header_len
;
792 if (pRxBlk
->DataSize
< pOSPkt
->len
) {
793 skb_trim(pOSPkt
, pRxBlk
->DataSize
);
795 skb_put(pOSPkt
, (pRxBlk
->DataSize
- pOSPkt
->len
));
798 if ((pRxBlk
->pData
- pOSPkt
->data
) > 0) {
799 skb_put(pOSPkt
, (pRxBlk
->pData
- pOSPkt
->data
));
800 skb_pull(pOSPkt
, (pRxBlk
->pData
- pOSPkt
->data
));
803 if (skb_headroom(pOSPkt
) < (sizeof(struct rt_wlan_ng_prism2_header
) + header_len
)) {
805 (pOSPkt
, (sizeof(struct rt_wlan_ng_prism2_header
) + header_len
), 0,
807 DBGPRINT(RT_DEBUG_ERROR
,
808 ("%s : Reallocate header size of sk_buff fail!\n",
810 goto err_free_sk_buff
;
815 NdisMoveMemory(skb_push(pOSPkt
, header_len
), temp_header
,
818 ph
= (struct rt_wlan_ng_prism2_header
*)skb_push(pOSPkt
,
819 sizeof(struct rt_wlan_ng_prism2_header
));
820 NdisZeroMemory(ph
, sizeof(struct rt_wlan_ng_prism2_header
));
822 ph
->msgcode
= DIDmsg_lnxind_wlansniffrm
;
823 ph
->msglen
= sizeof(struct rt_wlan_ng_prism2_header
);
824 strcpy((char *)ph
->devname
, (char *)pAd
->net_dev
->name
);
826 ph
->hosttime
.did
= DIDmsg_lnxind_wlansniffrm_hosttime
;
827 ph
->hosttime
.status
= 0;
828 ph
->hosttime
.len
= 4;
829 ph
->hosttime
.data
= jiffies
;
831 ph
->mactime
.did
= DIDmsg_lnxind_wlansniffrm_mactime
;
832 ph
->mactime
.status
= 0;
834 ph
->mactime
.data
= 0;
836 ph
->istx
.did
= DIDmsg_lnxind_wlansniffrm_istx
;
841 ph
->channel
.did
= DIDmsg_lnxind_wlansniffrm_channel
;
842 ph
->channel
.status
= 0;
845 ph
->channel
.data
= (u_int32_t
) pAd
->CommonCfg
.Channel
;
847 ph
->rssi
.did
= DIDmsg_lnxind_wlansniffrm_rssi
;
851 (u_int32_t
) RTMPMaxRssi(pAd
,
852 ConvertToRssi(pAd
, pRxBlk
->pRxWI
->RSSI0
,
853 RSSI_0
), ConvertToRssi(pAd
,
858 ConvertToRssi(pAd
, pRxBlk
->pRxWI
->RSSI2
,
861 ph
->signal
.did
= DIDmsg_lnxind_wlansniffrm_signal
;
862 ph
->signal
.status
= 0;
864 ph
->signal
.data
= 0; /*rssi + noise; */
866 ph
->noise
.did
= DIDmsg_lnxind_wlansniffrm_noise
;
867 ph
->noise
.status
= 0;
871 if (pRxBlk
->pRxWI
->PHYMODE
>= MODE_HTMIX
) {
873 16 + ((u8
)pRxBlk
->pRxWI
->BW
* 16) +
874 ((u8
)pRxBlk
->pRxWI
->ShortGI
* 32) +
875 ((u8
)pRxBlk
->pRxWI
->MCS
);
876 } else if (pRxBlk
->pRxWI
->PHYMODE
== MODE_OFDM
)
877 rate_index
= (u8
)(pRxBlk
->pRxWI
->MCS
) + 4;
879 rate_index
= (u8
)(pRxBlk
->pRxWI
->MCS
);
882 if (rate_index
> 255)
885 ph
->rate
.did
= DIDmsg_lnxind_wlansniffrm_rate
;
888 ph
->rate
.data
= ralinkrate
[rate_index
];
890 ph
->frmlen
.did
= DIDmsg_lnxind_wlansniffrm_frmlen
;
891 ph
->frmlen
.status
= 0;
893 ph
->frmlen
.data
= (u_int32_t
) pRxBlk
->DataSize
;
895 pOSPkt
->pkt_type
= PACKET_OTHERHOST
;
896 pOSPkt
->protocol
= eth_type_trans(pOSPkt
, pOSPkt
->dev
);
897 pOSPkt
->ip_summed
= CHECKSUM_NONE
;
903 RELEASE_NDIS_PACKET(pAd
, pRxBlk
->pRxPacket
, NDIS_STATUS_FAILURE
);
908 /*******************************************************************************
910 Device IRQ related functions.
912 *******************************************************************************/
913 int RtmpOSIRQRequest(struct net_device
*pNetDev
)
915 #ifdef RTMP_PCI_SUPPORT
916 struct net_device
*net_dev
= pNetDev
;
917 struct rt_rtmp_adapter
*pAd
= NULL
;
920 GET_PAD_FROM_NET_DEV(pAd
, pNetDev
);
924 if (pAd
->infType
== RTMP_DEV_INF_PCI
) {
925 struct os_cookie
*_pObj
= (struct os_cookie
*)(pAd
->OS_Cookie
);
926 RTMP_MSI_ENABLE(pAd
);
928 request_irq(_pObj
->pci_dev
->irq
, rt2860_interrupt
, SA_SHIRQ
,
929 (net_dev
)->name
, (net_dev
));
931 printk("RT2860: request_irq ERROR(%d)\n", retval
);
940 int RtmpOSIRQRelease(struct net_device
*pNetDev
)
942 struct net_device
*net_dev
= pNetDev
;
943 struct rt_rtmp_adapter
*pAd
= NULL
;
945 GET_PAD_FROM_NET_DEV(pAd
, net_dev
);
949 #ifdef RTMP_PCI_SUPPORT
950 if (pAd
->infType
== RTMP_DEV_INF_PCI
) {
951 struct os_cookie
*pObj
= (struct os_cookie
*)(pAd
->OS_Cookie
);
952 synchronize_irq(pObj
->pci_dev
->irq
);
953 free_irq(pObj
->pci_dev
->irq
, (net_dev
));
954 RTMP_MSI_DISABLE(pAd
);
956 #endif /* RTMP_PCI_SUPPORT // */
961 /*******************************************************************************
963 File open/close related functions.
965 *******************************************************************************/
966 struct file
*RtmpOSFileOpen(char *pPath
, int flag
, int mode
)
968 struct file
*filePtr
;
970 filePtr
= filp_open(pPath
, flag
, 0);
971 if (IS_ERR(filePtr
)) {
972 DBGPRINT(RT_DEBUG_ERROR
,
973 ("%s(): Error %ld opening %s\n", __func__
,
974 -PTR_ERR(filePtr
), pPath
));
977 return (struct file
*)filePtr
;
980 int RtmpOSFileClose(struct file
*osfd
)
982 filp_close(osfd
, NULL
);
986 void RtmpOSFileSeek(struct file
*osfd
, int offset
)
988 osfd
->f_pos
= offset
;
991 int RtmpOSFileRead(struct file
*osfd
, char *pDataPtr
, int readLen
)
993 /* The object must have a read method */
994 if (osfd
->f_op
&& osfd
->f_op
->read
) {
995 return osfd
->f_op
->read(osfd
, pDataPtr
, readLen
, &osfd
->f_pos
);
997 DBGPRINT(RT_DEBUG_ERROR
, ("no file read method\n"));
1002 int RtmpOSFileWrite(struct file
*osfd
, char *pDataPtr
, int writeLen
)
1004 return osfd
->f_op
->write(osfd
, pDataPtr
, (size_t) writeLen
,
1008 /*******************************************************************************
1010 Task create/management/kill related functions.
1012 *******************************************************************************/
1013 int RtmpOSTaskKill(struct rt_rtmp_os_task
*pTask
)
1015 struct rt_rtmp_adapter
*pAd
;
1016 int ret
= NDIS_STATUS_FAILURE
;
1020 #ifdef KTHREAD_SUPPORT
1021 if (pTask
->kthread_task
) {
1022 kthread_stop(pTask
->kthread_task
);
1023 ret
= NDIS_STATUS_SUCCESS
;
1026 CHECK_PID_LEGALITY(pTask
->taskPID
) {
1027 printk("Terminate the task(%s) with pid(%d)!\n",
1028 pTask
->taskName
, GET_PID_NUMBER(pTask
->taskPID
));
1030 pTask
->task_killed
= 1;
1032 ret
= KILL_THREAD_PID(pTask
->taskPID
, SIGTERM
, 1);
1035 "kill task(%s) with pid(%d) failed(retVal=%d)!\n",
1036 pTask
->taskName
, GET_PID_NUMBER(pTask
->taskPID
),
1039 wait_for_completion(&pTask
->taskComplete
);
1040 pTask
->taskPID
= THREAD_PID_INIT_VALUE
;
1041 pTask
->task_killed
= 0;
1042 ret
= NDIS_STATUS_SUCCESS
;
1051 int RtmpOSTaskNotifyToExit(struct rt_rtmp_os_task
*pTask
)
1054 #ifndef KTHREAD_SUPPORT
1055 complete_and_exit(&pTask
->taskComplete
, 0);
1061 void RtmpOSTaskCustomize(struct rt_rtmp_os_task
*pTask
)
1064 #ifndef KTHREAD_SUPPORT
1066 daemonize((char *)&pTask
->taskName
[0] /*"%s",pAd->net_dev->name */);
1068 allow_signal(SIGTERM
);
1069 allow_signal(SIGKILL
);
1070 current
->flags
|= PF_NOFREEZE
;
1072 /* signal that we've started the thread */
1073 complete(&pTask
->taskComplete
);
1078 int RtmpOSTaskAttach(struct rt_rtmp_os_task
*pTask
,
1079 IN
int (*fn
) (void *), IN
void *arg
)
1081 int status
= NDIS_STATUS_SUCCESS
;
1083 #ifdef KTHREAD_SUPPORT
1084 pTask
->task_killed
= 0;
1085 pTask
->kthread_task
= NULL
;
1086 pTask
->kthread_task
= kthread_run(fn
, arg
, pTask
->taskName
);
1087 if (IS_ERR(pTask
->kthread_task
))
1088 status
= NDIS_STATUS_FAILURE
;
1090 pid_number
= kernel_thread(fn
, arg
, RTMP_OS_MGMT_TASK_FLAGS
);
1091 if (pid_number
< 0) {
1092 DBGPRINT(RT_DEBUG_ERROR
,
1093 ("Attach task(%s) failed!\n", pTask
->taskName
));
1094 status
= NDIS_STATUS_FAILURE
;
1096 pTask
->taskPID
= GET_PID(pid_number
);
1098 /* Wait for the thread to start */
1099 wait_for_completion(&pTask
->taskComplete
);
1100 status
= NDIS_STATUS_SUCCESS
;
1106 int RtmpOSTaskInit(struct rt_rtmp_os_task
*pTask
,
1107 char *pTaskName
, void * pPriv
)
1113 #ifndef KTHREAD_SUPPORT
1114 NdisZeroMemory((u8
*)(pTask
), sizeof(struct rt_rtmp_os_task
));
1117 len
= strlen(pTaskName
);
1120 (RTMP_OS_TASK_NAME_LEN
- 1) ? (RTMP_OS_TASK_NAME_LEN
- 1) : len
;
1121 NdisMoveMemory(&pTask
->taskName
[0], pTaskName
, len
);
1122 pTask
->priv
= pPriv
;
1124 #ifndef KTHREAD_SUPPORT
1125 RTMP_SEM_EVENT_INIT_LOCKED(&(pTask
->taskSema
));
1126 pTask
->taskPID
= THREAD_PID_INIT_VALUE
;
1128 init_completion(&pTask
->taskComplete
);
1131 return NDIS_STATUS_SUCCESS
;
1134 void RTMP_IndicateMediaState(struct rt_rtmp_adapter
*pAd
)
1136 if (pAd
->CommonCfg
.bWirelessEvent
) {
1137 if (pAd
->IndicateMediaState
== NdisMediaStateConnected
) {
1138 RTMPSendWirelessEvent(pAd
, IW_STA_LINKUP_EVENT_FLAG
,
1139 pAd
->MacTab
.Content
[BSSID_WCID
].
1142 RTMPSendWirelessEvent(pAd
, IW_STA_LINKDOWN_EVENT_FLAG
,
1143 pAd
->MacTab
.Content
[BSSID_WCID
].
1149 int RtmpOSWrielessEventSend(struct rt_rtmp_adapter
*pAd
,
1153 u8
*pData
, u32 dataLen
)
1155 union iwreq_data wrqu
;
1157 memset(&wrqu
, 0, sizeof(wrqu
));
1160 wrqu
.data
.flags
= flags
;
1163 memcpy(wrqu
.ap_addr
.sa_data
, pSrcMac
, MAC_ADDR_LEN
);
1165 if ((pData
!= NULL
) && (dataLen
> 0))
1166 wrqu
.data
.length
= dataLen
;
1168 wireless_send_event(pAd
->net_dev
, eventType
, &wrqu
, (char *)pData
);
1172 int RtmpOSNetDevAddrSet(struct net_device
*pNetDev
, u8
*pMacAddr
)
1174 struct net_device
*net_dev
;
1175 struct rt_rtmp_adapter
*pAd
;
1178 GET_PAD_FROM_NET_DEV(pAd
, net_dev
);
1180 /* work-around for the SuSE due to it has it's own interface name management system. */
1182 NdisZeroMemory(pAd
->StaCfg
.dev_name
, 16);
1183 NdisMoveMemory(pAd
->StaCfg
.dev_name
, net_dev
->name
,
1184 strlen(net_dev
->name
));
1187 NdisMoveMemory(net_dev
->dev_addr
, pMacAddr
, 6);
1193 * Assign the network dev name for created Ralink WiFi interface.
1195 static int RtmpOSNetDevRequestName(struct rt_rtmp_adapter
*pAd
,
1196 struct net_device
*dev
,
1197 char *pPrefixStr
, int devIdx
)
1199 struct net_device
*existNetDev
;
1200 char suffixName
[IFNAMSIZ
];
1201 char desiredName
[IFNAMSIZ
];
1202 int ifNameIdx
, prefixLen
, slotNameLen
;
1205 prefixLen
= strlen(pPrefixStr
);
1206 ASSERT((prefixLen
< IFNAMSIZ
));
1208 for (ifNameIdx
= devIdx
; ifNameIdx
< 32; ifNameIdx
++) {
1209 memset(suffixName
, 0, IFNAMSIZ
);
1210 memset(desiredName
, 0, IFNAMSIZ
);
1211 strncpy(&desiredName
[0], pPrefixStr
, prefixLen
);
1213 sprintf(suffixName
, "%d", ifNameIdx
);
1215 slotNameLen
= strlen(suffixName
);
1216 ASSERT(((slotNameLen
+ prefixLen
) < IFNAMSIZ
));
1217 strcat(desiredName
, suffixName
);
1219 existNetDev
= RtmpOSNetDevGetByName(dev
, &desiredName
[0]);
1220 if (existNetDev
== NULL
)
1223 RtmpOSNetDeviceRefPut(existNetDev
);
1226 if (ifNameIdx
< 32) {
1227 strcpy(&dev
->name
[0], &desiredName
[0]);
1228 Status
= NDIS_STATUS_SUCCESS
;
1230 DBGPRINT(RT_DEBUG_ERROR
,
1231 ("Cannot request DevName with preifx(%s) and in range(0~32) as suffix from OS!\n",
1233 Status
= NDIS_STATUS_FAILURE
;
1239 void RtmpOSNetDevClose(struct net_device
*pNetDev
)
1244 void RtmpOSNetDevFree(struct net_device
*pNetDev
)
1248 free_netdev(pNetDev
);
1251 int RtmpOSNetDevAlloc(struct net_device
**new_dev_p
, u32 privDataSize
)
1253 /* assign it as null first. */
1256 DBGPRINT(RT_DEBUG_TRACE
,
1257 ("Allocate a net device with private data size=%d!\n",
1259 *new_dev_p
= alloc_etherdev(privDataSize
);
1261 return NDIS_STATUS_SUCCESS
;
1263 return NDIS_STATUS_FAILURE
;
1266 struct net_device
*RtmpOSNetDevGetByName(struct net_device
*pNetDev
, char *pDevName
)
1268 struct net_device
*pTargetNetDev
= NULL
;
1270 pTargetNetDev
= dev_get_by_name(dev_net(pNetDev
), pDevName
);
1272 return pTargetNetDev
;
1275 void RtmpOSNetDeviceRefPut(struct net_device
*pNetDev
)
1278 every time dev_get_by_name is called, and it has returned a valid struct
1279 net_device*, dev_put should be called afterwards, because otherwise the
1280 machine hangs when the device is unregistered (since dev->refcnt > 1).
1286 int RtmpOSNetDevDestory(struct rt_rtmp_adapter
*pAd
, struct net_device
*pNetDev
)
1289 /* TODO: Need to fix this */
1290 printk("WARNING: This function(%s) not implement yet!\n", __func__
);
1294 void RtmpOSNetDevDetach(struct net_device
*pNetDev
)
1296 unregister_netdev(pNetDev
);
1299 int RtmpOSNetDevAttach(struct net_device
*pNetDev
,
1300 struct rt_rtmp_os_netdev_op_hook
*pDevOpHook
)
1302 int ret
, rtnl_locked
= FALSE
;
1304 DBGPRINT(RT_DEBUG_TRACE
, ("RtmpOSNetDevAttach()--->\n"));
1305 /* If we need hook some callback function to the net device structrue, now do it. */
1307 struct rt_rtmp_adapter
*pAd
= NULL
;
1309 GET_PAD_FROM_NET_DEV(pAd
, pNetDev
);
1311 pNetDev
->netdev_ops
= pDevOpHook
->netdev_ops
;
1313 /* OS specific flags, here we used to indicate if we are virtual interface */
1314 pNetDev
->priv_flags
= pDevOpHook
->priv_flags
;
1316 if (pAd
->OpMode
== OPMODE_STA
) {
1317 pNetDev
->wireless_handlers
= &rt28xx_iw_handler_def
;
1320 /* copy the net device mac address to the net_device structure. */
1321 NdisMoveMemory(pNetDev
->dev_addr
, &pDevOpHook
->devAddr
[0],
1324 rtnl_locked
= pDevOpHook
->needProtcted
;
1328 ret
= register_netdevice(pNetDev
);
1330 ret
= register_netdev(pNetDev
);
1332 DBGPRINT(RT_DEBUG_TRACE
, ("<---RtmpOSNetDevAttach(), ret=%d\n", ret
));
1334 return NDIS_STATUS_SUCCESS
;
1336 return NDIS_STATUS_FAILURE
;
1339 struct net_device
*RtmpOSNetDevCreate(struct rt_rtmp_adapter
*pAd
,
1342 int privMemSize
, char *pNamePrefix
)
1344 struct net_device
*pNetDev
= NULL
;
1347 /* allocate a new network device */
1348 status
= RtmpOSNetDevAlloc(&pNetDev
, 0 /*privMemSize */);
1349 if (status
!= NDIS_STATUS_SUCCESS
) {
1350 /* allocation fail, exit */
1351 DBGPRINT(RT_DEBUG_ERROR
,
1352 ("Allocate network device fail (%s)...\n",
1357 /* find a available interface name, max 32 interfaces */
1358 status
= RtmpOSNetDevRequestName(pAd
, pNetDev
, pNamePrefix
, devNum
);
1359 if (status
!= NDIS_STATUS_SUCCESS
) {
1360 /* error! no any available ra name can be used! */
1361 DBGPRINT(RT_DEBUG_ERROR
,
1362 ("Assign interface name (%s with suffix 0~32) failed...\n",
1364 RtmpOSNetDevFree(pNetDev
);
1368 DBGPRINT(RT_DEBUG_TRACE
,
1369 ("The name of the new %s interface is %s...\n",
1370 pNamePrefix
, pNetDev
->name
));