101 lines
2.0 KiB
C
101 lines
2.0 KiB
C
/*
|
|
* Copyright (c) 2017, NXP
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <kernel.h>
|
|
#include <device.h>
|
|
#include <init.h>
|
|
#include <soc.h>
|
|
#include <drivers/uart.h>
|
|
#include <fsl_common.h>
|
|
#include <fsl_clock.h>
|
|
#include <arch/cpu.h>
|
|
|
|
#define ER32KSEL_OSC32KCLK (0)
|
|
#define ER32KSEL_RTC (2)
|
|
#define ER32KSEL_LPO1KHZ (3)
|
|
|
|
#define LPUART0SRC_OSCERCLK (1)
|
|
|
|
#define CLKDIV1_DIVBY2 (1)
|
|
|
|
static const osc_config_t oscConfig = {
|
|
.freq = CONFIG_OSC_XTAL0_FREQ,
|
|
|
|
#if defined(CONFIG_OSC_EXTERNAL)
|
|
.workMode = kOSC_ModeExt,
|
|
#elif defined(CONFIG_OSC_LOW_POWER)
|
|
.workMode = kOSC_ModeOscLowPower,
|
|
#elif defined(CONFIG_OSC_HIGH_GAIN)
|
|
.workMode = kOSC_ModeOscHighGain,
|
|
#else
|
|
#error "An oscillator mode must be defined"
|
|
#endif
|
|
};
|
|
|
|
static const sim_clock_config_t simConfig = {
|
|
.er32kSrc = ER32KSEL_OSC32KCLK,
|
|
.clkdiv1 = SIM_CLKDIV1_OUTDIV4(CLKDIV1_DIVBY2),
|
|
};
|
|
|
|
/* This function comes from the MCUX SDK:
|
|
* modules/hal/nxp/mcux/devices/MKW41Z4/clock_config.c
|
|
*/
|
|
static void CLOCK_SYS_FllStableDelay(void)
|
|
{
|
|
u32_t i = 30000U;
|
|
while (i--) {
|
|
__NOP();
|
|
}
|
|
}
|
|
|
|
static ALWAYS_INLINE void clock_init(void)
|
|
{
|
|
CLOCK_SetSimSafeDivs();
|
|
|
|
CLOCK_InitOsc0(&oscConfig);
|
|
CLOCK_SetXtal0Freq(CONFIG_OSC_XTAL0_FREQ);
|
|
|
|
CLOCK_BootToFeeMode(kMCG_OscselOsc, CONFIG_MCG_FRDIV, kMCG_Dmx32Default,
|
|
kMCG_DrsMid, CLOCK_SYS_FllStableDelay);
|
|
|
|
CLOCK_SetInternalRefClkConfig(kMCG_IrclkEnable, kMCG_IrcSlow,
|
|
CONFIG_MCG_FCRDIV);
|
|
|
|
CLOCK_SetSimConfig(&simConfig);
|
|
|
|
#if CONFIG_UART_MCUX_LPUART_0
|
|
CLOCK_SetLpuartClock(LPUART0SRC_OSCERCLK);
|
|
#endif
|
|
}
|
|
|
|
static int kwx_init(struct device *arg)
|
|
{
|
|
ARG_UNUSED(arg);
|
|
|
|
unsigned int oldLevel; /* old interrupt lock level */
|
|
|
|
/* disable interrupts */
|
|
oldLevel = irq_lock();
|
|
|
|
/* Disable the watchdog */
|
|
SIM->COPC = 0;
|
|
|
|
/* Initialize system clock to 40 MHz */
|
|
clock_init();
|
|
|
|
/*
|
|
* install default handler that simply resets the CPU
|
|
* if configured in the kernel, NOP otherwise
|
|
*/
|
|
NMI_INIT();
|
|
|
|
/* restore interrupt state */
|
|
irq_unlock(oldLevel);
|
|
return 0;
|
|
}
|
|
|
|
SYS_INIT(kwx_init, PRE_KERNEL_1, 0);
|