pcmciamtd.c revision b5cb259e7fac5536c4ddf350af6a3d6cc950e47e
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; 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds window_handle_t win = (window_handle_t)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 modconf_t mod; 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mod.Attributes = CONF_VPP1_CHANGE_VALID | CONF_VPP2_CHANGE_VALID; 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mod.Vcc = 0; 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mod.Vpp1 = mod.Vpp2 = on ? dev->vpp : 0; 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "dev = %p on = %d vpp = %d\n", dev, on, dev->vpp); 327fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski ret = pcmcia_modify_configuration(link, &mod); 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* After a card is removed, pcmciamtd_release() will unregister the 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * device, and release the PCMCIA configuration. If the device is 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * still open, this will be postponed until it is closed. 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 336fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void pcmciamtd_release(struct pcmcia_device *link) 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = link->priv; 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(3, "link = 0x%p", link); 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (link->win) { 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(dev->win_base) { 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(dev->win_base); 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_base = NULL; 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 347f5560da549ea2e32dd41e36548c0e7dee3d4aabbMagnus Damm pcmcia_release_window(link, link->win); 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 349fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_disable_device(link); 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 35318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#ifdef CONFIG_MTD_DEBUG 35418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_format(struct pcmcia_device *p_dev, 35518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 35618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cisparse_t parse; 35969f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 36018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (!pcmcia_parse_tuple(tuple, &parse)) { 36118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_format_t *t = &parse.format; 36218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski (void)t; /* Shut up, gcc */ 36318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Format type: %u, Error Detection: %u, offset = %u, length =%u", 36418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski t->type, t->edc, t->offset, t->length); 36518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 36618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -ENOSPC; 36718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 36869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 36918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_jedec(struct pcmcia_device *p_dev, 37018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 37118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 37218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 37318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 37418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 37569f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 37618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (!pcmcia_parse_tuple(tuple, &parse)) { 37718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_jedec_t *t = &parse.jedec; 37818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->nid; i++) 3799bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(2, "JEDEC: 0x%02x 0x%02x", 3809bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz t->id[i].mfr, t->id[i].info); 38118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 38218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -ENOSPC; 38318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 38418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#endif 38569f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 38618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_device(struct pcmcia_device *p_dev, 38718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 38818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 38918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 39018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski struct pcmciamtd_dev *dev = priv_data; 39118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 39218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_device_t *t = &parse.device; 39318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 39418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 39518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (pcmcia_parse_tuple(tuple, &parse)) 39618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -EINVAL; 39718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 39818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Common memory:"); 39918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->pcmcia_map.size = t->dev[0].size; 40018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski /* from here on: DEBUG only */ 40118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->ndev; i++) { 40218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, type = %u", i, t->dev[i].type); 40318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, wp = %u", i, t->dev[i].wp); 40418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, speed = %u ns", i, t->dev[i].speed); 40518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Region %d, size = %u bytes", i, t->dev[i].size); 40618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 40718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return 0; 40818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 40969f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 41018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_geo(struct pcmcia_device *p_dev, 41118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 41218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 41318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 41418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski struct pcmciamtd_dev *dev = priv_data; 41518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 41618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_device_geo_t *t = &parse.device_geo; 41718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 41818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 41918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (pcmcia_parse_tuple(tuple, &parse)) 42018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -EINVAL; 42118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 42218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->pcmcia_map.bankwidth = t->geo[0].buswidth; 42318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski /* from here on: DEBUG only */ 42418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->ngeo; i++) { 42518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d bankwidth = %u", i, t->geo[i].buswidth); 42618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d erase_block = %u", i, t->geo[i].erase_block); 42718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d read_block = %u", i, t->geo[i].read_block); 42818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d write_block = %u", i, t->geo[i].write_block); 42918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d partition = %u", i, t->geo[i].partition); 43018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "region: %d interleave = %u", i, t->geo[i].interleave); 43118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 43218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return 0; 43318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 43469f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 43569f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 436f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void card_settings(struct pcmciamtd_dev *dev, struct pcmcia_device *p_dev, int *new_name) 43718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 43818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 43918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 44018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (p_dev->prod_id[0]) { 44118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->mtd_name[0] = '\0'; 44218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < 4; i++) { 44318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (i) 44418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski strcat(dev->mtd_name, " "); 44518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (p_dev->prod_id[i]) 44618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski strcat(dev->mtd_name, p_dev->prod_id[i]); 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 44818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski DEBUG(2, "Found name: %s", dev->mtd_name); 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 45018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 45118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#ifdef CONFIG_MTD_DEBUG 45218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_FORMAT, pcmciamtd_cistpl_format, NULL); 45318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_JEDEC_C, pcmciamtd_cistpl_jedec, NULL); 45418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski#endif 45518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_DEVICE, pcmciamtd_cistpl_device, dev); 45618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_DEVICE_GEO, pcmciamtd_cistpl_geo, dev); 45718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->pcmcia_map.size) 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.size = MAX_PCMCIA_ADDR; 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->pcmcia_map.bankwidth) 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.bankwidth = 2; 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(force_size) { 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.size = force_size << 20; 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "size forced to %dM", force_size); 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(bankwidth) { 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.bankwidth = bankwidth; 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "bankwidth forced to %d", bankwidth); 47269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner } 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.name = dev->mtd_name; 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->mtd_name[0]) { 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds strcpy(dev->mtd_name, "PCMCIA Memory card"); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *new_name = 1; 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Device: Size: %lu Width:%d Name: %s", 4819bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->pcmcia_map.size, 4829bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->pcmcia_map.bankwidth << 3, dev->mtd_name); 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* pcmciamtd_config() is scheduled to run after a CARD_INSERTION event 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is received, to configure the PCMCIA socket, and to make the 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MTD device available to the system. 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 49115b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int pcmciamtd_config(struct pcmcia_device *link) 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = link->priv; 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mtd_info *mtd = NULL; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds win_req_t req; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static char *probes[] = { "jedec_probe", "cfi_probe" }; 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int new_name = 0; 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(3, "link=0x%p", link); 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds card_settings(dev, link, &new_name); 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.phys = NO_XIP; 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_from = pcmcia_copy_from_remap; 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_to = pcmcia_copy_to_remap; 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->pcmcia_map.bankwidth == 1) { 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read8_remap; 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write8_remap; 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read16_remap; 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write16_remap; 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(setvpp == 1) 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.set_vpp = pcmciamtd_set_vpp; 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5189bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz /* Request a memory window for PCMCIA. Some architeures can map windows 5199bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * upto the maximum that PCMCIA can support (64MiB) - this is ideal and 5209bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * we aim for a window the size of the whole card - otherwise we try 5219bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * smaller windows until we succeed 5229bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.Attributes = WIN_MEMORY_TYPE_CM | WIN_ENABLE; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.Attributes |= (dev->pcmcia_map.bankwidth == 1) ? WIN_DATA_WIDTH_8 : WIN_DATA_WIDTH_16; 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.Base = 0; 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.AccessSpeed = mem_speed; 528fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski link->win = (window_handle_t)link; 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.Size = (force_size) ? force_size << 20 : MAX_PCMCIA_ADDR; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_size = 0; 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "requesting window with size = %dKiB memspeed = %d", 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.Size >> 10, req.AccessSpeed); 5366838b03fc6564ea07d0cd87ea6e198d90ab1fc3eDominik Brodowski ret = pcmcia_request_window(link, &req, &link->win); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "ret = %d dev->win_size = %d", ret, dev->win_size); 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(ret) { 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req.Size >>= 1; 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "Got window of size %dKiB", req.Size >> 10); 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_size = req.Size; 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while(req.Size >= 0x1000); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "dev->win_size = %d", dev->win_size); 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->win_size) { 5509bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, "Cannot allocate memory window\n"); 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 55215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Allocated a window of %dKiB", dev->win_size >> 10); 55569f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Get write protect status */ 5574aeba0134f1e54cfd881e118b039ab6ed8b99126Dominik Brodowski DEBUG(2, "window handle = 0x%8.8lx", (unsigned long)link->win); 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_base = ioremap(req.Base, req.Size); 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->win_base) { 5609bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, "ioremap(%lu, %u) failed\n", 5619bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz req.Base, req.Size); 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 56315b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "mapped window dev = %p req.base = 0x%lx base = %p size = 0x%x", 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev, req.Base, dev->win_base, req.Size); 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->offset = 0; 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_1 = (unsigned long)dev; 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_2 = (unsigned long)link->win; 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 572f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz dev->vpp = (vpp) ? vpp : link->socket->socket.Vpp; 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.Attributes = 0; 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(setvpp == 2) { 57570294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski link->conf.Vpp = dev->vpp; 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 57770294b468302fd7a0a99dad935c7ba5322989345Dominik Brodowski link->conf.Vpp = 0; 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.IntType = INT_MEMORY; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.ConfigIndex = 0; 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(2, "Setting Configuration"); 583fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski ret = pcmcia_request_configuration(link, &link->conf); 5844c89e88bfde6a3c179790e21004f24e09a058290Dominik Brodowski if (ret != 0) { 58525f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad if (dev->win_base) { 58625f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad iounmap(dev->win_base); 58725f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad dev->win_base = NULL; 58825f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad } 58915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mem_type == 1) { 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe("map_ram", &dev->pcmcia_map); 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if(mem_type == 2) { 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe("map_rom", &dev->pcmcia_map); 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 59787d10f3c7954d143e509a2af2bca2a27aeb3114dTobias Klauser for(i = 0; i < ARRAY_SIZE(probes); i++) { 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Trying %s", probes[i]); 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe(probes[i], &dev->pcmcia_map); 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd) 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 60269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "FAILED: %s", probes[i]); 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 60669f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!mtd) { 6089bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz DEBUG(1, "Can not find an MTD"); 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 61015b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtd_info = mtd; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd->owner = THIS_MODULE; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(new_name) { 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int size = 0; 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char unit = ' '; 6199bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz /* Since we are using a default name, make it better by adding 6209bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * in the size 6219bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd->size < 1048576) { /* <1MiB in size, show size in KiB */ 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = mtd->size >> 10; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unit = 'K'; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = mtd->size >> 20; 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unit = 'M'; 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds snprintf(dev->mtd_name, sizeof(dev->mtd_name), "%d%ciB %s", size, unit, "PCMCIA Memory card"); 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the memory found is fits completely into the mapped PCMCIA window, 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds use the faster non-remapping read/write functions */ 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd->size <= dev->win_size) { 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "Using non remapping memory functions"); 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_2 = (unsigned long)dev->win_base; 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->pcmcia_map.bankwidth == 1) { 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read8; 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write8; 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read16; 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write16; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_from = pcmcia_copy_from; 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_to = pcmcia_copy_to; 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(add_mtd_device(mtd)) { 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_destroy(mtd); 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtd_info = NULL; 6519bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, 6529bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz "Could not register the MTD device\n"); 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 65415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6569bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_info(&dev->p_dev->dev, "mtd%d: %s\n", mtd->index, mtd->name); 65715b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return 0; 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6599bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, "CS Error, exiting\n"); 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 66115b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 66598e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowskistatic int pcmciamtd_suspend(struct pcmcia_device *dev) 66698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski{ 66798e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski DEBUG(2, "EVENT_PM_RESUME"); 66898e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 66998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski /* get_lock(link); */ 67098e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 67198e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski return 0; 67298e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski} 67398e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 67498e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowskistatic int pcmciamtd_resume(struct pcmcia_device *dev) 67598e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski{ 67698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski DEBUG(2, "EVENT_PM_SUSPEND"); 67798e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 67898e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski /* free_lock(link); */ 67998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 68098e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski return 0; 68198e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski} 68298e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* This deletes a driver "instance". The device is de-registered 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * with Card Services. If it has been released, all local data 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * structures are freed. Otherwise, the structures will be freed 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when the device is released. 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 690fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void pcmciamtd_detach(struct pcmcia_device *link) 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 692e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski struct pcmciamtd_dev *dev = link->priv; 693cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(3, "link=0x%p", link); 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 696e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski if(dev->mtd_info) { 697e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski del_mtd_device(dev->mtd_info); 6989bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_info(&dev->p_dev->dev, "mtd%d: Removing\n", 6999bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->mtd_info->index); 700599fb3298b70d75c12dbdc4dd30f52c5cf04ea2fSean Young map_destroy(dev->mtd_info); 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 702e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski 703e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski pcmciamtd_release(link); 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* pcmciamtd_attach() creates an "instance" of the driver, allocating 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * local data structures for one device. The device is registered 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * with Card Services. 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 71215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int pcmciamtd_probe(struct pcmcia_device *link) 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev; 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Create new memory card device */ 71795b93a0cd46682c6d9e8eea803fda510cb6b863aBurman Yan dev = kzalloc(sizeof(*dev), GFP_KERNEL); 718f8cfa618dccbdc6dab5297f75779566a388a98fdDominik Brodowski if (!dev) return -ENOMEM; 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, "dev=0x%p", dev); 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 721fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski dev->p_dev = link; 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->priv = dev; 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.Attributes = 0; 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->conf.IntType = INT_MEMORY; 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 72715b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return pcmciamtd_config(link); 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 73011d28a30219671607a235a518f395659599a748eDominik Brodowskistatic struct pcmcia_device_id pcmciamtd_ids[] = { 73111d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_FUNC_ID(1), 73211d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID123("IO DATA", "PCS-2M", "2MB SRAM", 0x547e66dc, 0x1fed36cd, 0x36eadd21), 73311d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "2MB SRAM", 0xb569a6e5, 0x36eadd21), 73411d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "4MB FLASH", 0xb569a6e5, 0x8bc54d2a), 73511d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "8MB FLASH", 0xb569a6e5, 0x6df1be3e), 73611d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Intel", "S2E20SW", 0x816cc815, 0xd14c9dcf), 73711d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Intel", "S2E8 SW", 0x816cc815, 0xa2d7dedb), 73811d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-02 ", 0x40ade711, 0x145cea5c), 73911d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-04 ", 0x40ade711, 0x42064dda), 74011d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-20 ", 0x40ade711, 0x25ee5cb0), 74111d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "VALUE SERIES 100 ", 0x40ade711, 0xdf8506d8), 74211d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("KINGMAX TECHNOLOGY INC.", "SRAM 256K Bytes", 0x54d0c69c, 0xad12c29c), 74311d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Maxtor", "MAXFL MobileMax Flash Memory Card", 0xb68968c8, 0x2dfb47b0), 744f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz PCMCIA_DEVICE_PROD_ID123("M-Systems", "M-SYS Flash Memory Card", "(c) M-Systems", 0x7ed2ad87, 0x675dc3fb, 0x7aef3965), 745b2321ac37a16f0d6bdbcd2d20263e8b8b943c0eaDominik Brodowski PCMCIA_DEVICE_PROD_ID12("PRETEC", " 2MB SRAM CARD", 0xebf91155, 0x805360ca), 74611d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB101EN20", 0xf9876baf, 0xad0b207b), 74711d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB513EN20", 0xf9876baf, 0xe8d884ad), 748f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz PCMCIA_DEVICE_PROD_ID12("SMART Modular Technologies", " 4MB FLASH Card", 0x96fd8277, 0x737a5b05), 74911d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-3000", 0x05ddca47, 0xe7d67bca), 75011d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-4100", 0x05ddca47, 0x7bc32944), 75111d28a30219671607a235a518f395659599a748eDominik Brodowski /* the following was commented out in pcmcia-cs-3.2.7 */ 75211d28a30219671607a235a518f395659599a748eDominik Brodowski /* PCMCIA_DEVICE_PROD_ID12("RATOC Systems,Inc.", "SmartMedia ADAPTER PC Card", 0xf4a2fefe, 0x5885b2ae), */ 75311d28a30219671607a235a518f395659599a748eDominik Brodowski#ifdef CONFIG_MTD_PCMCIA_ANONYMOUS 75411d28a30219671607a235a518f395659599a748eDominik Brodowski { .match_flags = PCMCIA_DEV_ID_MATCH_ANONYMOUS, }, 75511d28a30219671607a235a518f395659599a748eDominik Brodowski#endif 75611d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_NULL 75711d28a30219671607a235a518f395659599a748eDominik Brodowski}; 75811d28a30219671607a235a518f395659599a748eDominik BrodowskiMODULE_DEVICE_TABLE(pcmcia, pcmciamtd_ids); 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pcmcia_driver pcmciamtd_driver = { 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .drv = { 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "pcmciamtd" 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 76415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski .probe = pcmciamtd_probe, 765cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski .remove = pcmciamtd_detach, 76611d28a30219671607a235a518f395659599a748eDominik Brodowski .owner = THIS_MODULE, 76711d28a30219671607a235a518f395659599a748eDominik Brodowski .id_table = pcmciamtd_ids, 76898e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski .suspend = pcmciamtd_suspend, 76998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski .resume = pcmciamtd_resume, 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init init_pcmciamtd(void) 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 77559018b6d2acabb114ab58637e6ab95ba424a89d0Adrian Bunk info(DRIVER_DESC); 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(bankwidth && bankwidth != 1 && bankwidth != 2) { 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad bankwidth (%d), using default", bankwidth); 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bankwidth = 2; 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(force_size && (force_size < 1 || force_size > 64)) { 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad force_size (%d), using default", force_size); 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds force_size = 0; 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mem_type && mem_type != 1 && mem_type != 2) { 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad mem_type (%d), using default", mem_type); 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mem_type = 0; 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pcmcia_register_driver(&pcmciamtd_driver); 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit exit_pcmciamtd(void) 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(1, DRIVER_DESC " unloading"); 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmcia_unregister_driver(&pcmciamtd_driver); 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(init_pcmciamtd); 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(exit_pcmciamtd); 801