1 /* 2 * Flash memory access on SA11x0 based devices 3 * 4 * (C) 2000 Nicolas Pitre <nico@fluxnic.net> 5 */ 6 #include <linux/module.h> 7 #include <linux/types.h> 8 #include <linux/ioport.h> 9 #include <linux/kernel.h> 10 #include <linux/init.h> 11 #include <linux/errno.h> 12 #include <linux/slab.h> 13 #include <linux/platform_device.h> 14 #include <linux/err.h> 15 #include <linux/io.h> 16 17 #include <linux/mtd/mtd.h> 18 #include <linux/mtd/map.h> 19 #include <linux/mtd/partitions.h> 20 #include <linux/mtd/concat.h> 21 22 #include <mach/hardware.h> 23 #include <asm/sizes.h> 24 #include <asm/mach/flash.h> 25 26 #if 0 27 /* 28 * This is here for documentation purposes only - until these people 29 * submit their machine types. It will be gone January 2005. 30 */ 31 static struct mtd_partition consus_partitions[] = { 32 { 33 .name = "Consus boot firmware", 34 .offset = 0, 35 .size = 0x00040000, 36 .mask_flags = MTD_WRITABLE, /* force read-only */ 37 }, { 38 .name = "Consus kernel", 39 .offset = 0x00040000, 40 .size = 0x00100000, 41 .mask_flags = 0, 42 }, { 43 .name = "Consus disk", 44 .offset = 0x00140000, 45 /* The rest (up to 16M) for jffs. We could put 0 and 46 make it find the size automatically, but right now 47 i have 32 megs. jffs will use all 32 megs if given 48 the chance, and this leads to horrible problems 49 when you try to re-flash the image because blob 50 won't erase the whole partition. */ 51 .size = 0x01000000 - 0x00140000, 52 .mask_flags = 0, 53 }, { 54 /* this disk is a secondary disk, which can be used as 55 needed, for simplicity, make it the size of the other 56 consus partition, although realistically it could be 57 the remainder of the disk (depending on the file 58 system used) */ 59 .name = "Consus disk2", 60 .offset = 0x01000000, 61 .size = 0x01000000 - 0x00140000, 62 .mask_flags = 0, 63 } 64 }; 65 66 /* Frodo has 2 x 16M 28F128J3A flash chips in bank 0: */ 67 static struct mtd_partition frodo_partitions[] = 68 { 69 { 70 .name = "bootloader", 71 .size = 0x00040000, 72 .offset = 0x00000000, 73 .mask_flags = MTD_WRITEABLE 74 }, { 75 .name = "bootloader params", 76 .size = 0x00040000, 77 .offset = MTDPART_OFS_APPEND, 78 .mask_flags = MTD_WRITEABLE 79 }, { 80 .name = "kernel", 81 .size = 0x00100000, 82 .offset = MTDPART_OFS_APPEND, 83 .mask_flags = MTD_WRITEABLE 84 }, { 85 .name = "ramdisk", 86 .size = 0x00400000, 87 .offset = MTDPART_OFS_APPEND, 88 .mask_flags = MTD_WRITEABLE 89 }, { 90 .name = "file system", 91 .size = MTDPART_SIZ_FULL, 92 .offset = MTDPART_OFS_APPEND 93 } 94 }; 95 96 static struct mtd_partition jornada56x_partitions[] = { 97 { 98 .name = "bootldr", 99 .size = 0x00040000, 100 .offset = 0, 101 .mask_flags = MTD_WRITEABLE, 102 }, { 103 .name = "rootfs", 104 .size = MTDPART_SIZ_FULL, 105 .offset = MTDPART_OFS_APPEND, 106 } 107 }; 108 109 static void jornada56x_set_vpp(int vpp) 110 { 111 if (vpp) 112 GPSR = GPIO_GPIO26; 113 else 114 GPCR = GPIO_GPIO26; 115 GPDR |= GPIO_GPIO26; 116 } 117 118 /* 119 * Machine Phys Size set_vpp 120 * Consus : SA1100_CS0_PHYS SZ_32M 121 * Frodo : SA1100_CS0_PHYS SZ_32M 122 * Jornada56x: SA1100_CS0_PHYS SZ_32M jornada56x_set_vpp 123 */ 124 #endif 125 126 struct sa_subdev_info { 127 char name[16]; 128 struct map_info map; 129 struct mtd_info *mtd; 130 struct flash_platform_data *plat; 131 }; 132 133 struct sa_info { 134 struct mtd_partition *parts; 135 struct mtd_info *mtd; 136 int num_subdev; 137 unsigned int nr_parts; 138 struct sa_subdev_info subdev[0]; 139 }; 140 141 static void sa1100_set_vpp(struct map_info *map, int on) 142 { 143 struct sa_subdev_info *subdev = container_of(map, struct sa_subdev_info, map); 144 subdev->plat->set_vpp(on); 145 } 146 147 static void sa1100_destroy_subdev(struct sa_subdev_info *subdev) 148 { 149 if (subdev->mtd) 150 map_destroy(subdev->mtd); 151 if (subdev->map.virt) 152 iounmap(subdev->map.virt); 153 release_mem_region(subdev->map.phys, subdev->map.size); 154 } 155 156 static int sa1100_probe_subdev(struct sa_subdev_info *subdev, struct resource *res) 157 { 158 unsigned long phys; 159 unsigned int size; 160 int ret; 161 162 phys = res->start; 163 size = res->end - phys + 1; 164 165 /* 166 * Retrieve the bankwidth from the MSC registers. 167 * We currently only implement CS0 and CS1 here. 168 */ 169 switch (phys) { 170 default: 171 printk(KERN_WARNING "SA1100 flash: unknown base address " 172 "0x%08lx, assuming CS0\n", phys); 173 174 case SA1100_CS0_PHYS: 175 subdev->map.bankwidth = (MSC0 & MSC_RBW) ? 2 : 4; 176 break; 177 178 case SA1100_CS1_PHYS: 179 subdev->map.bankwidth = ((MSC0 >> 16) & MSC_RBW) ? 2 : 4; 180 break; 181 } 182 183 if (!request_mem_region(phys, size, subdev->name)) { 184 ret = -EBUSY; 185 goto out; 186 } 187 188 if (subdev->plat->set_vpp) 189 subdev->map.set_vpp = sa1100_set_vpp; 190 191 subdev->map.phys = phys; 192 subdev->map.size = size; 193 subdev->map.virt = ioremap(phys, size); 194 if (!subdev->map.virt) { 195 ret = -ENOMEM; 196 goto err; 197 } 198 199 simple_map_init(&subdev->map); 200 201 /* 202 * Now let's probe for the actual flash. Do it here since 203 * specific machine settings might have been set above. 204 */ 205 subdev->mtd = do_map_probe(subdev->plat->map_name, &subdev->map); 206 if (subdev->mtd == NULL) { 207 ret = -ENXIO; 208 goto err; 209 } 210 subdev->mtd->owner = THIS_MODULE; 211 212 printk(KERN_INFO "SA1100 flash: CFI device at 0x%08lx, %uMiB, %d-bit\n", 213 phys, (unsigned)(subdev->mtd->size >> 20), 214 subdev->map.bankwidth * 8); 215 216 return 0; 217 218 err: 219 sa1100_destroy_subdev(subdev); 220 out: 221 return ret; 222 } 223 224 static void sa1100_destroy(struct sa_info *info, struct flash_platform_data *plat) 225 { 226 int i; 227 228 if (info->mtd) { 229 mtd_device_unregister(info->mtd); 230 if (info->mtd != info->subdev[0].mtd) 231 mtd_concat_destroy(info->mtd); 232 } 233 234 kfree(info->parts); 235 236 for (i = info->num_subdev - 1; i >= 0; i--) 237 sa1100_destroy_subdev(&info->subdev[i]); 238 kfree(info); 239 240 if (plat->exit) 241 plat->exit(); 242 } 243 244 static struct sa_info *__devinit 245 sa1100_setup_mtd(struct platform_device *pdev, struct flash_platform_data *plat) 246 { 247 struct sa_info *info; 248 int nr, size, i, ret = 0; 249 250 /* 251 * Count number of devices. 252 */ 253 for (nr = 0; ; nr++) 254 if (!platform_get_resource(pdev, IORESOURCE_MEM, nr)) 255 break; 256 257 if (nr == 0) { 258 ret = -ENODEV; 259 goto out; 260 } 261 262 size = sizeof(struct sa_info) + sizeof(struct sa_subdev_info) * nr; 263 264 /* 265 * Allocate the map_info structs in one go. 266 */ 267 info = kzalloc(size, GFP_KERNEL); 268 if (!info) { 269 ret = -ENOMEM; 270 goto out; 271 } 272 273 if (plat->init) { 274 ret = plat->init(); 275 if (ret) 276 goto err; 277 } 278 279 /* 280 * Claim and then map the memory regions. 281 */ 282 for (i = 0; i < nr; i++) { 283 struct sa_subdev_info *subdev = &info->subdev[i]; 284 struct resource *res; 285 286 res = platform_get_resource(pdev, IORESOURCE_MEM, i); 287 if (!res) 288 break; 289 290 subdev->map.name = subdev->name; 291 sprintf(subdev->name, "%s-%d", plat->name, i); 292 subdev->plat = plat; 293 294 ret = sa1100_probe_subdev(subdev, res); 295 if (ret) 296 break; 297 } 298 299 info->num_subdev = i; 300 301 /* 302 * ENXIO is special. It means we didn't find a chip when we probed. 303 */ 304 if (ret != 0 && !(ret == -ENXIO && info->num_subdev > 0)) 305 goto err; 306 307 /* 308 * If we found one device, don't bother with concat support. If 309 * we found multiple devices, use concat if we have it available, 310 * otherwise fail. Either way, it'll be called "sa1100". 311 */ 312 if (info->num_subdev == 1) { 313 strcpy(info->subdev[0].name, plat->name); 314 info->mtd = info->subdev[0].mtd; 315 ret = 0; 316 } else if (info->num_subdev > 1) { 317 struct mtd_info *cdev[nr]; 318 /* 319 * We detected multiple devices. Concatenate them together. 320 */ 321 for (i = 0; i < info->num_subdev; i++) 322 cdev[i] = info->subdev[i].mtd; 323 324 info->mtd = mtd_concat_create(cdev, info->num_subdev, 325 plat->name); 326 if (info->mtd == NULL) 327 ret = -ENXIO; 328 } 329 330 if (ret == 0) 331 return info; 332 333 err: 334 sa1100_destroy(info, plat); 335 out: 336 return ERR_PTR(ret); 337 } 338 339 static const char *part_probes[] = { "cmdlinepart", "RedBoot", NULL }; 340 341 static int __devinit sa1100_mtd_probe(struct platform_device *pdev) 342 { 343 struct flash_platform_data *plat = pdev->dev.platform_data; 344 struct mtd_partition *parts; 345 const char *part_type = NULL; 346 struct sa_info *info; 347 int err, nr_parts = 0; 348 349 if (!plat) 350 return -ENODEV; 351 352 info = sa1100_setup_mtd(pdev, plat); 353 if (IS_ERR(info)) { 354 err = PTR_ERR(info); 355 goto out; 356 } 357 358 /* 359 * Partition selection stuff. 360 */ 361 nr_parts = parse_mtd_partitions(info->mtd, part_probes, &parts, 0); 362 if (nr_parts > 0) { 363 info->parts = parts; 364 part_type = "dynamic"; 365 } else { 366 parts = plat->parts; 367 nr_parts = plat->nr_parts; 368 part_type = "static"; 369 } 370 371 if (nr_parts == 0) 372 printk(KERN_NOTICE "SA1100 flash: no partition info " 373 "available, registering whole flash\n"); 374 else 375 printk(KERN_NOTICE "SA1100 flash: using %s partition " 376 "definition\n", part_type); 377 378 mtd_device_register(info->mtd, parts, nr_parts); 379 380 info->nr_parts = nr_parts; 381 382 platform_set_drvdata(pdev, info); 383 err = 0; 384 385 out: 386 return err; 387 } 388 389 static int __exit sa1100_mtd_remove(struct platform_device *pdev) 390 { 391 struct sa_info *info = platform_get_drvdata(pdev); 392 struct flash_platform_data *plat = pdev->dev.platform_data; 393 394 platform_set_drvdata(pdev, NULL); 395 sa1100_destroy(info, plat); 396 397 return 0; 398 } 399 400 #ifdef CONFIG_PM 401 static void sa1100_mtd_shutdown(struct platform_device *dev) 402 { 403 struct sa_info *info = platform_get_drvdata(dev); 404 if (info && info->mtd->suspend(info->mtd) == 0) 405 info->mtd->resume(info->mtd); 406 } 407 #else 408 #define sa1100_mtd_shutdown NULL 409 #endif 410 411 static struct platform_driver sa1100_mtd_driver = { 412 .probe = sa1100_mtd_probe, 413 .remove = __exit_p(sa1100_mtd_remove), 414 .shutdown = sa1100_mtd_shutdown, 415 .driver = { 416 .name = "sa1100-mtd", 417 .owner = THIS_MODULE, 418 }, 419 }; 420 421 static int __init sa1100_mtd_init(void) 422 { 423 return platform_driver_register(&sa1100_mtd_driver); 424 } 425 426 static void __exit sa1100_mtd_exit(void) 427 { 428 platform_driver_unregister(&sa1100_mtd_driver); 429 } 430 431 module_init(sa1100_mtd_init); 432 module_exit(sa1100_mtd_exit); 433 434 MODULE_AUTHOR("Nicolas Pitre"); 435 MODULE_DESCRIPTION("SA1100 CFI map driver"); 436 MODULE_LICENSE("GPL"); 437 MODULE_ALIAS("platform:sa1100-mtd"); 438