1 /* 2 * Atmel AT91 SAM9 SoCs reset code 3 * 4 * Copyright (C) 2007 Atmel Corporation. 5 * Copyright (C) BitBox Ltd 2010 6 * Copyright (C) 2011 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcosoft.com> 7 * Copyright (C) 2014 Free Electrons 8 * 9 * This file is licensed under the terms of the GNU General Public 10 * License version 2. This program is licensed "as is" without any 11 * warranty of any kind, whether express or implied. 12 */ 13 14 #include <linux/io.h> 15 #include <linux/module.h> 16 #include <linux/of_address.h> 17 #include <linux/platform_device.h> 18 #include <linux/reboot.h> 19 20 #include <soc/at91/at91sam9_ddrsdr.h> 21 #include <soc/at91/at91sam9_sdramc.h> 22 23 #define AT91_RSTC_CR 0x00 /* Reset Controller Control Register */ 24 #define AT91_RSTC_PROCRST BIT(0) /* Processor Reset */ 25 #define AT91_RSTC_PERRST BIT(2) /* Peripheral Reset */ 26 #define AT91_RSTC_EXTRST BIT(3) /* External Reset */ 27 #define AT91_RSTC_KEY (0xa5 << 24) /* KEY Password */ 28 29 #define AT91_RSTC_SR 0x04 /* Reset Controller Status Register */ 30 #define AT91_RSTC_URSTS BIT(0) /* User Reset Status */ 31 #define AT91_RSTC_RSTTYP GENMASK(10, 8) /* Reset Type */ 32 #define AT91_RSTC_NRSTL BIT(16) /* NRST Pin Level */ 33 #define AT91_RSTC_SRCMP BIT(17) /* Software Reset Command in Progress */ 34 35 #define AT91_RSTC_MR 0x08 /* Reset Controller Mode Register */ 36 #define AT91_RSTC_URSTEN BIT(0) /* User Reset Enable */ 37 #define AT91_RSTC_URSTIEN BIT(4) /* User Reset Interrupt Enable */ 38 #define AT91_RSTC_ERSTL GENMASK(11, 8) /* External Reset Length */ 39 40 enum reset_type { 41 RESET_TYPE_GENERAL = 0, 42 RESET_TYPE_WAKEUP = 1, 43 RESET_TYPE_WATCHDOG = 2, 44 RESET_TYPE_SOFTWARE = 3, 45 RESET_TYPE_USER = 4, 46 }; 47 48 static void __iomem *at91_ramc_base[2], *at91_rstc_base; 49 50 /* 51 * unless the SDRAM is cleanly shutdown before we hit the 52 * reset register it can be left driving the data bus and 53 * killing the chance of a subsequent boot from NAND 54 */ 55 static int at91sam9260_restart(struct notifier_block *this, unsigned long mode, 56 void *cmd) 57 { 58 asm volatile( 59 /* Align to cache lines */ 60 ".balign 32\n\t" 61 62 /* Disable SDRAM accesses */ 63 "str %2, [%0, #" __stringify(AT91_SDRAMC_TR) "]\n\t" 64 65 /* Power down SDRAM */ 66 "str %3, [%0, #" __stringify(AT91_SDRAMC_LPR) "]\n\t" 67 68 /* Reset CPU */ 69 "str %4, [%1, #" __stringify(AT91_RSTC_CR) "]\n\t" 70 71 "b .\n\t" 72 : 73 : "r" (at91_ramc_base[0]), 74 "r" (at91_rstc_base), 75 "r" (1), 76 "r" cpu_to_le32(AT91_SDRAMC_LPCB_POWER_DOWN), 77 "r" cpu_to_le32(AT91_RSTC_KEY | AT91_RSTC_PERRST | AT91_RSTC_PROCRST)); 78 79 return NOTIFY_DONE; 80 } 81 82 static int at91sam9g45_restart(struct notifier_block *this, unsigned long mode, 83 void *cmd) 84 { 85 asm volatile( 86 /* 87 * Test wether we have a second RAM controller to care 88 * about. 89 * 90 * First, test that we can dereference the virtual address. 91 */ 92 "cmp %1, #0\n\t" 93 "beq 1f\n\t" 94 95 /* Then, test that the RAM controller is enabled */ 96 "ldr r0, [%1]\n\t" 97 "cmp r0, #0\n\t" 98 99 /* Align to cache lines */ 100 ".balign 32\n\t" 101 102 /* Disable SDRAM0 accesses */ 103 "1: str %3, [%0, #" __stringify(AT91_DDRSDRC_RTR) "]\n\t" 104 /* Power down SDRAM0 */ 105 " str %4, [%0, #" __stringify(AT91_DDRSDRC_LPR) "]\n\t" 106 /* Disable SDRAM1 accesses */ 107 " strne %3, [%1, #" __stringify(AT91_DDRSDRC_RTR) "]\n\t" 108 /* Power down SDRAM1 */ 109 " strne %4, [%1, #" __stringify(AT91_DDRSDRC_LPR) "]\n\t" 110 /* Reset CPU */ 111 " str %5, [%2, #" __stringify(AT91_RSTC_CR) "]\n\t" 112 113 " b .\n\t" 114 : 115 : "r" (at91_ramc_base[0]), 116 "r" (at91_ramc_base[1]), 117 "r" (at91_rstc_base), 118 "r" (1), 119 "r" cpu_to_le32(AT91_DDRSDRC_LPCB_POWER_DOWN), 120 "r" cpu_to_le32(AT91_RSTC_KEY | AT91_RSTC_PERRST | AT91_RSTC_PROCRST) 121 : "r0"); 122 123 return NOTIFY_DONE; 124 } 125 126 static void __init at91_reset_status(struct platform_device *pdev) 127 { 128 u32 reg = readl(at91_rstc_base + AT91_RSTC_SR); 129 char *reason; 130 131 switch ((reg & AT91_RSTC_RSTTYP) >> 8) { 132 case RESET_TYPE_GENERAL: 133 reason = "general reset"; 134 break; 135 case RESET_TYPE_WAKEUP: 136 reason = "wakeup"; 137 break; 138 case RESET_TYPE_WATCHDOG: 139 reason = "watchdog reset"; 140 break; 141 case RESET_TYPE_SOFTWARE: 142 reason = "software reset"; 143 break; 144 case RESET_TYPE_USER: 145 reason = "user reset"; 146 break; 147 default: 148 reason = "unknown reset"; 149 break; 150 } 151 152 pr_info("AT91: Starting after %s\n", reason); 153 } 154 155 static const struct of_device_id at91_ramc_of_match[] = { 156 { .compatible = "atmel,at91sam9260-sdramc", }, 157 { .compatible = "atmel,at91sam9g45-ddramc", }, 158 { .compatible = "atmel,sama5d3-ddramc", }, 159 { /* sentinel */ } 160 }; 161 162 static const struct of_device_id at91_reset_of_match[] = { 163 { .compatible = "atmel,at91sam9260-rstc", .data = at91sam9260_restart }, 164 { .compatible = "atmel,at91sam9g45-rstc", .data = at91sam9g45_restart }, 165 { /* sentinel */ } 166 }; 167 168 static struct notifier_block at91_restart_nb = { 169 .priority = 192, 170 }; 171 172 static int at91_reset_of_probe(struct platform_device *pdev) 173 { 174 const struct of_device_id *match; 175 struct device_node *np; 176 int idx = 0; 177 178 at91_rstc_base = of_iomap(pdev->dev.of_node, 0); 179 if (!at91_rstc_base) { 180 dev_err(&pdev->dev, "Could not map reset controller address\n"); 181 return -ENODEV; 182 } 183 184 for_each_matching_node(np, at91_ramc_of_match) { 185 at91_ramc_base[idx] = of_iomap(np, 0); 186 if (!at91_ramc_base[idx]) { 187 dev_err(&pdev->dev, "Could not map ram controller address\n"); 188 return -ENODEV; 189 } 190 idx++; 191 } 192 193 match = of_match_node(at91_reset_of_match, pdev->dev.of_node); 194 at91_restart_nb.notifier_call = match->data; 195 return register_restart_handler(&at91_restart_nb); 196 } 197 198 static int at91_reset_platform_probe(struct platform_device *pdev) 199 { 200 const struct platform_device_id *match; 201 struct resource *res; 202 int idx = 0; 203 204 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 205 at91_rstc_base = devm_ioremap_resource(&pdev->dev, res); 206 if (IS_ERR(at91_rstc_base)) { 207 dev_err(&pdev->dev, "Could not map reset controller address\n"); 208 return PTR_ERR(at91_rstc_base); 209 } 210 211 for (idx = 0; idx < 2; idx++) { 212 res = platform_get_resource(pdev, IORESOURCE_MEM, idx + 1 ); 213 at91_ramc_base[idx] = devm_ioremap(&pdev->dev, res->start, 214 resource_size(res)); 215 if (IS_ERR(at91_ramc_base[idx])) { 216 dev_err(&pdev->dev, "Could not map ram controller address\n"); 217 return PTR_ERR(at91_ramc_base[idx]); 218 } 219 } 220 221 match = platform_get_device_id(pdev); 222 at91_restart_nb.notifier_call = 223 (int (*)(struct notifier_block *, 224 unsigned long, void *)) match->driver_data; 225 226 return register_restart_handler(&at91_restart_nb); 227 } 228 229 static int at91_reset_probe(struct platform_device *pdev) 230 { 231 int ret; 232 233 if (pdev->dev.of_node) 234 ret = at91_reset_of_probe(pdev); 235 else 236 ret = at91_reset_platform_probe(pdev); 237 238 if (ret) 239 return ret; 240 241 at91_reset_status(pdev); 242 243 return 0; 244 } 245 246 static struct platform_device_id at91_reset_plat_match[] = { 247 { "at91-sam9260-reset", (unsigned long)at91sam9260_restart }, 248 { "at91-sam9g45-reset", (unsigned long)at91sam9g45_restart }, 249 { /* sentinel */ } 250 }; 251 252 static struct platform_driver at91_reset_driver = { 253 .probe = at91_reset_probe, 254 .driver = { 255 .name = "at91-reset", 256 .of_match_table = at91_reset_of_match, 257 }, 258 .id_table = at91_reset_plat_match, 259 }; 260 module_platform_driver(at91_reset_driver); 261