diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/arch/infineon-tc1796-mock/arch.cc | 32 |
1 files changed, 32 insertions, 0 deletions
diff --git a/src/arch/infineon-tc1796-mock/arch.cc b/src/arch/infineon-tc1796-mock/arch.cc index e219da5..8905f9c 100644 --- a/src/arch/infineon-tc1796-mock/arch.cc +++ b/src/arch/infineon-tc1796-mock/arch.cc @@ -5,12 +5,33 @@ */ #include "arch.h" +extern "C" { +#include <machine/wdtcon.h> +#include <tc1796b/scu.h> +#include <tc1796b/pmi.h> +} + #ifdef __acweaving #define __delay_cycles(x) #endif +#define OF_BYP 29 +#define OF_NDIV 16 +#define OF_PDIV 13 +#define OF_KDIV 8 +#define OF_VCOSEL 6 +#define OF_SYSFS 2 + void Arch::setup(void) { + /* + * 20 MHz Crystal -> 150 MHz clock + * PLL_CLC := (NDIV = 29; PDIV = 0; KDIV = 3; VCOSEL = 2) + */ + unlock_wdtcon(); + (*(unsigned int*)0xf0000040) = (29 << OF_NDIV) | (0 << OF_PDIV) | (3 << OF_KDIV) | (2 << OF_VCOSEL); + //PMI_CON0.bits.CCBYP = 0; + lock_wdtcon(); } #ifdef CONFIG_wakeup @@ -26,13 +47,24 @@ volatile bool sleep_done = false; void Arch::sleep_ms(unsigned int const ms) { + delay_ms(ms); } void Arch::delay_us(unsigned int const us) { + for (unsigned int i = 0; i < us; i++) { + for (unsigned int c = 0; c < F_CPU/1000000; c++) { + asm volatile("nop"); + } + } } void Arch::delay_ms(unsigned int const ms) { + for (unsigned int i = 0; i < ms; i++) { + for (unsigned int c = 0; c < F_CPU/1000; c++) { + asm volatile("nop"); + } + } } void Arch::idle_loop(void) |