|
| 1 | +/* |
| 2 | + * Copyright (c) 2017, NXP |
| 3 | + * |
| 4 | + * SPDX-License-Identifier: Apache-2.0 |
| 5 | + */ |
| 6 | + |
| 7 | +#include <init.h> |
| 8 | +#include <soc.h> |
| 9 | +#include "wdog_imx.h" |
| 10 | + |
| 11 | +/* Initialize clock. */ |
| 12 | +void SOC_ClockInit(void) |
| 13 | +{ |
| 14 | + /* OSC/PLL is already initialized by Cortex-A7 (u-boot) */ |
| 15 | + |
| 16 | + /* |
| 17 | + * Disable WDOG3 |
| 18 | + * Note : The WDOG clock Root is shared by all the 4 WDOGs, |
| 19 | + * so Zephyr code should avoid closing it |
| 20 | + */ |
| 21 | + CCM_UpdateRoot(CCM, ccmRootWdog, ccmRootmuxWdogOsc24m, 0, 0); |
| 22 | + CCM_EnableRoot(CCM, ccmRootWdog); |
| 23 | + CCM_ControlGate(CCM, ccmCcgrGateWdog3, ccmClockNeededRun); |
| 24 | + |
| 25 | + RDC_SetPdapAccess(RDC, rdcPdapWdog3, |
| 26 | + RDC_DOMAIN_PERM(CONFIG_DOMAIN_ID, RDC_DOMAIN_PERM_RW), |
| 27 | + false, false); |
| 28 | + |
| 29 | + WDOG_DisablePowerdown(WDOG3); |
| 30 | + |
| 31 | + CCM_ControlGate(CCM, ccmCcgrGateWdog3, ccmClockNotNeeded); |
| 32 | + |
| 33 | + /* We need system PLL Div2 to run M4 core */ |
| 34 | + CCM_ControlGate(CCM, ccmPllGateSys, ccmClockNeededRun); |
| 35 | + CCM_ControlGate(CCM, ccmPllGateSysDiv2, ccmClockNeededRun); |
| 36 | + |
| 37 | + /* Enable clock gate for IP bridge and IO mux */ |
| 38 | + CCM_ControlGate(CCM, ccmCcgrGateIpmux1, ccmClockNeededRun); |
| 39 | + CCM_ControlGate(CCM, ccmCcgrGateIpmux2, ccmClockNeededRun); |
| 40 | + CCM_ControlGate(CCM, ccmCcgrGateIpmux3, ccmClockNeededRun); |
| 41 | + CCM_ControlGate(CCM, ccmCcgrGateIomux, ccmClockNeededRun); |
| 42 | + CCM_ControlGate(CCM, ccmCcgrGateIomuxLpsr, ccmClockNeededRun); |
| 43 | + |
| 44 | + /* Enable clock gate for RDC */ |
| 45 | + CCM_ControlGate(CCM, ccmCcgrGateRdc, ccmClockNeededRun); |
| 46 | +} |
| 47 | + |
| 48 | +void SOC_RdcInit(void) |
| 49 | +{ |
| 50 | + /* Move M4 core to specific RDC domain */ |
| 51 | + RDC_SetDomainID(RDC, rdcMdaM4, CONFIG_DOMAIN_ID, false); |
| 52 | +} |
| 53 | + |
| 54 | +#ifdef CONFIG_UART_IMX |
| 55 | +static void nxp_mcimx7_uart_config(void) |
| 56 | +{ |
| 57 | + |
| 58 | +#ifdef CONFIG_UART_IMX_UART_2 |
| 59 | + /* We need to grasp board uart exclusively */ |
| 60 | + RDC_SetPdapAccess(RDC, rdcPdapUart2, |
| 61 | + RDC_DOMAIN_PERM(CONFIG_DOMAIN_ID, RDC_DOMAIN_PERM_RW), |
| 62 | + false, false); |
| 63 | + /* Select clock derived from OSC clock(24M) */ |
| 64 | + CCM_UpdateRoot(CCM, ccmRootUart2, ccmRootmuxUartOsc24m, 0, 0); |
| 65 | + /* Enable uart clock */ |
| 66 | + CCM_EnableRoot(CCM, ccmRootUart2); |
| 67 | + /* |
| 68 | + * IC Limitation |
| 69 | + * M4 stop will cause A7 UART lose functionality |
| 70 | + * So we need UART clock all the time |
| 71 | + */ |
| 72 | + CCM_ControlGate(CCM, ccmCcgrGateUart2, ccmClockNeededAll); |
| 73 | +#endif /* #ifdef CONFIG_UART_IMX_UART_2 */ |
| 74 | + |
| 75 | +} |
| 76 | +#endif /* CONFIG_UART_IMX */ |
| 77 | + |
| 78 | +static int nxp_mcimx7_init(struct device *arg) |
| 79 | +{ |
| 80 | + ARG_UNUSED(arg); |
| 81 | + |
| 82 | + /* SoC specific RDC settings */ |
| 83 | + SOC_RdcInit(); |
| 84 | + |
| 85 | + /* BoC specific clock settings */ |
| 86 | + SOC_ClockInit(); |
| 87 | + |
| 88 | +#ifdef CONFIG_UART_IMX |
| 89 | + nxp_mcimx7_uart_config(); |
| 90 | +#endif /* CONFIG_UART_IMX */ |
| 91 | + |
| 92 | + return 0; |
| 93 | +} |
| 94 | + |
| 95 | +SYS_INIT(nxp_mcimx7_init, PRE_KERNEL_1, 0); |
0 commit comments