180 lines
7.0 KiB
C
180 lines
7.0 KiB
C
/*
|
|
** ###################################################################
|
|
** Processors: MKW21Z256VHT4
|
|
** MKW21Z512VHT4
|
|
**
|
|
** Compilers: Keil ARM C/C++ Compiler
|
|
** GNU C Compiler
|
|
** IAR ANSI C/C++ Compiler for ARM
|
|
** MCUXpresso Compiler
|
|
**
|
|
** Reference manual: MKW41Z512RM Rev. 0.1, 04/2016
|
|
** Version: rev. 1.0, 2015-09-23
|
|
** Build: b170112
|
|
**
|
|
** Abstract:
|
|
** Provides a system configuration function and a global variable that
|
|
** contains the system frequency. It configures the device and initializes
|
|
** the oscillator (PLL) that is part of the microcontroller device.
|
|
**
|
|
** Copyright (c) 2016 Freescale Semiconductor, Inc.
|
|
** Copyright 2016 - 2017 NXP
|
|
** Redistribution and use in source and binary forms, with or without modification,
|
|
** are permitted provided that the following conditions are met:
|
|
**
|
|
** o Redistributions of source code must retain the above copyright notice, this list
|
|
** of conditions and the following disclaimer.
|
|
**
|
|
** o Redistributions in binary form must reproduce the above copyright notice, this
|
|
** list of conditions and the following disclaimer in the documentation and/or
|
|
** other materials provided with the distribution.
|
|
**
|
|
** o Neither the name of the copyright holder nor the names of its
|
|
** contributors may be used to endorse or promote products derived from this
|
|
** software without specific prior written permission.
|
|
**
|
|
** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
|
|
** ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
** WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
** DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
|
|
** ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
** (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
** LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
|
** ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
** (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
** SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
**
|
|
** http: www.nxp.com
|
|
** mail: support@nxp.com
|
|
**
|
|
** Revisions:
|
|
** - rev. 1.0 (2015-09-23)
|
|
** Initial version.
|
|
**
|
|
** ###################################################################
|
|
*/
|
|
|
|
/*!
|
|
* @file MKW21Z4
|
|
* @version 1.0
|
|
* @date 2015-09-23
|
|
* @brief Device specific configuration file for MKW21Z4 (implementation file)
|
|
*
|
|
* Provides a system configuration function and a global variable that contains
|
|
* the system frequency. It configures the device and initializes the oscillator
|
|
* (PLL) that is part of the microcontroller device.
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include "fsl_device_registers.h"
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------------
|
|
-- Core clock
|
|
---------------------------------------------------------------------------- */
|
|
|
|
uint32_t SystemCoreClock = DEFAULT_SYSTEM_CLOCK;
|
|
|
|
/* ----------------------------------------------------------------------------
|
|
-- SystemInit()
|
|
---------------------------------------------------------------------------- */
|
|
|
|
void SystemInit (void) {
|
|
|
|
#if (DISABLE_WDOG)
|
|
/* SIM_COPC: COPT=0,COPCLKS=0,COPW=0 */
|
|
SIM->COPC = (uint32_t)0x00u;
|
|
#endif /* (DISABLE_WDOG) */
|
|
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------------
|
|
-- SystemCoreClockUpdate()
|
|
---------------------------------------------------------------------------- */
|
|
|
|
void SystemCoreClockUpdate (void) {
|
|
|
|
uint32_t MCGOUTClock; /* Variable to store output clock frequency of the MCG module */
|
|
uint16_t Divider;
|
|
|
|
if ((MCG->C1 & MCG_C1_CLKS_MASK) == 0x00U) {
|
|
/* FLL is selected */
|
|
if ((MCG->C1 & MCG_C1_IREFS_MASK) == 0x00U) {
|
|
/* External reference clock is selected */
|
|
if((MCG->C7 & MCG_C7_OSCSEL_MASK) == 0x00U) {
|
|
MCGOUTClock = CPU_XTAL_CLK_HZ; /* System oscillator drives MCG clock */
|
|
} else {
|
|
MCGOUTClock = CPU_XTAL32k_CLK_HZ; /* RTC 32 kHz oscillator drives MCG clock */
|
|
}
|
|
if (((MCG->C2 & MCG_C2_RANGE_MASK) != 0x00U) && ((MCG->C7 & MCG_C7_OSCSEL_MASK) != 0x01U)) {
|
|
switch (MCG->C1 & MCG_C1_FRDIV_MASK) {
|
|
case 0x38U:
|
|
Divider = 1536U;
|
|
break;
|
|
case 0x30U:
|
|
Divider = 1280U;
|
|
break;
|
|
default:
|
|
Divider = (uint16_t)(32LU << ((MCG->C1 & MCG_C1_FRDIV_MASK) >> MCG_C1_FRDIV_SHIFT));
|
|
break;
|
|
}
|
|
} else {/* ((MCG->C2 & MCG_C2_RANGE_MASK) != 0x00U) */
|
|
Divider = (uint16_t)(1LU << ((MCG->C1 & MCG_C1_FRDIV_MASK) >> MCG_C1_FRDIV_SHIFT));
|
|
}
|
|
MCGOUTClock = (MCGOUTClock / Divider); /* Calculate the divided FLL reference clock */
|
|
} else { /* (!((MCG->C1 & MCG_C1_IREFS_MASK) == 0x00U)) */
|
|
MCGOUTClock = CPU_INT_SLOW_CLK_HZ; /* The slow internal reference clock is selected */
|
|
} /* (!((MCG->C1 & MCG_C1_IREFS_MASK) == 0x00U)) */
|
|
/* Select correct multiplier to calculate the MCG output clock */
|
|
switch (MCG->C4 & (MCG_C4_DMX32_MASK | MCG_C4_DRST_DRS_MASK)) {
|
|
case 0x00U:
|
|
MCGOUTClock *= 640U;
|
|
break;
|
|
case 0x20U:
|
|
MCGOUTClock *= 1280U;
|
|
break;
|
|
case 0x40U:
|
|
MCGOUTClock *= 1920U;
|
|
break;
|
|
case 0x60U:
|
|
MCGOUTClock *= 2560U;
|
|
break;
|
|
case 0x80U:
|
|
MCGOUTClock *= 732U;
|
|
break;
|
|
case 0xA0U:
|
|
MCGOUTClock *= 1464U;
|
|
break;
|
|
case 0xC0U:
|
|
MCGOUTClock *= 2197U;
|
|
break;
|
|
case 0xE0U:
|
|
MCGOUTClock *= 2929U;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
} else if ((MCG->C1 & MCG_C1_CLKS_MASK) == 0x40U) {
|
|
/* Internal reference clock is selected */
|
|
if ((MCG->C2 & MCG_C2_IRCS_MASK) == 0x00U) {
|
|
MCGOUTClock = CPU_INT_SLOW_CLK_HZ; /* Slow internal reference clock selected */
|
|
} else { /* (!((MCG->C2 & MCG_C2_IRCS_MASK) == 0x00U)) */
|
|
Divider = (uint16_t)(0x01LU << ((MCG->SC & MCG_SC_FCRDIV_MASK) >> MCG_SC_FCRDIV_SHIFT));
|
|
MCGOUTClock = (uint32_t) (CPU_INT_FAST_CLK_HZ / Divider); /* Fast internal reference clock selected */
|
|
} /* (!((MCG->C2 & MCG_C2_IRCS_MASK) == 0x00U)) */
|
|
} else if ((MCG->C1 & MCG_C1_CLKS_MASK) == 0x80U) {
|
|
/* External reference clock is selected */
|
|
if((MCG->C7 & MCG_C7_OSCSEL_MASK) == 0x00U) {
|
|
MCGOUTClock = CPU_XTAL_CLK_HZ; /* System oscillator drives MCG clock */
|
|
} else {
|
|
MCGOUTClock = CPU_XTAL32k_CLK_HZ; /* RTC 32 kHz oscillator drives MCG clock */
|
|
}
|
|
} else { /* (!((MCG->C1 & MCG_C1_CLKS_MASK) == 0x80U)) */
|
|
/* Reserved value */
|
|
return;
|
|
} /* (!((MCG->C1 & MCG_C1_CLKS_MASK) == 0x80U)) */
|
|
SystemCoreClock = (MCGOUTClock / (0x01U + ((SIM->CLKDIV1 & SIM_CLKDIV1_OUTDIV1_MASK) >> SIM_CLKDIV1_OUTDIV1_SHIFT)));
|
|
|
|
}
|