--- /dev/null
+/*
+ * Copyright (c) 2013 Qualcomm Atheros, Inc.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted (subject to the limitations in the
+ * disclaimer below) provided that the following conditions are met:
+ *
+ * * Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ *
+ * * Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the
+ * distribution.
+ *
+ * * Neither the name of Qualcomm Atheros nor the names of its
+ * contributors may be used to endorse or promote products derived
+ * from this software without specific prior written permission.
+ *
+ * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
+ * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT
+ * HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
+ * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
+ * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/*
+ * Copyright (c) 2000-2008 Atheros Communications, Inc., All Rights Reserved
+ *
+ * $Id: //depot/sw/branches/fusion_usb/target_firmware/magpie_fw_dev/build/magpie_1_1/sboot/athos/src/athos_main.c#1 $
+ *
+ * This file contains type definitions
+ */
+
+/* osapi support */
+#include "sys_cfg.h"
+#include "athos_api.h"
+//#include <fwd.h>
+
+#include "regdump.h"
+
+/* dhry mips stone test */
+//#include "dhry.h"
+
+/* usb support */
+//#include "usb_defs.h"
+//#include "usb_type.h"
+
+/* xtensa related */
+#include "xtensa/corebits.h"
+#include "xtensa/tie/xt_core.h"
+
+#include <dma_lib.h>
+#include <hif_pci.h>
+#include <hif_gmac.h>
+#include <fwd.h>
+
+
+BOOLEAN download_enable = FALSE;
+
+/* #define ALLOCRAM_START 0x512800 */
+/* #define ALLOCRAM_SIZE ( SYS_RAM_SZIE - ( ALLOCRAM_START - SYS_D_RAM_REGION_0_BASE) - SYS_D_RAM_STACK_SIZE) */
+
+#define ALLOCRAM_START SYS_D_RAM_REGION_3_BASE
+#define ALLOCRAM_SIZE SYS_RAM_BLOCK_SIZE
+
+extern unsigned int _text_start_in_rom;
+extern unsigned int _text_start;
+extern unsigned int _text_end;
+
+extern unsigned int _rodata_start_in_rom;
+extern unsigned int _lit4_start;
+extern unsigned int _lit4_end;
+
+/*
+ * This special table is used by Xtensa startup code to copy
+ * ROM-based data into RAM. See Xtensa documentation or
+ * "unpack" code in ResetVector.S for details.
+ */
+const uint32_t _rom_store_table[] = {
+ (uint32_t)&_data_start, (uint32_t)&_data_end, (uint32_t)&_data_start_in_rom,
+ (uint32_t)&_text_start, (uint32_t)&_text_end, (uint32_t)0xf002000,
+ (uint32_t)&_lit4_start, (uint32_t)&_lit4_end, (uint32_t)0xf008000,
+ (uint32_t)0x00500400, (uint32_t)0x00500940, (uint32_t)0x004e0260,
+ 0, 0, 0
+};
+
+
+#define ATH_DATE_STRING __DATE__" "__TIME__
+
+
+/*
+ * 03/09: it'll always fall into this exception if we enable this exception handler, need to do more testing, Ryan
+ */
+void
+Magpie_fatal_exception_handler(CPU_exception_frame_t *exc_frame)
+{
+ struct register_dump_s dump;
+
+ dump.exc_frame = *exc_frame; /* structure copy */
+ dump.badvaddr = XT_RSR_EXCVADDR();
+ dump.exc_frame.xt_exccause = XT_RSR_EXCCAUSE();
+ dump.pc = exc_frame->xt_pc;
+ dump.assline = 0;
+
+ A_PRINTF("Fatal exception (%d): pc=0x%x badvaddr=0x%x dump area=0x%x\n",
+ dump.exc_frame.xt_exccause, dump.pc, dump.badvaddr, &dump);
+ // PRINT_FAILURE_STATE();
+
+ // A_ASSFAIL(&dump); // misc module
+}
+
+//dummy now
+//void app_start(void);
+
+static int
+athos_linkage_check(int sz, struct _A_os_linkage_check *link_check)
+{
+ if (sz != sizeof(struct _A_os_linkage_check)) {
+ goto app_link_error;
+ }
+
+ if (link_check->version != OS_LINKAGE_VERSION) {
+ goto app_link_error;
+ }
+
+ if (link_check->table != sizeof(struct _A_magpie_indirection_table) &&
+ (link_check->table != 0)) {
+ goto app_link_error;
+ }
+
+ return 1; /* successful linkage check */
+
+app_link_error:
+// A_PRINTF("athos_linkage_check failure!\n");
+ A_PUTS("-A1-\n\r");
+ return 0;
+}
+
+
+#ifdef SYSTEM_MODULE_INTR
+
+/* Mask of Interrupt Level bits in Xtensa's Processor Status register */
+#define XTENSA_PS_INTLEVEL_MASK 0xf
+
+LOCAL uint32_t
+athos_block_all_intrlvl(void)
+{
+ uint32_t tmp;
+
+ /*
+ * This function doesn't actually block ALL interrupts;
+ * it leaves ERROR & WDT interrupts -- which are fatal
+ * and are at level 3 -- active.
+ */
+ asm volatile("rsil %0,2" : "=r" (tmp));
+
+ return (uint32_t)((A_UINT32)tmp & XTENSA_PS_INTLEVEL_MASK);
+}
+
+LOCAL void
+athos_unblock_all_intrlvl(void)
+{
+ unsigned int tmp;
+
+ asm volatile("rsil %0, 0" : "=r" (tmp));
+}
+
+LOCAL void
+athos_restore_intrlvl(uint32_t old_intr)
+{
+ if (old_intr == 0) {
+ athos_unblock_all_intrlvl();
+ }
+}
+#endif
+
+
+static void
+AR6002_misaligned_load_handler(CPU_exception_frame_t *exc_frame)
+{
+ struct register_dump_s dump;
+ uint32_t *stkptr;
+
+#if SYSTEM_MODULE_PRINT
+ A_PRINTF("misaligned_load\n\r");
+#else
+ A_PUTS("misaligned_load\n\r");
+#endif
+
+ dump.exc_frame = *exc_frame; /* structure copy */
+ dump.badvaddr = XT_RSR_EXCVADDR();
+ dump.pc = exc_frame->xt_pc;
+
+ asm volatile("mov %0,a1" : "=r" (stkptr));
+
+ /* Stores a0,a1,a2,a3 on stack; but leaves sp unchanged */
+ xthal_window_spill();
+
+ {
+ int i;
+
+#define MAGPIE_REGDUMP_FRAMES 5
+
+ /* Walk back the stack */
+ for (i=0; i<MAGPIE_REGDUMP_FRAMES; i++) {
+ dump.exc_frame.wb[i].a0 = stkptr[-4];
+ dump.exc_frame.wb[i].a1 = stkptr[-3];
+ dump.exc_frame.wb[i].a2 = stkptr[-2];
+ dump.exc_frame.wb[i].a3 = stkptr[-1];
+ if (dump.exc_frame.wb[i].a0 == 0) {
+ break;
+ }
+ stkptr = (uint32_t *)dump.exc_frame.wb[i].a1;
+ }
+ }
+
+ A_MISALIGNED_LOAD_HANDLER(&dump);
+
+}
+
+static void
+AR6002_fatal_exception_handler(CPU_exception_frame_t *exc_frame)
+{
+ struct register_dump_s dump;
+
+ dump.exc_frame = *exc_frame; /* structure copy */
+ dump.badvaddr = XT_RSR_EXCVADDR();
+ dump.exc_frame.xt_exccause = XT_RSR_EXCCAUSE();
+ dump.pc = exc_frame->xt_pc;
+ dump.assline = 0;
+
+#if SYSTEM_MODULE_PRINT
+ A_PRINTF("Fatal exception (%d): \tpc=0x%x \n\r\tbadvaddr=0x%x \n\r\tdump area=0x%x\n",
+ dump.exc_frame.xt_exccause, dump.pc, dump.badvaddr, &dump);
+ PRINT_FAILURE_STATE();
+ #else
+ A_PUTS("Fatal exception\n\r");
+#endif
+
+ A_ASSFAIL(&dump);
+
+ // trigger wdt, in case hang
+#if defined(_ROM_)
+ //HAL_WORD_REG_WRITE(MAGPIE_REG_RST_WDT_TIMER_CTRL_ADDR, 0x03);
+ //HAL_WORD_REG_WRITE(MAGPIE_REG_RST_WDT_TIMER_ADDR, 0x10);
+ A_WDT_ENABLE();
+#endif
+
+ while(1)
+ ;
+}
+
+
+typedef void (*INSTFN)(void *);
+
+/*
+ * These are all modules that reside in ROM which are installed
+ * by default by the operating system. Other ROM modules may
+ * be installed by the application if they are needed.
+ */
+struct {
+ void (* install_fn)(void *);
+ void *api_tbl;
+} basic_ROM_module_table[] =
+{
+
+#if SYSTEM_MODULE_MEM
+ {(INSTFN)cmnos_mem_module_install, (void *)&A_CMN(mem)},
+#endif
+
+#if SYSTEM_MODULE_MISC
+ {(INSTFN)cmnos_misc_module_install, (void *)&A_CMN(misc)},
+#endif
+
+#if SYSTEM_MODULE_PRINT
+ {(INSTFN)cmnos_printf_module_install, (void *)&A_CMN(printf)},
+#endif
+
+#if SYSTEM_MODULE_UART
+ {(INSTFN)cmnos_uart_module_install, (void *)&A_CMN(uart)},
+#endif
+
+#if SYSTEM_MODULE_USB
+ {(INSTFN)cmnos_usb_module_install, (void *)&A_CMN(usb)},
+#endif
+
+#if SYSTEM_MODULE_INTR
+ {(INSTFN)cmnos_intr_module_install, (void *)&A_CMN(intr)},
+#endif
+
+#if SYSTEM_MODULE_TIMER
+ {(INSTFN)cmnos_timer_module_install, (void *)&A_CMN(timer)},
+#endif
+
+#if SYSTEM_MODULE_CLOCK
+ {(INSTFN)cmnos_clock_module_install, (void *)&A_CMN(clock)},
+#endif
+
+#if SYSTEM_MODULE_ALLOCRAM
+ {(INSTFN)cmnos_allocram_module_install, (void *)&A_CMN(allocram)},
+#endif
+
+#if SYSTEM_MODULE_ROM_PATCH
+ {(INSTFN)cmnos_romp_module_install, (void *)&A_CMN(romp)},
+#endif
+
+#if SYSTEM_MODULE_WDT
+ {(INSTFN)cmnos_wdt_module_install, (void *)&A_CMN(wdt_timer)},
+#endif
+
+#if SYSTEM_MODULE_EEPROM
+ {(INSTFN)cmnos_eep_module_install, (void *)&A_CMN(eep)},
+#endif
+ {(INSTFN)cmnos_string_module_install, (void *)&A_CMN(string)},
+ {(INSTFN)cmnos_tasklet_module_install, (void *)&A_CMN(tasklet)},
+ {(INSTFN)vdesc_module_install, (void *)&A_INDIR(vdesc)},
+ {(INSTFN)vbuf_module_install, (void *)&A_INDIR(vbuf)},
+ {(INSTFN)generic_hif_module_install, (void *)&A_INDIR(hif)},
+ {(INSTFN)buf_pool_module_install, (void *)&A_INDIR(buf_pool)},
+ {(INSTFN)usbfifo_module_install, (void *)&A_INDIR(usbfifo_api)},
+ {(INSTFN)dma_engine_module_install, (void *)&A_INDIR(dma_engine)},
+ {(INSTFN)dma_lib_module_install, (void *)&A_INDIR(dma_lib)},
+};
+
+#define BASIC_ROM_MODULE_TABLE_SZ (sizeof(basic_ROM_module_table)/sizeof(basic_ROM_module_table[0]))
+
+void
+generic_hif_module_install(struct hif_api *apis)
+{
+ A_HOSTIF hostif;
+
+ hostif = A_IS_HOST_PRESENT();
+
+ switch(hostif){
+ case HIF_USB:
+ hif_usb_module_install(apis);
+ break;
+ }
+}
+
+void
+athos_indirection_table_install(void)
+{
+ unsigned int i;
+
+ /* Sanity: start with a clear table */
+ {
+ //char *tbl = (char *)_A_OS_INDIRECTION_TABLE;
+ char *tbl = (char *)_A_MAGPIE_INDIRECTION_TABLE;
+
+ //for (i=0; i<_A_OS_INDIRECTION_TABLE_SIZE; i++) {
+ for (i=0; i<_A_MAGPIE_INDIRECTION_TABLE_SIZE; i++) {
+ tbl[i] = 0;
+ }
+ }
+
+ /* Install basic ROM modules */
+ for (i=0; i<BASIC_ROM_MODULE_TABLE_SZ; i++) {
+ basic_ROM_module_table[i].install_fn(basic_ROM_module_table[i].api_tbl);
+ }
+
+ #if !defined(_ROM_)
+ DBG_MODULE_INSTALL(); // move DBG to indirection table
+ #endif
+
+ //_A_OS_INDIRECTION_TABLE->cmnos.app_start = app_start;
+ //_A_OS_INDIRECTION_TABLE->cmnos.hal_linkage_check = athos_linkage_check;
+ //_A_MAGPIE_INDIRECTION_TABLE->cmnos.app_start = app_start;
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.hal_linkage_check = athos_linkage_check;
+
+// _A_OS_INDIRECTION_TABLE->cmnos.start_bss = &START_BSS;
+
+#if SYSTEM_MODULE_INTR
+ /* Install a few CPU-specific functions */
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.intr._get_intrenable = xthal_get_intenable;
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.intr._set_intrenable = xthal_set_intenable;
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.intr._get_intrpending = xthal_get_interrupt;
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.intr._unblock_all_intrlvl = athos_unblock_all_intrlvl;
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.intr._intr_disable = athos_block_all_intrlvl;
+ _A_MAGPIE_INDIRECTION_TABLE->cmnos.intr._intr_restore = athos_restore_intrlvl;
+#endif
+
+ /* UNALIGNED references are used for ASSERTs */
+ (void)_xtos_set_exception_handler(EXCCAUSE_UNALIGNED, AR6002_misaligned_load_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_LOAD_STORE_ERROR, AR6002_fatal_exception_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_ILLEGAL, AR6002_fatal_exception_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_INSTR_ERROR, AR6002_fatal_exception_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_PRIVILEGED, AR6002_fatal_exception_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_INSTR_DATA_ERROR, AR6002_fatal_exception_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_LOAD_STORE_DATA_ERROR, AR6002_fatal_exception_handler);
+ (void)_xtos_set_exception_handler(EXCCAUSE_DIVIDE_BY_ZERO, AR6002_fatal_exception_handler);
+}
+
+
+#ifdef SYSTEM_MODULE_INTR
+/*
+ * All interrupts pass through here. Yes, it adds a
+ * bit of overhead; but it may be very helpful with
+ * debugging, ROM patching, and workarounds.
+ *
+ * NB: Assembler code that calls this loops through all
+ * pending & enabled interrupts.
+ */
+void
+athos_interrupt_handler(unsigned int inum, unsigned int *interrupt_frame)
+{
+ A_INVOKE_ISR(inum);
+}
+#endif
+
+void
+athos_interrupt_init(void)
+{
+#ifdef SYSTEM_MODULE_INTR
+ int i;
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x20;
+
+ for (i=0; i<NUM_DIRECT_INTR; i++) {
+ (void)_xtos_set_interrupt_handler(i, athos_interrupt_handler);
+ }
+
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x21;
+ A_INTR_INIT();
+// A_MC_REG_WRITE(ADDR_ERROR_CONTROL_ADDRESS, ADDR_ERROR_CONTROL_ENABLE_MASK);
+
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x22;
+ athos_unblock_all_intrlvl();
+#endif
+}
+
+
+
+void athos_init(A_HOSTIF hif)
+{
+
+ ///////////////////////////////////////////////////////
+ //init each module, should be put together..
+ A_CLOCK_INIT(SYSTEM_CLK);
+
+ A_UART_INIT();
+ A_PRINTF_INIT();
+
+ A_EEP_INIT();
+}
+
+void led_on(unsigned int bit)
+{
+ *(unsigned long *)0x5200c = 1<<bit;
+}
+
+void led_off(unsigned int bit)
+{
+ *(unsigned long *)0x52010 = 1<<bit;
+}
+
+
+void led_all_on()
+{
+ led_on(10);
+ led_on(12);
+}
+
+void led_all_off()
+{
+ led_off(10);
+ led_off(12);
+}
+
+
+unsigned long i=0;
+#define LED_ON_OFF_FREQ 500
+
+void led_task()
+{
+ i++;
+
+ if(i==LED_ON_OFF_FREQ*1)
+ led_on(10);
+ else if (i==LED_ON_OFF_FREQ*2)
+ led_on(12);
+ else if (i==LED_ON_OFF_FREQ*3)
+ led_off(12);
+ else if (i==LED_ON_OFF_FREQ*4)
+ led_off(10);
+ else if (i==LED_ON_OFF_FREQ*5)
+ led_all_on();
+ else if (i==LED_ON_OFF_FREQ*6)
+ {
+ i=0;
+ led_all_off();
+ }
+}
+
+
+void bootload()
+{
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0xe;
+ CURRENT_PROGRAM = (uint32_t)bootload;
+ A_PUTS("8. wait for read/read_comp.... \n\r");
+ while(1) {
+
+ /* update wdt timer */
+ //A_WDT_TASK();
+
+ /* high priority tasks */
+ A_USB_ROM_TASK();
+
+// A_DBG_TASK();
+ led_task();
+
+ if( download_enable )
+ break;
+ }
+
+}
+
+void
+change_magpie_clk(uint32_t cpu_freq, uint32_t ahb_div)
+{
+ volatile uint32_t i = 0;
+ volatile uint32_t rd_data = 0, wd_data = 0;
+
+ /* Put the PLL into reset */
+ rd_data = HAL_WORD_REG_READ(0x00050010) | (1<<1);
+ HAL_WORD_REG_WRITE(0x00050010,rd_data);
+
+ HAL_WORD_REG_WRITE(0x00056004, 0x11);
+ rd_data = HAL_WORD_REG_READ(0x00056004) & 0x1;
+
+ /* Wait for the update bit to get cleared */
+ while (rd_data)
+ rd_data = HAL_WORD_REG_READ(0x00056004) & 0x1;
+
+ /* Setting of the PLL */
+ if (cpu_freq== 100) wd_data = 0x142; /* PLL 400 MHz*/
+ else if (cpu_freq== 105) wd_data = 0x152; /* PLL 420 MHz */
+ else if (cpu_freq== 110) wd_data = 0x162; /* PLL 440 MHz*/
+ else if (cpu_freq== 115) wd_data = 0x172; /* PLL 460 MHz */
+ else if (cpu_freq== 120) wd_data = 0x182; /* PLL 480 MHz */
+ else if (cpu_freq== 125) wd_data = 0x192; /* PLL 500 MHz */
+ else if (cpu_freq== 130) wd_data = 0x1a2; /* PLL 520 MHz */
+ else if (cpu_freq== 135) wd_data = 0x1b2; /* PLL 540 MHz */
+ else if (cpu_freq== 140) wd_data = 0x1c2; /* PLL 560 MHz */
+ else if (cpu_freq== 145) wd_data = 0x1d2; /* PLL 580 MHz */
+ else if (cpu_freq== 150) wd_data = 0x1e2; /* PLL 600 MHz */
+ else if (cpu_freq== 155) wd_data = 0x1f2; /* PLL 620 MHz */
+ else if (cpu_freq== 160) wd_data = 0x202; /* PLL 640 MHz */
+ else if (cpu_freq== 165) wd_data = 0x212; /* PLL 660 MHz */
+ else if (cpu_freq== 170) wd_data = 0x222; /* PLL 680 MHz */
+ else if (cpu_freq== 175) wd_data = 0x232; /* PLL 700 MHz */
+ else if (cpu_freq== 180) wd_data = 0x242; /* PLL 720 MHz */
+ else if (cpu_freq== 185) wd_data = 0x252; /* PLL 740 MHz */
+ else if (cpu_freq== 190) wd_data = 0x262; /* PLL 760 MHz */
+ else if (cpu_freq== 195) wd_data = 0x272; /* PLL 780 MHz */
+ else if (cpu_freq== 200) wd_data = 0x142; /* PLL 400 MHz */
+ else if (cpu_freq== 210) wd_data = 0x152; /* PLL 420 MHz */
+ else if (cpu_freq== 220) wd_data = 0x162; /* PLL 440 MHz */
+ else if (cpu_freq== 230) wd_data = 0x172; /* PLL 460 MHz */
+ else if (cpu_freq== 240) wd_data = 0x182; /* PLL 480 MHz */
+ else if (cpu_freq== 250) wd_data = 0x192; /* PLL 500 MHz */
+ else if (cpu_freq== 260) wd_data = 0x1a2; /* PLL 520 MHz */
+ else if (cpu_freq== 270) wd_data = 0x1b2; /* PLL 540 MHz */
+ else if (cpu_freq== 280) wd_data = 0x1c2; /* PLL 560 MHz */
+ else if (cpu_freq== 290) wd_data = 0x1d2; /* PLL 580 MHz */
+ else if (cpu_freq== 300) wd_data = 0x1e2; /* PLL 600 MHz */
+ else if (cpu_freq== 310) wd_data = 0x1f2; /* PLL 620 MHz */
+ else if (cpu_freq== 320) wd_data = 0x202; /* PLL 640 MHz */
+ else if (cpu_freq== 330) wd_data = 0x212; /* PLL 660 MHz */
+ else if (cpu_freq== 340) wd_data = 0x222; /* PLL 680 MHz */
+ else if (cpu_freq== 350) wd_data = 0x232; /* PLL 700 MHz */
+ else if (cpu_freq== 360) wd_data = 0x242; /* PLL 720 MHz */
+ else if (cpu_freq== 370) wd_data = 0x252; /* PLL 740 MHz */
+ else if (cpu_freq== 380) wd_data = 0x262; /* PLL 760 MHz */
+ else if (cpu_freq== 390) wd_data = 0x272; /* PLL 780 MHz */
+ else if (cpu_freq== 400) wd_data = 0x282; /* PLL 800 MHz */
+ else wd_data = 0x142; /* PLL 400 MHz*/
+
+ HAL_WORD_REG_WRITE(0x00056000, wd_data);
+
+ /* Pull CPU PLL out of Reset */
+ rd_data = HAL_WORD_REG_READ(0x00050010) & ~(1<<1);
+ HAL_WORD_REG_WRITE(0x00050010,rd_data);
+
+ /* CPU & AHB settings */
+ rd_data = HAL_WORD_REG_READ(0x00056004);
+
+ /* > 200 Mhz CPU clock (PLL / 2) or < 200 Mhz (PLL / 4) */
+ if (cpu_freq > 195)
+ rd_data = (rd_data & ~(0xff<<16)) | (1<<16);
+ else
+ rd_data = (rd_data & ~(0xff<<16)) | (2<<16);
+
+ /* AHB Clock, AHB_FREQ = CPU_FREQ / ahb_div */
+ switch (ahb_div) {
+ case 1:
+ rd_data = (rd_data & ~(0x3<<8) & ~(1<<4)) | 0x1;
+ break;
+ case 2:
+ rd_data = (rd_data & ~(0x3<<8) & ~(1<<4)) | (1<<8) | 0x1;
+ break;
+ case 4:
+ rd_data = (rd_data & ~(0x3<<8) & ~(1<<4)) | (2<<8) | 0x1;
+ break;
+ default:
+ rd_data = (rd_data & ~(0x3<<8) & ~(1<<4)) | (1<<8) | 0x1;
+ break;
+ }
+
+ HAL_WORD_REG_WRITE(0x00056004, rd_data);
+ rd_data = HAL_WORD_REG_READ(0x00056004) & 0x1;
+
+ while(rd_data)
+ rd_data = HAL_WORD_REG_READ(0x00056004) & 0x1;
+
+ while(i++ < 1000)
+ ;
+
+ /* UART Setting */
+ A_UART_HWINIT((cpu_freq / ahb_div) * (1000*1000), 115200);
+
+// A_PRINTF("reg_read(0x56000): %p \n", HAL_WORD_REG_READ(0x00056000));
+// A_PRINTF("reg_read(0x56004): %p \n", HAL_WORD_REG_READ(0x00056004));
+
+ /* set the current reference clock */
+// A_CLOCK_INIT(cpu_freq);
+
+}
+
+/*
+ * rom1.0 fix: turn off rc if no patch/eeprom exist
+*/
+void turn_off_rc()
+{
+ extern BOOLEAN eep_state;
+
+ // clear the cmnos_eeprom init state
+ eep_state = FALSE;
+
+ // reset the pcie_rc shift, pll and phy
+ HAL_WORD_REG_WRITE(MAGPIE_REG_RST_RESET_ADDR, (HAL_WORD_REG_READ(MAGPIE_REG_RST_RESET_ADDR)|(BIT10|BIT9|BIT8|BIT7)));
+
+ // reset ahb_arb of pcie_rc
+ HAL_WORD_REG_WRITE(MAGPIE_REG_AHB_ARB_ADDR, (HAL_WORD_REG_READ(MAGPIE_REG_AHB_ARB_ADDR)|BIT1));
+}
+
+void bootentry(void)
+{
+ /* uint32_t reset_temp; */
+ A_HOSTIF hostif=0x0;
+ T_BOOT_TYPE rst_status;
+ T_EEP_RET retEEP;
+
+ ///////////////////////////////////
+ athos_indirection_table_install();
+
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x1;
+ CURRENT_PROGRAM = (uint32_t)bootentry;
+ // athos module install
+ athos_init(hostif); // move all the athos indirection table init function to here
+
+ athos_interrupt_init(); // install all interrupt function to known state
+
+ A_WDT_DISABLE(); // make srue wdt is diable
+
+ rst_status = A_WDT_LASTBOOT();
+
+ // pump up flash clock to 12.5Mhz
+ HAL_WORD_REG_WRITE(0x5b01c, 0x401);
+
+ /*
+ *
+ * 1. turn on CPU PLL, reg(0x560000), 0x305
+ * 2. pll reset reg(0x50010), 0x03
+ * 3. pll reset reg(0x50010), 0x01
+ *
+ * - after enabling CPU PLL, left the interface pll setting
+ * be done in each interface
+ *
+ * e.g usb_init we mdid
+ * 4. usb divide reg(0x56008), 0x0808
+ * 5. clear register reg(0x50010), bit0, bit3, bit4
+ * 6. set register reg(0x50010), bit0, bit3, bit4
+ * 7. clear register reg(0x50010), bit0, bit3, bit4
+ *
+ * - wait for 200ms for usb phy 30mhz stable -
+ *
+ * 8. usb clock up, proceed reset of things
+ */
+
+ /* reset_temp = HAL_WORD_REG_READ(MAGPIE_REG_RST_RESET_ADDR); */
+ /* A_PRINTF("reset temp is %x \n",reset_temp); */
+ /* HAL_WORD_REG_WRITE( MAGPIE_REG_RST_RESET_ADDR, 0); */
+
+
+ /*! move the whole cpu pll setup to host interface specific
+ * since when bootup, we have an external clock source
+ */
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x2;
+
+ hostif = A_IS_HOST_PRESENT();
+
+/*!
+ * GPIO_FUNCTION(0x28) - config uart (sin, sout) pair,
+ *
+ * pci host interface will only have (GPIO1, GPIO0), other hif (usb, pcie, gmac)
+ * will use (GPIO5, GPIO4)
+ *
+ * BIT8 --> (9,8)
+ * BIT7 --> (7,6)
+ * BIT6 --> (5,4)
+ * BIT5 --> (3,2)
+ * BIT4 --> (1,0)
+ *
+ */
+ {
+ HAL_WORD_REG_WRITE( MAGPIE_REG_GPIO_FUNCTION, (HAL_WORD_REG_READ(MAGPIE_REG_GPIO_FUNCTION)&(~(BIT4|BIT5|BIT6|BIT7|BIT8))) );
+ HAL_WORD_REG_WRITE( MAGPIE_REG_GPIO_FUNCTION, (HAL_WORD_REG_READ(MAGPIE_REG_GPIO_FUNCTION)|(BIT8)) );
+ }
+
+ change_magpie_clk(200, 2);
+
+ // power on self test
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x5;
+ A_PUTS("\n - Boot from SFLASH - \n\r");
+
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x9;
+
+ /*!
+ * check the host interface type,
+ */
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0x15;
+ hostif = A_IS_HOST_PRESENT();
+
+ retEEP = A_EEP_IS_EXIST();
+
+ turn_off_rc();
+
+ if( hostif == HIF_USB )
+ {
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0xb;
+#if 0
+ if( retEEP == RET_SUCCESS)
+ {
+ A_EEP_INIT();
+ /* read the usb descriptor information from rom to ram */
+ read_usb_conf();
+
+ turn_off_rc();
+ }
+#endif
+ A_USB_INIT();
+
+ DEBUG_SYSTEM_STATE = (DEBUG_SYSTEM_STATE&(~0xff)) | 0xd;
+ bootload();
+ }
+
+}
+
+
+int main(void)
+{
+ *(unsigned long *)0x52000 = 0x7ebff; // set bit10/bit12 output mode
+ *(unsigned long *)0x0053fff8 = 0x0;
+
+ // for debug purpose in case we don't know where we are
+ // keep this address update, so that we could trace the where is is
+ DEBUG_SYSTEM_STATE = 0x0;
+
+ bootentry();
+
+ A_PRINTF("FLASH_READ_COMP, jump to firmware\n");
+
+ led_on(10);
+ led_on(12);
+
+ return 0;
+}
+