|
@@ -11,19 +11,13 @@
|
|
|
* NDIS_STATUS_FAILURE - the following initialization process should be terminated
|
|
|
* NDIS_STATUS_SUCCESS - if firmware initialization process success
|
|
|
**************************************************************************************************/
|
|
|
-#if defined(RTL8192SU)
|
|
|
#include "r8192U.h"
|
|
|
#include "r8192S_firmware.h"
|
|
|
#include <linux/unistd.h>
|
|
|
|
|
|
-#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
|
|
|
|
|
|
#include <linux/firmware.h>
|
|
|
|
|
@@ -342,11 +336,9 @@ u8 FirmwareHeaderMapRfType(struct net_device *dev)
|
|
|
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);
|
|
@@ -551,430 +543,4 @@ bool FirmwareDownload92S(struct net_device *dev)
|
|
|
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;
|
|
|
-
|
|
|
-#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)<frag_length)?code_virtual_address[i+3]:0;
|
|
|
- *seg_ptr++ = ((i+1)<frag_length)?code_virtual_address[i+2]:0;
|
|
|
- *seg_ptr++ = ((i+2)<frag_length)?code_virtual_address[i+1]:0;
|
|
|
- *seg_ptr++ = ((i+3)<frag_length)?code_virtual_address[i+0]:0;
|
|
|
- }
|
|
|
- tcb_desc->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
|
|
|
- */
|
|
|
- priv->firmware_source = FW_SOURCE_IMG_FILE;
|
|
|
-
|
|
|
- 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:
|
|
|
- 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;
|
|
|
- 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(rst_opt == OPT_SYSTEM_RESET) {
|
|
|
- release_firmware(fw_entry);
|
|
|
- }
|
|
|
-
|
|
|
- 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
|
|
|
|