|
- #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[160+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);
- extern void systick_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);
-
-
- __attribute__((section(".startup")))
- void ResetHandler(void)
- {
- unsigned int i;
-
-
-
-
-
- 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);
-
-
- memory_copy(&_stext, &_stextload, &_etext);
- memory_copy(&_sdata, &_sdataload, &_edata);
- memory_clear(&_sbss, &_ebss);
-
-
- SCB_CPACR = 0x00F00000;
-
-
- for (i=0; i < 176; i++) _VectorsRam[i] = &unused_interrupt_vector;
- SCB_VTOR = (uint32_t)_VectorsRam;
-
-
-
-
- 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();
- #if 1
-
-
-
-
- printf("ARM PLL = %08lX\n", CCM_ANALOG_PLL_ARM);
-
- uint32_t cdcdr = CCM_CBCDR;
- uint32_t cbcmr = CCM_CBCMR;
- printf("AHB divisor = %ld\n", ((cdcdr >> 10) & 7) + 1);
- printf("IPG divisor = %ld\n", ((cdcdr >> 8) & 3) + 1);
-
- if (cdcdr & CCM_CBCDR_PERIPH_CLK_SEL) {
- printf("using periph_clk2_clk_divided\n");
-
- } else {
- printf("using pre_periph_clk_sel\n");
- uint32_t n = (cbcmr >> 19) & 3;
- if (n == 0) {
- printf("using PLL2\n");
- } else if (n == 1) {
- printf("using PLL2 PFD2\n");
- } else if (n == 2) {
- printf("using PLL2 PFD0\n");
- } else {
- printf("using PLL1\n");
- }
-
-
- }
-
- #endif
-
-
- usb_init();
- analog_init();
- pwm_init();
-
-
- printf("before setup\n");
- setup();
- printf("after setup\n");
- while (1) {
-
- loop();
- }
- }
-
-
-
-
-
-
-
-
-
-
-
-
- #define SYSTICK_EXT_FREQ 100000
-
- static void configure_systick(void)
- {
- _VectorsRam[15] = systick_isr;
- SYST_RVR = (SYSTICK_EXT_FREQ / 1000) - 1;
- SYST_CVR = 0;
- SYST_CSR = SYST_CSR_TICKINT | SYST_CSR_ENABLE;
- ARM_DEMCR |= ARM_DEMCR_TRCENA;
- ARM_DWT_CTRL |= ARM_DWT_CTRL_CYCCNTENA;
- }
-
-
-
- #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);
- }
-
-
- uint32_t set_arm_clock(uint32_t frequency)
- {
- if (!(CCM_CBCDR & CCM_CBCDR_PERIPH_CLK_SEL)) {
-
- const uint32_t need1s = CCM_ANALOG_PLL_USB1_ENABLE | CCM_ANALOG_PLL_USB1_POWER |
- CCM_ANALOG_PLL_USB1_LOCK | CCM_ANALOG_PLL_USB1_EN_USB_CLKS;
- if ((CCM_ANALOG_PLL_USB1 & need1s) == need1s) {
-
-
- } else {
-
-
- }
-
- } else {
-
- }
-
-
-
-
-
-
-
- return frequency;
- }
-
-
-
- __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;
- }
- }
-
-
-
-
-
-
-
-
-
-
-
- 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
- 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; n++) ;
- GPIO2_DR_CLEAR = (1<<3);
- for (n=0; n < 1500000; n++) ;
- }
- #else
- while (1) {
- }
- #endif
- }
-
- 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++;
- }
- }
-
- static void memory_clear(uint32_t *dest, uint32_t *dest_end)
- {
- while (dest < dest_end) {
- *dest++ = 0;
- }
- }
-
|