1 /**************************************************************************************************
2 * Procedure: Init boot code/firmware code/data session
4 * Description: This routine will intialize firmware. If any error occurs during the initialization
5 * process, the routine shall terminate immediately and return fail.
6 * NIC driver should call NdisOpenFile only from MiniportInitialize.
8 * Arguments: The pointer of the adapter
11 * NDIS_STATUS_FAILURE - the following initialization process should be terminated
12 * NDIS_STATUS_SUCCESS - if firmware initialization process success
13 **************************************************************************************************/
15 #include "r8192S_firmware.h"
16 #include <linux/unistd.h>
18 #include "r8192S_hw.h"
19 #include "r8192SU_HWImg.h"
21 #include <linux/firmware.h>
23 #define byte(x,n) ( (x >> (8 * n)) & 0xff )
26 // Description: This routine will intialize firmware. If any error occurs during the initialization
27 // process, the routine shall terminate immediately and return fail.
29 // Arguments: The pointer of the adapter
30 // Code address (Virtual address, should fill descriptor with physical address)
32 // Created by Roger, 2008.04.10.
34 bool FirmwareDownloadCode(struct net_device
*dev
, u8
* code_virtual_address
,u32 buffer_len
)
36 struct r8192_priv
*priv
= ieee80211_priv(dev
);
37 bool rt_status
= true;
38 u16 frag_threshold
= MAX_FIRMWARE_CODE_SIZE
; //Fragmentation might be required in 90/92 but not in 92S
39 u16 frag_length
, frag_offset
= 0;
41 unsigned char *seg_ptr
;
44 u16 ExtraDescOffset
= 0;
47 RT_TRACE(COMP_FIRMWARE
, "--->FirmwareDownloadCode()\n" );
49 //MAX_TRANSMIT_BUFFER_SIZE
50 if(buffer_len
>= MAX_FIRMWARE_CODE_SIZE
-USB_HWDESC_HEADER_LEN
)
52 RT_TRACE(COMP_ERR
, "Size over MAX_FIRMWARE_CODE_SIZE! \n");
53 goto cmdsend_downloadcode_fail
;
56 ExtraDescOffset
= USB_HWDESC_HEADER_LEN
;
59 if((buffer_len
-frag_offset
) > frag_threshold
)
61 frag_length
= frag_threshold
+ ExtraDescOffset
;
65 frag_length
= (u16
)(buffer_len
- frag_offset
+ ExtraDescOffset
);
69 /* Allocate skb buffer to contain firmware info and tx descriptor info. */
70 skb
= dev_alloc_skb(frag_length
);
71 memcpy((unsigned char *)(skb
->cb
),&dev
,sizeof(dev
));
73 tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
74 tcb_desc
->queue_index
= TXCMD_QUEUE
;
75 tcb_desc
->bCmdOrInit
= DESC_PACKET_TYPE_INIT
;
76 tcb_desc
->bLastIniPkt
= bLastIniPkt
;
78 skb_reserve(skb
, ExtraDescOffset
);
79 seg_ptr
= (u8
*)skb_put(skb
, (u32
)(frag_length
-ExtraDescOffset
));
80 memcpy(seg_ptr
, code_virtual_address
+frag_offset
, (u32
)(frag_length
-ExtraDescOffset
));
82 tcb_desc
->txbuf_size
= frag_length
;
84 if(!priv
->ieee80211
->check_nic_enough_desc(dev
,tcb_desc
->queue_index
)||
85 (!skb_queue_empty(&priv
->ieee80211
->skb_waitQ
[tcb_desc
->queue_index
]))||\
86 (priv
->ieee80211
->queue_stop
) )
88 RT_TRACE(COMP_FIRMWARE
,"=====================================================> tx full!\n");
89 skb_queue_tail(&priv
->ieee80211
->skb_waitQ
[tcb_desc
->queue_index
], skb
);
93 priv
->ieee80211
->softmac_hard_start_xmit(skb
,dev
);
96 frag_offset
+= (frag_length
- ExtraDescOffset
);
98 }while(frag_offset
< buffer_len
);
103 cmdsend_downloadcode_fail
:
105 RT_TRACE(COMP_ERR
, "CmdSendDownloadCode fail !!\n");
112 FirmwareEnableCPU(struct net_device
*dev
)
115 RT_STATUS rtStatus
= RT_STATUS_SUCCESS
;
116 u8 tmpU1b
, CPUStatus
= 0;
118 u32 iCheckTime
= 200;
120 RT_TRACE(COMP_FIRMWARE
, "-->FirmwareEnableCPU()\n" );
122 tmpU1b
= read_nic_byte(dev
, SYS_CLKR
);
123 write_nic_byte(dev
, SYS_CLKR
, (tmpU1b
|SYS_CPU_CLKSEL
)); //AFE source
125 tmpU2b
= read_nic_word(dev
, SYS_FUNC_EN
);
126 write_nic_word(dev
, SYS_FUNC_EN
, (tmpU2b
|FEN_CPUEN
));
128 //Polling IMEM Ready after CPU has refilled.
131 CPUStatus
= read_nic_byte(dev
, TCR
);
132 if(CPUStatus
& IMEM_RDY
)
134 RT_TRACE(COMP_FIRMWARE
, "IMEM Ready after CPU has refilled.\n");
140 }while(iCheckTime
--);
142 if(!(CPUStatus
& IMEM_RDY
))
143 return RT_STATUS_FAILURE
;
145 RT_TRACE(COMP_FIRMWARE
, "<--FirmwareEnableCPU(): rtStatus(%#x)\n", rtStatus
);
149 FIRMWARE_8192S_STATUS
150 FirmwareGetNextStatus(FIRMWARE_8192S_STATUS FWCurrentStatus
)
152 FIRMWARE_8192S_STATUS NextFWStatus
= 0;
154 switch(FWCurrentStatus
)
157 NextFWStatus
= FW_STATUS_LOAD_IMEM
;
160 case FW_STATUS_LOAD_IMEM
:
161 NextFWStatus
= FW_STATUS_LOAD_EMEM
;
164 case FW_STATUS_LOAD_EMEM
:
165 NextFWStatus
= FW_STATUS_LOAD_DMEM
;
168 case FW_STATUS_LOAD_DMEM
:
169 NextFWStatus
= FW_STATUS_READY
;
173 RT_TRACE(COMP_ERR
,"Invalid FW Status(%#x)!!\n", FWCurrentStatus
);
180 FirmwareCheckReady(struct net_device
*dev
, u8 LoadFWStatus
)
182 struct r8192_priv
*priv
= ieee80211_priv(dev
);
183 RT_STATUS rtStatus
= RT_STATUS_SUCCESS
;
184 rt_firmware
*pFirmware
= priv
->pFirmware
;
185 int PollingCnt
= 1000;
186 //u8 tmpU1b, CPUStatus = 0;
189 //bool bOrgIMREnable;
191 RT_TRACE(COMP_FIRMWARE
, "--->FirmwareCheckReady(): LoadStaus(%d),", LoadFWStatus
);
193 pFirmware
->FWStatus
= (FIRMWARE_8192S_STATUS
)LoadFWStatus
;
194 if( LoadFWStatus
== FW_STATUS_LOAD_IMEM
)
197 {//Polling IMEM code done.
198 CPUStatus
= read_nic_byte(dev
, TCR
);
199 if(CPUStatus
& IMEM_CODE_DONE
)
203 }while(PollingCnt
--);
204 if(!(CPUStatus
& IMEM_CHK_RPT
) || PollingCnt
<= 0)
206 RT_TRACE(COMP_ERR
, "FW_STATUS_LOAD_IMEM FAIL CPU, Status=%x\r\n", CPUStatus
);
210 else if( LoadFWStatus
== FW_STATUS_LOAD_EMEM
)
211 {//Check Put Code OK and Turn On CPU
213 {//Polling EMEM code done.
214 CPUStatus
= read_nic_byte(dev
, TCR
);
215 if(CPUStatus
& EMEM_CODE_DONE
)
219 }while(PollingCnt
--);
220 if(!(CPUStatus
& EMEM_CHK_RPT
))
222 RT_TRACE(COMP_ERR
, "FW_STATUS_LOAD_EMEM FAIL CPU, Status=%x\r\n", CPUStatus
);
227 rtStatus
= FirmwareEnableCPU(dev
);
228 if(rtStatus
!= RT_STATUS_SUCCESS
)
230 RT_TRACE(COMP_ERR
, "Enable CPU fail ! \n" );
234 else if( LoadFWStatus
== FW_STATUS_LOAD_DMEM
)
237 {//Polling DMEM code done
238 CPUStatus
= read_nic_byte(dev
, TCR
);
239 if(CPUStatus
& DMEM_CODE_DONE
)
243 }while(PollingCnt
--);
245 if(!(CPUStatus
& DMEM_CODE_DONE
))
247 RT_TRACE(COMP_ERR
, "Polling DMEM code done fail ! CPUStatus(%#x)\n", CPUStatus
);
251 RT_TRACE(COMP_FIRMWARE
, "DMEM code download success, CPUStatus(%#x)\n", CPUStatus
);
253 // PollingCnt = 100; // Set polling cycle to 10ms.
254 PollingCnt
= 10000; // Set polling cycle to 10ms.
257 {//Polling Load Firmware ready
258 CPUStatus
= read_nic_byte(dev
, TCR
);
259 if(CPUStatus
& FWRDY
)
263 }while(PollingCnt
--);
265 RT_TRACE(COMP_FIRMWARE
, "Polling Load Firmware ready, CPUStatus(%x)\n", CPUStatus
);
267 //if(!(CPUStatus & LOAD_FW_READY))
268 //if((CPUStatus & LOAD_FW_READY) != 0xff)
269 if((CPUStatus
& LOAD_FW_READY
) != LOAD_FW_READY
)
271 RT_TRACE(COMP_ERR
, "Polling Load Firmware ready fail ! CPUStatus(%x)\n", CPUStatus
);
276 // <Roger_Notes> USB interface will update reserved followings parameters later!!
281 // <Roger_Notes> If right here, we can set TCR/RCR to desired value
282 // and config MAC lookback mode to normal mode. 2008.08.28.
284 tmpU4b
= read_nic_dword(dev
,TCR
);
285 write_nic_dword(dev
, TCR
, (tmpU4b
&(~TCR_ICV
)));
287 tmpU4b
= read_nic_dword(dev
, RCR
);
288 write_nic_dword(dev
, RCR
,
289 (tmpU4b
|RCR_APPFCS
|RCR_APP_ICV
|RCR_APP_MIC
));
291 RT_TRACE(COMP_FIRMWARE
, "FirmwareCheckReady(): Current RCR settings(%#x)\n", tmpU4b
);
294 // Set to normal mode.
295 write_nic_byte(dev
, LBKMD_SEL
, LBK_NORMAL
);
299 RT_TRACE(COMP_FIRMWARE
, "<---FirmwareCheckReady(): LoadFWStatus(%d), rtStatus(%x)\n", LoadFWStatus
, rtStatus
);
300 return (rtStatus
== RT_STATUS_SUCCESS
) ? true:false;
304 // Description: This routine is to update the RF types in FW header partially.
306 // Created by Roger, 2008.12.24.
308 u8
FirmwareHeaderMapRfType(struct net_device
*dev
)
310 struct r8192_priv
*priv
= ieee80211_priv(dev
);
311 switch(priv
->rf_type
)
313 case RF_1T1R
: return 0x11;
314 case RF_1T2R
: return 0x12;
315 case RF_2T2R
: return 0x22;
316 case RF_2T2R_GREEN
: return 0x92;
318 RT_TRACE(COMP_INIT
, "Unknown RF type(%x)\n",priv
->rf_type
);
326 // Description: This routine is to update the private parts in FW header partially.
328 // Created by Roger, 2008.12.18.
330 void FirmwareHeaderPriveUpdate(struct net_device
*dev
, PRT_8192S_FIRMWARE_PRIV pFwPriv
)
332 struct r8192_priv
*priv
= ieee80211_priv(dev
);
333 // Update USB endpoint number for RQPN settings.
334 pFwPriv
->usb_ep_num
= priv
->EEPROMUsbEndPointNumber
; // endpoint number: 4, 6 and 11.
335 RT_TRACE(COMP_INIT
, "FirmwarePriveUpdate(): usb_ep_num(%#x)\n", pFwPriv
->usb_ep_num
);
337 // Update RF types for RATR settings.
338 pFwPriv
->rf_config
= FirmwareHeaderMapRfType(dev
);
343 bool FirmwareDownload92S(struct net_device
*dev
)
345 struct r8192_priv
*priv
= ieee80211_priv(dev
);
346 bool rtStatus
= true;
347 const char *pFwImageFileName
[1] = {"RTL8192SU/rtl8192sfw.bin"};
348 u8
*pucMappedFile
= NULL
;
349 u32 ulFileLength
, ulInitStep
= 0;
350 u8 FwHdrSize
= RT_8192S_FIRMWARE_HDR_SIZE
;
351 rt_firmware
*pFirmware
= priv
->pFirmware
;
352 u8 FwStatus
= FW_STATUS_INIT
;
353 PRT_8192S_FIRMWARE_HDR pFwHdr
= NULL
;
354 PRT_8192S_FIRMWARE_PRIV pFwPriv
= NULL
;
356 const struct firmware
*fw_entry
;
359 pFirmware
->FWStatus
= FW_STATUS_INIT
;
361 RT_TRACE(COMP_FIRMWARE
, " --->FirmwareDownload92S()\n");
364 //3 //<1> Open Image file, and map file to contineous memory if open file success.
365 //3 // or read image file from array. Default load from BIN file
367 priv
->firmware_source
= FW_SOURCE_IMG_FILE
;// We should decided by Reg.
369 switch( priv
->firmware_source
)
371 case FW_SOURCE_IMG_FILE
:
372 if(pFirmware
->szFwTmpBufferLen
== 0)
375 rc
= request_firmware(&fw_entry
, pFwImageFileName
[ulInitStep
],&priv
->udev
->dev
);//===>1
377 RT_TRACE(COMP_ERR
, "request firmware fail!\n");
378 goto DownloadFirmware_Fail
;
381 if(fw_entry
->size
> sizeof(pFirmware
->szFwTmpBuffer
))
383 RT_TRACE(COMP_ERR
, "img file size exceed the container buffer fail!\n");
384 release_firmware(fw_entry
);
385 goto DownloadFirmware_Fail
;
388 memcpy(pFirmware
->szFwTmpBuffer
,fw_entry
->data
,fw_entry
->size
);
389 pFirmware
->szFwTmpBufferLen
= fw_entry
->size
;
390 release_firmware(fw_entry
);
392 pucMappedFile
= pFirmware
->szFwTmpBuffer
;
393 file_length
= pFirmware
->szFwTmpBufferLen
;
395 //Retrieve FW header.
396 pFirmware
->pFwHeader
= (PRT_8192S_FIRMWARE_HDR
) pucMappedFile
;
397 pFwHdr
= pFirmware
->pFwHeader
;
398 RT_TRACE(COMP_FIRMWARE
,"signature:%x, version:%x, size:%x, imemsize:%x, sram size:%x\n", \
399 pFwHdr
->Signature
, pFwHdr
->Version
, pFwHdr
->DMEMSize
, \
400 pFwHdr
->IMG_IMEM_SIZE
, pFwHdr
->IMG_SRAM_SIZE
);
401 pFirmware
->FirmwareVersion
= byte(pFwHdr
->Version
,0);
402 if ((pFwHdr
->IMG_IMEM_SIZE
==0) || (pFwHdr
->IMG_IMEM_SIZE
> sizeof(pFirmware
->FwIMEM
)))
404 RT_TRACE(COMP_ERR
, "%s: memory for data image is less than IMEM required\n",\
406 goto DownloadFirmware_Fail
;
408 pucMappedFile
+=FwHdrSize
;
410 //Retrieve IMEM image.
411 memcpy(pFirmware
->FwIMEM
, pucMappedFile
, pFwHdr
->IMG_IMEM_SIZE
);
412 pFirmware
->FwIMEMLen
= pFwHdr
->IMG_IMEM_SIZE
;
415 if (pFwHdr
->IMG_SRAM_SIZE
> sizeof(pFirmware
->FwEMEM
))
417 RT_TRACE(COMP_ERR
, "%s: memory for data image is less than EMEM required\n",\
419 goto DownloadFirmware_Fail
;
421 pucMappedFile
+= pFirmware
->FwIMEMLen
;
423 /* Retriecve EMEM image */
424 memcpy(pFirmware
->FwEMEM
, pucMappedFile
, pFwHdr
->IMG_SRAM_SIZE
);//===>6
425 pFirmware
->FwEMEMLen
= pFwHdr
->IMG_SRAM_SIZE
;
432 case FW_SOURCE_HEADER_FILE
:
434 #define Rtl819XFwImageArray Rtl8192SUFwImgArray
435 //2008.11.10 Add by tynli.
436 pucMappedFile
= Rtl819XFwImageArray
;
437 ulFileLength
= ImgArrayLength
;
439 RT_TRACE(COMP_INIT
,"Fw download from header.\n");
440 /* Retrieve FW header*/
441 pFirmware
->pFwHeader
= (PRT_8192S_FIRMWARE_HDR
) pucMappedFile
;
442 pFwHdr
= pFirmware
->pFwHeader
;
443 RT_TRACE(COMP_FIRMWARE
,"signature:%x, version:%x, size:%x, imemsize:%x, sram size:%x\n", \
444 pFwHdr
->Signature
, pFwHdr
->Version
, pFwHdr
->DMEMSize
, \
445 pFwHdr
->IMG_IMEM_SIZE
, pFwHdr
->IMG_SRAM_SIZE
);
446 pFirmware
->FirmwareVersion
= byte(pFwHdr
->Version
,0);
448 if ((pFwHdr
->IMG_IMEM_SIZE
==0) || (pFwHdr
->IMG_IMEM_SIZE
> sizeof(pFirmware
->FwIMEM
)))
450 printk("FirmwareDownload92S(): memory for data image is less than IMEM required\n");
451 goto DownloadFirmware_Fail
;
453 pucMappedFile
+=FwHdrSize
;
454 //Retrieve IMEM image.
455 memcpy(pFirmware
->FwIMEM
, pucMappedFile
, pFwHdr
->IMG_IMEM_SIZE
);
456 pFirmware
->FwIMEMLen
= pFwHdr
->IMG_IMEM_SIZE
;
459 if (pFwHdr
->IMG_SRAM_SIZE
> sizeof(pFirmware
->FwEMEM
))
461 printk(" FirmwareDownload92S(): memory for data image is less than EMEM required\n");
462 goto DownloadFirmware_Fail
;
464 pucMappedFile
+= pFirmware
->FwIMEMLen
;
466 //Retriecve EMEM image.
467 memcpy(pFirmware
->FwEMEM
, pucMappedFile
, pFwHdr
->IMG_SRAM_SIZE
);
468 pFirmware
->FwEMEMLen
= pFwHdr
->IMG_SRAM_SIZE
;
476 FwStatus
= FirmwareGetNextStatus(pFirmware
->FWStatus
);
477 while(FwStatus
!= FW_STATUS_READY
)
479 // Image buffer redirection.
482 case FW_STATUS_LOAD_IMEM
:
483 pucMappedFile
= pFirmware
->FwIMEM
;
484 ulFileLength
= pFirmware
->FwIMEMLen
;
487 case FW_STATUS_LOAD_EMEM
:
488 pucMappedFile
= pFirmware
->FwEMEM
;
489 ulFileLength
= pFirmware
->FwEMEMLen
;
492 case FW_STATUS_LOAD_DMEM
:
493 /* <Roger_Notes> Partial update the content of header private. 2008.12.18 */
494 pFwHdr
= pFirmware
->pFwHeader
;
495 pFwPriv
= (PRT_8192S_FIRMWARE_PRIV
)&pFwHdr
->FWPriv
;
496 FirmwareHeaderPriveUpdate(dev
, pFwPriv
);
497 pucMappedFile
= (u8
*)(pFirmware
->pFwHeader
)+RT_8192S_FIRMWARE_HDR_EXCLUDE_PRI_SIZE
;
498 ulFileLength
= FwHdrSize
-RT_8192S_FIRMWARE_HDR_EXCLUDE_PRI_SIZE
;
502 RT_TRACE(COMP_ERR
, "Unexpected Download step!!\n");
503 goto DownloadFirmware_Fail
;
508 //3// <2> Download image file
510 rtStatus
= FirmwareDownloadCode(dev
, pucMappedFile
, ulFileLength
);
514 RT_TRACE(COMP_ERR
, "FirmwareDownloadCode() fail ! \n" );
515 goto DownloadFirmware_Fail
;
519 //3// <3> Check whether load FW process is ready
521 rtStatus
= FirmwareCheckReady(dev
, FwStatus
);
525 RT_TRACE(COMP_ERR
, "FirmwareDownloadCode() fail ! \n");
526 goto DownloadFirmware_Fail
;
529 FwStatus
= FirmwareGetNextStatus(pFirmware
->FWStatus
);
532 RT_TRACE(COMP_FIRMWARE
, "Firmware Download Success!!\n");
535 DownloadFirmware_Fail
:
536 RT_TRACE(COMP_ERR
, "Firmware Download Fail!!%x\n",read_nic_word(dev
, TCR
));