I2C hang recover function added

Dependencies:   UniGraphic mbed vt100

In this version, check_i2c_pins function was added in edge_mgr.cpp.

プログラムの起動時、I2Cモジュールを初期化する前に、I2Cに使用するピンの電位を確認し
もし一方でも Low に張り付いていた場合、SCL を GPIO 出力に設定して 
所定回数 (I2C_UNLOCK_TRIAL_CYCLE) 反転させることにより、疑似リセットクロックを生成します。

その後は、通常の起動手順に復帰し、以降はこれまでと同様の動作をします。

Committer:
Rhyme
Date:
Tue Apr 03 08:30:29 2018 +0000
Revision:
0:d895cd1cd897
Initial I2C Pin force reset function added

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Rhyme 0:d895cd1cd897 1 #if defined (TARGET_KL25Z)
Rhyme 0:d895cd1cd897 2 /*
Rhyme 0:d895cd1cd897 3 ** ###################################################################
Rhyme 0:d895cd1cd897 4 ** Processor: MKL25Z128VLK4
Rhyme 0:d895cd1cd897 5 ** Compilers: ARM Compiler
Rhyme 0:d895cd1cd897 6 ** Freescale C/C++ for Embedded ARM
Rhyme 0:d895cd1cd897 7 ** GNU C Compiler
Rhyme 0:d895cd1cd897 8 ** IAR ANSI C/C++ Compiler for ARM
Rhyme 0:d895cd1cd897 9 **
Rhyme 0:d895cd1cd897 10 ** Reference manual: KL25RM, Rev.1, Jun 2012
Rhyme 0:d895cd1cd897 11 ** Version: rev. 1.1, 2012-06-21
Rhyme 0:d895cd1cd897 12 **
Rhyme 0:d895cd1cd897 13 ** Abstract:
Rhyme 0:d895cd1cd897 14 ** Provides a system configuration function and a global variable that
Rhyme 0:d895cd1cd897 15 ** contains the system frequency. It configures the device and initializes
Rhyme 0:d895cd1cd897 16 ** the oscillator (PLL) that is part of the microcontroller device.
Rhyme 0:d895cd1cd897 17 **
Rhyme 0:d895cd1cd897 18 ** Copyright: 2012 Freescale Semiconductor, Inc. All Rights Reserved.
Rhyme 0:d895cd1cd897 19 **
Rhyme 0:d895cd1cd897 20 ** http: www.freescale.com
Rhyme 0:d895cd1cd897 21 ** mail: support@freescale.com
Rhyme 0:d895cd1cd897 22 **
Rhyme 0:d895cd1cd897 23 ** Revisions:
Rhyme 0:d895cd1cd897 24 ** - rev. 1.0 (2012-06-13)
Rhyme 0:d895cd1cd897 25 ** Initial version.
Rhyme 0:d895cd1cd897 26 ** - rev. 1.1 (2012-06-21)
Rhyme 0:d895cd1cd897 27 ** Update according to reference manual rev. 1.
Rhyme 0:d895cd1cd897 28 **
Rhyme 0:d895cd1cd897 29 ** ###################################################################
Rhyme 0:d895cd1cd897 30 */
Rhyme 0:d895cd1cd897 31
Rhyme 0:d895cd1cd897 32 /**
Rhyme 0:d895cd1cd897 33 * @file MKL25Z4
Rhyme 0:d895cd1cd897 34 * @version 1.1
Rhyme 0:d895cd1cd897 35 * @date 2012-06-21
Rhyme 0:d895cd1cd897 36 * @brief Device specific configuration file for MKL25Z4 (implementation file)
Rhyme 0:d895cd1cd897 37 *
Rhyme 0:d895cd1cd897 38 * Provides a system configuration function and a global variable that contains
Rhyme 0:d895cd1cd897 39 * the system frequency. It configures the device and initializes the oscillator
Rhyme 0:d895cd1cd897 40 * (PLL) that is part of the microcontroller device.
Rhyme 0:d895cd1cd897 41 */
Rhyme 0:d895cd1cd897 42
Rhyme 0:d895cd1cd897 43 #include <stdint.h>
Rhyme 0:d895cd1cd897 44 #include "MKL25Z4.h"
Rhyme 0:d895cd1cd897 45
Rhyme 0:d895cd1cd897 46 //MODIFICATION: We DO want watchdog, uC default after reset is enabled with timeout=1024ms (2^10*LPO=1KHz)
Rhyme 0:d895cd1cd897 47 //#define DISABLE_WDOG 1
Rhyme 0:d895cd1cd897 48
Rhyme 0:d895cd1cd897 49 #define CLOCK_SETUP 1
Rhyme 0:d895cd1cd897 50 /* Predefined clock setups
Rhyme 0:d895cd1cd897 51 0 ... Multipurpose Clock Generator (MCG) in FLL Engaged Internal (FEI) mode
Rhyme 0:d895cd1cd897 52 Reference clock source for MCG module is the slow internal clock source 32.768kHz
Rhyme 0:d895cd1cd897 53 Core clock = 41.94MHz, BusClock = 13.98MHz
Rhyme 0:d895cd1cd897 54 1 ... Multipurpose Clock Generator (MCG) in PLL Engaged External (PEE) mode
Rhyme 0:d895cd1cd897 55 Reference clock source for MCG module is an external crystal 8MHz
Rhyme 0:d895cd1cd897 56 Core clock = 48MHz, BusClock = 24MHz
Rhyme 0:d895cd1cd897 57 2 ... Multipurpose Clock Generator (MCG) in Bypassed Low Power External (BLPE) mode
Rhyme 0:d895cd1cd897 58 Core clock/Bus clock derived directly from an external crystal 8MHz with no multiplication
Rhyme 0:d895cd1cd897 59 Core clock = 8MHz, BusClock = 8MHz
Rhyme 0:d895cd1cd897 60 3 ... Multipurpose Clock Generator (MCG) in FLL Engaged External (FEE) mode
Rhyme 0:d895cd1cd897 61 Reference clock source for MCG module is an external crystal 32.768kHz
Rhyme 0:d895cd1cd897 62 Core clock = 47.97MHz, BusClock = 23.98MHz
Rhyme 0:d895cd1cd897 63 This setup sets the RTC to be driven by the MCU clock directly without the need of an external source.
Rhyme 0:d895cd1cd897 64 RTC register values are retained when MCU is reset although there will be a slight (mSec's)loss of time
Rhyme 0:d895cd1cd897 65 accuracy durring the reset period. RTC will reset on power down.
Rhyme 0:d895cd1cd897 66 */
Rhyme 0:d895cd1cd897 67
Rhyme 0:d895cd1cd897 68 /*----------------------------------------------------------------------------
Rhyme 0:d895cd1cd897 69 Define clock source values
Rhyme 0:d895cd1cd897 70 *----------------------------------------------------------------------------*/
Rhyme 0:d895cd1cd897 71 #if (CLOCK_SETUP == 0)
Rhyme 0:d895cd1cd897 72 #define CPU_XTAL_CLK_HZ 8000000u /* Value of the external crystal or oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 73 #define CPU_INT_SLOW_CLK_HZ 32768u /* Value of the slow internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 74 #define CPU_INT_FAST_CLK_HZ 4000000u /* Value of the fast internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 75 #define DEFAULT_SYSTEM_CLOCK 41943040u /* Default System clock value */
Rhyme 0:d895cd1cd897 76 #elif (CLOCK_SETUP == 1)
Rhyme 0:d895cd1cd897 77 #define CPU_XTAL_CLK_HZ 8000000u /* Value of the external crystal or oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 78 #define CPU_INT_SLOW_CLK_HZ 32768u /* Value of the slow internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 79 #define CPU_INT_FAST_CLK_HZ 4000000u /* Value of the fast internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 80 #define DEFAULT_SYSTEM_CLOCK 48000000u /* Default System clock value */
Rhyme 0:d895cd1cd897 81 #elif (CLOCK_SETUP == 2)
Rhyme 0:d895cd1cd897 82 #define CPU_XTAL_CLK_HZ 8000000u /* Value of the external crystal or oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 83 #define CPU_INT_SLOW_CLK_HZ 32768u /* Value of the slow internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 84 #define CPU_INT_FAST_CLK_HZ 4000000u /* Value of the fast internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 85 #define DEFAULT_SYSTEM_CLOCK 8000000u /* Default System clock value */
Rhyme 0:d895cd1cd897 86 #elif (CLOCK_SETUP == 3)
Rhyme 0:d895cd1cd897 87 #define CPU_XTAL_CLK_HZ 32768u /* Value of the external crystal or oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 88 #define CPU_INT_SLOW_CLK_HZ 32768u /* Value of the slow internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 89 #define CPU_INT_FAST_CLK_HZ 4000000u /* Value of the fast internal oscillator clock frequency in Hz */
Rhyme 0:d895cd1cd897 90 #define DEFAULT_SYSTEM_CLOCK 47972352u /* Default System clock value */
Rhyme 0:d895cd1cd897 91 #endif /* (CLOCK_SETUP == 3) */
Rhyme 0:d895cd1cd897 92
Rhyme 0:d895cd1cd897 93 /* ----------------------------------------------------------------------------
Rhyme 0:d895cd1cd897 94 -- Core clock
Rhyme 0:d895cd1cd897 95 ---------------------------------------------------------------------------- */
Rhyme 0:d895cd1cd897 96
Rhyme 0:d895cd1cd897 97 //MODIFICATION: That vartiable already exists
Rhyme 0:d895cd1cd897 98 // uint32_t SystemCoreClock = DEFAULT_SYSTEM_CLOCK;
Rhyme 0:d895cd1cd897 99
Rhyme 0:d895cd1cd897 100 /* ----------------------------------------------------------------------------
Rhyme 0:d895cd1cd897 101 -- SystemInit()
Rhyme 0:d895cd1cd897 102 ---------------------------------------------------------------------------- */
Rhyme 0:d895cd1cd897 103
Rhyme 0:d895cd1cd897 104 void $Sub$$SystemInit (void) {
Rhyme 0:d895cd1cd897 105
Rhyme 0:d895cd1cd897 106 //MODIFICATION:
Rhyme 0:d895cd1cd897 107 // That variable already exists, we set it here
Rhyme 0:d895cd1cd897 108 SystemCoreClock = DEFAULT_SYSTEM_CLOCK;
Rhyme 0:d895cd1cd897 109 // We want visual indication of boot time with red LED on
Rhyme 0:d895cd1cd897 110 //TODO
Rhyme 0:d895cd1cd897 111
Rhyme 0:d895cd1cd897 112 #if (DISABLE_WDOG)
Rhyme 0:d895cd1cd897 113 /* Disable the WDOG module */
Rhyme 0:d895cd1cd897 114 /* SIM_COPC: COPT=0,COPCLKS=0,COPW=0 */
Rhyme 0:d895cd1cd897 115 SIM->COPC = (uint32_t)0x00u;
Rhyme 0:d895cd1cd897 116 #endif /* (DISABLE_WDOG) */
Rhyme 0:d895cd1cd897 117 #if (CLOCK_SETUP == 0)
Rhyme 0:d895cd1cd897 118 /* SIM->CLKDIV1: OUTDIV1=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,OUTDIV4=2,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0 */
Rhyme 0:d895cd1cd897 119 SIM->CLKDIV1 = (uint32_t)0x00020000UL; /* Update system prescalers */
Rhyme 0:d895cd1cd897 120 /* Switch to FEI Mode */
Rhyme 0:d895cd1cd897 121 /* MCG->C1: CLKS=0,FRDIV=0,IREFS=1,IRCLKEN=1,IREFSTEN=0 */
Rhyme 0:d895cd1cd897 122 MCG->C1 = (uint8_t)0x06U;
Rhyme 0:d895cd1cd897 123 /* MCG_C2: LOCRE0=0,??=0,RANGE0=0,HGO0=0,EREFS0=0,LP=0,IRCS=0 */
Rhyme 0:d895cd1cd897 124 MCG->C2 = (uint8_t)0x00U;
Rhyme 0:d895cd1cd897 125 /* MCG->C4: DMX32=0,DRST_DRS=1 */
Rhyme 0:d895cd1cd897 126 MCG->C4 = (uint8_t)((MCG->C4 & (uint8_t)~(uint8_t)0xC0U) | (uint8_t)0x20U);
Rhyme 0:d895cd1cd897 127 /* OSC0->CR: ERCLKEN=1,??=0,EREFSTEN=0,??=0,SC2P=0,SC4P=0,SC8P=0,SC16P=0 */
Rhyme 0:d895cd1cd897 128 OSC0->CR = (uint8_t)0x80U;
Rhyme 0:d895cd1cd897 129 /* MCG->C5: ??=0,PLLCLKEN0=0,PLLSTEN0=0,PRDIV0=0 */
Rhyme 0:d895cd1cd897 130 MCG->C5 = (uint8_t)0x00U;
Rhyme 0:d895cd1cd897 131 /* MCG->C6: LOLIE0=0,PLLS=0,CME0=0,VDIV0=0 */
Rhyme 0:d895cd1cd897 132 MCG->C6 = (uint8_t)0x00U;
Rhyme 0:d895cd1cd897 133 while((MCG->S & MCG_S_IREFST_MASK) == 0x00U) { /* Check that the source of the FLL reference clock is the internal reference clock. */
Rhyme 0:d895cd1cd897 134 }
Rhyme 0:d895cd1cd897 135 while((MCG->S & 0x0CU) != 0x00U) { /* Wait until output of the FLL is selected */
Rhyme 0:d895cd1cd897 136 }
Rhyme 0:d895cd1cd897 137 #elif (CLOCK_SETUP == 1)
Rhyme 0:d895cd1cd897 138 /* SIM->SCGC5: PORTA=1 */
Rhyme 0:d895cd1cd897 139 SIM->SCGC5 |= (uint32_t)0x0200UL; /* Enable clock gate for ports to enable pin routing */
Rhyme 0:d895cd1cd897 140 /* SIM->CLKDIV1: OUTDIV1=1,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,OUTDIV4=1,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0 */
Rhyme 0:d895cd1cd897 141 SIM->CLKDIV1 = (uint32_t)0x10010000UL; /* Update system prescalers */
Rhyme 0:d895cd1cd897 142 /* PORTA->PCR18: ISF=0,MUX=0 */
Rhyme 0:d895cd1cd897 143 PORTA->PCR[18] &= (uint32_t)~0x01000700UL;
Rhyme 0:d895cd1cd897 144 /* PORTA->PCR19: ISF=0,MUX=0 */
Rhyme 0:d895cd1cd897 145 PORTA->PCR[19] &= (uint32_t)~0x01000700UL;
Rhyme 0:d895cd1cd897 146 /* Switch to FBE Mode */
Rhyme 0:d895cd1cd897 147 /* OSC0->CR: ERCLKEN=1,??=0,EREFSTEN=0,??=0,SC2P=1,SC4P=0,SC8P=0,SC16P=1 */
Rhyme 0:d895cd1cd897 148 OSC0->CR = (uint8_t)0x89U;
Rhyme 0:d895cd1cd897 149 /* MCG->C2: LOCRE0=0,??=0,RANGE0=2,HGO0=0,EREFS0=1,LP=0,IRCS=0 */
Rhyme 0:d895cd1cd897 150 MCG->C2 = (uint8_t)0x24U;
Rhyme 0:d895cd1cd897 151 /* MCG->C1: CLKS=2,FRDIV=3,IREFS=0,IRCLKEN=1,IREFSTEN=0 */
Rhyme 0:d895cd1cd897 152 MCG->C1 = (uint8_t)0x9AU;
Rhyme 0:d895cd1cd897 153 /* MCG->C4: DMX32=0,DRST_DRS=0 */
Rhyme 0:d895cd1cd897 154 MCG->C4 &= (uint8_t)~(uint8_t)0xE0U;
Rhyme 0:d895cd1cd897 155 /* MCG->C5: ??=0,PLLCLKEN0=0,PLLSTEN0=0,PRDIV0=1 */
Rhyme 0:d895cd1cd897 156 MCG->C5 = (uint8_t)0x01U;
Rhyme 0:d895cd1cd897 157 /* MCG->C6: LOLIE0=0,PLLS=0,CME0=0,VDIV0=0 */
Rhyme 0:d895cd1cd897 158 MCG->C6 = (uint8_t)0x00U;
Rhyme 0:d895cd1cd897 159 while((MCG->S & MCG_S_IREFST_MASK) != 0x00U) { /* Check that the source of the FLL reference clock is the external reference clock. */
Rhyme 0:d895cd1cd897 160 }
Rhyme 0:d895cd1cd897 161 while((MCG->S & 0x0CU) != 0x08U) { /* Wait until external reference clock is selected as MCG output */
Rhyme 0:d895cd1cd897 162 }
Rhyme 0:d895cd1cd897 163 /* Switch to PBE Mode */
Rhyme 0:d895cd1cd897 164 /* MCG->C6: LOLIE0=0,PLLS=1,CME0=0,VDIV0=0 */
Rhyme 0:d895cd1cd897 165 MCG->C6 = (uint8_t)0x40U;
Rhyme 0:d895cd1cd897 166 while((MCG->S & 0x0CU) != 0x08U) { /* Wait until external reference clock is selected as MCG output */
Rhyme 0:d895cd1cd897 167 }
Rhyme 0:d895cd1cd897 168 while((MCG->S & MCG_S_LOCK0_MASK) == 0x00U) { /* Wait until locked */
Rhyme 0:d895cd1cd897 169 }
Rhyme 0:d895cd1cd897 170 /* Switch to PEE Mode */
Rhyme 0:d895cd1cd897 171 /* MCG->C1: CLKS=0,FRDIV=3,IREFS=0,IRCLKEN=1,IREFSTEN=0 */
Rhyme 0:d895cd1cd897 172 MCG->C1 = (uint8_t)0x1AU;
Rhyme 0:d895cd1cd897 173 while((MCG->S & 0x0CU) != 0x0CU) { /* Wait until output of the PLL is selected */
Rhyme 0:d895cd1cd897 174 }
Rhyme 0:d895cd1cd897 175 #elif (CLOCK_SETUP == 2)
Rhyme 0:d895cd1cd897 176 /* SIM->SCGC5: PORTA=1 */
Rhyme 0:d895cd1cd897 177 SIM->SCGC5 |= (uint32_t)0x0200UL; /* Enable clock gate for ports to enable pin routing */
Rhyme 0:d895cd1cd897 178 /* SIM->CLKDIV1: OUTDIV1=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,OUTDIV4=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0 */
Rhyme 0:d895cd1cd897 179 SIM->CLKDIV1 = (uint32_t)0x00000000UL; /* Update system prescalers */
Rhyme 0:d895cd1cd897 180 /* PORTA->PCR18: ISF=0,MUX=0 */
Rhyme 0:d895cd1cd897 181 PORTA->PCR[18] &= (uint32_t)~0x01000700UL;
Rhyme 0:d895cd1cd897 182 /* PORTA->PCR19: ISF=0,MUX=0 */
Rhyme 0:d895cd1cd897 183 PORTA->PCR[19] &= (uint32_t)~0x01000700UL;
Rhyme 0:d895cd1cd897 184 /* Switch to FBE Mode */
Rhyme 0:d895cd1cd897 185 /* OSC0->CR: ERCLKEN=1,??=0,EREFSTEN=0,??=0,SC2P=1,SC4P=0,SC8P=0,SC16P=1 */
Rhyme 0:d895cd1cd897 186 OSC0->CR = (uint8_t)0x89U;
Rhyme 0:d895cd1cd897 187 /* MCG->C2: LOCRE0=0,??=0,RANGE0=2,HGO0=0,EREFS0=1,LP=0,IRCS=0 */
Rhyme 0:d895cd1cd897 188 MCG->C2 = (uint8_t)0x24U;
Rhyme 0:d895cd1cd897 189 /* MCG->C1: CLKS=2,FRDIV=3,IREFS=0,IRCLKEN=1,IREFSTEN=0 */
Rhyme 0:d895cd1cd897 190 MCG->C1 = (uint8_t)0x9AU;
Rhyme 0:d895cd1cd897 191 /* MCG->C4: DMX32=0,DRST_DRS=0 */
Rhyme 0:d895cd1cd897 192 MCG->C4 &= (uint8_t)~(uint8_t)0xE0U;
Rhyme 0:d895cd1cd897 193 /* MCG->C5: ??=0,PLLCLKEN0=0,PLLSTEN0=0,PRDIV0=0 */
Rhyme 0:d895cd1cd897 194 MCG->C5 = (uint8_t)0x00U;
Rhyme 0:d895cd1cd897 195 /* MCG->C6: LOLIE0=0,PLLS=0,CME0=0,VDIV0=0 */
Rhyme 0:d895cd1cd897 196 MCG->C6 = (uint8_t)0x00U;
Rhyme 0:d895cd1cd897 197 while((MCG->S & MCG_S_IREFST_MASK) != 0x00U) { /* Check that the source of the FLL reference clock is the external reference clock. */
Rhyme 0:d895cd1cd897 198 }
Rhyme 0:d895cd1cd897 199 while((MCG->S & 0x0CU) != 0x08U) { /* Wait until external reference clock is selected as MCG output */
Rhyme 0:d895cd1cd897 200 }
Rhyme 0:d895cd1cd897 201 /* Switch to BLPE Mode */
Rhyme 0:d895cd1cd897 202 /* MCG->C2: LOCRE0=0,??=0,RANGE0=2,HGO0=0,EREFS0=1,LP=1,IRCS=0 */
Rhyme 0:d895cd1cd897 203 MCG->C2 = (uint8_t)0x26U;
Rhyme 0:d895cd1cd897 204 while((MCG->S & 0x0CU) != 0x08U) { /* Wait until external reference clock is selected as MCG output */
Rhyme 0:d895cd1cd897 205 }
Rhyme 0:d895cd1cd897 206 #elif (CLOCK_SETUP == 3)
Rhyme 0:d895cd1cd897 207 /* SIM->SCGC5: PORTA=1 */
Rhyme 0:d895cd1cd897 208 SIM->SCGC5 |= SIM_SCGC5_PORTA_MASK; /* Enable clock gate for ports to enable pin routing */
Rhyme 0:d895cd1cd897 209 /* SIM->CLKDIV1: OUTDIV1=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,OUTDIV4=1,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0,??=0 */
Rhyme 0:d895cd1cd897 210 SIM->CLKDIV1 = (SIM_CLKDIV1_OUTDIV1(0x00) | SIM_CLKDIV1_OUTDIV4(0x01)); /* Update system prescalers */
Rhyme 0:d895cd1cd897 211 /* PORTA->PCR[3]: ISF=0,MUX=0 */
Rhyme 0:d895cd1cd897 212 PORTA->PCR[3] &= (uint32_t)~(uint32_t)((PORT_PCR_ISF_MASK | PORT_PCR_MUX(0x07)));
Rhyme 0:d895cd1cd897 213 /* PORTA->PCR[4]: ISF=0,MUX=0 */
Rhyme 0:d895cd1cd897 214 PORTA->PCR[4] &= (uint32_t)~(uint32_t)((PORT_PCR_ISF_MASK | PORT_PCR_MUX(0x07)));
Rhyme 0:d895cd1cd897 215 /* Switch to FEE Mode */
Rhyme 0:d895cd1cd897 216 /* MCG->C2: LOCRE0=0,??=0,RANGE0=0,HGO0=0,EREFS0=1,LP=0,IRCS=0 */
Rhyme 0:d895cd1cd897 217 MCG->C2 = (MCG_C2_RANGE0(0x00) | MCG_C2_EREFS0_MASK);
Rhyme 0:d895cd1cd897 218 /* OSC0->CR: ERCLKEN=1,??=0,EREFSTEN=0,??=0,SC2P=0,SC4P=0,SC8P=0,SC16P=0 */
Rhyme 0:d895cd1cd897 219 OSC0->CR = OSC_CR_ERCLKEN_MASK | OSC_CR_SC16P_MASK | OSC_CR_SC4P_MASK | OSC_CR_SC2P_MASK;
Rhyme 0:d895cd1cd897 220 /* MCG->C1: CLKS=0,FRDIV=0,IREFS=0,IRCLKEN=1,IREFSTEN=0 */
Rhyme 0:d895cd1cd897 221 MCG->C1 = (MCG_C1_CLKS(0x00) | MCG_C1_FRDIV(0x00) | MCG_C1_IRCLKEN_MASK);
Rhyme 0:d895cd1cd897 222 /* MCG->C4: DMX32=1,DRST_DRS=1 */
Rhyme 0:d895cd1cd897 223 MCG->C4 = (uint8_t)((MCG->C4 & (uint8_t)~(uint8_t)(
Rhyme 0:d895cd1cd897 224 MCG_C4_DRST_DRS(0x02)
Rhyme 0:d895cd1cd897 225 )) | (uint8_t)(
Rhyme 0:d895cd1cd897 226 MCG_C4_DMX32_MASK |
Rhyme 0:d895cd1cd897 227 MCG_C4_DRST_DRS(0x01)
Rhyme 0:d895cd1cd897 228 ));
Rhyme 0:d895cd1cd897 229 while((MCG->S & MCG_S_IREFST_MASK) != 0x00U) { /* Check that the source of the FLL reference clock is the external reference clock. */
Rhyme 0:d895cd1cd897 230 }
Rhyme 0:d895cd1cd897 231 while((MCG->S & 0x0CU) != 0x00U) { /* Wait until output of the FLL is selected */
Rhyme 0:d895cd1cd897 232 }
Rhyme 0:d895cd1cd897 233 #endif /* (CLOCK_SETUP == 3) */
Rhyme 0:d895cd1cd897 234 }
Rhyme 0:d895cd1cd897 235 #endif // TARGET_KL25Z