1 /*
2 ** ###################################################################
3 **     Processors:          MK22FN128VDC10
4 **                          MK22FN128VLH10
5 **                          MK22FN128VLL10
6 **                          MK22FN128VMP10
7 **
8 **     Compilers:           Freescale C/C++ for Embedded ARM
9 **                          GNU C Compiler
10 **                          IAR ANSI C/C++ Compiler for ARM
11 **                          Keil ARM C/C++ Compiler
12 **                          MCUXpresso Compiler
13 **
14 **     Reference manual:    K22P121M100SF9RM, Rev. 1, April 25, 2014
15 **     Version:             rev. 1.6, 2015-02-19
16 **     Build:               b181105
17 **
18 **     Abstract:
19 **         Provides a system configuration function and a global variable that
20 **         contains the system frequency. It configures the device and initializes
21 **         the oscillator (PLL) that is part of the microcontroller device.
22 **
23 **     Copyright 2016 Freescale Semiconductor, Inc.
24 **     Copyright 2016-2018 NXP
25 **     All rights reserved.
26 **
27 **     SPDX-License-Identifier: BSD-3-Clause
28 **
29 **     http:                 www.nxp.com
30 **     mail:                 support@nxp.com
31 **
32 **     Revisions:
33 **     - rev. 1.0 (2013-11-01)
34 **         Initial version.
35 **     - rev. 1.1 (2013-12-20)
36 **         Update according to reference manual rev. 0.1,
37 **     - rev. 1.2 (2014-02-10)
38 **         The declaration of clock configurations has been moved to separate header file system_MK22F12810.h
39 **     - rev. 1.3 (2014-05-06)
40 **         Update according to reference manual rev. 1.0,
41 **         Update of system and startup files.
42 **         Module access macro module_BASES replaced by module_BASE_PTRS.
43 **     - rev. 1.4 (2014-08-28)
44 **         Update of system files - default clock configuration changed.
45 **         Update of startup files - possibility to override DefaultISR added.
46 **     - rev. 1.5 (2014-10-14)
47 **         Interrupt INT_LPTimer renamed to INT_LPTMR0, interrupt INT_Watchdog renamed to INT_WDOG_EWM.
48 **     - rev. 1.6 (2015-02-19)
49 **         Renamed interrupt vector LLW to LLWU.
50 **
51 ** ###################################################################
52 */
53 
54 /*!
55  * @file MK22F12810
56  * @version 1.6
57  * @date 2015-02-19
58  * @brief Device specific configuration file for MK22F12810 (implementation file)
59  *
60  * Provides a system configuration function and a global variable that contains
61  * the system frequency. It configures the device and initializes the oscillator
62  * (PLL) that is part of the microcontroller device.
63  */
64 
65 #include <stdint.h>
66 #include "fsl_device_registers.h"
67 
68 
69 
70 /* ----------------------------------------------------------------------------
71    -- Core clock
72    ---------------------------------------------------------------------------- */
73 
74 uint32_t SystemCoreClock = DEFAULT_SYSTEM_CLOCK;
75 
76 /* ----------------------------------------------------------------------------
77    -- SystemInit()
78    ---------------------------------------------------------------------------- */
79 
SystemInit(void)80 void SystemInit (void) {
81 #if ((__FPU_PRESENT == 1) && (__FPU_USED == 1))
82   SCB->CPACR |= ((3UL << 10*2) | (3UL << 11*2));    /* set CP10, CP11 Full Access */
83 #endif /* ((__FPU_PRESENT == 1) && (__FPU_USED == 1)) */
84 
85 #if (DISABLE_WDOG)
86   /* WDOG->UNLOCK: WDOGUNLOCK=0xC520 */
87   WDOG->UNLOCK = WDOG_UNLOCK_WDOGUNLOCK(0xC520); /* Key 1 */
88   /* WDOG->UNLOCK: WDOGUNLOCK=0xD928 */
89   WDOG->UNLOCK = WDOG_UNLOCK_WDOGUNLOCK(0xD928); /* Key 2 */
90   /* WDOG->STCTRLH: ?=0,DISTESTWDOG=0,BYTESEL=0,TESTSEL=0,TESTWDOG=0,?=0,?=1,WAITEN=1,STOPEN=1,DBGEN=0,ALLOWUPDATE=1,WINEN=0,IRQRSTEN=0,CLKSRC=1,WDOGEN=0 */
91   WDOG->STCTRLH = WDOG_STCTRLH_BYTESEL(0x00) |
92                  WDOG_STCTRLH_WAITEN_MASK |
93                  WDOG_STCTRLH_STOPEN_MASK |
94                  WDOG_STCTRLH_ALLOWUPDATE_MASK |
95                  WDOG_STCTRLH_CLKSRC_MASK |
96                  0x0100U;
97 #endif /* (DISABLE_WDOG) */
98 
99   SystemInitHook();
100 }
101 
102 /* ----------------------------------------------------------------------------
103    -- SystemCoreClockUpdate()
104    ---------------------------------------------------------------------------- */
105 
SystemCoreClockUpdate(void)106 void SystemCoreClockUpdate (void) {
107 
108   uint32_t MCGOUTClock;                                                        /* Variable to store output clock frequency of the MCG module */
109   uint16_t Divider;
110   uint8_t tmpC7 = 0;
111 
112   if ((MCG->C1 & MCG_C1_CLKS_MASK) == 0x00U) {
113     /* FLL is selected */
114     if ((MCG->C1 & MCG_C1_IREFS_MASK) == 0x00U) {
115       /* External reference clock is selected */
116       switch (MCG->C7 & MCG_C7_OSCSEL_MASK) {
117       case 0x00U:
118         MCGOUTClock = CPU_XTAL_CLK_HZ; /* System oscillator drives MCG clock */
119         break;
120       case 0x01U:
121         MCGOUTClock = CPU_XTAL32k_CLK_HZ; /* RTC 32 kHz oscillator drives MCG clock */
122         break;
123       case 0x02U:
124       default:
125         MCGOUTClock = CPU_INT_IRC_CLK_HZ; /* IRC 48MHz oscillator drives MCG clock */
126         break;
127       }
128       tmpC7 = MCG->C7;
129       if (((MCG->C2 & MCG_C2_RANGE_MASK) != 0x00U) && ((tmpC7 & MCG_C7_OSCSEL_MASK) != 0x01U)) {
130         switch (MCG->C1 & MCG_C1_FRDIV_MASK) {
131         case 0x38U:
132           Divider = 1536U;
133           break;
134         case 0x30U:
135           Divider = 1280U;
136           break;
137         default:
138           Divider = (uint16_t)(32LU << ((MCG->C1 & MCG_C1_FRDIV_MASK) >> MCG_C1_FRDIV_SHIFT));
139           break;
140         }
141       } else {/* ((MCG->C2 & MCG_C2_RANGE_MASK) != 0x00U) */
142         Divider = (uint16_t)(1LU << ((MCG->C1 & MCG_C1_FRDIV_MASK) >> MCG_C1_FRDIV_SHIFT));
143       }
144       MCGOUTClock = (MCGOUTClock / Divider); /* Calculate the divided FLL reference clock */
145     } else { /* (!((MCG->C1 & MCG_C1_IREFS_MASK) == 0x00U)) */
146       MCGOUTClock = CPU_INT_SLOW_CLK_HZ; /* The slow internal reference clock is selected */
147     } /* (!((MCG->C1 & MCG_C1_IREFS_MASK) == 0x00U)) */
148     /* Select correct multiplier to calculate the MCG output clock  */
149     switch (MCG->C4 & (MCG_C4_DMX32_MASK | MCG_C4_DRST_DRS_MASK)) {
150       case 0x00U:
151         MCGOUTClock *= 640U;
152         break;
153       case 0x20U:
154         MCGOUTClock *= 1280U;
155         break;
156       case 0x40U:
157         MCGOUTClock *= 1920U;
158         break;
159       case 0x60U:
160         MCGOUTClock *= 2560U;
161         break;
162       case 0x80U:
163         MCGOUTClock *= 732U;
164         break;
165       case 0xA0U:
166         MCGOUTClock *= 1464U;
167         break;
168       case 0xC0U:
169         MCGOUTClock *= 2197U;
170         break;
171       case 0xE0U:
172         MCGOUTClock *= 2929U;
173         break;
174       default:
175         MCGOUTClock *= 640U;
176         break;
177     }
178   } else if ((MCG->C1 & MCG_C1_CLKS_MASK) == 0x40U) {
179     /* Internal reference clock is selected */
180     if ((MCG->C2 & MCG_C2_IRCS_MASK) == 0x00U) {
181       MCGOUTClock = CPU_INT_SLOW_CLK_HZ; /* Slow internal reference clock selected */
182     } else { /* (!((MCG->C2 & MCG_C2_IRCS_MASK) == 0x00U)) */
183       Divider = (uint16_t)(0x01LU << ((MCG->SC & MCG_SC_FCRDIV_MASK) >> MCG_SC_FCRDIV_SHIFT));
184       MCGOUTClock = (uint32_t) (CPU_INT_FAST_CLK_HZ / Divider); /* Fast internal reference clock selected */
185     } /* (!((MCG->C2 & MCG_C2_IRCS_MASK) == 0x00U)) */
186   } else if ((MCG->C1 & MCG_C1_CLKS_MASK) == 0x80U) {
187     /* External reference clock is selected */
188     switch (MCG->C7 & MCG_C7_OSCSEL_MASK) {
189     case 0x00U:
190       MCGOUTClock = CPU_XTAL_CLK_HZ;   /* System oscillator drives MCG clock */
191       break;
192     case 0x01U:
193       MCGOUTClock = CPU_XTAL32k_CLK_HZ; /* RTC 32 kHz oscillator drives MCG clock */
194       break;
195     case 0x02U:
196     default:
197       MCGOUTClock = CPU_INT_IRC_CLK_HZ; /* IRC 48MHz oscillator drives MCG clock */
198       break;
199     }
200   } else { /* (!((MCG->C1 & MCG_C1_CLKS_MASK) == 0x80U)) */
201     /* Reserved value */
202     return;
203   } /* (!((MCG->C1 & MCG_C1_CLKS_MASK) == 0x80U)) */
204   SystemCoreClock = (MCGOUTClock / (0x01U + ((SIM->CLKDIV1 & SIM_CLKDIV1_OUTDIV1_MASK) >> SIM_CLKDIV1_OUTDIV1_SHIFT)));
205 }
206 
207 /* ----------------------------------------------------------------------------
208    -- SystemInitHook()
209    ---------------------------------------------------------------------------- */
210 
SystemInitHook(void)211 __attribute__ ((weak)) void SystemInitHook (void) {
212   /* Void implementation of the weak function. */
213 }
214