bfin-async-flash.c revision d20d5a5780a014bc4d24dbcb6daf7673a9dddf98
12e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger/* 22e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * drivers/mtd/maps/bfin-async-flash.c 32e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * 42e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * Handle the case where flash memory and ethernet mac/phy are 52e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * mapped onto the same async bank. The BF533-STAMP does this 62e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * for example. All board-specific configuration goes in your 72e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * board resources file. 82e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * 92f82af08fcc7dc01a7e98a49a5995a77e32a2925Nicolas Pitre * Copyright 2000 Nicolas Pitre <nico@fluxnic.net> 102e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * Copyright 2005-2008 Analog Devices Inc. 112e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * 122e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * Enter bugs at http://blackfin.uclinux.org/ 132e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * 142e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger * Licensed under the GPL-2 or later. 152e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger */ 162e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 172e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/init.h> 182e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/kernel.h> 192e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/module.h> 202e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/mtd/mtd.h> 212e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/mtd/map.h> 222e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/mtd/partitions.h> 232e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/mtd/physmap.h> 242e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/platform_device.h> 255a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 262e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/types.h> 272e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 282e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <asm/blackfin.h> 292e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/gpio.h> 302e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <linux/io.h> 312e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#include <asm/unaligned.h> 322e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 337bf350b7245b40fe6a57b79ec4a04c85195dc648Artem Bityutskiy#define pr_devinit(fmt, args...) \ 347bf350b7245b40fe6a57b79ec4a04c85195dc648Artem Bityutskiy ({ static const char __fmt[] = fmt; printk(__fmt, ## args); }) 352e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 362e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger#define DRIVER_NAME "bfin-async-flash" 372e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 382e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysingerstruct async_state { 392e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct mtd_info *mtd; 402e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct map_info map; 412e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger int enet_flash_pin; 422e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger uint32_t flash_ambctl0, flash_ambctl1; 432e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger uint32_t save_ambctl0, save_ambctl1; 442e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger unsigned long irq_flags; 452e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger}; 462e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 472e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysingerstatic void switch_to_flash(struct async_state *state) 482e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 492e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger local_irq_save(state->irq_flags); 502e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 512e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger gpio_set_value(state->enet_flash_pin, 0); 522e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 532e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->save_ambctl0 = bfin_read_EBIU_AMBCTL0(); 542e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->save_ambctl1 = bfin_read_EBIU_AMBCTL1(); 552e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger bfin_write_EBIU_AMBCTL0(state->flash_ambctl0); 562e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger bfin_write_EBIU_AMBCTL1(state->flash_ambctl1); 572e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger SSYNC(); 582e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 592e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 602e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysingerstatic void switch_back(struct async_state *state) 612e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 622e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger bfin_write_EBIU_AMBCTL0(state->save_ambctl0); 632e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger bfin_write_EBIU_AMBCTL1(state->save_ambctl1); 642e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger SSYNC(); 652e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 662e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger gpio_set_value(state->enet_flash_pin, 1); 672e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 682e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger local_irq_restore(state->irq_flags); 692e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 702e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 714335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysingerstatic map_word bfin_flash_read(struct map_info *map, unsigned long ofs) 722e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 732e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct async_state *state = (struct async_state *)map->map_priv_1; 742e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger uint16_t word; 752e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger map_word test; 762e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 772e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_to_flash(state); 782e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 792e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger word = readw(map->virt + ofs); 802e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 812e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_back(state); 822e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 832e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger test.x[0] = word; 842e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger return test; 852e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 862e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 874335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysingerstatic void bfin_flash_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len) 882e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 892e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct async_state *state = (struct async_state *)map->map_priv_1; 902e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 912e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_to_flash(state); 922e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 932e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger memcpy(to, map->virt + from, len); 942e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 952e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_back(state); 962e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 972e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 984335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysingerstatic void bfin_flash_write(struct map_info *map, map_word d1, unsigned long ofs) 992e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 1002e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct async_state *state = (struct async_state *)map->map_priv_1; 1012e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger uint16_t d; 1022e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1032e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger d = d1.x[0]; 1042e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1052e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_to_flash(state); 1062e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1072e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger writew(d, map->virt + ofs); 1082e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger SSYNC(); 1092e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1102e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_back(state); 1112e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 1122e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1134335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysingerstatic void bfin_flash_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len) 1142e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 1152e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct async_state *state = (struct async_state *)map->map_priv_1; 1162e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1172e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_to_flash(state); 1182e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1192e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger memcpy(map->virt + to, from, len); 1202e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger SSYNC(); 1212e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1222e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger switch_back(state); 1232e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 1242e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1250984c8910426371205da0b60fc1dae64a996fb64Artem Bityutskiystatic const char * const part_probe_types[] = { 1260984c8910426371205da0b60fc1dae64a996fb64Artem Bityutskiy "cmdlinepart", "RedBoot", NULL }; 1272e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 12806f25510692385ed4dadd23f7d3d064d1ab11c2dBill Pembertonstatic int bfin_flash_probe(struct platform_device *pdev) 1292e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 1302e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger int ret; 131d20d5a5780a014bc4d24dbcb6daf7673a9dddf98Jingoo Han struct physmap_flash_data *pdata = dev_get_platdata(&pdev->dev); 1322e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct resource *memory = platform_get_resource(pdev, IORESOURCE_MEM, 0); 1332e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct resource *flash_ambctl = platform_get_resource(pdev, IORESOURCE_MEM, 1); 1342e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct async_state *state; 1352e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1362e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state = kzalloc(sizeof(*state), GFP_KERNEL); 1372e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger if (!state) 1382e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger return -ENOMEM; 1392e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1402e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->map.name = DRIVER_NAME; 1414335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysinger state->map.read = bfin_flash_read; 1424335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysinger state->map.copy_from = bfin_flash_copy_from; 1434335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysinger state->map.write = bfin_flash_write; 1444335c1003ed05d5d5a386cd8008fc06a6d424ca2Mike Frysinger state->map.copy_to = bfin_flash_copy_to; 1452e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->map.bankwidth = pdata->width; 14628f65c11f2ffb3957259dece647a24f8ad2e241bJoe Perches state->map.size = resource_size(memory); 1472e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->map.virt = (void __iomem *)memory->start; 1482e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->map.phys = memory->start; 1492e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->map.map_priv_1 = (unsigned long)state; 1502e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->enet_flash_pin = platform_get_irq(pdev, 0); 1512e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->flash_ambctl0 = flash_ambctl->start; 1522e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->flash_ambctl1 = flash_ambctl->end; 1532e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1542e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger if (gpio_request(state->enet_flash_pin, DRIVER_NAME)) { 1552e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger pr_devinit(KERN_ERR DRIVER_NAME ": Failed to request gpio %d\n", state->enet_flash_pin); 15610715b8751dfc403aeb7fbc35166417fa1664edaMike Frysinger kfree(state); 1572e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger return -EBUSY; 1582e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger } 1592e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger gpio_direction_output(state->enet_flash_pin, 1); 1602e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1612e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger pr_devinit(KERN_NOTICE DRIVER_NAME ": probing %d-bit flash bus\n", state->map.bankwidth * 8); 1622e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger state->mtd = do_map_probe(memory->name, &state->map); 16310715b8751dfc403aeb7fbc35166417fa1664edaMike Frysinger if (!state->mtd) { 16410715b8751dfc403aeb7fbc35166417fa1664edaMike Frysinger gpio_free(state->enet_flash_pin); 16510715b8751dfc403aeb7fbc35166417fa1664edaMike Frysinger kfree(state); 1662e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger return -ENXIO; 16710715b8751dfc403aeb7fbc35166417fa1664edaMike Frysinger } 1682e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 16942d7fbe223ab878b23de9e3b0166f8cd665a2aa5Artem Bityutskiy mtd_device_parse_register(state->mtd, part_probe_types, NULL, 17042d7fbe223ab878b23de9e3b0166f8cd665a2aa5Artem Bityutskiy pdata->parts, pdata->nr_parts); 1712e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1722e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger platform_set_drvdata(pdev, state); 1732e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1742e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger return 0; 1752e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 1762e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 177810b7e060c14110d8f580daaf77fab3a7d950483Bill Pembertonstatic int bfin_flash_remove(struct platform_device *pdev) 1782e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger{ 1792e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger struct async_state *state = platform_get_drvdata(pdev); 1802e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger gpio_free(state->enet_flash_pin); 181fee88c58c7ddf6f0f41b76a59253d55d321da41aJamie Iles mtd_device_unregister(state->mtd); 1822e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger map_destroy(state->mtd); 1832e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger kfree(state); 1842e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger return 0; 1852e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger} 1862e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1872e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysingerstatic struct platform_driver bfin_flash_driver = { 1882e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger .probe = bfin_flash_probe, 1895153b88cac39b0a14662f0e15439b826bacfe213Bill Pemberton .remove = bfin_flash_remove, 1902e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger .driver = { 1912e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger .name = DRIVER_NAME, 1922e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger }, 1932e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger}; 1942e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 195f99640dee209df4730f35a28b02693affd571ad5Axel Linmodule_platform_driver(bfin_flash_driver); 1962e3c22f57029ce04d55c07b8332ae405005456d9Mike Frysinger 1972e3c22f57029ce04d55c07b8332ae405005456d9Mike FrysingerMODULE_LICENSE("GPL"); 1982e3c22f57029ce04d55c07b8332ae405005456d9Mike FrysingerMODULE_DESCRIPTION("MTD map driver for Blackfins with flash/ethernet on same async bank"); 199