diff --git a/exosphere/lp0fw/src/car.c b/exosphere/lp0fw/src/car.c index bf0a5b780..93e36da8a 100644 --- a/exosphere/lp0fw/src/car.c +++ b/exosphere/lp0fw/src/car.c @@ -19,6 +19,7 @@ #include "utils.h" #include "car.h" #include "timer.h" +#include "pmc.h" #include "lp0.h" static inline uint32_t get_special_clk_reg(CarDevice dev) { @@ -48,6 +49,20 @@ static inline uint32_t get_special_clk_val(CarDevice dev) { static uint32_t g_clk_reg_offsets[NUM_CAR_BANKS] = {0x010, 0x014, 0x018, 0x360, 0x364, 0x280, 0x298}; static uint32_t g_rst_reg_offsets[NUM_CAR_BANKS] = {0x004, 0x008, 0x00C, 0x358, 0x35C, 0x28C, 0x2A4}; +void car_configure_oscillators(void) { + /* Enable the crystal oscillator, setting drive strength to the saved value in PMC. */ + CLK_RST_CONTROLLER_OSC_CTRL_0 = (CLK_RST_CONTROLLER_OSC_CTRL_0 & 0xFFFFFC0E) | 1 | (((APBDEV_PMC_OSC_EDPD_OVER_0 >> 1) & 0x3F) << 4); + + /* Set CLK_M_DIVISOR to 1 (causes actual division by 2.) */ + CLK_RST_CONTROLLER_SPARE_REG0_0 = (1 << 2); + /* Reading the register after writing it is required to ensure value takes. */ + (void)(CLK_RST_CONTROLLER_SPARE_REG0_0); + + /* Set TIMERUS_USEC_CFG to cycle at 0x60 / 0x5 = 19.2 MHz. */ + /* Value is (dividend << 8) | (divisor). */ + TIMERUS_USEC_CFG_0 = 0x45F; +} + void clk_enable(CarDevice dev) { uint32_t special_reg; if ((special_reg = get_special_clk_reg(dev))) { diff --git a/exosphere/lp0fw/src/car.h b/exosphere/lp0fw/src/car.h index c2596b848..32659a2d0 100644 --- a/exosphere/lp0fw/src/car.h +++ b/exosphere/lp0fw/src/car.h @@ -24,11 +24,14 @@ #define MAKE_CAR_REG(n) MAKE_REG32(CAR_BASE + n) #define CLK_RST_CONTROLLER_MISC_CLK_ENB_0 MAKE_CAR_REG(0x048) +#define CLK_RST_CONTROLLER_OSC_CTRL_0 MAKE_CAR_REG(0x050) #define CLK_RST_CONTROLLER_RST_DEVICES_H_0 MAKE_CAR_REG(0x008) #define CLK_RST_CONTROLLER_LVL2_CLK_GATE_OVRD_0 MAKE_CAR_REG(0x3A4) #define CLK_RST_CONTROLLER_RST_CPUG_CMPLX_SET_0 MAKE_CAR_REG(0x450) #define CLK_RST_CONTROLLER_RST_CPUG_CMPLX_CLR_0 MAKE_CAR_REG(0x454) +#define CLK_RST_CONTROLLER_SPARE_REG0_0 MAKE_CAR_REG(0x55C) + #define NUM_CAR_BANKS 7 typedef enum { @@ -40,6 +43,8 @@ typedef enum { CARDEVICE_BPMP = 1 } CarDevice; +void car_configure_oscillators(void); + void clk_enable(CarDevice dev); void clk_disable(CarDevice dev); void rst_enable(CarDevice dev); diff --git a/exosphere/lp0fw/src/pmc.h b/exosphere/lp0fw/src/pmc.h index 982caf444..22ce2d94d 100644 --- a/exosphere/lp0fw/src/pmc.h +++ b/exosphere/lp0fw/src/pmc.h @@ -37,6 +37,8 @@ #define APBDEV_PMC_SCRATCH13_0 MAKE_PMC_REG(0x084) #define APBDEV_PMC_SCRATCH18_0 MAKE_PMC_REG(0x098) +#define APBDEV_PMC_OSC_EDPD_OVER_0 MAKE_PMC_REG(0x1A4) + #define APBDEV_PMC_STICKY_BITS_0 MAKE_PMC_REG(0x2C0) #define APBDEV_PMC_SEC_DISABLE2_0 MAKE_PMC_REG(0x2C4) #define APBDEV_PMC_WEAK_BIAS_0 MAKE_PMC_REG(0x2C8) diff --git a/exosphere/lp0fw/src/timer.h b/exosphere/lp0fw/src/timer.h index 74f4a6360..3a4911856 100644 --- a/exosphere/lp0fw/src/timer.h +++ b/exosphere/lp0fw/src/timer.h @@ -20,6 +20,7 @@ #include "utils.h" #define TIMERUS_CNTR_1US_0 MAKE_REG32(0x60005010) +#define TIMERUS_USEC_CFG_0 MAKE_REG32(0x60005014) static inline void timer_wait(uint32_t microseconds) { uint32_t old_time = TIMERUS_CNTR_1US_0;