int
main(int argc, char *argv[])
{
int ret;
char *config_file = NULL;
int opt = 0, daemonize = 1, debug = 0, console_output=0;
progname = argv[0];
A_STATUS status;
struct sigaction sa;
ATHBT_FILTER_INFO *pInfo;
A_UINT32 btfiltFlags = 0;
A_MEMZERO(&g_AthBtFilterInstance, sizeof(ATH_BT_FILTER_INSTANCE));
/*
* Keep an option to specify the wireless extension. By default,
* assume it to be equal to WIRELESS_EXT TODO
*/
/* Get user specified options */
while ((opt = getopt(argc, argv, "bsvandczxf:w:")) != EOF) {
switch (opt) {
case 'n':
daemonize = 0;
break;
case 'd':
debug = 1;
break;
case 'f':
if (optarg) {
config_file = strdup(optarg);
}
break;
case 'c':
console_output = 1;
break;
case 'a':
btfiltFlags |= ABF_ENABLE_AFH_CHANNEL_CLASSIFICATION;
break;
case 'z':
btfiltFlags |= ABF_USE_HCI_FILTER_FOR_HEADSET_PROFILE;
break;
case 'v':
btfiltFlags |= ABF_WIFI_CHIP_IS_VENUS ;
A_DEBUG("wifi chip is venus\n");
break;
case 'x':
btfiltFlags |= ABF_BT_CHIP_IS_ATHEROS ;
A_DEBUG("bt chip is atheros\n");
break;
case 's':
btfiltFlags |= ABF_FE_ANT_IS_SA ;
A_DEBUG("Front End Antenna Configuration is single antenna \n");
break;
case 'w':
memset(wifname, '\0', IFNAMSIZ);
strcpy(wifname, optarg);
g_AthBtFilterInstance.pWlanAdapterName = (A_CHAR *)&wifname;
break;
case 'b':
btfiltFlags |= ABF_USE_ONLY_DBUS_FILTERING;
break;
default:
usage();
exit(1);
}
}
/* Launch the daemon if desired */
if (daemonize && daemon(0, console_output ? 1 : 0)) {
printf("Can't daemonize: %s\n", strerror(errno));
exit(1);
}
/* Initialize the debug infrastructure */
A_DBG_INIT("ATHBT", "Ath BT Filter Daemon");
if (debug) {
if (console_output) {
A_DBG_SET_OUTPUT_TO_CONSOLE();
}
// setlogmask(LOG_INFO | LOG_DEBUG | LOG_ERR);
A_INFO("Enabling Debug Information\n");
A_SET_DEBUG(1);
}
if (config_file) {
A_DEBUG("Config file: %s\n", config_file);
if (!(gConfigFile = fopen(config_file, "r")))
{
A_ERR("[%s] fopen failed\n", __FUNCTION__);
}
}
A_MEMZERO(&sa, sizeof(struct sigaction));
sa.sa_flags = SA_NOCLDSTOP;
sa.sa_handler = Abf_SigTerm;
sigaction(SIGTERM, &sa, NULL);
sigaction(SIGINT, &sa, NULL);
sa.sa_handler = SIG_IGN;
sigaction(SIGPIPE, &sa, NULL);
Abf_HciLibInit(&btfiltFlags);
/* Initialize the Filter core */
do {
Abf_WlanCheckSettings(wifname, &btfiltFlags);
ret = AthBtFilter_Attach(&g_AthBtFilterInstance, btfiltFlags );
if (ret) {
A_ERR("Filter initialization failed\n");
break;
}
/* Initialize the WLAN notification mechanism */
status = Abf_WlanStackNotificationInit(&g_AthBtFilterInstance, btfiltFlags );
if (A_FAILED(status)) {
AthBtFilter_Detach(&g_AthBtFilterInstance);
A_ERR("WLAN stack notification init failed\n");
break;
}
/* Initialize the BT notification mechanism */
status = Abf_BtStackNotificationInit(&g_AthBtFilterInstance,btfiltFlags);
if (A_FAILED(status)) {
Abf_WlanStackNotificationDeInit(&g_AthBtFilterInstance);
AthBtFilter_Detach(&g_AthBtFilterInstance);
A_ERR("BT stack notification init failed\n");
break;
}
/* Check for errors on the return value TODO */
pInfo = g_AthBtFilterInstance.pContext;
GpInfo = pInfo;
A_DEBUG("Service running, waiting for termination .... \n");
/* wait for termination signal */
while (!terminated) {
sleep(1);
}
} while(FALSE);
/* Initiate the shutdown sequence */
if(GpInfo != NULL) {
AthBtFilter_State_Off(GpInfo);
}
Abf_ShutDown();
Abf_HciLibDeInit();
/* Shutdown */
if (gConfigFile) {
fclose(gConfigFile);
}
if (config_file) {
A_FREE(config_file);
}
A_DEBUG("Service terminated \n");
A_MEMZERO(&g_AthBtFilterInstance, sizeof(ATH_BT_FILTER_INSTANCE));
A_DBG_DEINIT();
return 0;
}
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
}