pcmciamtd.c revision e8405f0f617856de0ceb7d04e65b663051451544
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * pcmciamtd.c - MTD driver for PCMCIA flash memory cards 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Author: Simon Evans <spse@secret.org.uk> 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2002 Simon Evans 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Licence: GPL 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/slab.h> 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/timer.h> 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/system.h> 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <pcmcia/cs.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <pcmcia/cistpl.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <pcmcia/ds.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/map.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/mtd.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_MTD_DEBUG 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int debug = CONFIG_MTD_DEBUG_VERBOSE; 288d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(debug, int, 0); 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(debug, "Set Debug Level 0=quiet, 5=noisy"); 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef DEBUG 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DEBUG(n, format, arg...) \ 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n <= debug) { \ 33cb53b3b99992b6c548d56cdf47bc710640ee2ee1Harvey Harrison printk(KERN_DEBUG __FILE__ ":%s(): " format "\n", __func__ , ## arg); \ 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef DEBUG 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DEBUG(n, arg...) 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic const int debug = 0; 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define info(format, arg...) printk(KERN_INFO "pcmciamtd: " format "\n" , ## arg) 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DRIVER_DESC "PCMCIA Flash memory card driver" 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Size of the PCMCIA address space: 26 bits = 64 MB */ 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAX_PCMCIA_ADDR 0x4000000 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct pcmciamtd_dev { 50fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski struct pcmcia_device *p_dev; 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base; /* ioremapped address of PCMCIA window */ 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int win_size; /* size of window */ 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int offset; /* offset into card the window currently points at */ 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct map_info pcmcia_map; 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mtd_info *mtd_info; 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int vpp; 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char mtd_name[sizeof(struct cistpl_vers_1_t)]; 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Module parameters */ 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 2 = do 16-bit transfers, 1 = do 8-bit transfers */ 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int bankwidth = 2; 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Speed of memory accesses, in ns */ 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mem_speed; 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Force the size of an SRAM card */ 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int force_size; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Force Vpp */ 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int vpp; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Set Vpp */ 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int setvpp; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Force card to be treated as FLASH, ROM or RAM */ 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mem_type; 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Simon Evans <spse@secret.org.uk>"); 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION(DRIVER_DESC); 848d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(bankwidth, int, 0); 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(bankwidth, "Set bankwidth (1=8 bit, 2=16 bit, default=2)"); 868d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(mem_speed, int, 0); 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(mem_speed, "Set memory access speed in ns"); 888d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(force_size, int, 0); 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(force_size, "Force size of card in MiB (1-64)"); 908d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(setvpp, int, 0); 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(setvpp, "Set Vpp (0=Never, 1=On writes, 2=Always on, default=0)"); 928d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(vpp, int, 0); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(vpp, "Vpp value in 1/10ths eg 33=3.3V 120=12V (Dangerous)"); 948d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(mem_type, int, 0); 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(mem_type, "Set Memory type (0=Flash, 1=RAM, 2=ROM, default=0)"); 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 989bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz/* read/write{8,16} copy_{from,to} routines with window remapping 999bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * to access whole card 1009bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic caddr_t remap_window(struct map_info *map, unsigned long to) 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 104cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski struct resource *win = (struct resource *) map->map_priv_2; 105b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski unsigned int offset; 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 108e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski if (!pcmcia_dev_present(dev->p_dev)) { 109e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski DEBUG(1, "device removed"); 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 113b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski offset = to & ~(dev->win_size-1); 114b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski if (offset != dev->offset) { 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "Remapping window from 0x%8.8x to 0x%8.8x", 116b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski dev->offset, offset); 117b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski ret = pcmcia_map_mem_page(dev->p_dev, win, offset); 1189b44de2015ff4a2ed1d56efedfcc72b917d356a6Dominik Brodowski if (ret != 0) 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 120b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski dev->offset = offset; 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return dev->win_base + (to & (dev->win_size-1)); 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read8_remap(struct map_info *map, unsigned long ofs) 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, ofs); 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readb(addr); 136f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz DEBUG(3, "ofs = 0x%08lx (%p) data = 0x%02lx", ofs, addr, d.x[0]); 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read16_remap(struct map_info *map, unsigned long ofs) 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, ofs); 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readw(addr); 151f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz DEBUG(3, "ofs = 0x%08lx (%p) data = 0x%04lx", ofs, addr, d.x[0]); 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_from_remap(struct map_info *map, void *to, unsigned long from, ssize_t len) 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long win_size = dev->win_size; 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16111c93605faecfe6f9a28a6f3d14989bad077055aDavid Woodhouse DEBUG(3, "to = %p from = %lu len = %zd", to, from, len); 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while(len) { 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int toread = win_size - (from & (win_size-1)); 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(toread > len) 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds toread = len; 16869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, from); 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(4, "memcpy from %p to %p len = %d", addr, to, toread); 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_fromio(to, addr, toread); 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds len -= toread; 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds to += toread; 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds from += toread; 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_write8_remap(struct map_info *map, map_word d, unsigned long adr) 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr = remap_window(map, adr); 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 189f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz DEBUG(3, "adr = 0x%08lx (%p) data = 0x%02lx", adr, addr, d.x[0]); 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(d.x[0], addr); 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_write16_remap(struct map_info *map, map_word d, unsigned long adr) 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr = remap_window(map, adr); 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 200f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz DEBUG(3, "adr = 0x%08lx (%p) data = 0x%04lx", adr, addr, d.x[0]); 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writew(d.x[0], addr); 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_to_remap(struct map_info *map, unsigned long to, const void *from, ssize_t len) 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long win_size = dev->win_size; 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21011c93605faecfe6f9a28a6f3d14989bad077055aDavid Woodhouse DEBUG(3, "to = %lu from = %p len = %zd", to, from, len); 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while(len) { 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int towrite = win_size - (to & (win_size-1)); 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(towrite > len) 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds towrite = len; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, to); 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(4, "memcpy from %p to %p len = %d", from, addr, towrite); 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_toio(addr, from, towrite); 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds len -= towrite; 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds to += towrite; 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds from += towrite; 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* read/write{8,16} copy_{from,to} routines with direct access */ 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 233e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski#define DEV_REMOVED(x) (!(pcmcia_dev_present(((struct pcmciamtd_dev *)map->map_priv_1)->p_dev))) 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read8(struct map_info *map, unsigned long ofs) 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readb(win_base + ofs); 2449bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(3, "ofs = 0x%08lx (%p) data = 0x%02lx", 2459bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz ofs, win_base + ofs, d.x[0]); 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read16(struct map_info *map, unsigned long ofs) 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readw(win_base + ofs); 2599bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(3, "ofs = 0x%08lx (%p) data = 0x%04lx", 2609bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz ofs, win_base + ofs, d.x[0]); 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len) 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27211c93605faecfe6f9a28a6f3d14989bad077055aDavid Woodhouse DEBUG(3, "to = %p from = %lu len = %zd", to, from, len); 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_fromio(to, win_base + from, len); 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 277f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void pcmcia_write8(struct map_info *map, map_word d, unsigned long adr) 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2849bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(3, "adr = 0x%08lx (%p) data = 0x%02lx", 2859bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz adr, win_base + adr, d.x[0]); 286f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz writeb(d.x[0], win_base + adr); 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 290f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void pcmcia_write16(struct map_info *map, map_word d, unsigned long adr) 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2979bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(3, "adr = 0x%08lx (%p) data = 0x%04lx", 2989bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz adr, win_base + adr, d.x[0]); 299f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz writew(d.x[0], win_base + adr); 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len) 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31011c93605faecfe6f9a28a6f3d14989bad077055aDavid Woodhouse DEBUG(3, "to = %lu from = %p len = %zd", to, from, len); 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_toio(win_base + to, from, len); 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmciamtd_set_vpp(struct map_info *map, int on) 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 318fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski struct pcmcia_device *link = dev->p_dev; 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "dev = %p on = %d vpp = %d\n", dev, on, dev->vpp); 321fb49fa533f9d211994c33efb752ffa5b30033729Dominik Brodowski pcmcia_fixup_vpp(link, on ? dev->vpp : 0); 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* After a card is removed, pcmciamtd_release() will unregister the 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * device, and release the PCMCIA configuration. If the device is 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * still open, this will be postponed until it is closed. 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 330fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void pcmciamtd_release(struct pcmcia_device *link) 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = link->priv; 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(3, "link = 0x%p", link); 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 336cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski if (link->resource[2]->end) { 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(dev->win_base) { 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(dev->win_base); 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_base = NULL; 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 342fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_disable_device(link); 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 34618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#ifdef CONFIG_MTD_DEBUG 34718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_format(struct pcmcia_device *p_dev, 34818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 34918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cisparse_t parse; 35269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 35318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (!pcmcia_parse_tuple(tuple, &parse)) { 35418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_format_t *t = &parse.format; 35518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski (void)t; /* Shut up, gcc */ 35618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Format type: %u, Error Detection: %u, offset = %u, length =%u", 35718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski t->type, t->edc, t->offset, t->length); 35818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 35918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -ENOSPC; 36018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 36169f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 36218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_jedec(struct pcmcia_device *p_dev, 36318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 36418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 36518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 36618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 36718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 36869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 36918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (!pcmcia_parse_tuple(tuple, &parse)) { 37018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_jedec_t *t = &parse.jedec; 37118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->nid; i++) 3729bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(2, "JEDEC: 0x%02x 0x%02x", 3739bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz t->id[i].mfr, t->id[i].info); 37418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 37518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -ENOSPC; 37618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 37718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#endif 37869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 37918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_device(struct pcmcia_device *p_dev, 38018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 38118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 38218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 38318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski struct pcmciamtd_dev *dev = priv_data; 38418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 38518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_device_t *t = &parse.device; 38618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 38718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 38818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (pcmcia_parse_tuple(tuple, &parse)) 38918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -EINVAL; 39018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 39118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Common memory:"); 39218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->pcmcia_map.size = t->dev[0].size; 39318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski /* from here on: DEBUG only */ 39418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->ndev; i++) { 39518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, type = %u", i, t->dev[i].type); 39618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, wp = %u", i, t->dev[i].wp); 39718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, speed = %u ns", i, t->dev[i].speed); 39818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, size = %u bytes", i, t->dev[i].size); 39918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 40018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return 0; 40118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 40269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 40318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_geo(struct pcmcia_device *p_dev, 40418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 40518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 40618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 40718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski struct pcmciamtd_dev *dev = priv_data; 40818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 40918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_device_geo_t *t = &parse.device_geo; 41018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 41118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 41218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (pcmcia_parse_tuple(tuple, &parse)) 41318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -EINVAL; 41418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 41518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->pcmcia_map.bankwidth = t->geo[0].buswidth; 41618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski /* from here on: DEBUG only */ 41718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->ngeo; i++) { 41818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d bankwidth = %u", i, t->geo[i].buswidth); 41918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d erase_block = %u", i, t->geo[i].erase_block); 42018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d read_block = %u", i, t->geo[i].read_block); 42118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d write_block = %u", i, t->geo[i].write_block); 42218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d partition = %u", i, t->geo[i].partition); 42318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d interleave = %u", i, t->geo[i].interleave); 42418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 42518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return 0; 42618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 42769f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 42869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 429f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void card_settings(struct pcmciamtd_dev *dev, struct pcmcia_device *p_dev, int *new_name) 43018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 43118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 43218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 43318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (p_dev->prod_id[0]) { 43418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->mtd_name[0] = '\0'; 43518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < 4; i++) { 43618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (i) 43718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski strcat(dev->mtd_name, " "); 43818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (p_dev->prod_id[i]) 43918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski strcat(dev->mtd_name, p_dev->prod_id[i]); 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 44118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Found name: %s", dev->mtd_name); 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 44318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 44418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#ifdef CONFIG_MTD_DEBUG 44518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_FORMAT, pcmciamtd_cistpl_format, NULL); 44618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_JEDEC_C, pcmciamtd_cistpl_jedec, NULL); 44718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#endif 44818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_DEVICE, pcmciamtd_cistpl_device, dev); 44918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_DEVICE_GEO, pcmciamtd_cistpl_geo, dev); 45018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->pcmcia_map.size) 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.size = MAX_PCMCIA_ADDR; 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->pcmcia_map.bankwidth) 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.bankwidth = 2; 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(force_size) { 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.size = force_size << 20; 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "size forced to %dM", force_size); 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(bankwidth) { 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.bankwidth = bankwidth; 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "bankwidth forced to %d", bankwidth); 46569f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner } 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.name = dev->mtd_name; 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->mtd_name[0]) { 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds strcpy(dev->mtd_name, "PCMCIA Memory card"); 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *new_name = 1; 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Device: Size: %lu Width:%d Name: %s", 4749bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->pcmcia_map.size, 4759bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->pcmcia_map.bankwidth << 3, dev->mtd_name); 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* pcmciamtd_config() is scheduled to run after a CARD_INSERTION event 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is received, to configure the PCMCIA socket, and to make the 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MTD device available to the system. 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 48415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int pcmciamtd_config(struct pcmcia_device *link) 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = link->priv; 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mtd_info *mtd = NULL; 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 489cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski int i, j = 0; 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static char *probes[] = { "jedec_probe", "cfi_probe" }; 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int new_name = 0; 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(3, "link=0x%p", link); 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds card_settings(dev, link, &new_name); 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.phys = NO_XIP; 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_from = pcmcia_copy_from_remap; 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_to = pcmcia_copy_to_remap; 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->pcmcia_map.bankwidth == 1) { 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read8_remap; 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write8_remap; 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read16_remap; 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write16_remap; 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(setvpp == 1) 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.set_vpp = pcmciamtd_set_vpp; 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5109bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz /* Request a memory window for PCMCIA. Some architeures can map windows 5119bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * upto the maximum that PCMCIA can support (64MiB) - this is ideal and 5129bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * we aim for a window the size of the whole card - otherwise we try 5139bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * smaller windows until we succeed 5149bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 516cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->flags |= WIN_MEMORY_TYPE_CM | WIN_ENABLE; 517cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->flags |= (dev->pcmcia_map.bankwidth == 1) ? 518cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski WIN_DATA_WIDTH_8 : WIN_DATA_WIDTH_16; 519cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->start = 0; 520cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->end = (force_size) ? force_size << 20 : 521cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski MAX_PCMCIA_ADDR; 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_size = 0; 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 526cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski DEBUG(2, "requesting window with size = %luKiB memspeed = %d", 527cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski (unsigned long) resource_size(link->resource[2]) >> 10, 528cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski mem_speed); 529cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski ret = pcmcia_request_window(link, link->resource[2], mem_speed); 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "ret = %d dev->win_size = %d", ret, dev->win_size); 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(ret) { 532cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski j++; 533cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->start = 0; 534cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->end = (force_size) ? 535cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski force_size << 20 : MAX_PCMCIA_ADDR; 536cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->end >>= j; 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 538cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski DEBUG(2, "Got window of size %luKiB", (unsigned long) 539cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski resource_size(link->resource[2]) >> 10); 540cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev->win_size = resource_size(link->resource[2]); 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 543cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski } while (link->resource[2]->end >= 0x1000); 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "dev->win_size = %d", dev->win_size); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->win_size) { 5489bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, "Cannot allocate memory window\n"); 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 55015b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Allocated a window of %dKiB", dev->win_size >> 10); 55369f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Get write protect status */ 555cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev->win_base = ioremap(link->resource[2]->start, 556cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski resource_size(link->resource[2])); 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->win_base) { 558cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev_err(&dev->p_dev->dev, "ioremap(%pR) failed\n", 559cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]); 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 56115b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 563cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski DEBUG(1, "mapped window dev = %p @ %pR, base = %p", 564cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev, link->resource[2], dev->win_base); 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->offset = 0; 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_1 = (unsigned long)dev; 568cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev->pcmcia_map.map_priv_2 = (unsigned long)link->resource[2]; 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 570f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz dev->vpp = (vpp) ? vpp : link->socket->socket.Vpp; 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.Attributes = 0; 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(setvpp == 2) { 573e8405f0f617856de0ceb7d04e65b663051451544Dominik Brodowski link->vpp = dev->vpp; 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 575e8405f0f617856de0ceb7d04e65b663051451544Dominik Brodowski link->vpp = 0; 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.IntType = INT_MEMORY; 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.ConfigIndex = 0; 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "Setting Configuration"); 581fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski ret = pcmcia_request_configuration(link, &link->conf); 5824c89e88bfde6a3c179790e21004f24e09a058290Dominik Brodowski if (ret != 0) { 58325f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad if (dev->win_base) { 58425f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad iounmap(dev->win_base); 58525f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad dev->win_base = NULL; 58625f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad } 58715b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mem_type == 1) { 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe("map_ram", &dev->pcmcia_map); 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if(mem_type == 2) { 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe("map_rom", &dev->pcmcia_map); 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 59587d10f3c7954d143e509a2af2bca2a27aeb3114dTobias Klauser for(i = 0; i < ARRAY_SIZE(probes); i++) { 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Trying %s", probes[i]); 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe(probes[i], &dev->pcmcia_map); 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd) 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 60069f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "FAILED: %s", probes[i]); 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 60469f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!mtd) { 6069bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(1, "Can not find an MTD"); 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 60815b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtd_info = mtd; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd->owner = THIS_MODULE; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(new_name) { 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int size = 0; 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char unit = ' '; 6179bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz /* Since we are using a default name, make it better by adding 6189bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * in the size 6199bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd->size < 1048576) { /* <1MiB in size, show size in KiB */ 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = mtd->size >> 10; 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unit = 'K'; 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = mtd->size >> 20; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unit = 'M'; 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds snprintf(dev->mtd_name, sizeof(dev->mtd_name), "%d%ciB %s", size, unit, "PCMCIA Memory card"); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the memory found is fits completely into the mapped PCMCIA window, 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds use the faster non-remapping read/write functions */ 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd->size <= dev->win_size) { 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Using non remapping memory functions"); 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_2 = (unsigned long)dev->win_base; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->pcmcia_map.bankwidth == 1) { 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read8; 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write8; 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read16; 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write16; 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_from = pcmcia_copy_from; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_to = pcmcia_copy_to; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(add_mtd_device(mtd)) { 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_destroy(mtd); 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtd_info = NULL; 6499bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, 6509bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz "Could not register the MTD device\n"); 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 65215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6549bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_info(&dev->p_dev->dev, "mtd%d: %s\n", mtd->index, mtd->name); 65515b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return 0; 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6579bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, "CS Error, exiting\n"); 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 65915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 66398e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowskistatic int pcmciamtd_suspend(struct pcmcia_device *dev) 66498e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski{ 66598e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski DEBUG(2, "EVENT_PM_RESUME"); 66698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 66798e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski /* get_lock(link); */ 66898e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 66998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski return 0; 67098e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski} 67198e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 67298e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowskistatic int pcmciamtd_resume(struct pcmcia_device *dev) 67398e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski{ 67498e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski DEBUG(2, "EVENT_PM_SUSPEND"); 67598e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 67698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski /* free_lock(link); */ 67798e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 67898e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski return 0; 67998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski} 68098e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* This deletes a driver "instance". The device is de-registered 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * with Card Services. If it has been released, all local data 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * structures are freed. Otherwise, the structures will be freed 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when the device is released. 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 688fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void pcmciamtd_detach(struct pcmcia_device *link) 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 690e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski struct pcmciamtd_dev *dev = link->priv; 691cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(3, "link=0x%p", link); 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 694e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski if(dev->mtd_info) { 695e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski del_mtd_device(dev->mtd_info); 6969bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_info(&dev->p_dev->dev, "mtd%d: Removing\n", 6979bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->mtd_info->index); 698599fb3298b70d75c12dbdc4dd30f52c5cf04ea2fSean Young map_destroy(dev->mtd_info); 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 700e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski 701e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski pcmciamtd_release(link); 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* pcmciamtd_attach() creates an "instance" of the driver, allocating 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * local data structures for one device. The device is registered 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * with Card Services. 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 71015b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int pcmciamtd_probe(struct pcmcia_device *link) 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev; 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Create new memory card device */ 71595b93a0cd46682c6d9e8eea803fda510cb6b863aBurman Yan dev = kzalloc(sizeof(*dev), GFP_KERNEL); 716f8cfa618dccbdc6dab5297f75779566a388a98fdDominik Brodowski if (!dev) return -ENOMEM; 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "dev=0x%p", dev); 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 719fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski dev->p_dev = link; 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->priv = dev; 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.Attributes = 0; 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.IntType = INT_MEMORY; 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 72515b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return pcmciamtd_config(link); 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 72811d28a30219671607a235a518f395659599a748eDominik Brodowskistatic struct pcmcia_device_id pcmciamtd_ids[] = { 72911d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_FUNC_ID(1), 73011d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID123("IO DATA", "PCS-2M", "2MB SRAM", 0x547e66dc, 0x1fed36cd, 0x36eadd21), 73111d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "2MB SRAM", 0xb569a6e5, 0x36eadd21), 73211d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "4MB FLASH", 0xb569a6e5, 0x8bc54d2a), 73311d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "8MB FLASH", 0xb569a6e5, 0x6df1be3e), 73411d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Intel", "S2E20SW", 0x816cc815, 0xd14c9dcf), 73511d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Intel", "S2E8 SW", 0x816cc815, 0xa2d7dedb), 73611d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-02 ", 0x40ade711, 0x145cea5c), 73711d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-04 ", 0x40ade711, 0x42064dda), 73811d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-20 ", 0x40ade711, 0x25ee5cb0), 73911d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "VALUE SERIES 100 ", 0x40ade711, 0xdf8506d8), 74011d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("KINGMAX TECHNOLOGY INC.", "SRAM 256K Bytes", 0x54d0c69c, 0xad12c29c), 74111d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Maxtor", "MAXFL MobileMax Flash Memory Card", 0xb68968c8, 0x2dfb47b0), 742f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz PCMCIA_DEVICE_PROD_ID123("M-Systems", "M-SYS Flash Memory Card", "(c) M-Systems", 0x7ed2ad87, 0x675dc3fb, 0x7aef3965), 743b2321ac37a16f0d6bdbcd2d20263e8b8b943c0eaDominik Brodowski PCMCIA_DEVICE_PROD_ID12("PRETEC", " 2MB SRAM CARD", 0xebf91155, 0x805360ca), 74411d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB101EN20", 0xf9876baf, 0xad0b207b), 74511d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB513EN20", 0xf9876baf, 0xe8d884ad), 746f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz PCMCIA_DEVICE_PROD_ID12("SMART Modular Technologies", " 4MB FLASH Card", 0x96fd8277, 0x737a5b05), 74711d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-3000", 0x05ddca47, 0xe7d67bca), 74811d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-4100", 0x05ddca47, 0x7bc32944), 74911d28a30219671607a235a518f395659599a748eDominik Brodowski /* the following was commented out in pcmcia-cs-3.2.7 */ 75011d28a30219671607a235a518f395659599a748eDominik Brodowski /* PCMCIA_DEVICE_PROD_ID12("RATOC Systems,Inc.", "SmartMedia ADAPTER PC Card", 0xf4a2fefe, 0x5885b2ae), */ 75111d28a30219671607a235a518f395659599a748eDominik Brodowski#ifdef CONFIG_MTD_PCMCIA_ANONYMOUS 75211d28a30219671607a235a518f395659599a748eDominik Brodowski { .match_flags = PCMCIA_DEV_ID_MATCH_ANONYMOUS, }, 75311d28a30219671607a235a518f395659599a748eDominik Brodowski#endif 75411d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_NULL 75511d28a30219671607a235a518f395659599a748eDominik Brodowski}; 75611d28a30219671607a235a518f395659599a748eDominik BrodowskiMODULE_DEVICE_TABLE(pcmcia, pcmciamtd_ids); 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pcmcia_driver pcmciamtd_driver = { 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .drv = { 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "pcmciamtd" 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 76215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski .probe = pcmciamtd_probe, 763cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski .remove = pcmciamtd_detach, 76411d28a30219671607a235a518f395659599a748eDominik Brodowski .owner = THIS_MODULE, 76511d28a30219671607a235a518f395659599a748eDominik Brodowski .id_table = pcmciamtd_ids, 76698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski .suspend = pcmciamtd_suspend, 76798e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski .resume = pcmciamtd_resume, 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init init_pcmciamtd(void) 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 77359018b6d2acabb114ab58637e6ab95ba424a89d0Adrian Bunk info(DRIVER_DESC); 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(bankwidth && bankwidth != 1 && bankwidth != 2) { 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad bankwidth (%d), using default", bankwidth); 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bankwidth = 2; 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(force_size && (force_size < 1 || force_size > 64)) { 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad force_size (%d), using default", force_size); 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds force_size = 0; 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mem_type && mem_type != 1 && mem_type != 2) { 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad mem_type (%d), using default", mem_type); 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mem_type = 0; 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pcmcia_register_driver(&pcmciamtd_driver); 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit exit_pcmciamtd(void) 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, DRIVER_DESC " unloading"); 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmcia_unregister_driver(&pcmciamtd_driver); 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(init_pcmciamtd); 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(exit_pcmciamtd); 799