Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 1 | /* |
| 2 | * OMAP4 specific common source file. |
| 3 | * |
| 4 | * Copyright (C) 2010 Texas Instruments, Inc. |
| 5 | * Author: |
| 6 | * Santosh Shilimkar <santosh.shilimkar@ti.com> |
| 7 | * |
| 8 | * |
| 9 | * This program is free software,you can redistribute it and/or modify |
| 10 | * it under the terms of the GNU General Public License version 2 as |
| 11 | * published by the Free Software Foundation. |
| 12 | */ |
| 13 | |
| 14 | #include <linux/kernel.h> |
| 15 | #include <linux/init.h> |
| 16 | #include <linux/io.h> |
Colin Cross | cd8ce15 | 2012-10-18 12:20:08 +0300 | [diff] [blame] | 17 | #include <linux/irq.h> |
Rob Herring | 0529e315 | 2012-11-05 16:18:28 -0600 | [diff] [blame] | 18 | #include <linux/irqchip.h> |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 19 | #include <linux/platform_device.h> |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 20 | #include <linux/memblock.h> |
Tony Lindgren | 7d7e1eb | 2012-08-27 17:43:01 -0700 | [diff] [blame] | 21 | #include <linux/of_irq.h> |
| 22 | #include <linux/of_platform.h> |
| 23 | #include <linux/export.h> |
Rob Herring | 520f7bd | 2012-12-27 13:10:24 -0600 | [diff] [blame] | 24 | #include <linux/irqchip/arm-gic.h> |
Santosh Shilimkar | fd1c078 | 2013-02-25 14:12:58 +0530 | [diff] [blame] | 25 | #include <linux/of_address.h> |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 26 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 27 | #include <asm/hardware/cache-l2x0.h> |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 28 | #include <asm/mach/map.h> |
Russell King | 716a3dc | 2012-01-13 15:00:51 +0000 | [diff] [blame] | 29 | #include <asm/memblock.h> |
Colin Cross | cd8ce15 | 2012-10-18 12:20:08 +0300 | [diff] [blame] | 30 | #include <asm/smp_twd.h> |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 31 | |
Tony Lindgren | 732231a | 2012-09-20 11:41:16 -0700 | [diff] [blame] | 32 | #include "omap-wakeupgen.h" |
Tony Lindgren | dbc0416 | 2012-08-31 10:59:07 -0700 | [diff] [blame] | 33 | #include "soc.h" |
Paul Walmsley | b6a4226 | 2012-10-29 20:50:21 -0600 | [diff] [blame] | 34 | #include "iomap.h" |
Tony Lindgren | 4e65331 | 2011-11-10 22:45:17 +0100 | [diff] [blame] | 35 | #include "common.h" |
Tony Lindgren | 68f39e7 | 2012-10-15 12:09:43 -0700 | [diff] [blame] | 36 | #include "mmc.h" |
Balaji T K | 1ee47b0 | 2012-04-25 17:27:46 +0530 | [diff] [blame] | 37 | #include "hsmmc.h" |
Paul Walmsley | 2f334a3 | 2012-10-29 20:56:07 -0600 | [diff] [blame] | 38 | #include "prminst44xx.h" |
Paul Walmsley | d9a16f9 | 2012-10-29 20:57:39 -0600 | [diff] [blame] | 39 | #include "prcm_mpu44xx.h" |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 40 | #include "omap4-sar-layout.h" |
Lokesh Vutla | f7a9b8a | 2012-10-02 00:17:06 +0530 | [diff] [blame] | 41 | #include "omap-secure.h" |
Tony Lindgren | bb77209 | 2012-10-29 09:35:35 -0700 | [diff] [blame] | 42 | #include "sram.h" |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 43 | |
| 44 | #ifdef CONFIG_CACHE_L2X0 |
Santosh Shilimkar | 02afe8a | 2011-03-03 18:03:25 +0530 | [diff] [blame] | 45 | static void __iomem *l2cache_base; |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 46 | #endif |
| 47 | |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 48 | static void __iomem *sar_ram_base; |
Santosh Shilimkar | ff999b8 | 2012-10-18 12:20:05 +0300 | [diff] [blame] | 49 | static void __iomem *gic_dist_base_addr; |
Colin Cross | cd8ce15 | 2012-10-18 12:20:08 +0300 | [diff] [blame] | 50 | static void __iomem *twd_base; |
| 51 | |
| 52 | #define IRQ_LOCALTIMER 29 |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 53 | |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 54 | #ifdef CONFIG_OMAP4_ERRATA_I688 |
| 55 | /* Used to implement memory barrier on DRAM path */ |
| 56 | #define OMAP4_DRAM_BARRIER_VA 0xfe600000 |
| 57 | |
| 58 | void __iomem *dram_sync, *sram_sync; |
| 59 | |
Santosh Shilimkar | 2ec1fc4 | 2012-02-02 19:33:55 +0530 | [diff] [blame] | 60 | static phys_addr_t paddr; |
| 61 | static u32 size; |
| 62 | |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 63 | void omap_bus_sync(void) |
| 64 | { |
| 65 | if (dram_sync && sram_sync) { |
| 66 | writel_relaxed(readl_relaxed(dram_sync), dram_sync); |
| 67 | writel_relaxed(readl_relaxed(sram_sync), sram_sync); |
| 68 | isb(); |
| 69 | } |
| 70 | } |
R Sricharan | cc4ad90 | 2012-03-02 16:31:18 +0530 | [diff] [blame] | 71 | EXPORT_SYMBOL(omap_bus_sync); |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 72 | |
Santosh Shilimkar | 2ec1fc4 | 2012-02-02 19:33:55 +0530 | [diff] [blame] | 73 | /* Steal one page physical memory for barrier implementation */ |
| 74 | int __init omap_barrier_reserve_memblock(void) |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 75 | { |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 76 | |
| 77 | size = ALIGN(PAGE_SIZE, SZ_1M); |
Russell King | 716a3dc | 2012-01-13 15:00:51 +0000 | [diff] [blame] | 78 | paddr = arm_memblock_steal(size, SZ_1M); |
| 79 | |
Santosh Shilimkar | 2ec1fc4 | 2012-02-02 19:33:55 +0530 | [diff] [blame] | 80 | return 0; |
| 81 | } |
| 82 | |
| 83 | void __init omap_barriers_init(void) |
| 84 | { |
| 85 | struct map_desc dram_io_desc[1]; |
| 86 | |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 87 | dram_io_desc[0].virtual = OMAP4_DRAM_BARRIER_VA; |
| 88 | dram_io_desc[0].pfn = __phys_to_pfn(paddr); |
| 89 | dram_io_desc[0].length = size; |
| 90 | dram_io_desc[0].type = MT_MEMORY_SO; |
| 91 | iotable_init(dram_io_desc, ARRAY_SIZE(dram_io_desc)); |
| 92 | dram_sync = (void __iomem *) dram_io_desc[0].virtual; |
| 93 | sram_sync = (void __iomem *) OMAP4_SRAM_VA; |
| 94 | |
| 95 | pr_info("OMAP4: Map 0x%08llx to 0x%08lx for dram barrier\n", |
| 96 | (long long) paddr, dram_io_desc[0].virtual); |
| 97 | |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 98 | } |
Santosh Shilimkar | 2ec1fc4 | 2012-02-02 19:33:55 +0530 | [diff] [blame] | 99 | #else |
| 100 | void __init omap_barriers_init(void) |
| 101 | {} |
Santosh Shilimkar | 137d105 | 2011-06-25 18:04:31 -0700 | [diff] [blame] | 102 | #endif |
| 103 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 104 | void __init gic_init_irq(void) |
| 105 | { |
Marc Zyngier | ab65be2 | 2011-11-15 17:22:45 +0000 | [diff] [blame] | 106 | void __iomem *omap_irq_base; |
Marc Zyngier | ab65be2 | 2011-11-15 17:22:45 +0000 | [diff] [blame] | 107 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 108 | /* Static mapping, never released */ |
| 109 | gic_dist_base_addr = ioremap(OMAP44XX_GIC_DIST_BASE, SZ_4K); |
| 110 | BUG_ON(!gic_dist_base_addr); |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 111 | |
Colin Cross | cd8ce15 | 2012-10-18 12:20:08 +0300 | [diff] [blame] | 112 | twd_base = ioremap(OMAP44XX_LOCAL_TWD_BASE, SZ_4K); |
| 113 | BUG_ON(!twd_base); |
| 114 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 115 | /* Static mapping, never released */ |
Tony Lindgren | 741e3a8 | 2011-05-17 03:51:26 -0700 | [diff] [blame] | 116 | omap_irq_base = ioremap(OMAP44XX_GIC_CPU_BASE, SZ_512); |
| 117 | BUG_ON(!omap_irq_base); |
Russell King | b580b89 | 2010-12-04 15:55:14 +0000 | [diff] [blame] | 118 | |
Santosh Shilimkar | fcf6efa | 2010-06-16 22:19:47 +0530 | [diff] [blame] | 119 | omap_wakeupgen_init(); |
| 120 | |
Tony Lindgren | 741e3a8 | 2011-05-17 03:51:26 -0700 | [diff] [blame] | 121 | gic_init(0, 29, gic_dist_base_addr, omap_irq_base); |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 122 | } |
| 123 | |
Santosh Shilimkar | ff999b8 | 2012-10-18 12:20:05 +0300 | [diff] [blame] | 124 | void gic_dist_disable(void) |
| 125 | { |
| 126 | if (gic_dist_base_addr) |
| 127 | __raw_writel(0x0, gic_dist_base_addr + GIC_DIST_CTRL); |
| 128 | } |
| 129 | |
Colin Cross | cd8ce15 | 2012-10-18 12:20:08 +0300 | [diff] [blame] | 130 | bool gic_dist_disabled(void) |
| 131 | { |
| 132 | return !(__raw_readl(gic_dist_base_addr + GIC_DIST_CTRL) & 0x1); |
| 133 | } |
| 134 | |
| 135 | void gic_timer_retrigger(void) |
| 136 | { |
| 137 | u32 twd_int = __raw_readl(twd_base + TWD_TIMER_INTSTAT); |
| 138 | u32 gic_int = __raw_readl(gic_dist_base_addr + GIC_DIST_PENDING_SET); |
| 139 | u32 twd_ctrl = __raw_readl(twd_base + TWD_TIMER_CONTROL); |
| 140 | |
| 141 | if (twd_int && !(gic_int & BIT(IRQ_LOCALTIMER))) { |
| 142 | /* |
| 143 | * The local timer interrupt got lost while the distributor was |
| 144 | * disabled. Ack the pending interrupt, and retrigger it. |
| 145 | */ |
| 146 | pr_warn("%s: lost localtimer interrupt\n", __func__); |
| 147 | __raw_writel(1, twd_base + TWD_TIMER_INTSTAT); |
| 148 | if (!(twd_ctrl & TWD_TIMER_CONTROL_PERIODIC)) { |
| 149 | __raw_writel(1, twd_base + TWD_TIMER_COUNTER); |
| 150 | twd_ctrl |= TWD_TIMER_CONTROL_ENABLE; |
| 151 | __raw_writel(twd_ctrl, twd_base + TWD_TIMER_CONTROL); |
| 152 | } |
| 153 | } |
| 154 | } |
| 155 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 156 | #ifdef CONFIG_CACHE_L2X0 |
Santosh Shilimkar | 4e803c4 | 2010-07-31 21:40:10 +0530 | [diff] [blame] | 157 | |
Santosh Shilimkar | 02afe8a | 2011-03-03 18:03:25 +0530 | [diff] [blame] | 158 | void __iomem *omap4_get_l2cache_base(void) |
| 159 | { |
| 160 | return l2cache_base; |
| 161 | } |
| 162 | |
Santosh Shilimkar | 4e803c4 | 2010-07-31 21:40:10 +0530 | [diff] [blame] | 163 | static void omap4_l2x0_disable(void) |
| 164 | { |
| 165 | /* Disable PL310 L2 Cache controller */ |
| 166 | omap_smc1(0x102, 0x0); |
| 167 | } |
| 168 | |
Santosh Shilimkar | 4bdb157 | 2011-02-22 10:00:44 +0100 | [diff] [blame] | 169 | static void omap4_l2x0_set_debug(unsigned long val) |
| 170 | { |
| 171 | /* Program PL310 L2 Cache controller debug register */ |
| 172 | omap_smc1(0x100, val); |
| 173 | } |
| 174 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 175 | static int __init omap_l2_cache_init(void) |
| 176 | { |
Santosh Shilimkar | 1773e60 | 2010-11-19 23:01:03 +0530 | [diff] [blame] | 177 | u32 aux_ctrl = 0; |
| 178 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 179 | /* |
| 180 | * To avoid code running on other OMAPs in |
| 181 | * multi-omap builds |
| 182 | */ |
| 183 | if (!cpu_is_omap44xx()) |
| 184 | return -ENODEV; |
| 185 | |
| 186 | /* Static mapping, never released */ |
| 187 | l2cache_base = ioremap(OMAP44XX_L2CACHE_BASE, SZ_4K); |
Santosh Shilimkar | 0db1803 | 2011-03-03 17:36:52 +0530 | [diff] [blame] | 188 | if (WARN_ON(!l2cache_base)) |
| 189 | return -ENOMEM; |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 190 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 191 | /* |
Santosh Shilimkar | a777b72 | 2010-09-16 18:44:47 +0530 | [diff] [blame] | 192 | * 16-way associativity, parity disabled |
| 193 | * Way size - 32KB (es1.0) |
| 194 | * Way size - 64KB (es2.0 +) |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 195 | */ |
Santosh Shilimkar | 1773e60 | 2010-11-19 23:01:03 +0530 | [diff] [blame] | 196 | aux_ctrl = ((1 << L2X0_AUX_CTRL_ASSOCIATIVITY_SHIFT) | |
| 197 | (0x1 << 25) | |
| 198 | (0x1 << L2X0_AUX_CTRL_NS_LOCKDOWN_SHIFT) | |
| 199 | (0x1 << L2X0_AUX_CTRL_NS_INT_CTRL_SHIFT)); |
| 200 | |
Mans Rullgard | 11e0264 | 2010-11-19 23:01:04 +0530 | [diff] [blame] | 201 | if (omap_rev() == OMAP4430_REV_ES1_0) { |
Santosh Shilimkar | 1773e60 | 2010-11-19 23:01:03 +0530 | [diff] [blame] | 202 | aux_ctrl |= 0x2 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT; |
Mans Rullgard | 11e0264 | 2010-11-19 23:01:04 +0530 | [diff] [blame] | 203 | } else { |
| 204 | aux_ctrl |= ((0x3 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT) | |
Santosh Shilimkar | b0f20ff | 2010-11-19 23:01:05 +0530 | [diff] [blame] | 205 | (1 << L2X0_AUX_CTRL_SHARE_OVERRIDE_SHIFT) | |
Mans Rullgard | 11e0264 | 2010-11-19 23:01:04 +0530 | [diff] [blame] | 206 | (1 << L2X0_AUX_CTRL_DATA_PREFETCH_SHIFT) | |
Santosh Shilimkar | b89cd71 | 2010-11-19 23:01:06 +0530 | [diff] [blame] | 207 | (1 << L2X0_AUX_CTRL_INSTR_PREFETCH_SHIFT) | |
| 208 | (1 << L2X0_AUX_CTRL_EARLY_BRESP_SHIFT)); |
Mans Rullgard | 11e0264 | 2010-11-19 23:01:04 +0530 | [diff] [blame] | 209 | } |
| 210 | if (omap_rev() != OMAP4430_REV_ES1_0) |
| 211 | omap_smc1(0x109, aux_ctrl); |
| 212 | |
| 213 | /* Enable PL310 L2 Cache controller */ |
| 214 | omap_smc1(0x102, 0x1); |
Santosh Shilimkar | 1773e60 | 2010-11-19 23:01:03 +0530 | [diff] [blame] | 215 | |
Santosh Shilimkar | 926fd45 | 2012-07-04 17:57:34 +0530 | [diff] [blame] | 216 | if (of_have_populated_dt()) |
| 217 | l2x0_of_init(aux_ctrl, L2X0_AUX_CTRL_MASK); |
| 218 | else |
| 219 | l2x0_init(l2cache_base, aux_ctrl, L2X0_AUX_CTRL_MASK); |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 220 | |
Santosh Shilimkar | 4e803c4 | 2010-07-31 21:40:10 +0530 | [diff] [blame] | 221 | /* |
| 222 | * Override default outer_cache.disable with a OMAP4 |
| 223 | * specific one |
| 224 | */ |
| 225 | outer_cache.disable = omap4_l2x0_disable; |
Santosh Shilimkar | 4bdb157 | 2011-02-22 10:00:44 +0100 | [diff] [blame] | 226 | outer_cache.set_debug = omap4_l2x0_set_debug; |
Santosh Shilimkar | 4e803c4 | 2010-07-31 21:40:10 +0530 | [diff] [blame] | 227 | |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 228 | return 0; |
| 229 | } |
Tony Lindgren | b76c8b1 | 2013-01-11 11:24:18 -0800 | [diff] [blame] | 230 | omap_early_initcall(omap_l2_cache_init); |
Santosh Shilimkar | fbc9be1 | 2010-05-14 12:05:26 -0700 | [diff] [blame] | 231 | #endif |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 232 | |
| 233 | void __iomem *omap4_get_sar_ram_base(void) |
| 234 | { |
| 235 | return sar_ram_base; |
| 236 | } |
| 237 | |
| 238 | /* |
| 239 | * SAR RAM used to save and restore the HW |
| 240 | * context in low power modes |
| 241 | */ |
| 242 | static int __init omap4_sar_ram_init(void) |
| 243 | { |
Santosh Shilimkar | da0e02a | 2013-02-06 17:54:39 +0530 | [diff] [blame] | 244 | unsigned long sar_base; |
| 245 | |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 246 | /* |
| 247 | * To avoid code running on other OMAPs in |
| 248 | * multi-omap builds |
| 249 | */ |
Santosh Shilimkar | da0e02a | 2013-02-06 17:54:39 +0530 | [diff] [blame] | 250 | if (cpu_is_omap44xx()) |
| 251 | sar_base = OMAP44XX_SAR_RAM_BASE; |
| 252 | else if (soc_is_omap54xx()) |
| 253 | sar_base = OMAP54XX_SAR_RAM_BASE; |
| 254 | else |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 255 | return -ENOMEM; |
| 256 | |
| 257 | /* Static mapping, never released */ |
Santosh Shilimkar | da0e02a | 2013-02-06 17:54:39 +0530 | [diff] [blame] | 258 | sar_ram_base = ioremap(sar_base, SZ_16K); |
Santosh Shilimkar | 501f0c7 | 2011-01-01 19:56:04 +0530 | [diff] [blame] | 259 | if (WARN_ON(!sar_ram_base)) |
| 260 | return -ENOMEM; |
| 261 | |
| 262 | return 0; |
| 263 | } |
Tony Lindgren | b76c8b1 | 2013-01-11 11:24:18 -0800 | [diff] [blame] | 264 | omap_early_initcall(omap4_sar_ram_init); |
Balaji T K | 1ee47b0 | 2012-04-25 17:27:46 +0530 | [diff] [blame] | 265 | |
R Sricharan | c4082d4 | 2012-06-05 16:31:06 +0530 | [diff] [blame] | 266 | void __init omap_gic_of_init(void) |
| 267 | { |
Santosh Shilimkar | fd1c078 | 2013-02-25 14:12:58 +0530 | [diff] [blame] | 268 | struct device_node *np; |
| 269 | |
| 270 | /* Extract GIC distributor and TWD bases for OMAP4460 ROM Errata WA */ |
| 271 | if (!cpu_is_omap446x()) |
| 272 | goto skip_errata_init; |
| 273 | |
| 274 | np = of_find_compatible_node(NULL, NULL, "arm,cortex-a9-gic"); |
| 275 | gic_dist_base_addr = of_iomap(np, 0); |
| 276 | WARN_ON(!gic_dist_base_addr); |
| 277 | |
| 278 | np = of_find_compatible_node(NULL, NULL, "arm,cortex-a9-twd-timer"); |
| 279 | twd_base = of_iomap(np, 0); |
| 280 | WARN_ON(!twd_base); |
| 281 | |
| 282 | skip_errata_init: |
R Sricharan | c4082d4 | 2012-06-05 16:31:06 +0530 | [diff] [blame] | 283 | omap_wakeupgen_init(); |
Rob Herring | 0529e315 | 2012-11-05 16:18:28 -0600 | [diff] [blame] | 284 | irqchip_init(); |
R Sricharan | c4082d4 | 2012-06-05 16:31:06 +0530 | [diff] [blame] | 285 | } |
| 286 | |
Balaji T K | 1ee47b0 | 2012-04-25 17:27:46 +0530 | [diff] [blame] | 287 | #if defined(CONFIG_MMC_OMAP_HS) || defined(CONFIG_MMC_OMAP_HS_MODULE) |
| 288 | static int omap4_twl6030_hsmmc_late_init(struct device *dev) |
| 289 | { |
| 290 | int irq = 0; |
| 291 | struct platform_device *pdev = container_of(dev, |
| 292 | struct platform_device, dev); |
| 293 | struct omap_mmc_platform_data *pdata = dev->platform_data; |
| 294 | |
| 295 | /* Setting MMC1 Card detect Irq */ |
| 296 | if (pdev->id == 0) { |
| 297 | irq = twl6030_mmc_card_detect_config(); |
| 298 | if (irq < 0) { |
| 299 | dev_err(dev, "%s: Error card detect config(%d)\n", |
| 300 | __func__, irq); |
| 301 | return irq; |
| 302 | } |
| 303 | pdata->slots[0].card_detect_irq = irq; |
| 304 | pdata->slots[0].card_detect = twl6030_mmc_card_detect; |
| 305 | } |
| 306 | return 0; |
| 307 | } |
| 308 | |
| 309 | static __init void omap4_twl6030_hsmmc_set_late_init(struct device *dev) |
| 310 | { |
| 311 | struct omap_mmc_platform_data *pdata; |
| 312 | |
| 313 | /* dev can be null if CONFIG_MMC_OMAP_HS is not set */ |
| 314 | if (!dev) { |
| 315 | pr_err("Failed %s\n", __func__); |
| 316 | return; |
| 317 | } |
| 318 | pdata = dev->platform_data; |
| 319 | pdata->init = omap4_twl6030_hsmmc_late_init; |
| 320 | } |
| 321 | |
| 322 | int __init omap4_twl6030_hsmmc_init(struct omap2_hsmmc_info *controllers) |
| 323 | { |
| 324 | struct omap2_hsmmc_info *c; |
| 325 | |
| 326 | omap_hsmmc_init(controllers); |
| 327 | for (c = controllers; c->mmc; c++) { |
| 328 | /* pdev can be null if CONFIG_MMC_OMAP_HS is not set */ |
| 329 | if (!c->pdev) |
| 330 | continue; |
| 331 | omap4_twl6030_hsmmc_set_late_init(&c->pdev->dev); |
| 332 | } |
| 333 | |
| 334 | return 0; |
| 335 | } |
| 336 | #else |
| 337 | int __init omap4_twl6030_hsmmc_init(struct omap2_hsmmc_info *controllers) |
| 338 | { |
| 339 | return 0; |
| 340 | } |
| 341 | #endif |
Paul Walmsley | 2f334a3 | 2012-10-29 20:56:07 -0600 | [diff] [blame] | 342 | |
| 343 | /** |
| 344 | * omap44xx_restart - trigger a software restart of the SoC |
| 345 | * @mode: the "reboot mode", see arch/arm/kernel/{setup,process}.c |
| 346 | * @cmd: passed from the userspace program rebooting the system (if provided) |
| 347 | * |
| 348 | * Resets the SoC. For @cmd, see the 'reboot' syscall in |
| 349 | * kernel/sys.c. No return value. |
| 350 | */ |
| 351 | void omap44xx_restart(char mode, const char *cmd) |
| 352 | { |
| 353 | /* XXX Should save 'cmd' into scratchpad for use after reboot */ |
| 354 | omap4_prminst_global_warm_sw_reset(); /* never returns */ |
| 355 | while (1); |
| 356 | } |
| 357 | |