|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431 |
- #include "imxrt.h"
- #include "wiring.h"
- #include "usb_dev.h"
-
- #include "debug/printf.h"
-
-
- extern unsigned long _stextload;
- extern unsigned long _stext;
- extern unsigned long _etext;
- extern unsigned long _sdataload;
- extern unsigned long _sdata;
- extern unsigned long _edata;
- extern unsigned long _sbss;
- extern unsigned long _ebss;
-
-
- __attribute__ ((used, aligned(1024)))
- void (* _VectorsRam[NVIC_NUM_INTERRUPTS+16])(void);
-
- static void memory_copy(uint32_t *dest, const uint32_t *src, uint32_t *dest_end);
- static void memory_clear(uint32_t *dest, uint32_t *dest_end);
- static void configure_systick(void);
- static void reset_PFD();
- extern void systick_isr(void);
- extern void pendablesrvreq_isr(void);
- void configure_cache(void);
- void unused_interrupt_vector(void);
- void usb_pll_start();
- extern void analog_init(void);
- extern void pwm_init(void);
- extern void tempmon_init(void);
- uint32_t set_arm_clock(uint32_t frequency);
- extern void __libc_init_array(void);
-
-
- __attribute__((section(".startup"), optimize("no-tree-loop-distribute-patterns")))
- void ResetHandler(void)
- {
- unsigned int i;
-
-
-
-
-
-
-
-
-
-
-
- memory_copy(&_stext, &_stextload, &_etext);
- memory_copy(&_sdata, &_sdataload, &_edata);
- memory_clear(&_sbss, &_ebss);
-
-
- SCB_CPACR = 0x00F00000;
-
-
- for (i=0; i < NVIC_NUM_INTERRUPTS + 16; i++) _VectorsRam[i] = &unused_interrupt_vector;
- for (i=0; i < NVIC_NUM_INTERRUPTS; i++) NVIC_SET_PRIORITY(i, 128);
- SCB_VTOR = (uint32_t)_VectorsRam;
-
- reset_PFD();
-
-
-
-
- CCM_CSCMR1 = (CCM_CSCMR1 & ~CCM_CSCMR1_PERCLK_PODF(0x3F)) | CCM_CSCMR1_PERCLK_CLK_SEL;
-
- CCM_CSCDR1 = (CCM_CSCDR1 & ~CCM_CSCDR1_UART_CLK_PODF(0x3F)) | CCM_CSCDR1_UART_CLK_SEL;
-
-
- printf_debug_init();
- printf("\n***********IMXRT Startup**********\n");
- printf("test %d %d %d\n", 1, -1234567, 3);
-
- configure_cache();
- configure_systick();
- usb_pll_start();
- reset_PFD();
-
- set_arm_clock(600000000);
-
-
- while (millis() < 20) ;
- usb_init();
- analog_init();
- pwm_init();
- tempmon_init();
-
- while (millis() < 300) ;
- printf("before C++ constructors\n");
- __libc_init_array();
- printf("after C++ constructors\n");
- printf("before setup\n");
- setup();
- printf("after setup\n");
- while (1) {
-
- loop();
- }
- }
-
-
-
-
-
-
-
-
-
-
-
-
- #define SYSTICK_EXT_FREQ 100000
-
- extern volatile uint32_t systick_cycle_count;
- static void configure_systick(void)
- {
- _VectorsRam[14] = pendablesrvreq_isr;
- _VectorsRam[15] = systick_isr;
- SYST_RVR = (SYSTICK_EXT_FREQ / 1000) - 1;
- SYST_CVR = 0;
- SYST_CSR = SYST_CSR_TICKINT | SYST_CSR_ENABLE;
- SCB_SHPR3 = 0x20000000;
- ARM_DEMCR |= ARM_DEMCR_TRCENA;
- ARM_DWT_CTRL |= ARM_DWT_CTRL_CYCCNTENA;
- systick_cycle_count = ARM_DWT_CYCCNT;
- }
-
-
-
- #define NOEXEC SCB_MPU_RASR_XN
- #define READONLY SCB_MPU_RASR_AP(7)
- #define READWRITE SCB_MPU_RASR_AP(3)
- #define NOACCESS SCB_MPU_RASR_AP(0)
- #define MEM_CACHE_WT SCB_MPU_RASR_TEX(0) | SCB_MPU_RASR_C
- #define MEM_CACHE_WB SCB_MPU_RASR_TEX(0) | SCB_MPU_RASR_C | SCB_MPU_RASR_B
- #define MEM_CACHE_WBWA SCB_MPU_RASR_TEX(1) | SCB_MPU_RASR_C | SCB_MPU_RASR_B
- #define MEM_NOCACHE SCB_MPU_RASR_TEX(1)
- #define DEV_NOCACHE SCB_MPU_RASR_TEX(2)
- #define SIZE_128K (SCB_MPU_RASR_SIZE(16) | SCB_MPU_RASR_ENABLE)
- #define SIZE_256K (SCB_MPU_RASR_SIZE(17) | SCB_MPU_RASR_ENABLE)
- #define SIZE_512K (SCB_MPU_RASR_SIZE(18) | SCB_MPU_RASR_ENABLE)
- #define SIZE_1M (SCB_MPU_RASR_SIZE(19) | SCB_MPU_RASR_ENABLE)
- #define SIZE_2M (SCB_MPU_RASR_SIZE(20) | SCB_MPU_RASR_ENABLE)
- #define SIZE_4M (SCB_MPU_RASR_SIZE(21) | SCB_MPU_RASR_ENABLE)
- #define SIZE_8M (SCB_MPU_RASR_SIZE(22) | SCB_MPU_RASR_ENABLE)
- #define SIZE_16M (SCB_MPU_RASR_SIZE(23) | SCB_MPU_RASR_ENABLE)
- #define SIZE_32M (SCB_MPU_RASR_SIZE(24) | SCB_MPU_RASR_ENABLE)
- #define SIZE_64M (SCB_MPU_RASR_SIZE(25) | SCB_MPU_RASR_ENABLE)
- #define REGION(n) (SCB_MPU_RBAR_REGION(n) | SCB_MPU_RBAR_VALID)
-
- __attribute__((section(".progmem")))
- void configure_cache(void)
- {
-
-
-
-
-
- SCB_MPU_CTRL = 0;
-
- SCB_MPU_RBAR = 0x00000000 | REGION(0);
- SCB_MPU_RASR = MEM_NOCACHE | READWRITE | SIZE_512K;
-
- SCB_MPU_RBAR = 0x00200000 | REGION(1);
- SCB_MPU_RASR = MEM_CACHE_WT | READONLY | SIZE_128K;
-
- SCB_MPU_RBAR = 0x20000000 | REGION(2);
- SCB_MPU_RASR = MEM_NOCACHE | READWRITE | NOEXEC | SIZE_512K;
-
- SCB_MPU_RBAR = 0x20200000 | REGION(3);
- SCB_MPU_RASR = MEM_CACHE_WBWA | READWRITE | NOEXEC | SIZE_1M;
-
- SCB_MPU_RBAR = 0x40000000 | REGION(4);
- SCB_MPU_RASR = DEV_NOCACHE | READWRITE | NOEXEC | SIZE_64M;
-
- SCB_MPU_RBAR = 0x60000000 | REGION(5);
- SCB_MPU_RASR = MEM_CACHE_WBWA | READONLY | SIZE_16M;
-
-
-
-
-
- SCB_MPU_CTRL = SCB_MPU_CTRL_ENABLE;
-
-
- asm("dsb");
- asm("isb");
- SCB_CACHE_ICIALLU = 0;
-
- asm("dsb");
- asm("isb");
- SCB_CCR |= (SCB_CCR_IC | SCB_CCR_DC);
- }
-
-
- __attribute__((section(".progmem")))
- void usb_pll_start()
- {
- while (1) {
- uint32_t n = CCM_ANALOG_PLL_USB1;
- printf("CCM_ANALOG_PLL_USB1=%08lX\n", n);
- if (n & CCM_ANALOG_PLL_USB1_DIV_SELECT) {
- printf(" ERROR, 528 MHz mode!\n");
- CCM_ANALOG_PLL_USB1_CLR = 0xC000;
- CCM_ANALOG_PLL_USB1_SET = CCM_ANALOG_PLL_USB1_BYPASS;
- CCM_ANALOG_PLL_USB1_CLR = CCM_ANALOG_PLL_USB1_POWER |
- CCM_ANALOG_PLL_USB1_DIV_SELECT |
- CCM_ANALOG_PLL_USB1_ENABLE |
- CCM_ANALOG_PLL_USB1_EN_USB_CLKS;
- continue;
- }
- if (!(n & CCM_ANALOG_PLL_USB1_ENABLE)) {
- printf(" enable PLL\n");
-
- CCM_ANALOG_PLL_USB1_SET = CCM_ANALOG_PLL_USB1_ENABLE;
- continue;
- }
- if (!(n & CCM_ANALOG_PLL_USB1_POWER)) {
- printf(" power up PLL\n");
- CCM_ANALOG_PLL_USB1_SET = CCM_ANALOG_PLL_USB1_POWER;
- continue;
- }
- if (!(n & CCM_ANALOG_PLL_USB1_LOCK)) {
- printf(" wait for lock\n");
- continue;
- }
- if (n & CCM_ANALOG_PLL_USB1_BYPASS) {
- printf(" turn off bypass\n");
- CCM_ANALOG_PLL_USB1_CLR = CCM_ANALOG_PLL_USB1_BYPASS;
- continue;
- }
- if (!(n & CCM_ANALOG_PLL_USB1_EN_USB_CLKS)) {
- printf(" enable USB clocks\n");
- CCM_ANALOG_PLL_USB1_SET = CCM_ANALOG_PLL_USB1_EN_USB_CLKS;
- continue;
- }
- return;
- }
- }
-
- __attribute__((section(".progmem")))
- void reset_PFD()
- {
-
- CCM_ANALOG_PFD_528_SET = (1 << 31) | (1 << 23) | (1 << 15) | (1 << 7);
- CCM_ANALOG_PFD_528 = 0x2018101B;
-
- CCM_ANALOG_PFD_480_SET = (1 << 31) | (1 << 23) | (1 << 15) | (1 << 7);
- CCM_ANALOG_PFD_480 = 0x13110D0C;
- }
-
-
-
-
-
-
-
-
-
-
- __attribute__((weak))
- void unused_interrupt_vector(void)
- {
-
- #ifdef PRINT_DEBUG_STUFF
- uint32_t addr;
- asm volatile("mrs %0, ipsr\n" : "=r" (addr)::);
- printf("\nirq %d\n", addr & 0x1FF);
- asm("ldr %0, [sp, #52]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #48]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #44]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #40]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #36]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #33]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #34]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #28]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #24]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #20]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #16]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #12]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #8]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #4]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- asm("ldr %0, [sp, #0]" : "=r" (addr) ::);
- printf(" %x\n", addr);
- #endif
- #if 1
- if ( F_CPU_ACTUAL >= 600000000 )
- set_arm_clock(100000000);
- IOMUXC_SW_MUX_CTL_PAD_GPIO_B0_03 = 5;
- IOMUXC_SW_PAD_CTL_PAD_GPIO_B0_03 = IOMUXC_PAD_DSE(7);
- GPIO2_GDIR |= (1<<3);
- GPIO2_DR_SET = (1<<3);
- while (1) {
- volatile uint32_t n;
- GPIO2_DR_SET = (1<<3);
- for (n=0; n < 2000000/6; n++) ;
- GPIO2_DR_CLEAR = (1<<3);
- for (n=0; n < 1500000/6; n++) ;
- }
- #else
- if ( F_CPU_ACTUAL >= 600000000 )
- set_arm_clock(100000000);
- while (1) {
- }
- #endif
- }
-
- __attribute__((section(".startup"), optimize("no-tree-loop-distribute-patterns")))
- static void memory_copy(uint32_t *dest, const uint32_t *src, uint32_t *dest_end)
- {
- if (dest == src) return;
- while (dest < dest_end) {
- *dest++ = *src++;
- }
- }
-
- __attribute__((section(".startup"), optimize("no-tree-loop-distribute-patterns")))
- static void memory_clear(uint32_t *dest, uint32_t *dest_end)
- {
- while (dest < dest_end) {
- *dest++ = 0;
- }
- }
-
-
-
-
-
-
- #include <errno.h>
-
-
- extern unsigned long _heap_start;
- extern unsigned long _heap_end;
-
- char *__brkval = (char *)&_heap_start;
-
- void * _sbrk(int incr)
- {
- char *prev = __brkval;
- if (incr != 0) {
- if (prev + incr > (char *)&_heap_end) {
- errno = ENOMEM;
- return (void *)-1;
- }
- __brkval = prev + incr;
- }
- return prev;
- }
-
- __attribute__((weak))
- int _read(int file, char *ptr, int len)
- {
- return 0;
- }
-
- __attribute__((weak))
- int _close(int fd)
- {
- return -1;
- }
-
- #include <sys/stat.h>
-
- __attribute__((weak))
- int _fstat(int fd, struct stat *st)
- {
- st->st_mode = S_IFCHR;
- return 0;
- }
-
- __attribute__((weak))
- int _isatty(int fd)
- {
- return 1;
- }
-
- __attribute__((weak))
- int _lseek(int fd, long long offset, int whence)
- {
- return -1;
- }
-
- __attribute__((weak))
- void _exit(int status)
- {
- while (1);
- }
-
- __attribute__((weak))
- void __cxa_pure_virtual()
- {
- while (1);
- }
-
- __attribute__((weak))
- int __cxa_guard_acquire (char *g)
- {
- return !(*g);
- }
-
- __attribute__((weak))
- void __cxa_guard_release(char *g)
- {
- *g = 1;
- }
-
- __attribute__((weak))
- void abort(void)
- {
- while (1) ;
- }
-
|