1 // SPDX-License-Identifier: GPL-2.0-only 2 /****************************************************************************/ 3 4 /* 5 * nettel.c -- mappings for NETtel/SecureEdge/SnapGear (x86) boards. 6 * 7 * (C) Copyright 2000-2001, Greg Ungerer (gerg@snapgear.com) 8 * (C) Copyright 2001-2002, SnapGear (www.snapgear.com) 9 */ 10 11 /****************************************************************************/ 12 13 #include <linux/module.h> 14 #include <linux/init.h> 15 #include <linux/types.h> 16 #include <linux/kernel.h> 17 #include <linux/mtd/mtd.h> 18 #include <linux/mtd/map.h> 19 #include <linux/mtd/partitions.h> 20 #include <linux/mtd/cfi.h> 21 #include <linux/reboot.h> 22 #include <linux/err.h> 23 #include <linux/kdev_t.h> 24 #include <linux/root_dev.h> 25 #include <asm/io.h> 26 27 /****************************************************************************/ 28 29 #define INTEL_BUSWIDTH 1 30 #define AMD_WINDOW_MAXSIZE 0x00200000 31 #define AMD_BUSWIDTH 1 32 33 /* 34 * PAR masks and shifts, assuming 64K pages. 35 */ 36 #define SC520_PAR_ADDR_MASK 0x00003fff 37 #define SC520_PAR_ADDR_SHIFT 16 38 #define SC520_PAR_TO_ADDR(par) \ 39 (((par)&SC520_PAR_ADDR_MASK) << SC520_PAR_ADDR_SHIFT) 40 41 #define SC520_PAR_SIZE_MASK 0x01ffc000 42 #define SC520_PAR_SIZE_SHIFT 2 43 #define SC520_PAR_TO_SIZE(par) \ 44 ((((par)&SC520_PAR_SIZE_MASK) << SC520_PAR_SIZE_SHIFT) + (64*1024)) 45 46 #define SC520_PAR(cs, addr, size) \ 47 ((cs) | \ 48 ((((size)-(64*1024)) >> SC520_PAR_SIZE_SHIFT) & SC520_PAR_SIZE_MASK) | \ 49 (((addr) >> SC520_PAR_ADDR_SHIFT) & SC520_PAR_ADDR_MASK)) 50 51 #define SC520_PAR_BOOTCS 0x8a000000 52 #define SC520_PAR_ROMCS1 0xaa000000 53 #define SC520_PAR_ROMCS2 0xca000000 /* Cache disabled, 64K page */ 54 55 static void *nettel_mmcrp = NULL; 56 57 #ifdef CONFIG_MTD_CFI_INTELEXT 58 static struct mtd_info *intel_mtd; 59 #endif 60 static struct mtd_info *amd_mtd; 61 62 /****************************************************************************/ 63 64 /****************************************************************************/ 65 66 #ifdef CONFIG_MTD_CFI_INTELEXT 67 static struct map_info nettel_intel_map = { 68 .name = "SnapGear Intel", 69 .size = 0, 70 .bankwidth = INTEL_BUSWIDTH, 71 }; 72 73 static struct mtd_partition nettel_intel_partitions[] = { 74 { 75 .name = "SnapGear kernel", 76 .offset = 0, 77 .size = 0x000e0000 78 }, 79 { 80 .name = "SnapGear filesystem", 81 .offset = 0x00100000, 82 }, 83 { 84 .name = "SnapGear config", 85 .offset = 0x000e0000, 86 .size = 0x00020000 87 }, 88 { 89 .name = "SnapGear Intel", 90 .offset = 0 91 }, 92 { 93 .name = "SnapGear BIOS Config", 94 .offset = 0x007e0000, 95 .size = 0x00020000 96 }, 97 { 98 .name = "SnapGear BIOS", 99 .offset = 0x007e0000, 100 .size = 0x00020000 101 }, 102 }; 103 #endif 104 105 static struct map_info nettel_amd_map = { 106 .name = "SnapGear AMD", 107 .size = AMD_WINDOW_MAXSIZE, 108 .bankwidth = AMD_BUSWIDTH, 109 }; 110 111 static const struct mtd_partition nettel_amd_partitions[] = { 112 { 113 .name = "SnapGear BIOS config", 114 .offset = 0x000e0000, 115 .size = 0x00010000 116 }, 117 { 118 .name = "SnapGear BIOS", 119 .offset = 0x000f0000, 120 .size = 0x00010000 121 }, 122 { 123 .name = "SnapGear AMD", 124 .offset = 0 125 }, 126 { 127 .name = "SnapGear high BIOS", 128 .offset = 0x001f0000, 129 .size = 0x00010000 130 } 131 }; 132 133 #define NUM_AMD_PARTITIONS ARRAY_SIZE(nettel_amd_partitions) 134 135 /****************************************************************************/ 136 137 #ifdef CONFIG_MTD_CFI_INTELEXT 138 139 /* 140 * Set the Intel flash back to read mode since some old boot 141 * loaders don't. 142 */ 143 static int nettel_reboot_notifier(struct notifier_block *nb, unsigned long val, void *v) 144 { 145 struct cfi_private *cfi = nettel_intel_map.fldrv_priv; 146 unsigned long b; 147 148 /* Make sure all FLASH chips are put back into read mode */ 149 for (b = 0; (b < nettel_intel_partitions[3].size); b += 0x100000) { 150 cfi_send_gen_cmd(0xff, 0x55, b, &nettel_intel_map, cfi, 151 cfi->device_type, NULL); 152 } 153 return(NOTIFY_OK); 154 } 155 156 static struct notifier_block nettel_notifier_block = { 157 nettel_reboot_notifier, NULL, 0 158 }; 159 160 #endif 161 162 /****************************************************************************/ 163 164 static int __init nettel_init(void) 165 { 166 volatile unsigned long *amdpar; 167 unsigned long amdaddr, maxsize; 168 int num_amd_partitions=0; 169 #ifdef CONFIG_MTD_CFI_INTELEXT 170 volatile unsigned long *intel0par, *intel1par; 171 unsigned long orig_bootcspar, orig_romcs1par; 172 unsigned long intel0addr, intel0size; 173 unsigned long intel1addr, intel1size; 174 int intelboot, intel0cs, intel1cs; 175 int num_intel_partitions; 176 #endif 177 int rc = 0; 178 179 nettel_mmcrp = (void *) ioremap_nocache(0xfffef000, 4096); 180 if (nettel_mmcrp == NULL) { 181 printk("SNAPGEAR: failed to disable MMCR cache??\n"); 182 return(-EIO); 183 } 184 185 /* Set CPU clock to be 33.000MHz */ 186 *((unsigned char *) (nettel_mmcrp + 0xc64)) = 0x01; 187 188 amdpar = (volatile unsigned long *) (nettel_mmcrp + 0xc4); 189 190 #ifdef CONFIG_MTD_CFI_INTELEXT 191 intelboot = 0; 192 intel0cs = SC520_PAR_ROMCS1; 193 intel0par = (volatile unsigned long *) (nettel_mmcrp + 0xc0); 194 intel1cs = SC520_PAR_ROMCS2; 195 intel1par = (volatile unsigned long *) (nettel_mmcrp + 0xbc); 196 197 /* 198 * Save the CS settings then ensure ROMCS1 and ROMCS2 are off, 199 * otherwise they might clash with where we try to map BOOTCS. 200 */ 201 orig_bootcspar = *amdpar; 202 orig_romcs1par = *intel0par; 203 *intel0par = 0; 204 *intel1par = 0; 205 #endif 206 207 /* 208 * The first thing to do is determine if we have a separate 209 * boot FLASH device. Typically this is a small (1 to 2MB) 210 * AMD FLASH part. It seems that device size is about the 211 * only way to tell if this is the case... 212 */ 213 amdaddr = 0x20000000; 214 maxsize = AMD_WINDOW_MAXSIZE; 215 216 *amdpar = SC520_PAR(SC520_PAR_BOOTCS, amdaddr, maxsize); 217 __asm__ ("wbinvd"); 218 219 nettel_amd_map.phys = amdaddr; 220 nettel_amd_map.virt = ioremap_nocache(amdaddr, maxsize); 221 if (!nettel_amd_map.virt) { 222 printk("SNAPGEAR: failed to ioremap() BOOTCS\n"); 223 iounmap(nettel_mmcrp); 224 return(-EIO); 225 } 226 simple_map_init(&nettel_amd_map); 227 228 if ((amd_mtd = do_map_probe("jedec_probe", &nettel_amd_map))) { 229 printk(KERN_NOTICE "SNAPGEAR: AMD flash device size = %dK\n", 230 (int)(amd_mtd->size>>10)); 231 232 amd_mtd->owner = THIS_MODULE; 233 234 /* The high BIOS partition is only present for 2MB units */ 235 num_amd_partitions = NUM_AMD_PARTITIONS; 236 if (amd_mtd->size < AMD_WINDOW_MAXSIZE) 237 num_amd_partitions--; 238 /* Don't add the partition until after the primary INTEL's */ 239 240 #ifdef CONFIG_MTD_CFI_INTELEXT 241 /* 242 * Map the Intel flash into memory after the AMD 243 * It has to start on a multiple of maxsize. 244 */ 245 maxsize = SC520_PAR_TO_SIZE(orig_romcs1par); 246 if (maxsize < (32 * 1024 * 1024)) 247 maxsize = (32 * 1024 * 1024); 248 intel0addr = amdaddr + maxsize; 249 #endif 250 } else { 251 #ifdef CONFIG_MTD_CFI_INTELEXT 252 /* INTEL boot FLASH */ 253 intelboot++; 254 255 if (!orig_romcs1par) { 256 intel0cs = SC520_PAR_BOOTCS; 257 intel0par = (volatile unsigned long *) 258 (nettel_mmcrp + 0xc4); 259 intel1cs = SC520_PAR_ROMCS1; 260 intel1par = (volatile unsigned long *) 261 (nettel_mmcrp + 0xc0); 262 263 intel0addr = SC520_PAR_TO_ADDR(orig_bootcspar); 264 maxsize = SC520_PAR_TO_SIZE(orig_bootcspar); 265 } else { 266 /* Kernel base is on ROMCS1, not BOOTCS */ 267 intel0cs = SC520_PAR_ROMCS1; 268 intel0par = (volatile unsigned long *) 269 (nettel_mmcrp + 0xc0); 270 intel1cs = SC520_PAR_BOOTCS; 271 intel1par = (volatile unsigned long *) 272 (nettel_mmcrp + 0xc4); 273 274 intel0addr = SC520_PAR_TO_ADDR(orig_romcs1par); 275 maxsize = SC520_PAR_TO_SIZE(orig_romcs1par); 276 } 277 278 /* Destroy useless AMD MTD mapping */ 279 amd_mtd = NULL; 280 iounmap(nettel_amd_map.virt); 281 nettel_amd_map.virt = NULL; 282 #else 283 /* Only AMD flash supported */ 284 rc = -ENXIO; 285 goto out_unmap2; 286 #endif 287 } 288 289 #ifdef CONFIG_MTD_CFI_INTELEXT 290 /* 291 * We have determined the INTEL FLASH configuration, so lets 292 * go ahead and probe for them now. 293 */ 294 295 /* Set PAR to the maximum size */ 296 if (maxsize < (32 * 1024 * 1024)) 297 maxsize = (32 * 1024 * 1024); 298 *intel0par = SC520_PAR(intel0cs, intel0addr, maxsize); 299 300 /* Turn other PAR off so the first probe doesn't find it */ 301 *intel1par = 0; 302 303 /* Probe for the size of the first Intel flash */ 304 nettel_intel_map.size = maxsize; 305 nettel_intel_map.phys = intel0addr; 306 nettel_intel_map.virt = ioremap_nocache(intel0addr, maxsize); 307 if (!nettel_intel_map.virt) { 308 printk("SNAPGEAR: failed to ioremap() ROMCS1\n"); 309 rc = -EIO; 310 goto out_unmap2; 311 } 312 simple_map_init(&nettel_intel_map); 313 314 intel_mtd = do_map_probe("cfi_probe", &nettel_intel_map); 315 if (!intel_mtd) { 316 rc = -ENXIO; 317 goto out_unmap1; 318 } 319 320 /* Set PAR to the detected size */ 321 intel0size = intel_mtd->size; 322 *intel0par = SC520_PAR(intel0cs, intel0addr, intel0size); 323 324 /* 325 * Map second Intel FLASH right after first. Set its size to the 326 * same maxsize used for the first Intel FLASH. 327 */ 328 intel1addr = intel0addr + intel0size; 329 *intel1par = SC520_PAR(intel1cs, intel1addr, maxsize); 330 __asm__ ("wbinvd"); 331 332 maxsize += intel0size; 333 334 /* Delete the old map and probe again to do both chips */ 335 map_destroy(intel_mtd); 336 intel_mtd = NULL; 337 iounmap(nettel_intel_map.virt); 338 339 nettel_intel_map.size = maxsize; 340 nettel_intel_map.virt = ioremap_nocache(intel0addr, maxsize); 341 if (!nettel_intel_map.virt) { 342 printk("SNAPGEAR: failed to ioremap() ROMCS1/2\n"); 343 rc = -EIO; 344 goto out_unmap2; 345 } 346 347 intel_mtd = do_map_probe("cfi_probe", &nettel_intel_map); 348 if (! intel_mtd) { 349 rc = -ENXIO; 350 goto out_unmap1; 351 } 352 353 intel1size = intel_mtd->size - intel0size; 354 if (intel1size > 0) { 355 *intel1par = SC520_PAR(intel1cs, intel1addr, intel1size); 356 __asm__ ("wbinvd"); 357 } else { 358 *intel1par = 0; 359 } 360 361 printk(KERN_NOTICE "SNAPGEAR: Intel flash device size = %lldKiB\n", 362 (unsigned long long)(intel_mtd->size >> 10)); 363 364 intel_mtd->owner = THIS_MODULE; 365 366 num_intel_partitions = ARRAY_SIZE(nettel_intel_partitions); 367 368 if (intelboot) { 369 /* 370 * Adjust offset and size of last boot partition. 371 * Must allow for BIOS region at end of FLASH. 372 */ 373 nettel_intel_partitions[1].size = (intel0size + intel1size) - 374 (1024*1024 + intel_mtd->erasesize); 375 nettel_intel_partitions[3].size = intel0size + intel1size; 376 nettel_intel_partitions[4].offset = 377 (intel0size + intel1size) - intel_mtd->erasesize; 378 nettel_intel_partitions[4].size = intel_mtd->erasesize; 379 nettel_intel_partitions[5].offset = 380 nettel_intel_partitions[4].offset; 381 nettel_intel_partitions[5].size = 382 nettel_intel_partitions[4].size; 383 } else { 384 /* No BIOS regions when AMD boot */ 385 num_intel_partitions -= 2; 386 } 387 rc = mtd_device_register(intel_mtd, nettel_intel_partitions, 388 num_intel_partitions); 389 if (rc) 390 goto out_map_destroy; 391 #endif 392 393 if (amd_mtd) { 394 rc = mtd_device_register(amd_mtd, nettel_amd_partitions, 395 num_amd_partitions); 396 if (rc) 397 goto out_mtd_unreg; 398 } 399 400 #ifdef CONFIG_MTD_CFI_INTELEXT 401 register_reboot_notifier(&nettel_notifier_block); 402 #endif 403 404 return rc; 405 406 out_mtd_unreg: 407 #ifdef CONFIG_MTD_CFI_INTELEXT 408 mtd_device_unregister(intel_mtd); 409 out_map_destroy: 410 map_destroy(intel_mtd); 411 out_unmap1: 412 iounmap(nettel_intel_map.virt); 413 #endif 414 415 out_unmap2: 416 iounmap(nettel_mmcrp); 417 iounmap(nettel_amd_map.virt); 418 419 return rc; 420 } 421 422 /****************************************************************************/ 423 424 static void __exit nettel_cleanup(void) 425 { 426 #ifdef CONFIG_MTD_CFI_INTELEXT 427 unregister_reboot_notifier(&nettel_notifier_block); 428 #endif 429 if (amd_mtd) { 430 mtd_device_unregister(amd_mtd); 431 map_destroy(amd_mtd); 432 } 433 if (nettel_mmcrp) { 434 iounmap(nettel_mmcrp); 435 nettel_mmcrp = NULL; 436 } 437 if (nettel_amd_map.virt) { 438 iounmap(nettel_amd_map.virt); 439 nettel_amd_map.virt = NULL; 440 } 441 #ifdef CONFIG_MTD_CFI_INTELEXT 442 if (intel_mtd) { 443 mtd_device_unregister(intel_mtd); 444 map_destroy(intel_mtd); 445 } 446 if (nettel_intel_map.virt) { 447 iounmap(nettel_intel_map.virt); 448 nettel_intel_map.virt = NULL; 449 } 450 #endif 451 } 452 453 /****************************************************************************/ 454 455 module_init(nettel_init); 456 module_exit(nettel_cleanup); 457 458 MODULE_LICENSE("GPL"); 459 MODULE_AUTHOR("Greg Ungerer <gerg@snapgear.com>"); 460 MODULE_DESCRIPTION("SnapGear/SecureEdge FLASH support"); 461 462 /****************************************************************************/ 463