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 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <pcmcia/cistpl.h> 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <pcmcia/ds.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/map.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mtd/mtd.h> 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define info(format, arg...) printk(KERN_INFO "pcmciamtd: " format "\n" , ## arg) 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DRIVER_DESC "PCMCIA Flash memory card driver" 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Size of the PCMCIA address space: 26 bits = 64 MB */ 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAX_PCMCIA_ADDR 0x4000000 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct pcmciamtd_dev { 32fd238232cd0ff4840ae6946bb338502154096d88Dominik Brodowski struct pcmcia_device *p_dev; 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base; /* ioremapped address of PCMCIA window */ 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int win_size; /* size of window */ 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int offset; /* offset into card the window currently points at */ 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct map_info pcmcia_map; 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mtd_info *mtd_info; 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int vpp; 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char mtd_name[sizeof(struct cistpl_vers_1_t)]; 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Module parameters */ 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 2 = do 16-bit transfers, 1 = do 8-bit transfers */ 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int bankwidth = 2; 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Speed of memory accesses, in ns */ 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mem_speed; 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Force the size of an SRAM card */ 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int force_size; 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Force Vpp */ 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int vpp; 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Set Vpp */ 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int setvpp; 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Force card to be treated as FLASH, ROM or RAM */ 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mem_type; 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Simon Evans <spse@secret.org.uk>"); 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION(DRIVER_DESC); 668d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(bankwidth, int, 0); 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(bankwidth, "Set bankwidth (1=8 bit, 2=16 bit, default=2)"); 688d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(mem_speed, int, 0); 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(mem_speed, "Set memory access speed in ns"); 708d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(force_size, int, 0); 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(force_size, "Force size of card in MiB (1-64)"); 728d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(setvpp, int, 0); 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(setvpp, "Set Vpp (0=Never, 1=On writes, 2=Always on, default=0)"); 748d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(vpp, int, 0); 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(vpp, "Vpp value in 1/10ths eg 33=3.3V 120=12V (Dangerous)"); 768d3b33f67fdc0fb364a1ef6d8fbbea7c2e4e6c98Rusty Russellmodule_param(mem_type, int, 0); 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(mem_type, "Set Memory type (0=Flash, 1=RAM, 2=ROM, default=0)"); 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 809bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz/* read/write{8,16} copy_{from,to} routines with window remapping 819bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * to access whole card 829bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic caddr_t remap_window(struct map_info *map, unsigned long to) 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 86cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski struct resource *win = (struct resource *) map->map_priv_2; 87b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski unsigned int offset; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 90e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski if (!pcmcia_dev_present(dev->p_dev)) { 91e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("device removed\n"); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 95b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski offset = to & ~(dev->win_size-1); 96b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski if (offset != dev->offset) { 97e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Remapping window from 0x%8.8x to 0x%8.8x\n", 98b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski dev->offset, offset); 99b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski ret = pcmcia_map_mem_page(dev->p_dev, win, offset); 1009b44de2015ff4a2ed1d56efedfcc72b917d356a6Dominik Brodowski if (ret != 0) 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 102b5cb259e7fac5536c4ddf350af6a3d6cc950e47eDominik Brodowski dev->offset = offset; 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return dev->win_base + (to & (dev->win_size-1)); 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read8_remap(struct map_info *map, unsigned long ofs) 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, ofs); 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readb(addr); 118e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("ofs = 0x%08lx (%p) data = 0x%02lx\n", ofs, addr, d.x[0]); 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read16_remap(struct map_info *map, unsigned long ofs) 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, ofs); 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readw(addr); 133e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("ofs = 0x%08lx (%p) data = 0x%04lx\n", ofs, addr, d.x[0]); 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_from_remap(struct map_info *map, void *to, unsigned long from, ssize_t len) 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long win_size = dev->win_size; 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 143e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("to = %p from = %lu len = %zd\n", to, from, len); 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while(len) { 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int toread = win_size - (from & (win_size-1)); 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(toread > len) 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds toread = len; 15069f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, from); 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 155e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("memcpy from %p to %p len = %d\n", addr, to, toread); 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_fromio(to, addr, toread); 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds len -= toread; 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds to += toread; 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds from += toread; 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_write8_remap(struct map_info *map, map_word d, unsigned long adr) 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr = remap_window(map, adr); 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 171e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("adr = 0x%08lx (%p) data = 0x%02lx\n", adr, addr, d.x[0]); 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writeb(d.x[0], addr); 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_write16_remap(struct map_info *map, map_word d, unsigned long adr) 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr = remap_window(map, adr); 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 182e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("adr = 0x%08lx (%p) data = 0x%04lx\n", adr, addr, d.x[0]); 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writew(d.x[0], addr); 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_to_remap(struct map_info *map, unsigned long to, const void *from, ssize_t len) 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long win_size = dev->win_size; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 192e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("to = %lu from = %p len = %zd\n", to, from, len); 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while(len) { 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int towrite = win_size - (to & (win_size-1)); 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t addr; 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(towrite > len) 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds towrite = len; 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds addr = remap_window(map, to); 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!addr) 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 204e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("memcpy from %p to %p len = %d\n", from, addr, towrite); 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_toio(addr, from, towrite); 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds len -= towrite; 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds to += towrite; 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds from += towrite; 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* read/write{8,16} copy_{from,to} routines with direct access */ 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 215e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski#define DEV_REMOVED(x) (!(pcmcia_dev_present(((struct pcmciamtd_dev *)map->map_priv_1)->p_dev))) 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read8(struct map_info *map, unsigned long ofs) 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readb(win_base + ofs); 226e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("ofs = 0x%08lx (%p) data = 0x%02lx\n", 2279bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz ofs, win_base + ofs, d.x[0]); 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic map_word pcmcia_read16(struct map_info *map, unsigned long ofs) 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_word d = {{0}}; 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds d.x[0] = readw(win_base + ofs); 241e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("ofs = 0x%08lx (%p) data = 0x%04lx\n", 2429bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz ofs, win_base + ofs, d.x[0]); 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return d; 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len) 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 254e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("to = %p from = %lu len = %zd\n", to, from, len); 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_fromio(to, win_base + from, len); 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 259f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void pcmcia_write8(struct map_info *map, map_word d, unsigned long adr) 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 266e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("adr = 0x%08lx (%p) data = 0x%02lx\n", 2679bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz adr, win_base + adr, d.x[0]); 268f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz writeb(d.x[0], win_base + adr); 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 272f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void pcmcia_write16(struct map_info *map, map_word d, unsigned long adr) 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 279e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("adr = 0x%08lx (%p) data = 0x%04lx\n", 2809bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz adr, win_base + adr, d.x[0]); 281f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz writew(d.x[0], win_base + adr); 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmcia_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len) 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds caddr_t win_base = (caddr_t)map->map_priv_2; 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(DEV_REMOVED(map)) 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 292e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("to = %lu from = %p len = %zd\n", to, from, len); 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy_toio(win_base + to, from, len); 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2977c8d206f219fe52966d970f791246a542718e5baPaul Parsonsstatic DEFINE_SPINLOCK(pcmcia_vpp_lock); 2987c8d206f219fe52966d970f791246a542718e5baPaul Parsonsstatic int pcmcia_vpp_refcnt; 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pcmciamtd_set_vpp(struct map_info *map, int on) 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1; 302fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski struct pcmcia_device *link = dev->p_dev; 3037c8d206f219fe52966d970f791246a542718e5baPaul Parsons unsigned long flags; 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 305e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("dev = %p on = %d vpp = %d\n\n", dev, on, dev->vpp); 3067c8d206f219fe52966d970f791246a542718e5baPaul Parsons spin_lock_irqsave(&pcmcia_vpp_lock, flags); 3077c8d206f219fe52966d970f791246a542718e5baPaul Parsons if (on) { 3087c8d206f219fe52966d970f791246a542718e5baPaul Parsons if (++pcmcia_vpp_refcnt == 1) /* first nested 'on' */ 3097c8d206f219fe52966d970f791246a542718e5baPaul Parsons pcmcia_fixup_vpp(link, dev->vpp); 3107c8d206f219fe52966d970f791246a542718e5baPaul Parsons } else { 3117c8d206f219fe52966d970f791246a542718e5baPaul Parsons if (--pcmcia_vpp_refcnt == 0) /* last nested 'off' */ 3127c8d206f219fe52966d970f791246a542718e5baPaul Parsons pcmcia_fixup_vpp(link, 0); 3137c8d206f219fe52966d970f791246a542718e5baPaul Parsons } 3147c8d206f219fe52966d970f791246a542718e5baPaul Parsons spin_unlock_irqrestore(&pcmcia_vpp_lock, flags); 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 318fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void pcmciamtd_release(struct pcmcia_device *link) 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = link->priv; 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 322e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("link = 0x%p\n", link); 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 324cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski if (link->resource[2]->end) { 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(dev->win_base) { 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(dev->win_base); 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_base = NULL; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 330fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski pcmcia_disable_device(link); 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 33418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_format(struct pcmcia_device *p_dev, 33518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 33618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cisparse_t parse; 33969f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 34018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (!pcmcia_parse_tuple(tuple, &parse)) { 34118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_format_t *t = &parse.format; 34218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski (void)t; /* Shut up, gcc */ 343e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Format type: %u, Error Detection: %u, offset = %u, length =%u\n", 34418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski t->type, t->edc, t->offset, t->length); 34518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 34618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -ENOSPC; 34718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 34869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 34918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_jedec(struct pcmcia_device *p_dev, 35018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 35118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 35218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 35318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 35418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 35569f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 35618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (!pcmcia_parse_tuple(tuple, &parse)) { 35718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_jedec_t *t = &parse.jedec; 35818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->nid; i++) 359e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("JEDEC: 0x%02x 0x%02x\n", 3609bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz t->id[i].mfr, t->id[i].info); 36118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 36218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -ENOSPC; 36318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 36469f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 36518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_device(struct pcmcia_device *p_dev, 36618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 36718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 36818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 36918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski struct pcmciamtd_dev *dev = priv_data; 37018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 37118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_device_t *t = &parse.device; 37218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 37318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 37418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (pcmcia_parse_tuple(tuple, &parse)) 37518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -EINVAL; 37618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 377e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Common memory:\n"); 37818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->pcmcia_map.size = t->dev[0].size; 37918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski /* from here on: DEBUG only */ 38018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->ndev; i++) { 381e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Region %d, type = %u\n", i, t->dev[i].type); 382e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Region %d, wp = %u\n", i, t->dev[i].wp); 383e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Region %d, speed = %u ns\n", i, t->dev[i].speed); 384e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Region %d, size = %u bytes\n", i, t->dev[i].size); 38518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 38618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return 0; 38718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 38869f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 38918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowskistatic int pcmciamtd_cistpl_geo(struct pcmcia_device *p_dev, 39018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski tuple_t *tuple, 39118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski void *priv_data) 39218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 39318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski struct pcmciamtd_dev *dev = priv_data; 39418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cisparse_t parse; 39518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski cistpl_device_geo_t *t = &parse.device_geo; 39618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 39718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 39818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (pcmcia_parse_tuple(tuple, &parse)) 39918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return -EINVAL; 40018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 40118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->pcmcia_map.bankwidth = t->geo[0].buswidth; 40218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski /* from here on: DEBUG only */ 40318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < t->ngeo; i++) { 404e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("region: %d bankwidth = %u\n", i, t->geo[i].buswidth); 405e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("region: %d erase_block = %u\n", i, t->geo[i].erase_block); 406e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("region: %d read_block = %u\n", i, t->geo[i].read_block); 407e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("region: %d write_block = %u\n", i, t->geo[i].write_block); 408e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("region: %d partition = %u\n", i, t->geo[i].partition); 409e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("region: %d interleave = %u\n", i, t->geo[i].interleave); 41018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski } 41118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski return 0; 41218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski} 41369f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 41469f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 415f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurzstatic void card_settings(struct pcmciamtd_dev *dev, struct pcmcia_device *p_dev, int *new_name) 41618b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski{ 41718b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski int i; 41818b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 41918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (p_dev->prod_id[0]) { 42018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski dev->mtd_name[0] = '\0'; 42118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski for (i = 0; i < 4; i++) { 42218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (i) 42318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski strcat(dev->mtd_name, " "); 42418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski if (p_dev->prod_id[i]) 42518b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski strcat(dev->mtd_name, p_dev->prod_id[i]); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 427e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Found name: %s\n", dev->mtd_name); 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 42918b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 43018b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_FORMAT, pcmciamtd_cistpl_format, NULL); 43118b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_JEDEC_C, pcmciamtd_cistpl_jedec, NULL); 43218b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_DEVICE, pcmciamtd_cistpl_device, dev); 43318b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski pcmcia_loop_tuple(p_dev, CISTPL_DEVICE_GEO, pcmciamtd_cistpl_geo, dev); 43418b61b97294dad74dd00a1aa8efed0cfacb95affDominik Brodowski 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->pcmcia_map.size) 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.size = MAX_PCMCIA_ADDR; 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->pcmcia_map.bankwidth) 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.bankwidth = 2; 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(force_size) { 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.size = force_size << 20; 443e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("size forced to %dM\n", force_size); 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(bankwidth) { 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.bankwidth = bankwidth; 448e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("bankwidth forced to %d\n", bankwidth); 44969f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner } 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.name = dev->mtd_name; 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->mtd_name[0]) { 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds strcpy(dev->mtd_name, "PCMCIA Memory card"); 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *new_name = 1; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 457e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Device: Size: %lu Width:%d Name: %s\n", 4589bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->pcmcia_map.size, 4599bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->pcmcia_map.bankwidth << 3, dev->mtd_name); 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 46315b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int pcmciamtd_config(struct pcmcia_device *link) 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev = link->priv; 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mtd_info *mtd = NULL; 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 468cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski int i, j = 0; 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static char *probes[] = { "jedec_probe", "cfi_probe" }; 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int new_name = 0; 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 472e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("link=0x%p\n", link); 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds card_settings(dev, link, &new_name); 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.phys = NO_XIP; 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_from = pcmcia_copy_from_remap; 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_to = pcmcia_copy_to_remap; 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->pcmcia_map.bankwidth == 1) { 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read8_remap; 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write8_remap; 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read16_remap; 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write16_remap; 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(setvpp == 1) 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.set_vpp = pcmciamtd_set_vpp; 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4899bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz /* Request a memory window for PCMCIA. Some architeures can map windows 49025985edcedea6396277003854657b5f3cb31a628Lucas De Marchi * up to the maximum that PCMCIA can support (64MiB) - this is ideal and 4919bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * we aim for a window the size of the whole card - otherwise we try 4929bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * smaller windows until we succeed 4939bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 495cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->flags |= WIN_MEMORY_TYPE_CM | WIN_ENABLE; 496cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->flags |= (dev->pcmcia_map.bankwidth == 1) ? 497cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski WIN_DATA_WIDTH_8 : WIN_DATA_WIDTH_16; 498cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->start = 0; 499cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->end = (force_size) ? force_size << 20 : 500cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski MAX_PCMCIA_ADDR; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->win_size = 0; 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 505e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("requesting window with size = %luKiB memspeed = %d\n", 506cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski (unsigned long) resource_size(link->resource[2]) >> 10, 507cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski mem_speed); 508cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski ret = pcmcia_request_window(link, link->resource[2], mem_speed); 509e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("ret = %d dev->win_size = %d\n", ret, dev->win_size); 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(ret) { 511cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski j++; 512cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->start = 0; 513cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->end = (force_size) ? 514cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski force_size << 20 : MAX_PCMCIA_ADDR; 515cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]->end >>= j; 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 517e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Got window of size %luKiB\n", (unsigned long) 518cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski resource_size(link->resource[2]) >> 10); 519cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev->win_size = resource_size(link->resource[2]); 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 522cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski } while (link->resource[2]->end >= 0x1000); 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 524e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("dev->win_size = %d\n", dev->win_size); 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->win_size) { 5279bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, "Cannot allocate memory window\n"); 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 52915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 531e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Allocated a window of %dKiB\n", dev->win_size >> 10); 53269f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Get write protect status */ 534cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev->win_base = ioremap(link->resource[2]->start, 535cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski resource_size(link->resource[2])); 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!dev->win_base) { 537cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev_err(&dev->p_dev->dev, "ioremap(%pR) failed\n", 538cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski link->resource[2]); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 54015b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 542e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("mapped window dev = %p @ %pR, base = %p\n", 543cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev, link->resource[2], dev->win_base); 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->offset = 0; 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_1 = (unsigned long)dev; 547cdb138080b78146d1cdadba9f5dadbeb97445b91Dominik Brodowski dev->pcmcia_map.map_priv_2 = (unsigned long)link->resource[2]; 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 549f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz dev->vpp = (vpp) ? vpp : link->socket->socket.Vpp; 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(setvpp == 2) { 551e8405f0f617856de0ceb7d04e65b663051451544Dominik Brodowski link->vpp = dev->vpp; 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 553e8405f0f617856de0ceb7d04e65b663051451544Dominik Brodowski link->vpp = 0; 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5567feabb6412ea23edd298c0fa90e5aa6733eb4a42Dominik Brodowski link->config_index = 0; 557e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Setting Configuration\n"); 5581ac71e5a35eebee60cdcf15b3980bd94498f037bDominik Brodowski ret = pcmcia_enable_device(link); 5594c89e88bfde6a3c179790e21004f24e09a058290Dominik Brodowski if (ret != 0) { 56025f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad if (dev->win_base) { 56125f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad iounmap(dev->win_base); 56225f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad dev->win_base = NULL; 56325f0c659fe64832d8ee06aa623fffaad708dcf8bAmol Lad } 56415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mem_type == 1) { 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe("map_ram", &dev->pcmcia_map); 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if(mem_type == 2) { 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe("map_rom", &dev->pcmcia_map); 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 57287d10f3c7954d143e509a2af2bca2a27aeb3114dTobias Klauser for(i = 0; i < ARRAY_SIZE(probes); i++) { 573e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Trying %s\n", probes[i]); 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd = do_map_probe(probes[i], &dev->pcmcia_map); 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd) 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 57769f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 578e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("FAILED: %s\n", probes[i]); 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 58169f34c98c1416eb74c55e38a21dbf3e294966514Thomas Gleixner 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(!mtd) { 583e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Can not find an MTD\n"); 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 58515b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtd_info = mtd; 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtd->owner = THIS_MODULE; 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(new_name) { 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int size = 0; 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char unit = ' '; 5949bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz /* Since we are using a default name, make it better by adding 5959bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz * in the size 5969bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz */ 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd->size < 1048576) { /* <1MiB in size, show size in KiB */ 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = mtd->size >> 10; 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unit = 'K'; 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = mtd->size >> 20; 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unit = 'M'; 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds snprintf(dev->mtd_name, sizeof(dev->mtd_name), "%d%ciB %s", size, unit, "PCMCIA Memory card"); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the memory found is fits completely into the mapped PCMCIA window, 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds use the faster non-remapping read/write functions */ 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mtd->size <= dev->win_size) { 610e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("Using non remapping memory functions\n"); 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.map_priv_2 = (unsigned long)dev->win_base; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->pcmcia_map.bankwidth == 1) { 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read8; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write8; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.read = pcmcia_read16; 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.write = pcmcia_write16; 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_from = pcmcia_copy_from; 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->pcmcia_map.copy_to = pcmcia_copy_to; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 623ee0e87b174bb41f0310cf089262bf5dd8f95a212Jamie Iles if (mtd_device_register(mtd, NULL, 0)) { 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds map_destroy(mtd); 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtd_info = NULL; 6269bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_err(&dev->p_dev->dev, 6279bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz "Could not register the MTD device\n"); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmciamtd_release(link); 62915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return -ENODEV; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6319bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_info(&dev->p_dev->dev, "mtd%d: %s\n", mtd->index, mtd->name); 63215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return 0; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 63698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowskistatic int pcmciamtd_suspend(struct pcmcia_device *dev) 63798e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski{ 638e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("EVENT_PM_RESUME\n"); 63998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 64098e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski /* get_lock(link); */ 64198e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 64298e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski return 0; 64398e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski} 64498e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 64598e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowskistatic int pcmciamtd_resume(struct pcmcia_device *dev) 64698e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski{ 647e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("EVENT_PM_SUSPEND\n"); 64898e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 64998e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski /* free_lock(link); */ 65098e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 65198e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski return 0; 65298e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski} 65398e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 655fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowskistatic void pcmciamtd_detach(struct pcmcia_device *link) 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 657e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski struct pcmciamtd_dev *dev = link->priv; 658cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski 659e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("link=0x%p\n", link); 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 661e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski if(dev->mtd_info) { 662ee0e87b174bb41f0310cf089262bf5dd8f95a212Jamie Iles mtd_device_unregister(dev->mtd_info); 6639bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev_info(&dev->p_dev->dev, "mtd%d: Removing\n", 6649bdde162ebcc0237e722e8c3d0d376e35188a98fAlexander Kurz dev->mtd_info->index); 665599fb3298b70d75c12dbdc4dd30f52c5cf04ea2fSean Young map_destroy(dev->mtd_info); 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 667e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski 668e2d4096365e06b9a3799afbadc28b4519c0b3526Dominik Brodowski pcmciamtd_release(link); 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 67215b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowskistatic int pcmciamtd_probe(struct pcmcia_device *link) 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pcmciamtd_dev *dev; 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Create new memory card device */ 67795b93a0cd46682c6d9e8eea803fda510cb6b863aBurman Yan dev = kzalloc(sizeof(*dev), GFP_KERNEL); 678f8cfa618dccbdc6dab5297f75779566a388a98fdDominik Brodowski if (!dev) return -ENOMEM; 679e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug("dev=0x%p\n", dev); 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 681fba395eee7d3f342ca739c20f5b3ee635d0420a0Dominik Brodowski dev->p_dev = link; 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds link->priv = dev; 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 68415b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski return pcmciamtd_config(link); 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 68725f8f54f6e178acfd503a95441b0ea05c525f751Joe Perchesstatic const struct pcmcia_device_id pcmciamtd_ids[] = { 68811d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_FUNC_ID(1), 68911d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID123("IO DATA", "PCS-2M", "2MB SRAM", 0x547e66dc, 0x1fed36cd, 0x36eadd21), 69011d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "2MB SRAM", 0xb569a6e5, 0x36eadd21), 69111d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "4MB FLASH", 0xb569a6e5, 0x8bc54d2a), 69211d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("IBM", "8MB FLASH", 0xb569a6e5, 0x6df1be3e), 69311d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Intel", "S2E20SW", 0x816cc815, 0xd14c9dcf), 69411d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Intel", "S2E8 SW", 0x816cc815, 0xa2d7dedb), 69511d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-02 ", 0x40ade711, 0x145cea5c), 69611d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-04 ", 0x40ade711, 0x42064dda), 69711d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-20 ", 0x40ade711, 0x25ee5cb0), 69811d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("intel", "VALUE SERIES 100 ", 0x40ade711, 0xdf8506d8), 69911d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("KINGMAX TECHNOLOGY INC.", "SRAM 256K Bytes", 0x54d0c69c, 0xad12c29c), 70011d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Maxtor", "MAXFL MobileMax Flash Memory Card", 0xb68968c8, 0x2dfb47b0), 701f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz PCMCIA_DEVICE_PROD_ID123("M-Systems", "M-SYS Flash Memory Card", "(c) M-Systems", 0x7ed2ad87, 0x675dc3fb, 0x7aef3965), 702b2321ac37a16f0d6bdbcd2d20263e8b8b943c0eaDominik Brodowski PCMCIA_DEVICE_PROD_ID12("PRETEC", " 2MB SRAM CARD", 0xebf91155, 0x805360ca), 70311d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB101EN20", 0xf9876baf, 0xad0b207b), 70411d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB513EN20", 0xf9876baf, 0xe8d884ad), 705f6763c98cb2175a816936f9b125d40054a27c185Alexander Kurz PCMCIA_DEVICE_PROD_ID12("SMART Modular Technologies", " 4MB FLASH Card", 0x96fd8277, 0x737a5b05), 70611d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-3000", 0x05ddca47, 0xe7d67bca), 70711d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-4100", 0x05ddca47, 0x7bc32944), 70811d28a30219671607a235a518f395659599a748eDominik Brodowski /* the following was commented out in pcmcia-cs-3.2.7 */ 70911d28a30219671607a235a518f395659599a748eDominik Brodowski /* PCMCIA_DEVICE_PROD_ID12("RATOC Systems,Inc.", "SmartMedia ADAPTER PC Card", 0xf4a2fefe, 0x5885b2ae), */ 71011d28a30219671607a235a518f395659599a748eDominik Brodowski#ifdef CONFIG_MTD_PCMCIA_ANONYMOUS 71111d28a30219671607a235a518f395659599a748eDominik Brodowski { .match_flags = PCMCIA_DEV_ID_MATCH_ANONYMOUS, }, 71211d28a30219671607a235a518f395659599a748eDominik Brodowski#endif 71311d28a30219671607a235a518f395659599a748eDominik Brodowski PCMCIA_DEVICE_NULL 71411d28a30219671607a235a518f395659599a748eDominik Brodowski}; 71511d28a30219671607a235a518f395659599a748eDominik BrodowskiMODULE_DEVICE_TABLE(pcmcia, pcmciamtd_ids); 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pcmcia_driver pcmciamtd_driver = { 7182e9b981a7c63ee8278df6823f8389d69dad1a499Dominik Brodowski .name = "pcmciamtd", 71915b99ac1729503db9e6dc642a50b9b6cb3bf51f9Dominik Brodowski .probe = pcmciamtd_probe, 720cc3b4866bee996c922e875b8c8efe9f0d8803aaeDominik Brodowski .remove = pcmciamtd_detach, 72111d28a30219671607a235a518f395659599a748eDominik Brodowski .owner = THIS_MODULE, 72211d28a30219671607a235a518f395659599a748eDominik Brodowski .id_table = pcmciamtd_ids, 72398e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski .suspend = pcmciamtd_suspend, 72498e4c28b7ec390c2dad6a4c69d69629c0f7e8b10Dominik Brodowski .resume = pcmciamtd_resume, 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init init_pcmciamtd(void) 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(bankwidth && bankwidth != 1 && bankwidth != 2) { 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad bankwidth (%d), using default", bankwidth); 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bankwidth = 2; 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(force_size && (force_size < 1 || force_size > 64)) { 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad force_size (%d), using default", force_size); 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds force_size = 0; 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if(mem_type && mem_type != 1 && mem_type != 2) { 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds info("bad mem_type (%d), using default", mem_type); 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mem_type = 0; 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pcmcia_register_driver(&pcmciamtd_driver); 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit exit_pcmciamtd(void) 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 748e6453521edcaa6f130946b5f4fcaf28dbc02f2edBrian Norris pr_debug(DRIVER_DESC " unloading"); 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pcmcia_unregister_driver(&pcmciamtd_driver); 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(init_pcmciamtd); 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(exit_pcmciamtd); 754