1 /******************************************************************************
2 *
3 * Copyright (C) 2022-2023 Maxim Integrated Products, Inc. (now owned by
4 * Analog Devices, Inc.),
5 * Copyright (C) 2023-2024 Analog Devices, Inc.
6 *
7 * Licensed under the Apache License, Version 2.0 (the "License");
8 * you may not use this file except in compliance with the License.
9 * You may obtain a copy of the License at
10 *
11 * http://www.apache.org/licenses/LICENSE-2.0
12 *
13 * Unless required by applicable law or agreed to in writing, software
14 * distributed under the License is distributed on an "AS IS" BASIS,
15 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
16 * See the License for the specific language governing permissions and
17 * limitations under the License.
18 *
19 ******************************************************************************/
20
21 #include <string.h>
22 #include <stdio.h>
23 #include <stdlib.h>
24 #include "max32570.h"
25 #include "gcr_regs.h"
26 #include "mxc_sys.h"
27 #include "usbhs_regs.h"
28 #include "icc.h"
29
30 extern void (*const __isr_vector[])(void);
31
32 uint32_t SystemCoreClock = ISO_FREQ;
33
34 /*
35 The libc implementation from GCC 11+ depends on _getpid and _kill in some places.
36 There is no concept of processes/PIDs in the baremetal PeriphDrivers, therefore
37 we implement stub functions that return an error code to resolve linker warnings.
38 */
_getpid(void)39 __weak int _getpid(void)
40 {
41 return E_NOT_SUPPORTED;
42 }
43
_kill(void)44 __weak int _kill(void)
45 {
46 return E_NOT_SUPPORTED;
47 }
48
SystemCoreClockUpdate(void)49 __weak void SystemCoreClockUpdate(void)
50 {
51 uint32_t base_freq, div, clk_src;
52
53 // Get the clock source and frequency
54 clk_src = (MXC_GCR->clkctrl & MXC_F_GCR_CLKCTRL_SYSCLK_SEL);
55 switch (clk_src) {
56 case MXC_S_GCR_CLKCTRL_SYSCLK_SEL_ISO:
57 base_freq = ISO_FREQ;
58 break;
59 case MXC_S_GCR_CLKCTRL_SYSCLK_SEL_ERFO:
60 base_freq = ERFO_FREQ;
61 break;
62 case MXC_S_GCR_CLKCTRL_SYSCLK_SEL_INRO:
63 base_freq = INRO_FREQ;
64 break;
65 case MXC_S_GCR_CLKCTRL_SYSCLK_SEL_IPO:
66 base_freq = IPO_FREQ;
67 break;
68 case MXC_S_GCR_CLKCTRL_SYSCLK_SEL_IBRO:
69 base_freq = IBRO_FREQ;
70 break;
71 case MXC_S_GCR_CLKCTRL_SYSCLK_SEL_ERTCO:
72 base_freq = ERTCO_FREQ;
73 break;
74 default:
75 // Codes 001 and 111 are reserved.
76 // This code should never execute, however, initialize to safe value.
77 base_freq = ISO_FREQ;
78 break;
79 }
80 // Get the clock divider
81 div = (MXC_GCR->clkctrl & MXC_F_GCR_CLKCTRL_SYSCLK_DIV) >> MXC_F_GCR_CLKCTRL_SYSCLK_DIV_POS;
82
83 SystemCoreClock = base_freq >> div;
84 }
85
86 /* This function is called before C runtime initialization and can be
87 * implemented by the application for early initializations. If a value other
88 * than '0' is returned, the C runtime initialization will be skipped.
89 *
90 * You may over-ride this function in your program by defining a custom
91 * PreInit(), but care should be taken to reproduce the initialization steps
92 * or a non-functional system may result.
93 */
PreInit(void)94 __weak int PreInit(void)
95 {
96 /* Do nothing */
97 return 0;
98 }
99
100 /* This function can be implemented by the application to initialize the board */
Board_Init(void)101 __weak int Board_Init(void)
102 {
103 /* Do nothing */
104 return 0;
105 }
106
107 /* This function is called just before control is transferred to main().
108 *
109 * You may over-ride this function in your program by defining a custom
110 * SystemInit(), but care should be taken to reproduce the initialization
111 * steps or a non-functional system may result.
112 */
SystemInit(void)113 __weak void SystemInit(void)
114 {
115 /* Configure the interrupt controller to use the application vector table in */
116 /* the application space */
117 #if defined(__CC_ARM) || defined(__GNUC__)
118 /* IAR sets the VTOR pointer incorrectly and causes stack corruption */
119 SCB->VTOR = (uint32_t)__isr_vector;
120 #endif /* __CC_ARM || __GNUC__ */
121
122 /* Make sure interrupts are enabled. */
123 __enable_irq();
124
125 /* Enable FPU on Cortex-M4, which occupies coprocessor slots 10 & 11 */
126 /* Grant full access, per "Table B3-24 CPACR bit assignments". */
127 /* DDI0403D "ARMv7-M Architecture Reference Manual" */
128 SCB->CPACR |= SCB_CPACR_CP10_Msk | SCB_CPACR_CP11_Msk;
129 __DSB();
130 __ISB();
131
132 MXC_ICC_Enable();
133
134 /* Change system clock source to the main high-speed clock */
135 MXC_SYS_Clock_Select(MXC_SYS_CLOCK_IPO);
136 SystemCoreClockUpdate();
137
138 MXC_SYS_ClockEnable(MXC_SYS_PERIPH_CLOCK_GPIO0);
139 MXC_SYS_ClockEnable(MXC_SYS_PERIPH_CLOCK_GPIO1);
140
141 Board_Init();
142 }
143
