/*
* support more than 64 bytes command on ep4
*/
void usb_reg_out_patch(void)
{
uint16_t usbfifolen;
uint16_t ii;
uint32_t ep4_data;
static volatile uint32_t *regaddr;
static uint16_t cmd_len;
static VBUF *buf;
BOOLEAN cmd_is_last = FALSE;
static BOOLEAN cmd_is_new = TRUE;
/* get the size of this transcation */
usbfifolen = USB_BYTE_REG_READ(ZM_EP4_BYTE_COUNT_LOW_OFFSET);
if (usbfifolen > USB_EP4_MAX_PKT_SIZE) {
A_PRINTF("EP4 FIFO Bug? Buffer is too big: %x\n", usbfifolen);
cold_reboot();
}
/* check is command is new */
if(cmd_is_new) {
buf = usbFifoConf.get_command_buf();
cmd_len = 0;
if(!buf) {
A_PRINTF("%s: Filed to get new buffer.\n", __func__);
goto err;
}
/* copy free, assignment buffer of the address */
regaddr = (uint32_t *)buf->desc_list->buf_addr;
cmd_is_new = FALSE;
}
/* just in case, suppose should not happen */
if(!buf)
goto err;
/* if size is smaller, this is the last command!
* zero-length supposed should be set through 0x27/bit7->0x19/bit4, not here
*/
if(usbfifolen < USB_EP4_MAX_PKT_SIZE)
cmd_is_last = TRUE;
/* accumulate the size */
cmd_len += usbfifolen;
if (cmd_len > buf->desc_list->buf_size) {
A_PRINTF("%s: Data length on EP4 FIFO is bigger as "
"allocated buffer data! Drop it!\n", __func__);
goto err;
}
/* round it to alignment */
if(usbfifolen % 4)
usbfifolen = (usbfifolen >> 2) + 1;
else
/*
* -- support more than 64 bytes command on ep4 --
*/
void vUsb_Reg_Out_patch(void)
{
uint16_t usbfifolen;
uint16_t ii;
uint32_t ep4_data;
static volatile uint32_t *regaddr;
static uint16_t cmdLen;
static VBUF *buf;
BOOLEAN cmd_is_last = FALSE;
static BOOLEAN cmd_is_new = TRUE;
// get the size of this transcation
usbfifolen = USB_BYTE_REG_READ(ZM_EP4_BYTE_COUNT_LOW_OFFSET);
// check is command is new
if( cmd_is_new ){
buf = usbFifoConf.get_command_buf();
cmdLen = 0;
if( !buf )
goto ERR;
// copy free, assignment buffer of the address
regaddr = (uint32_t *)buf->desc_list->buf_addr;
cmd_is_new = FALSE;
}
// just in case, suppose should not happen
if( !buf )
goto ERR;
// if size is smaller, this is the last command!
// zero-length supposed should be set through 0x27/bit7->0x19/bit4, not here
if( usbfifolen<64 ) {
cmd_is_last = TRUE;
}
// accumulate the size
cmdLen += usbfifolen;
// round it to alignment
if(usbfifolen % 4)
usbfifolen = (usbfifolen >> 2) + 1;
else
void app_start()
{
uint32_t rst_status;
A_HOSTIF hostif;
#if defined(PROJECT_MAGPIE)
T_EEP_RET retEEP;
#endif
/* Zero BSS segment & dynamic memory section. */
init_mem();
#if defined(PROJECT_MAGPIE)
fatal_exception_func();
#endif
if( IS_FLASHBOOT() ) {
athos_indirection_table_install();
DBG_MODULE_INSTALL();
A_CLOCK_INIT(SYSTEM_CLK);
A_UART_INIT();
A_PRINTF_INIT();
A_DBG_INIT();
A_EEP_INIT();
A_TASKLET_INIT();
_indir_tbl.cmnos.timer._timer_init();
#if defined(PROJECT_K2)
/*
* WAR: these variable is not initialized when boot from flash
* either re-enumeration or config them to default value = 0 would fix the issue
*/
u8UsbInterfaceAlternateSetting = u8UsbConfigValue = u8UsbInterfaceValue = 0;
#endif
}
#ifdef ROM_VER_1_1
else
A_EEP_INIT(); /*Required for 1_1*/
#endif
#if defined(PROJECT_MAGPIE)
retEEP = A_EEP_IS_EXIST();
bJumptoFlash = FALSE;
if ( RET_SUCCESS == retEEP ) {
bEepromExist = TRUE;
} else {
bEepromExist = FALSE;
}
#endif
hostif = A_IS_HOST_PRESENT();
#if defined(PROJECT_MAGPIE)
rst_status = *((volatile uint32_t*)WATCH_DOG_MAGIC_PATTERN_ADDR);
#elif defined(PROJECT_K2)
rst_status = HAL_WORD_REG_READ(MAGPIE_REG_RST_STATUS_ADDR);
#endif /* #if defined(PROJECT_MAGPIE) */
A_PRINTF(" A_WDT_INIT()\n\r");
#if defined(PROJECT_K2)
save_cmnos_printf = fw_cmnos_printf;
#endif
if( hostif == HIF_USB ) {
#if defined(PROJECT_K2)
#if MOVE_PRINT_TO_RAM
save_cmnos_printf = _indir_tbl.cmnos.printf._printf;
_indir_tbl.cmnos.printf._printf = fw_cmnos_printf;
#endif
_indir_tbl.cmnos.usb._usb_fw_task = _fw_usb_fw_task;
_indir_tbl.cmnos.usb._usb_reset_fifo = _fw_usb_reset_fifo;
#endif
}
if( rst_status == WDT_MAGIC_PATTERN ) {
A_PRINTF(" ==>WDT reset<==\n");
#if defined(PROJECT_MAGPIE)
reset_EP4_FIFO();
#endif
*((volatile uint32_t*)WATCH_DOG_RESET_COUNTER_ADDR)+=1;
} else if (rst_status == SUS_MAGIC_PATTERN) {
A_PRINTF(" ==>warm start<==\n");
} else
A_PRINTF(" ==>cold start<==\n");
#if defined(PROJECT_MAGPIE)
*((volatile uint32_t*)WATCH_DOG_MAGIC_PATTERN_ADDR)=WDT_MAGIC_PATTERN;
#elif defined(PROJECT_K2)
HAL_WORD_REG_WRITE(MAGPIE_REG_RST_STATUS_ADDR, WDT_MAGIC_PATTERN);
#endif /* #if defined(PROJECT_MAGPIE) */
/* intr enable would left for firmware */
/* athos_interrupt_init(); */
DBG_MODULE_INSTALL();
#if defined(PROJECT_K2)
A_DBG_INIT();
#endif
#if defined(PROJECT_K2)
#if SYSTEM_MODULE_SFLASH
SFLASH_MODULE_INSTALL();
A_SFLASH_INIT();
#endif
#endif
HIF_MODULE_INSTALL();
HTC_MODULE_INSTALL();
WMI_SERVICE_MODULE_INSTALL();
BUF_POOL_MODULE_INSTALL();
VBUF_MODULE_INSTALL();
VDESC_MODULE_INSTALL();
//init each module, should be put together..
A_PRINTF("ALLOCRAM start 0x%x size %d\n", ALLOCRAM_START, ALLOCRAM_SIZE);
A_ALLOCRAM_INIT(ALLOCRAM_START, ALLOCRAM_SIZE);
if( hostif == HIF_USB ) {
_indir_tbl.hif._get_max_msg_len = _HIFusb_get_max_msg_len_patch;
_indir_tbl.cmnos.usb._usb_reg_out = vUsb_Reg_Out_patch;
_indir_tbl.hif._isr_handler = _HIFusb_isr_handler_patch;
_indir_tbl.cmnos.usb._usb_set_configuration = bSet_configuration_patch;
_indir_tbl.cmnos.usb._usb_status_in = vUsb_Status_In_patch;
_indir_tbl.cmnos.usb._usb_get_descriptor = bGet_descriptor_patch;
_indir_tbl.cmnos.usb._usb_standard_cmd = bStandardCommand_patch;
_indir_tbl.usbfifo_api._init = _fw_usbfifo_init;
#if defined(PROJECT_MAGPIE)
_indir_tbl.cmnos.usb._usb_power_off = zfTurnOffPower_patch;
_indir_tbl.cmnos.usb._usb_reset_fifo = zfResetUSBFIFO_patch;
_indir_tbl.hif._start = _HIFusb_start_patch;
_indir_tbl.htc._HTC_MsgRecvHandler = HTCMsgRecvHandler_patch;
_indir_tbl.htc._HTC_ControlSvcProcessMsg = HTCControlSvcProcessMsg_patch;
#endif
if (!(USB_BYTE_REG_READ(ZM_MAIN_CTRL_OFFSET)&BIT6)) {
vUSBFIFO_EP6Cfg_FS_patch();
}
#ifdef FUSION_USB_ENABLE_TX_STREAM
// For K2, enable tx stream mode
A_PRINTF("Enable Tx Stream mode: 0x%x\r\n",
USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET));
// Patch for K2 USB STREAM mode
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET, \
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)&(~BIT0))); // disable down stream DMA mode
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET,
((USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)|BIT6)));
#if SYSTEM_MODULE_HP_EP5
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET,
((USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)|BIT8)));
#endif
#if SYSTEM_MODULE_HP_EP6
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET,
((USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)|BIT9)));
#endif
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET,
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)|(BIT0))); // enable down stream DMA mode
#endif
#ifdef FUSION_USB_ENABLE_RX_STREAM
// Patch for K2 USB STREAM mode
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET, \
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)&(~BIT1))); // disable upstream DMA mode
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET, \
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)&(~BIT3))); // enable upstream stream mode
// K2, Set maximum IN transfer to 8K
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET, \
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)&(0xcf)));
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET, \
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)|(0x20)));
USB_WORD_REG_WRITE(ZM_SOC_USB_MODE_CTRL_OFFSET,
(USB_WORD_REG_READ(ZM_SOC_USB_MODE_CTRL_OFFSET)|(BIT1))); // enable upstream DMA mode
USB_WORD_REG_WRITE(ZM_SOC_USB_TIME_CTRL_OFFSET, 0xa0); // set stream mode timeout critirea
#if defined(PROJECT_K2)
/*0x10004020 is vaild in k2 but could be invaild in other chip*/
if ((HAL_WORD_REG_READ(0x10004020) & 0x2000) != 0) {
/* disable stream mode for AR9270 */
USB_WORD_REG_WRITE(ZM_SOC_USB_MAX_AGGREGATE_OFFSET, 0);
} else {
/* enable stream mode for AR9271 */
USB_WORD_REG_WRITE(ZM_SOC_USB_MAX_AGGREGATE_OFFSET, 9);
}
#else
USB_WORD_REG_WRITE(ZM_SOC_USB_MAX_AGGREGATE_OFFSET, 9);
#endif
#endif
}
#if defined(PROJECT_MAGPIE) && !defined(ROM_VER_1_1)
else if (hostif == HIF_PCI )
hif_pci_patch_install(&_indir_tbl.hif);
#endif
A_PRINTF("USB mode: 0x%x\r\n",
USB_WORD_REG_READ(0x100));
// patch the clock function
if(1) {
_indir_tbl.cmnos.clock._clock_init = cmnos_clock_init_patch;
_indir_tbl.cmnos.clock._refclk_speed_get = cmnos_refclk_speed_get_patch;
_indir_tbl.cmnos.clock._delay_us = cmnos_delay_us_patch;
_indir_tbl.cmnos.clock._clock_tick = cmnos_tick_patch;
_indir_tbl.cmnos.clock._milliseconds = cmnos_milliseconds_patch;
//default clock, setup initial variable, SYSTEM_FREQ=40
A_CLOCK_INIT(SYSTEM_FREQ);
}
Magpie_init();
#if MAGPIE_ENABLE_WLAN == 1
HAL_WORD_REG_WRITE(MAGPIE_REG_RST_RESET_ADDR,
(HAL_WORD_REG_READ(MAGPIE_REG_RST_RESET_ADDR)&(~(BIT10|BIT8|BIT7|BIT6))));
#if defined(PROJECT_MAGPIE)
HAL_WORD_REG_WRITE(MAGPIE_REG_AHB_ARB_ADDR,
(HAL_WORD_REG_READ(MAGPIE_REG_AHB_ARB_ADDR)|BIT1));
#endif
wlan_pci_module_init();
wlan_pci_probe();
#endif
A_PRINTF("Tgt running\n\r");
#if defined(PROJECT_MAGPIE)
if(1) {
A_PRINTF("======= Apply MISC Assert patch\n\r");
_assfail_ori = _indir_tbl.cmnos.misc._assfail;
_indir_tbl.cmnos.misc._assfail = exception_reset;
}
change_magpie_clk();
#endif
wlan_task(); //never return
}
