X-Git-Url: https://jxself.org/git/?a=blobdiff_plain;f=carlfw%2Fsrc%2Fmain.c;h=3efa6a8fe5383939e3000c7c036b4739d66a1a59;hb=1999e162e83656d48ede992f37923c6efa85b123;hp=35f5d29c88d770541440edbcf57623f4442fa1c3;hpb=0f370216f7d50a6c8ffebfb1ba49b196e869d0ec;p=carl9170fw.git diff --git a/carlfw/src/main.c b/carlfw/src/main.c index 35f5d29..3efa6a8 100644 --- a/carlfw/src/main.c +++ b/carlfw/src/main.c @@ -46,6 +46,7 @@ static void init(void) /* USB init */ usb_init(); + /* initialize DMA memory */ memset(&dma_mem, 0, sizeof(dma_mem)); /* fill DMA rings */ @@ -75,14 +76,20 @@ static void init(void) down_trigger(); } -static void __attribute__((noreturn)) main_loop(void) +static void handle_fw(void) { - clock_set(true, AHB_40MHZ_OSC); + if (fw.watchdog_enable == 1) + set(AR9170_TIMER_REG_WATCH_DOG, AR9170_WATCH_DOG_TIMER); + + if (fw.reboot) + reboot(); +} +static void __attribute__((noreturn)) main_loop(void) +{ /* main loop */ while (1) { - if (fw.watchdog_enable == 1) - set(AR9170_TIMER_REG_WATCH_DOG, AR9170_WATCH_DOG_TIMER); + handle_fw(); /* * Due to frame order persevation, the wlan subroutines @@ -112,8 +119,7 @@ static void __attribute__((noreturn)) main_loop(void) void __attribute__((noreturn)) start(void) { - /* initialize firmware context and DMA memory */ - memset(&fw, 0, sizeof(fw)); + clock_set(true, AHB_40MHZ_OSC); /* watchdog magic pattern check */ if ((get(AR9170_PWR_REG_WATCH_DOG_MAGIC) & 0xffff0000) == 0x12340000) { @@ -141,5 +147,10 @@ void __attribute__((noreturn)) start(void) " ~`!1@2#3$4%%5^6&7*8(9)0_-+={[}]|\\:;\"'<,>.?/"); #endif /* CONFIG_CARL9170FW_DEBUG */ + /* + * Tell the host, that the firmware has booted and is + * now ready to process requests. + */ + send_cmd_to_host(0, CARL9170_RSP_BOOT, 0x00, NULL); main_loop(); }