/************************************************************************************************** * Procedure: Init boot code/firmware code/data session * * Description: This routine will intialize firmware. If any error occurs during the initialization * process, the routine shall terminate immediately and return fail. * NIC driver should call NdisOpenFile only from MiniportInitialize. * * Arguments: The pointer of the adapter * Returns: * NDIS_STATUS_FAILURE - the following initialization process should be terminated * NDIS_STATUS_SUCCESS - if firmware initialization process success **************************************************************************************************/ //#include "ieee80211.h" #if defined(RTL8192SE)||defined(RTL8192SU) #include "r8192U.h" #include "r8192S_firmware.h" #include #ifdef RTL8192SU #include "r8192S_hw.h" #include "r8192SU_HWImg.h" //#include "r8192S_FwImgDTM.h" #else //#include "r8192U_hw.h" #include "r8192xU_firmware_img.h" #endif #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) #include #endif #define byte(x,n) ( (x >> (8 * n)) & 0xff ) // // Description: This routine will intialize firmware. If any error occurs during the initialization // process, the routine shall terminate immediately and return fail. // // Arguments: The pointer of the adapter // Code address (Virtual address, should fill descriptor with physical address) // Code size // Created by Roger, 2008.04.10. // bool FirmwareDownloadCode(struct net_device *dev, u8 * code_virtual_address,u32 buffer_len) { struct r8192_priv *priv = ieee80211_priv(dev); bool rt_status = true; u16 frag_threshold = MAX_FIRMWARE_CODE_SIZE; //Fragmentation might be required in 90/92 but not in 92S u16 frag_length, frag_offset = 0; struct sk_buff *skb; unsigned char *seg_ptr; cb_desc *tcb_desc; u8 bLastIniPkt = 0; u16 ExtraDescOffset = 0; #ifdef RTL8192SE fw_SetRQPN(dev); // For 92SE only #endif RT_TRACE(COMP_FIRMWARE, "--->FirmwareDownloadCode()\n" ); //MAX_TRANSMIT_BUFFER_SIZE if(buffer_len >= MAX_FIRMWARE_CODE_SIZE-USB_HWDESC_HEADER_LEN) { RT_TRACE(COMP_ERR, "Size over MAX_FIRMWARE_CODE_SIZE! \n"); goto cmdsend_downloadcode_fail; } ExtraDescOffset = USB_HWDESC_HEADER_LEN; do { if((buffer_len-frag_offset) > frag_threshold) { frag_length = frag_threshold + ExtraDescOffset; } else { frag_length = (u16)(buffer_len - frag_offset + ExtraDescOffset); bLastIniPkt = 1; } /* Allocate skb buffer to contain firmware info and tx descriptor info. */ skb = dev_alloc_skb(frag_length); memcpy((unsigned char *)(skb->cb),&dev,sizeof(dev)); tcb_desc = (cb_desc*)(skb->cb + MAX_DEV_ADDR_SIZE); tcb_desc->queue_index = TXCMD_QUEUE; tcb_desc->bCmdOrInit = DESC_PACKET_TYPE_INIT; tcb_desc->bLastIniPkt = bLastIniPkt; skb_reserve(skb, ExtraDescOffset); seg_ptr = (u8 *)skb_put(skb, (u32)(frag_length-ExtraDescOffset)); memcpy(seg_ptr, code_virtual_address+frag_offset, (u32)(frag_length-ExtraDescOffset)); tcb_desc->txbuf_size= frag_length; if(!priv->ieee80211->check_nic_enough_desc(dev,tcb_desc->queue_index)|| (!skb_queue_empty(&priv->ieee80211->skb_waitQ[tcb_desc->queue_index]))||\ (priv->ieee80211->queue_stop) ) { RT_TRACE(COMP_FIRMWARE,"=====================================================> tx full!\n"); skb_queue_tail(&priv->ieee80211->skb_waitQ[tcb_desc->queue_index], skb); } else { priv->ieee80211->softmac_hard_start_xmit(skb,dev); } frag_offset += (frag_length - ExtraDescOffset); }while(frag_offset < buffer_len); return rt_status ; cmdsend_downloadcode_fail: rt_status = false; RT_TRACE(COMP_ERR, "CmdSendDownloadCode fail !!\n"); return rt_status; } #ifdef RTL8192SE static void fw_SetRQPN(struct net_device *dev) { // Only for 92SE HW bug, we have to set RAPN before every FW download // We can remove the code later. write_nic_dword(dev, RQPN, 0xffffffff); write_nic_dword(dev, RQPN+4, 0xffffffff); write_nic_byte(dev, RQPN+8, 0xff); write_nic_byte(dev, RQPN+0xB, 0x80); //#if ((HAL_CODE_BASE == RTL8192_S) && (PLATFORM != PLATFORM_WINDOWS_USB)) } /* fw_SetRQPN */ #endif RT_STATUS FirmwareEnableCPU(struct net_device *dev) { RT_STATUS rtStatus = RT_STATUS_SUCCESS; u8 tmpU1b, CPUStatus = 0; u16 tmpU2b; u32 iCheckTime = 200; RT_TRACE(COMP_FIRMWARE, "-->FirmwareEnableCPU()\n" ); #ifdef RTL8192SE fw_SetRQPN(dev); // For 92SE only #endif // Enable CPU. tmpU1b = read_nic_byte(dev, SYS_CLKR); write_nic_byte(dev, SYS_CLKR, (tmpU1b|SYS_CPU_CLKSEL)); //AFE source tmpU2b = read_nic_word(dev, SYS_FUNC_EN); write_nic_word(dev, SYS_FUNC_EN, (tmpU2b|FEN_CPUEN)); //Polling IMEM Ready after CPU has refilled. do { CPUStatus = read_nic_byte(dev, TCR); if(CPUStatus& IMEM_RDY) { RT_TRACE(COMP_FIRMWARE, "IMEM Ready after CPU has refilled.\n"); break; } //usleep(100); udelay(100); }while(iCheckTime--); if(!(CPUStatus & IMEM_RDY)) return RT_STATUS_FAILURE; RT_TRACE(COMP_FIRMWARE, "<--FirmwareEnableCPU(): rtStatus(%#x)\n", rtStatus); return rtStatus; } FIRMWARE_8192S_STATUS FirmwareGetNextStatus(FIRMWARE_8192S_STATUS FWCurrentStatus) { FIRMWARE_8192S_STATUS NextFWStatus = 0; switch(FWCurrentStatus) { case FW_STATUS_INIT: NextFWStatus = FW_STATUS_LOAD_IMEM; break; case FW_STATUS_LOAD_IMEM: NextFWStatus = FW_STATUS_LOAD_EMEM; break; case FW_STATUS_LOAD_EMEM: NextFWStatus = FW_STATUS_LOAD_DMEM; break; case FW_STATUS_LOAD_DMEM: NextFWStatus = FW_STATUS_READY; break; default: RT_TRACE(COMP_ERR,"Invalid FW Status(%#x)!!\n", FWCurrentStatus); break; } return NextFWStatus; } bool FirmwareCheckReady(struct net_device *dev, u8 LoadFWStatus) { struct r8192_priv *priv = ieee80211_priv(dev); RT_STATUS rtStatus = RT_STATUS_SUCCESS; rt_firmware *pFirmware = priv->pFirmware; int PollingCnt = 1000; //u8 tmpU1b, CPUStatus = 0; u8 CPUStatus = 0; u32 tmpU4b; //bool bOrgIMREnable; RT_TRACE(COMP_FIRMWARE, "--->FirmwareCheckReady(): LoadStaus(%d),", LoadFWStatus); pFirmware->FWStatus = (FIRMWARE_8192S_STATUS)LoadFWStatus; if( LoadFWStatus == FW_STATUS_LOAD_IMEM) { do {//Polling IMEM code done. CPUStatus = read_nic_byte(dev, TCR); if(CPUStatus& IMEM_CODE_DONE) break; udelay(5); }while(PollingCnt--); if(!(CPUStatus & IMEM_CHK_RPT) || PollingCnt <= 0) { RT_TRACE(COMP_ERR, "FW_STATUS_LOAD_IMEM FAIL CPU, Status=%x\r\n", CPUStatus); return false; } } else if( LoadFWStatus == FW_STATUS_LOAD_EMEM) {//Check Put Code OK and Turn On CPU do {//Polling EMEM code done. CPUStatus = read_nic_byte(dev, TCR); if(CPUStatus& EMEM_CODE_DONE) break; udelay(5); }while(PollingCnt--); if(!(CPUStatus & EMEM_CHK_RPT)) { RT_TRACE(COMP_ERR, "FW_STATUS_LOAD_EMEM FAIL CPU, Status=%x\r\n", CPUStatus); return false; } // Turn On CPU rtStatus = FirmwareEnableCPU(dev); if(rtStatus != RT_STATUS_SUCCESS) { RT_TRACE(COMP_ERR, "Enable CPU fail ! \n" ); return false; } } else if( LoadFWStatus == FW_STATUS_LOAD_DMEM) { do {//Polling DMEM code done CPUStatus = read_nic_byte(dev, TCR); if(CPUStatus& DMEM_CODE_DONE) break; udelay(5); }while(PollingCnt--); if(!(CPUStatus & DMEM_CODE_DONE)) { RT_TRACE(COMP_ERR, "Polling DMEM code done fail ! CPUStatus(%#x)\n", CPUStatus); return false; } RT_TRACE(COMP_FIRMWARE, "DMEM code download success, CPUStatus(%#x)\n", CPUStatus); // PollingCnt = 100; // Set polling cycle to 10ms. PollingCnt = 10000; // Set polling cycle to 10ms. do {//Polling Load Firmware ready CPUStatus = read_nic_byte(dev, TCR); if(CPUStatus & FWRDY) break; udelay(100); }while(PollingCnt--); RT_TRACE(COMP_FIRMWARE, "Polling Load Firmware ready, CPUStatus(%x)\n", CPUStatus); //if(!(CPUStatus & LOAD_FW_READY)) //if((CPUStatus & LOAD_FW_READY) != 0xff) if((CPUStatus & LOAD_FW_READY) != LOAD_FW_READY) { RT_TRACE(COMP_ERR, "Polling Load Firmware ready fail ! CPUStatus(%x)\n", CPUStatus); return false; } // // USB interface will update reserved followings parameters later!! // 2008.08.28. // #ifdef RTL8192SE //write_nic_dword(dev, RQPN, 0x10101010); //write_nic_byte(dev, 0xAB, 0x80); #endif // // If right here, we can set TCR/RCR to desired value // and config MAC lookback mode to normal mode. 2008.08.28. // tmpU4b = read_nic_dword(dev,TCR); write_nic_dword(dev, TCR, (tmpU4b&(~TCR_ICV))); tmpU4b = read_nic_dword(dev, RCR); write_nic_dword(dev, RCR, (tmpU4b|RCR_APPFCS|RCR_APP_ICV|RCR_APP_MIC)); RT_TRACE(COMP_FIRMWARE, "FirmwareCheckReady(): Current RCR settings(%#x)\n", tmpU4b); #if (defined (RTL8192SU_FPGA_2MAC_VERIFICATION) ||defined (RTL8192SU_ASIC_VERIFICATION)) #ifdef NOT_YET //YJ,TMP priv->TransmitConfig = read_nic_dword(dev, TCR); RT_TRACE(COMP_FIRMWARE, "FirmwareCheckReady(): Current TCR settings(%x)\n", priv->TransmitConfig); pHalData->FwRsvdTxPageCfg = read_nic_byte(dev, FW_RSVD_PG_CRTL); #endif #endif // Set to normal mode. write_nic_byte(dev, LBKMD_SEL, LBK_NORMAL); } RT_TRACE(COMP_FIRMWARE, "<---FirmwareCheckReady(): LoadFWStatus(%d), rtStatus(%x)\n", LoadFWStatus, rtStatus); return (rtStatus == RT_STATUS_SUCCESS) ? true:false; } // // Description: This routine is to update the RF types in FW header partially. // // Created by Roger, 2008.12.24. // u8 FirmwareHeaderMapRfType(struct net_device *dev) { struct r8192_priv *priv = ieee80211_priv(dev); switch(priv->rf_type) { case RF_1T1R: return 0x11; case RF_1T2R: return 0x12; case RF_2T2R: return 0x22; case RF_2T2R_GREEN: return 0x92; default: RT_TRACE(COMP_INIT, "Unknown RF type(%x)\n",priv->rf_type); break; } return 0x22; } // // Description: This routine is to update the private parts in FW header partially. // // Created by Roger, 2008.12.18. // void FirmwareHeaderPriveUpdate(struct net_device *dev, PRT_8192S_FIRMWARE_PRIV pFwPriv) { struct r8192_priv *priv = ieee80211_priv(dev); #ifdef RTL8192SU // Update USB endpoint number for RQPN settings. pFwPriv->usb_ep_num = priv->EEPROMUsbEndPointNumber; // endpoint number: 4, 6 and 11. RT_TRACE(COMP_INIT, "FirmwarePriveUpdate(): usb_ep_num(%#x)\n", pFwPriv->usb_ep_num); #endif // Update RF types for RATR settings. pFwPriv->rf_config = FirmwareHeaderMapRfType(dev); } bool FirmwareDownload92S(struct net_device *dev) { struct r8192_priv *priv = ieee80211_priv(dev); bool rtStatus = true; const char *pFwImageFileName[1] = {"RTL8192SU/rtl8192sfw.bin"}; u8 *pucMappedFile = NULL; u32 ulFileLength, ulInitStep = 0; u8 FwHdrSize = RT_8192S_FIRMWARE_HDR_SIZE; rt_firmware *pFirmware = priv->pFirmware; u8 FwStatus = FW_STATUS_INIT; PRT_8192S_FIRMWARE_HDR pFwHdr = NULL; PRT_8192S_FIRMWARE_PRIV pFwPriv = NULL; int rc; const struct firmware *fw_entry; u32 file_length = 0; pFirmware->FWStatus = FW_STATUS_INIT; RT_TRACE(COMP_FIRMWARE, " --->FirmwareDownload92S()\n"); //3// //3 //<1> Open Image file, and map file to contineous memory if open file success. //3 // or read image file from array. Default load from BIN file //3// #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) priv->firmware_source = FW_SOURCE_HEADER_FILE; #else priv->firmware_source = FW_SOURCE_IMG_FILE;// We should decided by Reg. #endif switch( priv->firmware_source ) { case FW_SOURCE_IMG_FILE: #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) if(pFirmware->szFwTmpBufferLen == 0) { rc = request_firmware(&fw_entry, pFwImageFileName[ulInitStep],&priv->udev->dev);//===>1 if(rc < 0 ) { RT_TRACE(COMP_ERR, "request firmware fail!\n"); goto DownloadFirmware_Fail; } if(fw_entry->size > sizeof(pFirmware->szFwTmpBuffer)) { RT_TRACE(COMP_ERR, "img file size exceed the container buffer fail!\n"); release_firmware(fw_entry); goto DownloadFirmware_Fail; } memcpy(pFirmware->szFwTmpBuffer,fw_entry->data,fw_entry->size); pFirmware->szFwTmpBufferLen = fw_entry->size; release_firmware(fw_entry); pucMappedFile = pFirmware->szFwTmpBuffer; file_length = pFirmware->szFwTmpBufferLen; //Retrieve FW header. pFirmware->pFwHeader = (PRT_8192S_FIRMWARE_HDR) pucMappedFile; pFwHdr = pFirmware->pFwHeader; RT_TRACE(COMP_FIRMWARE,"signature:%x, version:%x, size:%x, imemsize:%x, sram size:%x\n", \ pFwHdr->Signature, pFwHdr->Version, pFwHdr->DMEMSize, \ pFwHdr->IMG_IMEM_SIZE, pFwHdr->IMG_SRAM_SIZE); pFirmware->FirmwareVersion = byte(pFwHdr->Version ,0); if ((pFwHdr->IMG_IMEM_SIZE==0) || (pFwHdr->IMG_IMEM_SIZE > sizeof(pFirmware->FwIMEM))) { RT_TRACE(COMP_ERR, "%s: memory for data image is less than IMEM required\n",\ __FUNCTION__); goto DownloadFirmware_Fail; } else { pucMappedFile+=FwHdrSize; //Retrieve IMEM image. memcpy(pFirmware->FwIMEM, pucMappedFile, pFwHdr->IMG_IMEM_SIZE); pFirmware->FwIMEMLen = pFwHdr->IMG_IMEM_SIZE; } if (pFwHdr->IMG_SRAM_SIZE > sizeof(pFirmware->FwEMEM)) { RT_TRACE(COMP_ERR, "%s: memory for data image is less than EMEM required\n",\ __FUNCTION__); goto DownloadFirmware_Fail; } else { pucMappedFile += pFirmware->FwIMEMLen; /* Retriecve EMEM image */ memcpy(pFirmware->FwEMEM, pucMappedFile, pFwHdr->IMG_SRAM_SIZE);//===>6 pFirmware->FwEMEMLen = pFwHdr->IMG_SRAM_SIZE; } } #endif break; case FW_SOURCE_HEADER_FILE: #if 1 #define Rtl819XFwImageArray Rtl8192SUFwImgArray //2008.11.10 Add by tynli. pucMappedFile = Rtl819XFwImageArray; ulFileLength = ImgArrayLength; RT_TRACE(COMP_INIT,"Fw download from header.\n"); /* Retrieve FW header*/ pFirmware->pFwHeader = (PRT_8192S_FIRMWARE_HDR) pucMappedFile; pFwHdr = pFirmware->pFwHeader; RT_TRACE(COMP_FIRMWARE,"signature:%x, version:%x, size:%x, imemsize:%x, sram size:%x\n", \ pFwHdr->Signature, pFwHdr->Version, pFwHdr->DMEMSize, \ pFwHdr->IMG_IMEM_SIZE, pFwHdr->IMG_SRAM_SIZE); pFirmware->FirmwareVersion = byte(pFwHdr->Version ,0); if ((pFwHdr->IMG_IMEM_SIZE==0) || (pFwHdr->IMG_IMEM_SIZE > sizeof(pFirmware->FwIMEM))) { printk("FirmwareDownload92S(): memory for data image is less than IMEM required\n"); goto DownloadFirmware_Fail; } else { pucMappedFile+=FwHdrSize; //Retrieve IMEM image. memcpy(pFirmware->FwIMEM, pucMappedFile, pFwHdr->IMG_IMEM_SIZE); pFirmware->FwIMEMLen = pFwHdr->IMG_IMEM_SIZE; } if (pFwHdr->IMG_SRAM_SIZE > sizeof(pFirmware->FwEMEM)) { printk(" FirmwareDownload92S(): memory for data image is less than EMEM required\n"); goto DownloadFirmware_Fail; } else { pucMappedFile+= pFirmware->FwIMEMLen; //Retriecve EMEM image. memcpy(pFirmware->FwEMEM, pucMappedFile, pFwHdr->IMG_SRAM_SIZE); pFirmware->FwEMEMLen = pFwHdr->IMG_SRAM_SIZE; } #endif break; default: break; } FwStatus = FirmwareGetNextStatus(pFirmware->FWStatus); while(FwStatus!= FW_STATUS_READY) { // Image buffer redirection. switch(FwStatus) { case FW_STATUS_LOAD_IMEM: pucMappedFile = pFirmware->FwIMEM; ulFileLength = pFirmware->FwIMEMLen; break; case FW_STATUS_LOAD_EMEM: pucMappedFile = pFirmware->FwEMEM; ulFileLength = pFirmware->FwEMEMLen; break; case FW_STATUS_LOAD_DMEM: /* Partial update the content of header private. 2008.12.18 */ pFwHdr = pFirmware->pFwHeader; pFwPriv = (PRT_8192S_FIRMWARE_PRIV)&pFwHdr->FWPriv; FirmwareHeaderPriveUpdate(dev, pFwPriv); pucMappedFile = (u8*)(pFirmware->pFwHeader)+RT_8192S_FIRMWARE_HDR_EXCLUDE_PRI_SIZE; ulFileLength = FwHdrSize-RT_8192S_FIRMWARE_HDR_EXCLUDE_PRI_SIZE; break; default: RT_TRACE(COMP_ERR, "Unexpected Download step!!\n"); goto DownloadFirmware_Fail; break; } //3// //3// <2> Download image file //3 // rtStatus = FirmwareDownloadCode(dev, pucMappedFile, ulFileLength); if(rtStatus != true) { RT_TRACE(COMP_ERR, "FirmwareDownloadCode() fail ! \n" ); goto DownloadFirmware_Fail; } //3// //3// <3> Check whether load FW process is ready //3 // rtStatus = FirmwareCheckReady(dev, FwStatus); if(rtStatus != true) { RT_TRACE(COMP_ERR, "FirmwareDownloadCode() fail ! \n"); goto DownloadFirmware_Fail; } FwStatus = FirmwareGetNextStatus(pFirmware->FWStatus); } RT_TRACE(COMP_FIRMWARE, "Firmware Download Success!!\n"); return rtStatus; DownloadFirmware_Fail: RT_TRACE(COMP_ERR, "Firmware Download Fail!!%x\n",read_nic_word(dev, TCR)); rtStatus = false; return rtStatus; } #else void firmware_init_param(struct net_device *dev) { struct r8192_priv *priv = ieee80211_priv(dev); rt_firmware *pfirmware = priv->pFirmware; pfirmware->cmdpacket_frag_thresold = GET_COMMAND_PACKET_FRAG_THRESHOLD(MAX_TRANSMIT_BUFFER_SIZE); } /* * segment the img and use the ptr and length to remember info on each segment * */ bool fw_download_code(struct net_device *dev, u8 *code_virtual_address, u32 buffer_len) { struct r8192_priv *priv = ieee80211_priv(dev); bool rt_status = true; //u16 frag_threshold; u16 frag_length, frag_offset = 0; //u16 total_size; int i; //rt_firmware *pfirmware = priv->pFirmware; struct sk_buff *skb; unsigned char *seg_ptr; cb_desc *tcb_desc; u8 bLastIniPkt; #ifdef RTL8192SE fw_SetRQPN(dev); // For 92SE only #endif #ifndef RTL8192SU if(buffer_len >= 64000-USB_HWDESC_HEADER_LEN) { return rt_status; } firmware_init_param(dev); //Fragmentation might be required frag_threshold = pfirmware->cmdpacket_frag_thresold; #endif do { #ifndef RTL8192SU if((buffer_len - frag_offset) > frag_threshold) { frag_length = frag_threshold ; bLastIniPkt = 0; } else #endif { frag_length = buffer_len - frag_offset; bLastIniPkt = 1; } /* Allocate skb buffer to contain firmware info and tx descriptor info * add 4 to avoid packet appending overflow. * */ #ifdef RTL8192U skb = dev_alloc_skb(USB_HWDESC_HEADER_LEN + frag_length + 4); #else skb = dev_alloc_skb(frag_length + 4); #endif memcpy((unsigned char *)(skb->cb),&dev,sizeof(dev)); tcb_desc = (cb_desc*)(skb->cb + MAX_DEV_ADDR_SIZE); tcb_desc->queue_index = TXCMD_QUEUE; tcb_desc->bCmdOrInit = DESC_PACKET_TYPE_INIT; tcb_desc->bLastIniPkt = bLastIniPkt; #ifdef RTL8192U skb_reserve(skb, USB_HWDESC_HEADER_LEN); #endif seg_ptr = skb->data; /* * Transform from little endian to big endian * and pending zero */ for(i=0 ; i < frag_length; i+=4) { *seg_ptr++ = ((i+0)txbuf_size= (u16)i; skb_put(skb, i); if(!priv->ieee80211->check_nic_enough_desc(dev,tcb_desc->queue_index)|| (!skb_queue_empty(&priv->ieee80211->skb_waitQ[tcb_desc->queue_index]))||\ (priv->ieee80211->queue_stop) ) { RT_TRACE(COMP_FIRMWARE,"=====================================================> tx full!\n"); skb_queue_tail(&priv->ieee80211->skb_waitQ[tcb_desc->queue_index], skb); } else { priv->ieee80211->softmac_hard_start_xmit(skb,dev); } code_virtual_address += frag_length; frag_offset += frag_length; }while(frag_offset < buffer_len); return rt_status; #if 0 cmdsend_downloadcode_fail: rt_status = false; RT_TRACE(COMP_ERR, "CmdSendDownloadCode fail !!\n"); return rt_status; #endif } bool fwSendNullPacket( struct net_device *dev, u32 Length ) { bool rtStatus = true; struct r8192_priv *priv = ieee80211_priv(dev); struct sk_buff *skb; cb_desc *tcb_desc; unsigned char *ptr_buf; bool bLastInitPacket = false; //PlatformAcquireSpinLock(dev, RT_TX_SPINLOCK); //Get TCB and local buffer from common pool. (It is shared by CmdQ, MgntQ, and USB coalesce DataQ) skb = dev_alloc_skb(Length+ 4); memcpy((unsigned char *)(skb->cb),&dev,sizeof(dev)); tcb_desc = (cb_desc*)(skb->cb + MAX_DEV_ADDR_SIZE); tcb_desc->queue_index = TXCMD_QUEUE; tcb_desc->bCmdOrInit = DESC_PACKET_TYPE_INIT; tcb_desc->bLastIniPkt = bLastInitPacket; ptr_buf = skb_put(skb, Length); memset(ptr_buf,0,Length); tcb_desc->txbuf_size= (u16)Length; if(!priv->ieee80211->check_nic_enough_desc(dev,tcb_desc->queue_index)|| (!skb_queue_empty(&priv->ieee80211->skb_waitQ[tcb_desc->queue_index]))||\ (priv->ieee80211->queue_stop) ) { RT_TRACE(COMP_FIRMWARE,"===================NULL packet==================================> tx full!\n"); skb_queue_tail(&priv->ieee80211->skb_waitQ[tcb_desc->queue_index], skb); } else { priv->ieee80211->softmac_hard_start_xmit(skb,dev); } //PlatformReleaseSpinLock(dev, RT_TX_SPINLOCK); return rtStatus; } //----------------------------------------------------------------------------- // Procedure: Check whether main code is download OK. If OK, turn on CPU // // Description: CPU register locates in different page against general register. // Switch to CPU register in the begin and switch back before return // // // Arguments: The pointer of the dev // // Returns: // NDIS_STATUS_FAILURE - the following initialization process should be terminated // NDIS_STATUS_SUCCESS - if firmware initialization process success //----------------------------------------------------------------------------- bool CPUcheck_maincodeok_turnonCPU(struct net_device *dev) { bool rt_status = true; int check_putcodeOK_time = 200000, check_bootOk_time = 200000; u32 CPU_status = 0; /* Check whether put code OK */ do { CPU_status = read_nic_dword(dev, CPU_GEN); if(CPU_status&CPU_GEN_PUT_CODE_OK) break; }while(check_putcodeOK_time--); if(!(CPU_status&CPU_GEN_PUT_CODE_OK)) { RT_TRACE(COMP_ERR, "Download Firmware: Put code fail!\n"); goto CPUCheckMainCodeOKAndTurnOnCPU_Fail; } else { RT_TRACE(COMP_FIRMWARE, "Download Firmware: Put code ok!\n"); } /* Turn On CPU */ CPU_status = read_nic_dword(dev, CPU_GEN); write_nic_byte(dev, CPU_GEN, (u8)((CPU_status|CPU_GEN_PWR_STB_CPU)&0xff)); mdelay(1000); /* Check whether CPU boot OK */ do { CPU_status = read_nic_dword(dev, CPU_GEN); if(CPU_status&CPU_GEN_BOOT_RDY) break; }while(check_bootOk_time--); if(!(CPU_status&CPU_GEN_BOOT_RDY)) { goto CPUCheckMainCodeOKAndTurnOnCPU_Fail; } else { RT_TRACE(COMP_FIRMWARE, "Download Firmware: Boot ready!\n"); } return rt_status; CPUCheckMainCodeOKAndTurnOnCPU_Fail: RT_TRACE(COMP_ERR, "ERR in %s()\n", __FUNCTION__); rt_status = FALSE; return rt_status; } bool CPUcheck_firmware_ready(struct net_device *dev) { bool rt_status = true; int check_time = 200000; u32 CPU_status = 0; /* Check Firmware Ready */ do { CPU_status = read_nic_dword(dev, CPU_GEN); if(CPU_status&CPU_GEN_FIRM_RDY) break; }while(check_time--); if(!(CPU_status&CPU_GEN_FIRM_RDY)) goto CPUCheckFirmwareReady_Fail; else RT_TRACE(COMP_FIRMWARE, "Download Firmware: Firmware ready!\n"); return rt_status; CPUCheckFirmwareReady_Fail: RT_TRACE(COMP_ERR, "ERR in %s()\n", __FUNCTION__); rt_status = false; return rt_status; } bool init_firmware(struct net_device *dev) { struct r8192_priv *priv = ieee80211_priv(dev); bool rt_status = TRUE; u8 *firmware_img_buf[3] = { &rtl8190_fwboot_array[0], &rtl8190_fwmain_array[0], &rtl8190_fwdata_array[0]}; u32 firmware_img_len[3] = { sizeof(rtl8190_fwboot_array), sizeof(rtl8190_fwmain_array), sizeof(rtl8190_fwdata_array)}; u32 file_length = 0; u8 *mapped_file = NULL; u32 init_step = 0; opt_rst_type_e rst_opt = OPT_SYSTEM_RESET; firmware_init_step_e starting_state = FW_INIT_STEP0_BOOT; rt_firmware *pfirmware = priv->pFirmware; const struct firmware *fw_entry; const char *fw_name[3] = { "RTL8192U/boot.img", "RTL8192U/main.img", "RTL8192U/data.img"}; int rc; RT_TRACE(COMP_FIRMWARE, " PlatformInitFirmware()==>\n"); if (pfirmware->firmware_status == FW_STATUS_0_INIT ) { /* it is called by reset */ rst_opt = OPT_SYSTEM_RESET; starting_state = FW_INIT_STEP0_BOOT; // TODO: system reset }else if(pfirmware->firmware_status == FW_STATUS_5_READY) { /* it is called by Initialize */ rst_opt = OPT_FIRMWARE_RESET; starting_state = FW_INIT_STEP2_DATA; }else { RT_TRACE(COMP_FIRMWARE, "PlatformInitFirmware: undefined firmware state\n"); } /* * Download boot, main, and data image for System reset. * Download data image for firmware reseta */ #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) priv->firmware_source = FW_SOURCE_HEADER_FILE; #else priv->firmware_source = FW_SOURCE_IMG_FILE; #endif for(init_step = starting_state; init_step <= FW_INIT_STEP2_DATA; init_step++) { /* * Open Image file, and map file to contineous memory if open file success. * or read image file from array. Default load from IMG file */ if(rst_opt == OPT_SYSTEM_RESET) { switch(priv->firmware_source) { case FW_SOURCE_IMG_FILE: #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) rc = request_firmware(&fw_entry, fw_name[init_step],&priv->udev->dev); if(rc < 0 ) { RT_TRACE(COMP_ERR, "request firmware fail!\n"); goto download_firmware_fail; } if(fw_entry->size > sizeof(pfirmware->firmware_buf)) { RT_TRACE(COMP_ERR, "img file size exceed the container buffer fail!\n"); goto download_firmware_fail; } if(init_step != FW_INIT_STEP1_MAIN) { memcpy(pfirmware->firmware_buf,fw_entry->data,fw_entry->size); mapped_file = pfirmware->firmware_buf; file_length = fw_entry->size; } else { #ifdef RTL8190P memcpy(pfirmware->firmware_buf,fw_entry->data,fw_entry->size); mapped_file = pfirmware->firmware_buf; file_length = fw_entry->size; #else memset(pfirmware->firmware_buf,0,128); memcpy(&pfirmware->firmware_buf[128],fw_entry->data,fw_entry->size); mapped_file = pfirmware->firmware_buf; file_length = fw_entry->size + 128; #endif } pfirmware->firmware_buf_size = file_length; #endif break; case FW_SOURCE_HEADER_FILE: mapped_file = firmware_img_buf[init_step]; file_length = firmware_img_len[init_step]; if(init_step == FW_INIT_STEP2_DATA) { memcpy(pfirmware->firmware_buf, mapped_file, file_length); pfirmware->firmware_buf_size = file_length; } break; default: break; } }else if(rst_opt == OPT_FIRMWARE_RESET ) { /* we only need to download data.img here */ mapped_file = pfirmware->firmware_buf; file_length = pfirmware->firmware_buf_size; } /* Download image file */ /* The firmware download process is just as following, * 1. that is each packet will be segmented and inserted to the wait queue. * 2. each packet segment will be put in the skb_buff packet. * 3. each skb_buff packet data content will already include the firmware info * and Tx descriptor info * */ rt_status = fw_download_code(dev,mapped_file,file_length); #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) if(rst_opt == OPT_SYSTEM_RESET) { release_firmware(fw_entry); } #endif if(rt_status != TRUE) { goto download_firmware_fail; } switch(init_step) { case FW_INIT_STEP0_BOOT: /* Download boot * initialize command descriptor. * will set polling bit when firmware code is also configured */ pfirmware->firmware_status = FW_STATUS_1_MOVE_BOOT_CODE; #ifdef RTL8190P // To initialize IMEM, CPU move code from 0x80000080, hence, we send 0x80 byte packet rt_status = fwSendNullPacket(dev, RTL8190_CPU_START_OFFSET); if(rt_status != true) { RT_TRACE(COMP_INIT, "fwSendNullPacket() fail ! \n"); goto download_firmware_fail; } #endif //mdelay(1000); /* * To initialize IMEM, CPU move code from 0x80000080, * hence, we send 0x80 byte packet */ break; case FW_INIT_STEP1_MAIN: /* Download firmware code. Wait until Boot Ready and Turn on CPU */ pfirmware->firmware_status = FW_STATUS_2_MOVE_MAIN_CODE; /* Check Put Code OK and Turn On CPU */ rt_status = CPUcheck_maincodeok_turnonCPU(dev); if(rt_status != TRUE) { RT_TRACE(COMP_ERR, "CPUcheck_maincodeok_turnonCPU fail!\n"); goto download_firmware_fail; } pfirmware->firmware_status = FW_STATUS_3_TURNON_CPU; break; case FW_INIT_STEP2_DATA: /* download initial data code */ pfirmware->firmware_status = FW_STATUS_4_MOVE_DATA_CODE; mdelay(1); rt_status = CPUcheck_firmware_ready(dev); if(rt_status != TRUE) { RT_TRACE(COMP_ERR, "CPUcheck_firmware_ready fail(%d)!\n",rt_status); goto download_firmware_fail; } /* wait until data code is initialized ready.*/ pfirmware->firmware_status = FW_STATUS_5_READY; break; } } RT_TRACE(COMP_FIRMWARE, "Firmware Download Success\n"); //assert(pfirmware->firmware_status == FW_STATUS_5_READY, ("Firmware Download Fail\n")); return rt_status; download_firmware_fail: RT_TRACE(COMP_ERR, "ERR in %s()\n", __FUNCTION__); rt_status = FALSE; return rt_status; } #endif