1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (C) 1999,2000 Arm Limited 4 * Copyright (C) 2000 Deep Blue Solutions Ltd 5 * Copyright (C) 2002 Shane Nay (shane@minirl.com) 6 * Copyright 2005-2007 Freescale Semiconductor, Inc. All Rights Reserved. 7 * - add MX31 specific definitions 8 */ 9 10 #include <linux/mm.h> 11 #include <linux/init.h> 12 #include <linux/err.h> 13 #include <linux/io.h> 14 #include <linux/of_address.h> 15 #include <linux/pinctrl/machine.h> 16 17 #include <asm/system_misc.h> 18 #include <asm/hardware/cache-l2x0.h> 19 #include <asm/mach/map.h> 20 21 #include "common.h" 22 #include "crmregs-imx3.h" 23 #include "hardware.h" 24 25 void __iomem *mx3_ccm_base; 26 27 static void imx3_idle(void) 28 { 29 unsigned long reg = 0; 30 31 __asm__ __volatile__( 32 /* disable I and D cache */ 33 "mrc p15, 0, %0, c1, c0, 0\n" 34 "bic %0, %0, #0x00001000\n" 35 "bic %0, %0, #0x00000004\n" 36 "mcr p15, 0, %0, c1, c0, 0\n" 37 /* invalidate I cache */ 38 "mov %0, #0\n" 39 "mcr p15, 0, %0, c7, c5, 0\n" 40 /* clear and invalidate D cache */ 41 "mov %0, #0\n" 42 "mcr p15, 0, %0, c7, c14, 0\n" 43 /* WFI */ 44 "mov %0, #0\n" 45 "mcr p15, 0, %0, c7, c0, 4\n" 46 "nop\n" "nop\n" "nop\n" "nop\n" 47 "nop\n" "nop\n" "nop\n" 48 /* enable I and D cache */ 49 "mrc p15, 0, %0, c1, c0, 0\n" 50 "orr %0, %0, #0x00001000\n" 51 "orr %0, %0, #0x00000004\n" 52 "mcr p15, 0, %0, c1, c0, 0\n" 53 : "=r" (reg)); 54 } 55 56 static void __iomem *imx3_ioremap_caller(phys_addr_t phys_addr, size_t size, 57 unsigned int mtype, void *caller) 58 { 59 if (mtype == MT_DEVICE) { 60 /* 61 * Access all peripherals below 0x80000000 as nonshared device 62 * on mx3, but leave l2cc alone. Otherwise cache corruptions 63 * can occur. 64 */ 65 if (phys_addr < 0x80000000 && 66 !addr_in_module(phys_addr, MX3x_L2CC)) 67 mtype = MT_DEVICE_NONSHARED; 68 } 69 70 return __arm_ioremap_caller(phys_addr, size, mtype, caller); 71 } 72 73 #ifdef CONFIG_SOC_IMX31 74 static struct map_desc mx31_io_desc[] __initdata = { 75 imx_map_entry(MX31, X_MEMC, MT_DEVICE), 76 imx_map_entry(MX31, AVIC, MT_DEVICE_NONSHARED), 77 imx_map_entry(MX31, AIPS1, MT_DEVICE_NONSHARED), 78 imx_map_entry(MX31, AIPS2, MT_DEVICE_NONSHARED), 79 imx_map_entry(MX31, SPBA0, MT_DEVICE_NONSHARED), 80 }; 81 82 /* 83 * This function initializes the memory map. It is called during the 84 * system startup to create static physical to virtual memory mappings 85 * for the IO modules. 86 */ 87 void __init mx31_map_io(void) 88 { 89 iotable_init(mx31_io_desc, ARRAY_SIZE(mx31_io_desc)); 90 } 91 92 static void imx31_idle(void) 93 { 94 int reg = imx_readl(mx3_ccm_base + MXC_CCM_CCMR); 95 reg &= ~MXC_CCM_CCMR_LPM_MASK; 96 imx_writel(reg, mx3_ccm_base + MXC_CCM_CCMR); 97 98 imx3_idle(); 99 } 100 101 void __init imx31_init_early(void) 102 { 103 struct device_node *np; 104 105 mxc_set_cpu_type(MXC_CPU_MX31); 106 arch_ioremap_caller = imx3_ioremap_caller; 107 arm_pm_idle = imx31_idle; 108 np = of_find_compatible_node(NULL, NULL, "fsl,imx31-ccm"); 109 mx3_ccm_base = of_iomap(np, 0); 110 BUG_ON(!mx3_ccm_base); 111 } 112 113 void __init mx31_init_irq(void) 114 { 115 void __iomem *avic_base; 116 struct device_node *np; 117 118 np = of_find_compatible_node(NULL, NULL, "fsl,imx31-avic"); 119 avic_base = of_iomap(np, 0); 120 BUG_ON(!avic_base); 121 122 mxc_init_irq(avic_base); 123 } 124 #endif /* ifdef CONFIG_SOC_IMX31 */ 125 126 #ifdef CONFIG_SOC_IMX35 127 static struct map_desc mx35_io_desc[] __initdata = { 128 imx_map_entry(MX35, X_MEMC, MT_DEVICE), 129 imx_map_entry(MX35, AVIC, MT_DEVICE_NONSHARED), 130 imx_map_entry(MX35, AIPS1, MT_DEVICE_NONSHARED), 131 imx_map_entry(MX35, AIPS2, MT_DEVICE_NONSHARED), 132 imx_map_entry(MX35, SPBA0, MT_DEVICE_NONSHARED), 133 }; 134 135 void __init mx35_map_io(void) 136 { 137 iotable_init(mx35_io_desc, ARRAY_SIZE(mx35_io_desc)); 138 } 139 140 static void imx35_idle(void) 141 { 142 int reg = imx_readl(mx3_ccm_base + MXC_CCM_CCMR); 143 reg &= ~MXC_CCM_CCMR_LPM_MASK; 144 reg |= MXC_CCM_CCMR_LPM_WAIT_MX35; 145 imx_writel(reg, mx3_ccm_base + MXC_CCM_CCMR); 146 147 imx3_idle(); 148 } 149 150 void __init imx35_init_early(void) 151 { 152 struct device_node *np; 153 154 mxc_set_cpu_type(MXC_CPU_MX35); 155 arm_pm_idle = imx35_idle; 156 arch_ioremap_caller = imx3_ioremap_caller; 157 np = of_find_compatible_node(NULL, NULL, "fsl,imx35-ccm"); 158 mx3_ccm_base = of_iomap(np, 0); 159 BUG_ON(!mx3_ccm_base); 160 } 161 162 void __init mx35_init_irq(void) 163 { 164 void __iomem *avic_base; 165 struct device_node *np; 166 167 np = of_find_compatible_node(NULL, NULL, "fsl,imx35-avic"); 168 avic_base = of_iomap(np, 0); 169 BUG_ON(!avic_base); 170 171 mxc_init_irq(avic_base); 172 } 173 #endif /* ifdef CONFIG_SOC_IMX35 */ 174