^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * pcmciamtd.c - MTD driver for PCMCIA flash memory cards
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Author: Simon Evans <spse@secret.org.uk>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2002 Simon Evans
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Licence: GPL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/timer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <pcmcia/cistpl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <pcmcia/ds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/mtd/map.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/mtd/mtd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define info(format, arg...) printk(KERN_INFO "pcmciamtd: " format "\n" , ## arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define DRIVER_DESC "PCMCIA Flash memory card driver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) /* Size of the PCMCIA address space: 26 bits = 64 MB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define MAX_PCMCIA_ADDR 0x4000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) struct pcmciamtd_dev {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct pcmcia_device *p_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) void __iomem *win_base; /* ioremapped address of PCMCIA window */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) unsigned int win_size; /* size of window */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) unsigned int offset; /* offset into card the window currently points at */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct map_info pcmcia_map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct mtd_info *mtd_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int vpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) char mtd_name[sizeof(struct cistpl_vers_1_t)];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) /* Module parameters */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) /* 2 = do 16-bit transfers, 1 = do 8-bit transfers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) static int bankwidth = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) /* Speed of memory accesses, in ns */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static int mem_speed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) /* Force the size of an SRAM card */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) static int force_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) /* Force Vpp */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static int vpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) /* Set Vpp */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static int setvpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) /* Force card to be treated as FLASH, ROM or RAM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) static int mem_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) MODULE_AUTHOR("Simon Evans <spse@secret.org.uk>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) module_param(bankwidth, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) MODULE_PARM_DESC(bankwidth, "Set bankwidth (1=8 bit, 2=16 bit, default=2)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) module_param(mem_speed, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) MODULE_PARM_DESC(mem_speed, "Set memory access speed in ns");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) module_param(force_size, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) MODULE_PARM_DESC(force_size, "Force size of card in MiB (1-64)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) module_param(setvpp, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) MODULE_PARM_DESC(setvpp, "Set Vpp (0=Never, 1=On writes, 2=Always on, default=0)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) module_param(vpp, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) MODULE_PARM_DESC(vpp, "Vpp value in 1/10ths eg 33=3.3V 120=12V (Dangerous)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) module_param(mem_type, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) MODULE_PARM_DESC(mem_type, "Set Memory type (0=Flash, 1=RAM, 2=ROM, default=0)");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) /* read/write{8,16} copy_{from,to} routines with window remapping
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) * to access whole card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) static void __iomem *remap_window(struct map_info *map, unsigned long to)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) struct resource *win = (struct resource *) map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) unsigned int offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (!pcmcia_dev_present(dev->p_dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) pr_debug("device removed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) offset = to & ~(dev->win_size-1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) if (offset != dev->offset) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) pr_debug("Remapping window from 0x%8.8x to 0x%8.8x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) dev->offset, offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) ret = pcmcia_map_mem_page(dev->p_dev, win, offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (ret != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) dev->offset = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return dev->win_base + (to & (dev->win_size-1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static map_word pcmcia_read8_remap(struct map_info *map, unsigned long ofs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) void __iomem *addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) map_word d = {{0}};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) addr = remap_window(map, ofs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) if(!addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) d.x[0] = readb(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) pr_debug("ofs = 0x%08lx (%p) data = 0x%02lx\n", ofs, addr, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static map_word pcmcia_read16_remap(struct map_info *map, unsigned long ofs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) void __iomem *addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) map_word d = {{0}};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) addr = remap_window(map, ofs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) if(!addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) d.x[0] = readw(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) pr_debug("ofs = 0x%08lx (%p) data = 0x%04lx\n", ofs, addr, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static void pcmcia_copy_from_remap(struct map_info *map, void *to, unsigned long from, ssize_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) unsigned long win_size = dev->win_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) pr_debug("to = %p from = %lu len = %zd\n", to, from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) while(len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) int toread = win_size - (from & (win_size-1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) void __iomem *addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if(toread > len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) toread = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) addr = remap_window(map, from);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) if(!addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) pr_debug("memcpy from %p to %p len = %d\n", addr, to, toread);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) memcpy_fromio(to, addr, toread);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) len -= toread;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) to += toread;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) from += toread;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) static void pcmcia_write8_remap(struct map_info *map, map_word d, unsigned long adr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) void __iomem *addr = remap_window(map, adr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if(!addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) pr_debug("adr = 0x%08lx (%p) data = 0x%02lx\n", adr, addr, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) writeb(d.x[0], addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) static void pcmcia_write16_remap(struct map_info *map, map_word d, unsigned long adr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) void __iomem *addr = remap_window(map, adr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) if(!addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) pr_debug("adr = 0x%08lx (%p) data = 0x%04lx\n", adr, addr, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) writew(d.x[0], addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) static void pcmcia_copy_to_remap(struct map_info *map, unsigned long to, const void *from, ssize_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) unsigned long win_size = dev->win_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) pr_debug("to = %lu from = %p len = %zd\n", to, from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) while(len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) int towrite = win_size - (to & (win_size-1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) void __iomem *addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) if(towrite > len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) towrite = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) addr = remap_window(map, to);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) if(!addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) pr_debug("memcpy from %p to %p len = %d\n", from, addr, towrite);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) memcpy_toio(addr, from, towrite);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) len -= towrite;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) to += towrite;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) from += towrite;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) /* read/write{8,16} copy_{from,to} routines with direct access */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) #define DEV_REMOVED(x) (!(pcmcia_dev_present(((struct pcmciamtd_dev *)map->map_priv_1)->p_dev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) static map_word pcmcia_read8(struct map_info *map, unsigned long ofs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) void __iomem *win_base = (void __iomem *)map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) map_word d = {{0}};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if(DEV_REMOVED(map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) d.x[0] = readb(win_base + ofs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) pr_debug("ofs = 0x%08lx (%p) data = 0x%02lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) ofs, win_base + ofs, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) static map_word pcmcia_read16(struct map_info *map, unsigned long ofs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) void __iomem *win_base = (void __iomem *)map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) map_word d = {{0}};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if(DEV_REMOVED(map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) d.x[0] = readw(win_base + ofs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) pr_debug("ofs = 0x%08lx (%p) data = 0x%04lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) ofs, win_base + ofs, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) static void pcmcia_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) void __iomem *win_base = (void __iomem *)map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) if(DEV_REMOVED(map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) pr_debug("to = %p from = %lu len = %zd\n", to, from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) memcpy_fromio(to, win_base + from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) static void pcmcia_write8(struct map_info *map, map_word d, unsigned long adr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) void __iomem *win_base = (void __iomem *)map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) if(DEV_REMOVED(map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) pr_debug("adr = 0x%08lx (%p) data = 0x%02lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) adr, win_base + adr, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) writeb(d.x[0], win_base + adr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) static void pcmcia_write16(struct map_info *map, map_word d, unsigned long adr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) void __iomem *win_base = (void __iomem *)map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) if(DEV_REMOVED(map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) pr_debug("adr = 0x%08lx (%p) data = 0x%04lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) adr, win_base + adr, d.x[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) writew(d.x[0], win_base + adr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) static void pcmcia_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) void __iomem *win_base = (void __iomem *)map->map_priv_2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) if(DEV_REMOVED(map))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) pr_debug("to = %lu from = %p len = %zd\n", to, from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) memcpy_toio(win_base + to, from, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static DEFINE_MUTEX(pcmcia_vpp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) static int pcmcia_vpp_refcnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) static void pcmciamtd_set_vpp(struct map_info *map, int on)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) struct pcmcia_device *link = dev->p_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) pr_debug("dev = %p on = %d vpp = %d\n\n", dev, on, dev->vpp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) mutex_lock(&pcmcia_vpp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) if (on) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) if (++pcmcia_vpp_refcnt == 1) /* first nested 'on' */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) pcmcia_fixup_vpp(link, dev->vpp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) if (--pcmcia_vpp_refcnt == 0) /* last nested 'off' */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) pcmcia_fixup_vpp(link, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) mutex_unlock(&pcmcia_vpp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) static void pcmciamtd_release(struct pcmcia_device *link)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) struct pcmciamtd_dev *dev = link->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) pr_debug("link = 0x%p\n", link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) if (link->resource[2]->end) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) if(dev->win_base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) iounmap(dev->win_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) dev->win_base = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) pcmcia_disable_device(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) static int pcmciamtd_cistpl_format(struct pcmcia_device *p_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) tuple_t *tuple,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) void *priv_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) cisparse_t parse;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) if (!pcmcia_parse_tuple(tuple, &parse)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) cistpl_format_t *t = &parse.format;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) (void)t; /* Shut up, gcc */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) pr_debug("Format type: %u, Error Detection: %u, offset = %u, length =%u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) t->type, t->edc, t->offset, t->length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) return -ENOSPC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) static int pcmciamtd_cistpl_jedec(struct pcmcia_device *p_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) tuple_t *tuple,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) void *priv_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) cisparse_t parse;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) if (!pcmcia_parse_tuple(tuple, &parse)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) cistpl_jedec_t *t = &parse.jedec;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) for (i = 0; i < t->nid; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) pr_debug("JEDEC: 0x%02x 0x%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) t->id[i].mfr, t->id[i].info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) return -ENOSPC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) static int pcmciamtd_cistpl_device(struct pcmcia_device *p_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) tuple_t *tuple,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) void *priv_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) struct pcmciamtd_dev *dev = priv_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) cisparse_t parse;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) cistpl_device_t *t = &parse.device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) if (pcmcia_parse_tuple(tuple, &parse))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) pr_debug("Common memory:\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) dev->pcmcia_map.size = t->dev[0].size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) /* from here on: DEBUG only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) for (i = 0; i < t->ndev; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) pr_debug("Region %d, type = %u\n", i, t->dev[i].type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) pr_debug("Region %d, wp = %u\n", i, t->dev[i].wp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) pr_debug("Region %d, speed = %u ns\n", i, t->dev[i].speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) pr_debug("Region %d, size = %u bytes\n", i, t->dev[i].size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) static int pcmciamtd_cistpl_geo(struct pcmcia_device *p_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) tuple_t *tuple,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) void *priv_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) struct pcmciamtd_dev *dev = priv_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) cisparse_t parse;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) cistpl_device_geo_t *t = &parse.device_geo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) if (pcmcia_parse_tuple(tuple, &parse))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) dev->pcmcia_map.bankwidth = t->geo[0].buswidth;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) /* from here on: DEBUG only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) for (i = 0; i < t->ngeo; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) pr_debug("region: %d bankwidth = %u\n", i, t->geo[i].buswidth);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) pr_debug("region: %d erase_block = %u\n", i, t->geo[i].erase_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) pr_debug("region: %d read_block = %u\n", i, t->geo[i].read_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) pr_debug("region: %d write_block = %u\n", i, t->geo[i].write_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) pr_debug("region: %d partition = %u\n", i, t->geo[i].partition);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) pr_debug("region: %d interleave = %u\n", i, t->geo[i].interleave);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) static void card_settings(struct pcmciamtd_dev *dev, struct pcmcia_device *p_dev, int *new_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) if (p_dev->prod_id[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) dev->mtd_name[0] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) for (i = 0; i < 4; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) if (i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) strcat(dev->mtd_name, " ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) if (p_dev->prod_id[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) strcat(dev->mtd_name, p_dev->prod_id[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) pr_debug("Found name: %s\n", dev->mtd_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) pcmcia_loop_tuple(p_dev, CISTPL_FORMAT, pcmciamtd_cistpl_format, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) pcmcia_loop_tuple(p_dev, CISTPL_JEDEC_C, pcmciamtd_cistpl_jedec, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) pcmcia_loop_tuple(p_dev, CISTPL_DEVICE, pcmciamtd_cistpl_device, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) pcmcia_loop_tuple(p_dev, CISTPL_DEVICE_GEO, pcmciamtd_cistpl_geo, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) if(!dev->pcmcia_map.size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) dev->pcmcia_map.size = MAX_PCMCIA_ADDR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) if(!dev->pcmcia_map.bankwidth)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) dev->pcmcia_map.bankwidth = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) if(force_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) dev->pcmcia_map.size = force_size << 20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) pr_debug("size forced to %dM\n", force_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if(bankwidth) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) dev->pcmcia_map.bankwidth = bankwidth;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) pr_debug("bankwidth forced to %d\n", bankwidth);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) dev->pcmcia_map.name = dev->mtd_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) if(!dev->mtd_name[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) strcpy(dev->mtd_name, "PCMCIA Memory card");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) *new_name = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) pr_debug("Device: Size: %lu Width:%d Name: %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) dev->pcmcia_map.size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) dev->pcmcia_map.bankwidth << 3, dev->mtd_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) static int pcmciamtd_config(struct pcmcia_device *link)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) struct pcmciamtd_dev *dev = link->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) struct mtd_info *mtd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) int i, j = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) static char *probes[] = { "jedec_probe", "cfi_probe" };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) int new_name = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) pr_debug("link=0x%p\n", link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) card_settings(dev, link, &new_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) dev->pcmcia_map.phys = NO_XIP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) dev->pcmcia_map.copy_from = pcmcia_copy_from_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) dev->pcmcia_map.copy_to = pcmcia_copy_to_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) if (dev->pcmcia_map.bankwidth == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) dev->pcmcia_map.read = pcmcia_read8_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) dev->pcmcia_map.write = pcmcia_write8_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) dev->pcmcia_map.read = pcmcia_read16_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) dev->pcmcia_map.write = pcmcia_write16_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) if(setvpp == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) dev->pcmcia_map.set_vpp = pcmciamtd_set_vpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) /* Request a memory window for PCMCIA. Some architeures can map windows
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) * up to the maximum that PCMCIA can support (64MiB) - this is ideal and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) * we aim for a window the size of the whole card - otherwise we try
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) * smaller windows until we succeed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) link->resource[2]->flags |= WIN_MEMORY_TYPE_CM | WIN_ENABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) link->resource[2]->flags |= (dev->pcmcia_map.bankwidth == 1) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) WIN_DATA_WIDTH_8 : WIN_DATA_WIDTH_16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) link->resource[2]->start = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) link->resource[2]->end = (force_size) ? force_size << 20 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) MAX_PCMCIA_ADDR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) dev->win_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) pr_debug("requesting window with size = %luKiB memspeed = %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) (unsigned long) resource_size(link->resource[2]) >> 10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) mem_speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) ret = pcmcia_request_window(link, link->resource[2], mem_speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) pr_debug("ret = %d dev->win_size = %d\n", ret, dev->win_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) if(ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) j++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) link->resource[2]->start = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) link->resource[2]->end = (force_size) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) force_size << 20 : MAX_PCMCIA_ADDR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) link->resource[2]->end >>= j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) pr_debug("Got window of size %luKiB\n", (unsigned long)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) resource_size(link->resource[2]) >> 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) dev->win_size = resource_size(link->resource[2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) } while (link->resource[2]->end >= 0x1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) pr_debug("dev->win_size = %d\n", dev->win_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) if(!dev->win_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) dev_err(&dev->p_dev->dev, "Cannot allocate memory window\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) pcmciamtd_release(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) pr_debug("Allocated a window of %dKiB\n", dev->win_size >> 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) /* Get write protect status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) dev->win_base = ioremap(link->resource[2]->start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) resource_size(link->resource[2]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) if(!dev->win_base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) dev_err(&dev->p_dev->dev, "ioremap(%pR) failed\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) link->resource[2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) pcmciamtd_release(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) pr_debug("mapped window dev = %p @ %pR, base = %p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) dev, link->resource[2], dev->win_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) dev->offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) dev->pcmcia_map.map_priv_1 = (unsigned long)dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) dev->pcmcia_map.map_priv_2 = (unsigned long)link->resource[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) dev->vpp = (vpp) ? vpp : link->socket->socket.Vpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) if(setvpp == 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) link->vpp = dev->vpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) link->vpp = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) link->config_index = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) pr_debug("Setting Configuration\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) ret = pcmcia_enable_device(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) if (dev->win_base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) iounmap(dev->win_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) dev->win_base = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) if(mem_type == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) mtd = do_map_probe("map_ram", &dev->pcmcia_map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) } else if(mem_type == 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) mtd = do_map_probe("map_rom", &dev->pcmcia_map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) for(i = 0; i < ARRAY_SIZE(probes); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) pr_debug("Trying %s\n", probes[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) mtd = do_map_probe(probes[i], &dev->pcmcia_map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) if(mtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) pr_debug("FAILED: %s\n", probes[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) if(!mtd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) pr_debug("Can not find an MTD\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) pcmciamtd_release(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) dev->mtd_info = mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) mtd->owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) if(new_name) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) int size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) char unit = ' ';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) /* Since we are using a default name, make it better by adding
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) * in the size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) if(mtd->size < 1048576) { /* <1MiB in size, show size in KiB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) size = mtd->size >> 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) unit = 'K';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) size = mtd->size >> 20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) unit = 'M';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) snprintf(dev->mtd_name, sizeof(dev->mtd_name), "%d%ciB %s", size, unit, "PCMCIA Memory card");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) /* If the memory found is fits completely into the mapped PCMCIA window,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) use the faster non-remapping read/write functions */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) if(mtd->size <= dev->win_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) pr_debug("Using non remapping memory functions\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) dev->pcmcia_map.map_priv_2 = (unsigned long)dev->win_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) if (dev->pcmcia_map.bankwidth == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) dev->pcmcia_map.read = pcmcia_read8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) dev->pcmcia_map.write = pcmcia_write8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) dev->pcmcia_map.read = pcmcia_read16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) dev->pcmcia_map.write = pcmcia_write16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) dev->pcmcia_map.copy_from = pcmcia_copy_from;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) dev->pcmcia_map.copy_to = pcmcia_copy_to;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) if (mtd_device_register(mtd, NULL, 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) map_destroy(mtd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) dev->mtd_info = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) dev_err(&dev->p_dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) "Could not register the MTD device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) pcmciamtd_release(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) dev_info(&dev->p_dev->dev, "mtd%d: %s\n", mtd->index, mtd->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) static int pcmciamtd_suspend(struct pcmcia_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) pr_debug("EVENT_PM_RESUME\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) /* get_lock(link); */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) static int pcmciamtd_resume(struct pcmcia_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) pr_debug("EVENT_PM_SUSPEND\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) /* free_lock(link); */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) static void pcmciamtd_detach(struct pcmcia_device *link)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) struct pcmciamtd_dev *dev = link->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) pr_debug("link=0x%p\n", link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) if(dev->mtd_info) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) mtd_device_unregister(dev->mtd_info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) dev_info(&dev->p_dev->dev, "mtd%d: Removing\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) dev->mtd_info->index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) map_destroy(dev->mtd_info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) pcmciamtd_release(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) static int pcmciamtd_probe(struct pcmcia_device *link)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) struct pcmciamtd_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) /* Create new memory card device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) dev = kzalloc(sizeof(*dev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) if (!dev) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) pr_debug("dev=0x%p\n", dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) dev->p_dev = link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) link->priv = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) return pcmciamtd_config(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) static const struct pcmcia_device_id pcmciamtd_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) PCMCIA_DEVICE_FUNC_ID(1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) PCMCIA_DEVICE_PROD_ID123("IO DATA", "PCS-2M", "2MB SRAM", 0x547e66dc, 0x1fed36cd, 0x36eadd21),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) PCMCIA_DEVICE_PROD_ID12("IBM", "2MB SRAM", 0xb569a6e5, 0x36eadd21),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) PCMCIA_DEVICE_PROD_ID12("IBM", "4MB FLASH", 0xb569a6e5, 0x8bc54d2a),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) PCMCIA_DEVICE_PROD_ID12("IBM", "8MB FLASH", 0xb569a6e5, 0x6df1be3e),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) PCMCIA_DEVICE_PROD_ID12("Intel", "S2E20SW", 0x816cc815, 0xd14c9dcf),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) PCMCIA_DEVICE_PROD_ID12("Intel", "S2E8 SW", 0x816cc815, 0xa2d7dedb),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-02 ", 0x40ade711, 0x145cea5c),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-04 ", 0x40ade711, 0x42064dda),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-20 ", 0x40ade711, 0x25ee5cb0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) PCMCIA_DEVICE_PROD_ID12("intel", "VALUE SERIES 100 ", 0x40ade711, 0xdf8506d8),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) PCMCIA_DEVICE_PROD_ID12("KINGMAX TECHNOLOGY INC.", "SRAM 256K Bytes", 0x54d0c69c, 0xad12c29c),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) PCMCIA_DEVICE_PROD_ID12("Maxtor", "MAXFL MobileMax Flash Memory Card", 0xb68968c8, 0x2dfb47b0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) PCMCIA_DEVICE_PROD_ID123("M-Systems", "M-SYS Flash Memory Card", "(c) M-Systems", 0x7ed2ad87, 0x675dc3fb, 0x7aef3965),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) PCMCIA_DEVICE_PROD_ID12("PRETEC", " 2MB SRAM CARD", 0xebf91155, 0x805360ca),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) PCMCIA_DEVICE_PROD_ID12("PRETEC", " 4MB SRAM CARD", 0xebf91155, 0x20b6bf17),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB101EN20", 0xf9876baf, 0xad0b207b),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB513EN20", 0xf9876baf, 0xe8d884ad),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) PCMCIA_DEVICE_PROD_ID12("SMART Modular Technologies", " 4MB FLASH Card", 0x96fd8277, 0x737a5b05),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-3000", 0x05ddca47, 0xe7d67bca),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-4100", 0x05ddca47, 0x7bc32944),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) /* the following was commented out in pcmcia-cs-3.2.7 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) /* PCMCIA_DEVICE_PROD_ID12("RATOC Systems,Inc.", "SmartMedia ADAPTER PC Card", 0xf4a2fefe, 0x5885b2ae), */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) #ifdef CONFIG_MTD_PCMCIA_ANONYMOUS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) { .match_flags = PCMCIA_DEV_ID_MATCH_ANONYMOUS, },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) PCMCIA_DEVICE_NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) MODULE_DEVICE_TABLE(pcmcia, pcmciamtd_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) static struct pcmcia_driver pcmciamtd_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) .name = "pcmciamtd",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) .probe = pcmciamtd_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) .remove = pcmciamtd_detach,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) .id_table = pcmciamtd_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) .suspend = pcmciamtd_suspend,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) .resume = pcmciamtd_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) static int __init init_pcmciamtd(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) if(bankwidth && bankwidth != 1 && bankwidth != 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) info("bad bankwidth (%d), using default", bankwidth);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) bankwidth = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) if(force_size && (force_size < 1 || force_size > 64)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) info("bad force_size (%d), using default", force_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) force_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) if(mem_type && mem_type != 1 && mem_type != 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) info("bad mem_type (%d), using default", mem_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) mem_type = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) return pcmcia_register_driver(&pcmciamtd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) static void __exit exit_pcmciamtd(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) pr_debug(DRIVER_DESC " unloading");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) pcmcia_unregister_driver(&pcmciamtd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) module_init(init_pcmciamtd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) module_exit(exit_pcmciamtd);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags