| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /*====================================================================== | 
|  | 2 |  | 
|  | 3 | Device driver for Databook TCIC-2 PCMCIA controller | 
|  | 4 |  | 
|  | 5 | tcic.c 1.111 2000/02/15 04:13:12 | 
|  | 6 |  | 
|  | 7 | The contents of this file are subject to the Mozilla Public | 
|  | 8 | License Version 1.1 (the "License"); you may not use this file | 
|  | 9 | except in compliance with the License. You may obtain a copy of | 
|  | 10 | the License at http://www.mozilla.org/MPL/ | 
|  | 11 |  | 
|  | 12 | Software distributed under the License is distributed on an "AS | 
|  | 13 | IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or | 
|  | 14 | implied. See the License for the specific language governing | 
|  | 15 | rights and limitations under the License. | 
|  | 16 |  | 
|  | 17 | The initial developer of the original code is David A. Hinds | 
|  | 18 | <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds | 
|  | 19 | are Copyright (C) 1999 David A. Hinds.  All Rights Reserved. | 
|  | 20 |  | 
|  | 21 | Alternatively, the contents of this file may be used under the | 
|  | 22 | terms of the GNU General Public License version 2 (the "GPL"), in which | 
|  | 23 | case the provisions of the GPL are applicable instead of the | 
|  | 24 | above.  If you wish to allow the use of your version of this file | 
|  | 25 | only under the terms of the GPL and not to allow others to use | 
|  | 26 | your version of this file under the MPL, indicate your decision | 
|  | 27 | by deleting the provisions above and replace them with the notice | 
|  | 28 | and other provisions required by the GPL.  If you do not delete | 
|  | 29 | the provisions above, a recipient may use your version of this | 
|  | 30 | file under either the MPL or the GPL. | 
|  | 31 |  | 
|  | 32 | ======================================================================*/ | 
|  | 33 |  | 
|  | 34 | #include <linux/module.h> | 
|  | 35 | #include <linux/moduleparam.h> | 
|  | 36 | #include <linux/init.h> | 
|  | 37 | #include <linux/types.h> | 
|  | 38 | #include <linux/fcntl.h> | 
|  | 39 | #include <linux/string.h> | 
|  | 40 | #include <linux/errno.h> | 
|  | 41 | #include <linux/interrupt.h> | 
|  | 42 | #include <linux/slab.h> | 
|  | 43 | #include <linux/timer.h> | 
|  | 44 | #include <linux/ioport.h> | 
|  | 45 | #include <linux/delay.h> | 
|  | 46 | #include <linux/workqueue.h> | 
| Russell King | d052d1b | 2005-10-29 19:07:23 +0100 | [diff] [blame] | 47 | #include <linux/platform_device.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | #include <linux/bitops.h> | 
|  | 49 |  | 
|  | 50 | #include <asm/io.h> | 
|  | 51 | #include <asm/system.h> | 
|  | 52 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | #include <pcmcia/cs_types.h> | 
|  | 54 | #include <pcmcia/cs.h> | 
|  | 55 | #include <pcmcia/ss.h> | 
|  | 56 | #include "tcic.h" | 
|  | 57 |  | 
| Dominik Brodowski | 7d16b65 | 2008-08-02 21:02:01 +0200 | [diff] [blame] | 58 | #ifdef CONFIG_PCMCIA_DEBUG | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | static int pc_debug; | 
|  | 60 |  | 
|  | 61 | module_param(pc_debug, int, 0644); | 
|  | 62 | static const char version[] = | 
|  | 63 | "tcic.c 1.111 2000/02/15 04:13:12 (David Hinds)"; | 
|  | 64 |  | 
|  | 65 | #define debug(lvl, fmt, arg...) do {				\ | 
|  | 66 | if (pc_debug > (lvl))					\ | 
|  | 67 | printk(KERN_DEBUG "tcic: " fmt , ## arg);	\ | 
|  | 68 | } while (0) | 
|  | 69 | #else | 
|  | 70 | #define debug(lvl, fmt, arg...) do { } while (0) | 
|  | 71 | #endif | 
|  | 72 |  | 
|  | 73 | MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>"); | 
|  | 74 | MODULE_DESCRIPTION("Databook TCIC-2 PCMCIA socket driver"); | 
|  | 75 | MODULE_LICENSE("Dual MPL/GPL"); | 
|  | 76 |  | 
|  | 77 | /*====================================================================*/ | 
|  | 78 |  | 
|  | 79 | /* Parameters that can be set with 'insmod' */ | 
|  | 80 |  | 
|  | 81 | /* The base port address of the TCIC-2 chip */ | 
|  | 82 | static unsigned long tcic_base = TCIC_BASE; | 
|  | 83 |  | 
|  | 84 | /* Specify a socket number to ignore */ | 
|  | 85 | static int ignore = -1; | 
|  | 86 |  | 
|  | 87 | /* Probe for safe interrupts? */ | 
|  | 88 | static int do_scan = 1; | 
|  | 89 |  | 
|  | 90 | /* Bit map of interrupts to choose from */ | 
|  | 91 | static u_int irq_mask = 0xffff; | 
|  | 92 | static int irq_list[16]; | 
| Al Viro | 64a6f95 | 2007-10-14 19:35:30 +0100 | [diff] [blame] | 93 | static unsigned int irq_list_count; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 |  | 
|  | 95 | /* The card status change interrupt -- 0 means autoselect */ | 
|  | 96 | static int cs_irq; | 
|  | 97 |  | 
|  | 98 | /* Poll status interval -- 0 means default to interrupt */ | 
|  | 99 | static int poll_interval; | 
|  | 100 |  | 
|  | 101 | /* Delay for card status double-checking */ | 
|  | 102 | static int poll_quick = HZ/20; | 
|  | 103 |  | 
|  | 104 | /* CCLK external clock time, in nanoseconds.  70 ns = 14.31818 MHz */ | 
|  | 105 | static int cycle_time = 70; | 
|  | 106 |  | 
|  | 107 | module_param(tcic_base, ulong, 0444); | 
|  | 108 | module_param(ignore, int, 0444); | 
|  | 109 | module_param(do_scan, int, 0444); | 
|  | 110 | module_param(irq_mask, int, 0444); | 
|  | 111 | module_param_array(irq_list, int, &irq_list_count, 0444); | 
|  | 112 | module_param(cs_irq, int, 0444); | 
|  | 113 | module_param(poll_interval, int, 0444); | 
|  | 114 | module_param(poll_quick, int, 0444); | 
|  | 115 | module_param(cycle_time, int, 0444); | 
|  | 116 |  | 
|  | 117 | /*====================================================================*/ | 
|  | 118 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 119 | static irqreturn_t tcic_interrupt(int irq, void *dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | static void tcic_timer(u_long data); | 
|  | 121 | static struct pccard_operations tcic_operations; | 
|  | 122 |  | 
|  | 123 | struct tcic_socket { | 
|  | 124 | u_short	psock; | 
|  | 125 | u_char	last_sstat; | 
|  | 126 | u_char	id; | 
|  | 127 | struct pcmcia_socket	socket; | 
|  | 128 | }; | 
|  | 129 |  | 
|  | 130 | static struct timer_list poll_timer; | 
|  | 131 | static int tcic_timer_pending; | 
|  | 132 |  | 
|  | 133 | static int sockets; | 
|  | 134 | static struct tcic_socket socket_table[2]; | 
|  | 135 |  | 
|  | 136 | /*====================================================================*/ | 
|  | 137 |  | 
|  | 138 | /* Trick when selecting interrupts: the TCIC sktirq pin is supposed | 
|  | 139 | to map to irq 11, but is coded as 0 or 1 in the irq registers. */ | 
|  | 140 | #define TCIC_IRQ(x) ((x) ? (((x) == 11) ? 1 : (x)) : 15) | 
|  | 141 |  | 
|  | 142 | #ifdef DEBUG_X | 
|  | 143 | static u_char tcic_getb(u_char reg) | 
|  | 144 | { | 
|  | 145 | u_char val = inb(tcic_base+reg); | 
|  | 146 | printk(KERN_DEBUG "tcic_getb(%#lx) = %#x\n", tcic_base+reg, val); | 
|  | 147 | return val; | 
|  | 148 | } | 
|  | 149 |  | 
|  | 150 | static u_short tcic_getw(u_char reg) | 
|  | 151 | { | 
|  | 152 | u_short val = inw(tcic_base+reg); | 
|  | 153 | printk(KERN_DEBUG "tcic_getw(%#lx) = %#x\n", tcic_base+reg, val); | 
|  | 154 | return val; | 
|  | 155 | } | 
|  | 156 |  | 
|  | 157 | static void tcic_setb(u_char reg, u_char data) | 
|  | 158 | { | 
|  | 159 | printk(KERN_DEBUG "tcic_setb(%#lx, %#x)\n", tcic_base+reg, data); | 
|  | 160 | outb(data, tcic_base+reg); | 
|  | 161 | } | 
|  | 162 |  | 
|  | 163 | static void tcic_setw(u_char reg, u_short data) | 
|  | 164 | { | 
|  | 165 | printk(KERN_DEBUG "tcic_setw(%#lx, %#x)\n", tcic_base+reg, data); | 
|  | 166 | outw(data, tcic_base+reg); | 
|  | 167 | } | 
|  | 168 | #else | 
|  | 169 | #define tcic_getb(reg) inb(tcic_base+reg) | 
|  | 170 | #define tcic_getw(reg) inw(tcic_base+reg) | 
|  | 171 | #define tcic_setb(reg, data) outb(data, tcic_base+reg) | 
|  | 172 | #define tcic_setw(reg, data) outw(data, tcic_base+reg) | 
|  | 173 | #endif | 
|  | 174 |  | 
|  | 175 | static void tcic_setl(u_char reg, u_int data) | 
|  | 176 | { | 
|  | 177 | #ifdef DEBUG_X | 
|  | 178 | printk(KERN_DEBUG "tcic_setl(%#x, %#lx)\n", tcic_base+reg, data); | 
|  | 179 | #endif | 
|  | 180 | outw(data & 0xffff, tcic_base+reg); | 
|  | 181 | outw(data >> 16, tcic_base+reg+2); | 
|  | 182 | } | 
|  | 183 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 184 | static void tcic_aux_setb(u_short reg, u_char data) | 
|  | 185 | { | 
|  | 186 | u_char mode = (tcic_getb(TCIC_MODE) & TCIC_MODE_PGMMASK) | reg; | 
|  | 187 | tcic_setb(TCIC_MODE, mode); | 
|  | 188 | tcic_setb(TCIC_AUX, data); | 
|  | 189 | } | 
|  | 190 |  | 
|  | 191 | static u_short tcic_aux_getw(u_short reg) | 
|  | 192 | { | 
|  | 193 | u_char mode = (tcic_getb(TCIC_MODE) & TCIC_MODE_PGMMASK) | reg; | 
|  | 194 | tcic_setb(TCIC_MODE, mode); | 
|  | 195 | return tcic_getw(TCIC_AUX); | 
|  | 196 | } | 
|  | 197 |  | 
|  | 198 | static void tcic_aux_setw(u_short reg, u_short data) | 
|  | 199 | { | 
|  | 200 | u_char mode = (tcic_getb(TCIC_MODE) & TCIC_MODE_PGMMASK) | reg; | 
|  | 201 | tcic_setb(TCIC_MODE, mode); | 
|  | 202 | tcic_setw(TCIC_AUX, data); | 
|  | 203 | } | 
|  | 204 |  | 
|  | 205 | /*====================================================================*/ | 
|  | 206 |  | 
|  | 207 | /* Time conversion functions */ | 
|  | 208 |  | 
|  | 209 | static int to_cycles(int ns) | 
|  | 210 | { | 
|  | 211 | if (ns < 14) | 
|  | 212 | return 0; | 
|  | 213 | else | 
|  | 214 | return 2*(ns-14)/cycle_time; | 
|  | 215 | } | 
|  | 216 |  | 
|  | 217 | /*====================================================================*/ | 
|  | 218 |  | 
|  | 219 | static volatile u_int irq_hits; | 
|  | 220 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 221 | static irqreturn_t __init tcic_irq_count(int irq, void *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 222 | { | 
|  | 223 | irq_hits++; | 
|  | 224 | return IRQ_HANDLED; | 
|  | 225 | } | 
|  | 226 |  | 
|  | 227 | static u_int __init try_irq(int irq) | 
|  | 228 | { | 
|  | 229 | u_short cfg; | 
|  | 230 |  | 
|  | 231 | irq_hits = 0; | 
|  | 232 | if (request_irq(irq, tcic_irq_count, 0, "irq scan", tcic_irq_count) != 0) | 
|  | 233 | return -1; | 
|  | 234 | mdelay(10); | 
|  | 235 | if (irq_hits) { | 
|  | 236 | free_irq(irq, tcic_irq_count); | 
|  | 237 | return -1; | 
|  | 238 | } | 
|  | 239 |  | 
|  | 240 | /* Generate one interrupt */ | 
|  | 241 | cfg = TCIC_SYSCFG_AUTOBUSY | 0x0a00; | 
|  | 242 | tcic_aux_setw(TCIC_AUX_SYSCFG, cfg | TCIC_IRQ(irq)); | 
|  | 243 | tcic_setb(TCIC_IENA, TCIC_IENA_ERR | TCIC_IENA_CFG_HIGH); | 
|  | 244 | tcic_setb(TCIC_ICSR, TCIC_ICSR_ERR | TCIC_ICSR_JAM); | 
|  | 245 |  | 
|  | 246 | udelay(1000); | 
|  | 247 | free_irq(irq, tcic_irq_count); | 
|  | 248 |  | 
|  | 249 | /* Turn off interrupts */ | 
|  | 250 | tcic_setb(TCIC_IENA, TCIC_IENA_CFG_OFF); | 
|  | 251 | while (tcic_getb(TCIC_ICSR)) | 
|  | 252 | tcic_setb(TCIC_ICSR, TCIC_ICSR_JAM); | 
|  | 253 | tcic_aux_setw(TCIC_AUX_SYSCFG, cfg); | 
|  | 254 |  | 
|  | 255 | return (irq_hits != 1); | 
|  | 256 | } | 
|  | 257 |  | 
|  | 258 | static u_int __init irq_scan(u_int mask0) | 
|  | 259 | { | 
|  | 260 | u_int mask1; | 
|  | 261 | int i; | 
|  | 262 |  | 
|  | 263 | #ifdef __alpha__ | 
|  | 264 | #define PIC 0x4d0 | 
|  | 265 | /* Don't probe level-triggered interrupts -- reserved for PCI */ | 
|  | 266 | int level_mask = inb_p(PIC) | (inb_p(PIC+1) << 8); | 
|  | 267 | if (level_mask) | 
|  | 268 | mask0 &= ~level_mask; | 
|  | 269 | #endif | 
|  | 270 |  | 
|  | 271 | mask1 = 0; | 
|  | 272 | if (do_scan) { | 
|  | 273 | for (i = 0; i < 16; i++) | 
|  | 274 | if ((mask0 & (1 << i)) && (try_irq(i) == 0)) | 
|  | 275 | mask1 |= (1 << i); | 
|  | 276 | for (i = 0; i < 16; i++) | 
|  | 277 | if ((mask1 & (1 << i)) && (try_irq(i) != 0)) { | 
|  | 278 | mask1 ^= (1 << i); | 
|  | 279 | } | 
|  | 280 | } | 
|  | 281 |  | 
|  | 282 | if (mask1) { | 
|  | 283 | printk("scanned"); | 
|  | 284 | } else { | 
|  | 285 | /* Fallback: just find interrupts that aren't in use */ | 
|  | 286 | for (i = 0; i < 16; i++) | 
|  | 287 | if ((mask0 & (1 << i)) && | 
|  | 288 | (request_irq(i, tcic_irq_count, 0, "x", tcic_irq_count) == 0)) { | 
|  | 289 | mask1 |= (1 << i); | 
|  | 290 | free_irq(i, tcic_irq_count); | 
|  | 291 | } | 
|  | 292 | printk("default"); | 
|  | 293 | } | 
|  | 294 |  | 
|  | 295 | printk(") = "); | 
|  | 296 | for (i = 0; i < 16; i++) | 
|  | 297 | if (mask1 & (1<<i)) | 
|  | 298 | printk("%s%d", ((mask1 & ((1<<i)-1)) ? "," : ""), i); | 
|  | 299 | printk(" "); | 
|  | 300 |  | 
|  | 301 | return mask1; | 
|  | 302 | } | 
|  | 303 |  | 
|  | 304 | /*====================================================================== | 
|  | 305 |  | 
|  | 306 | See if a card is present, powered up, in IO mode, and already | 
|  | 307 | bound to a (non-PCMCIA) Linux driver. | 
|  | 308 |  | 
|  | 309 | We make an exception for cards that look like serial devices. | 
|  | 310 |  | 
|  | 311 | ======================================================================*/ | 
|  | 312 |  | 
|  | 313 | static int __init is_active(int s) | 
|  | 314 | { | 
|  | 315 | u_short scf1, ioctl, base, num; | 
|  | 316 | u_char pwr, sstat; | 
|  | 317 | u_int addr; | 
|  | 318 |  | 
|  | 319 | tcic_setl(TCIC_ADDR, (s << TCIC_ADDR_SS_SHFT) | 
|  | 320 | | TCIC_ADDR_INDREG | TCIC_SCF1(s)); | 
|  | 321 | scf1 = tcic_getw(TCIC_DATA); | 
|  | 322 | pwr = tcic_getb(TCIC_PWR); | 
|  | 323 | sstat = tcic_getb(TCIC_SSTAT); | 
|  | 324 | addr = TCIC_IWIN(s, 0); | 
|  | 325 | tcic_setw(TCIC_ADDR, addr + TCIC_IBASE_X); | 
|  | 326 | base = tcic_getw(TCIC_DATA); | 
|  | 327 | tcic_setw(TCIC_ADDR, addr + TCIC_ICTL_X); | 
|  | 328 | ioctl = tcic_getw(TCIC_DATA); | 
|  | 329 |  | 
|  | 330 | if (ioctl & TCIC_ICTL_TINY) | 
|  | 331 | num = 1; | 
|  | 332 | else { | 
|  | 333 | num = (base ^ (base-1)); | 
|  | 334 | base = base & (base-1); | 
|  | 335 | } | 
|  | 336 |  | 
|  | 337 | if ((sstat & TCIC_SSTAT_CD) && (pwr & TCIC_PWR_VCC(s)) && | 
|  | 338 | (scf1 & TCIC_SCF1_IOSTS) && (ioctl & TCIC_ICTL_ENA) && | 
|  | 339 | ((base & 0xfeef) != 0x02e8)) { | 
|  | 340 | struct resource *res = request_region(base, num, "tcic-2"); | 
|  | 341 | if (!res) /* region is busy */ | 
|  | 342 | return 1; | 
|  | 343 | release_region(base, num); | 
|  | 344 | } | 
|  | 345 |  | 
|  | 346 | return 0; | 
|  | 347 | } | 
|  | 348 |  | 
|  | 349 | /*====================================================================== | 
|  | 350 |  | 
|  | 351 | This returns the revision code for the specified socket. | 
|  | 352 |  | 
|  | 353 | ======================================================================*/ | 
|  | 354 |  | 
|  | 355 | static int __init get_tcic_id(void) | 
|  | 356 | { | 
|  | 357 | u_short id; | 
|  | 358 |  | 
|  | 359 | tcic_aux_setw(TCIC_AUX_TEST, TCIC_TEST_DIAG); | 
|  | 360 | id = tcic_aux_getw(TCIC_AUX_ILOCK); | 
|  | 361 | id = (id & TCIC_ILOCKTEST_ID_MASK) >> TCIC_ILOCKTEST_ID_SH; | 
|  | 362 | tcic_aux_setw(TCIC_AUX_TEST, 0); | 
|  | 363 | return id; | 
|  | 364 | } | 
|  | 365 |  | 
| Ming Lei | 7a192ec | 2009-02-06 23:40:12 +0800 | [diff] [blame] | 366 | static int tcic_drv_pcmcia_suspend(struct platform_device *dev, | 
|  | 367 | pm_message_t state) | 
|  | 368 | { | 
|  | 369 | return pcmcia_socket_dev_suspend(&dev->dev, state); | 
|  | 370 | } | 
|  | 371 |  | 
|  | 372 | static int tcic_drv_pcmcia_resume(struct platform_device *dev) | 
|  | 373 | { | 
|  | 374 | return pcmcia_socket_dev_resume(&dev->dev); | 
|  | 375 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 | /*====================================================================*/ | 
|  | 377 |  | 
| Ming Lei | 7a192ec | 2009-02-06 23:40:12 +0800 | [diff] [blame] | 378 | static struct platform_driver tcic_driver = { | 
|  | 379 | .driver = { | 
|  | 380 | .name = "tcic-pcmcia", | 
|  | 381 | .owner		= THIS_MODULE, | 
|  | 382 | }, | 
|  | 383 | .suspend 	= tcic_drv_pcmcia_suspend, | 
|  | 384 | .resume 	= tcic_drv_pcmcia_resume, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 385 | }; | 
|  | 386 |  | 
|  | 387 | static struct platform_device tcic_device = { | 
|  | 388 | .name = "tcic-pcmcia", | 
|  | 389 | .id = 0, | 
|  | 390 | }; | 
|  | 391 |  | 
|  | 392 |  | 
|  | 393 | static int __init init_tcic(void) | 
|  | 394 | { | 
|  | 395 | int i, sock, ret = 0; | 
|  | 396 | u_int mask, scan; | 
|  | 397 |  | 
| Ming Lei | 7a192ec | 2009-02-06 23:40:12 +0800 | [diff] [blame] | 398 | if (platform_driver_register(&tcic_driver)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 399 | return -1; | 
|  | 400 |  | 
|  | 401 | printk(KERN_INFO "Databook TCIC-2 PCMCIA probe: "); | 
|  | 402 | sock = 0; | 
|  | 403 |  | 
|  | 404 | if (!request_region(tcic_base, 16, "tcic-2")) { | 
|  | 405 | printk("could not allocate ports,\n "); | 
| Ming Lei | 7a192ec | 2009-02-06 23:40:12 +0800 | [diff] [blame] | 406 | platform_driver_unregister(&tcic_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 407 | return -ENODEV; | 
|  | 408 | } | 
|  | 409 | else { | 
|  | 410 | tcic_setw(TCIC_ADDR, 0); | 
|  | 411 | if (tcic_getw(TCIC_ADDR) == 0) { | 
|  | 412 | tcic_setw(TCIC_ADDR, 0xc3a5); | 
|  | 413 | if (tcic_getw(TCIC_ADDR) == 0xc3a5) sock = 2; | 
|  | 414 | } | 
|  | 415 | if (sock == 0) { | 
|  | 416 | /* See if resetting the controller does any good */ | 
|  | 417 | tcic_setb(TCIC_SCTRL, TCIC_SCTRL_RESET); | 
|  | 418 | tcic_setb(TCIC_SCTRL, 0); | 
|  | 419 | tcic_setw(TCIC_ADDR, 0); | 
|  | 420 | if (tcic_getw(TCIC_ADDR) == 0) { | 
|  | 421 | tcic_setw(TCIC_ADDR, 0xc3a5); | 
|  | 422 | if (tcic_getw(TCIC_ADDR) == 0xc3a5) sock = 2; | 
|  | 423 | } | 
|  | 424 | } | 
|  | 425 | } | 
|  | 426 | if (sock == 0) { | 
|  | 427 | printk("not found.\n"); | 
|  | 428 | release_region(tcic_base, 16); | 
| Ming Lei | 7a192ec | 2009-02-06 23:40:12 +0800 | [diff] [blame] | 429 | platform_driver_unregister(&tcic_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 430 | return -ENODEV; | 
|  | 431 | } | 
|  | 432 |  | 
|  | 433 | sockets = 0; | 
|  | 434 | for (i = 0; i < sock; i++) { | 
|  | 435 | if ((i == ignore) || is_active(i)) continue; | 
|  | 436 | socket_table[sockets].psock = i; | 
|  | 437 | socket_table[sockets].id = get_tcic_id(); | 
|  | 438 |  | 
|  | 439 | socket_table[sockets].socket.owner = THIS_MODULE; | 
|  | 440 | /* only 16-bit cards, memory windows must be size-aligned */ | 
|  | 441 | /* No PCI or CardBus support */ | 
|  | 442 | socket_table[sockets].socket.features = SS_CAP_PCCARD | SS_CAP_MEM_ALIGN; | 
|  | 443 | /* irq 14, 11, 10, 7, 6, 5, 4, 3 */ | 
|  | 444 | socket_table[sockets].socket.irq_mask = 0x4cf8; | 
|  | 445 | /* 4K minimum window size */ | 
|  | 446 | socket_table[sockets].socket.map_size = 0x1000; | 
|  | 447 | sockets++; | 
|  | 448 | } | 
|  | 449 |  | 
|  | 450 | switch (socket_table[0].id) { | 
|  | 451 | case TCIC_ID_DB86082: | 
|  | 452 | printk("DB86082"); break; | 
|  | 453 | case TCIC_ID_DB86082A: | 
|  | 454 | printk("DB86082A"); break; | 
|  | 455 | case TCIC_ID_DB86084: | 
|  | 456 | printk("DB86084"); break; | 
|  | 457 | case TCIC_ID_DB86084A: | 
|  | 458 | printk("DB86084A"); break; | 
|  | 459 | case TCIC_ID_DB86072: | 
|  | 460 | printk("DB86072"); break; | 
|  | 461 | case TCIC_ID_DB86184: | 
|  | 462 | printk("DB86184"); break; | 
|  | 463 | case TCIC_ID_DB86082B: | 
|  | 464 | printk("DB86082B"); break; | 
|  | 465 | default: | 
|  | 466 | printk("Unknown ID 0x%02x", socket_table[0].id); | 
|  | 467 | } | 
|  | 468 |  | 
|  | 469 | /* Set up polling */ | 
|  | 470 | poll_timer.function = &tcic_timer; | 
|  | 471 | poll_timer.data = 0; | 
|  | 472 | init_timer(&poll_timer); | 
|  | 473 |  | 
|  | 474 | /* Build interrupt mask */ | 
|  | 475 | printk(", %d sockets\n" KERN_INFO "  irq list (", sockets); | 
|  | 476 | if (irq_list_count == 0) | 
|  | 477 | mask = irq_mask; | 
|  | 478 | else | 
|  | 479 | for (i = mask = 0; i < irq_list_count; i++) | 
|  | 480 | mask |= (1<<irq_list[i]); | 
|  | 481 |  | 
|  | 482 | /* irq 14, 11, 10, 7, 6, 5, 4, 3 */ | 
|  | 483 | mask &= 0x4cf8; | 
|  | 484 | /* Scan interrupts */ | 
|  | 485 | mask = irq_scan(mask); | 
|  | 486 | for (i=0;i<sockets;i++) | 
|  | 487 | socket_table[i].socket.irq_mask = mask; | 
|  | 488 |  | 
|  | 489 | /* Check for only two interrupts available */ | 
|  | 490 | scan = (mask & (mask-1)); | 
|  | 491 | if (((scan & (scan-1)) == 0) && (poll_interval == 0)) | 
|  | 492 | poll_interval = HZ; | 
|  | 493 |  | 
|  | 494 | if (poll_interval == 0) { | 
|  | 495 | /* Avoid irq 12 unless it is explicitly requested */ | 
|  | 496 | u_int cs_mask = mask & ((cs_irq) ? (1<<cs_irq) : ~(1<<12)); | 
|  | 497 | for (i = 15; i > 0; i--) | 
|  | 498 | if ((cs_mask & (1 << i)) && | 
|  | 499 | (request_irq(i, tcic_interrupt, 0, "tcic", | 
|  | 500 | tcic_interrupt) == 0)) | 
|  | 501 | break; | 
|  | 502 | cs_irq = i; | 
|  | 503 | if (cs_irq == 0) poll_interval = HZ; | 
|  | 504 | } | 
|  | 505 |  | 
|  | 506 | if (socket_table[0].socket.irq_mask & (1 << 11)) | 
|  | 507 | printk("sktirq is irq 11, "); | 
|  | 508 | if (cs_irq != 0) | 
|  | 509 | printk("status change on irq %d\n", cs_irq); | 
|  | 510 | else | 
|  | 511 | printk("polled status, interval = %d ms\n", | 
|  | 512 | poll_interval * 1000 / HZ); | 
|  | 513 |  | 
|  | 514 | for (i = 0; i < sockets; i++) { | 
|  | 515 | tcic_setw(TCIC_ADDR+2, socket_table[i].psock << TCIC_SS_SHFT); | 
|  | 516 | socket_table[i].last_sstat = tcic_getb(TCIC_SSTAT); | 
|  | 517 | } | 
|  | 518 |  | 
|  | 519 | /* jump start interrupt handler, if needed */ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 520 | tcic_interrupt(0, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 521 |  | 
|  | 522 | platform_device_register(&tcic_device); | 
|  | 523 |  | 
|  | 524 | for (i = 0; i < sockets; i++) { | 
|  | 525 | socket_table[i].socket.ops = &tcic_operations; | 
|  | 526 | socket_table[i].socket.resource_ops = &pccard_nonstatic_ops; | 
| Greg Kroah-Hartman | 8737331 | 2006-09-12 17:00:10 +0200 | [diff] [blame] | 527 | socket_table[i].socket.dev.parent = &tcic_device.dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 528 | ret = pcmcia_register_socket(&socket_table[i].socket); | 
|  | 529 | if (ret && i) | 
|  | 530 | pcmcia_unregister_socket(&socket_table[0].socket); | 
|  | 531 | } | 
|  | 532 |  | 
|  | 533 | return ret; | 
|  | 534 |  | 
|  | 535 | return 0; | 
|  | 536 |  | 
|  | 537 | } /* init_tcic */ | 
|  | 538 |  | 
|  | 539 | /*====================================================================*/ | 
|  | 540 |  | 
|  | 541 | static void __exit exit_tcic(void) | 
|  | 542 | { | 
|  | 543 | int i; | 
|  | 544 |  | 
|  | 545 | del_timer_sync(&poll_timer); | 
|  | 546 | if (cs_irq != 0) { | 
|  | 547 | tcic_aux_setw(TCIC_AUX_SYSCFG, TCIC_SYSCFG_AUTOBUSY|0x0a00); | 
|  | 548 | free_irq(cs_irq, tcic_interrupt); | 
|  | 549 | } | 
|  | 550 | release_region(tcic_base, 16); | 
|  | 551 |  | 
|  | 552 | for (i = 0; i < sockets; i++) { | 
|  | 553 | pcmcia_unregister_socket(&socket_table[i].socket); | 
|  | 554 | } | 
|  | 555 |  | 
|  | 556 | platform_device_unregister(&tcic_device); | 
| Ming Lei | 7a192ec | 2009-02-06 23:40:12 +0800 | [diff] [blame] | 557 | platform_driver_unregister(&tcic_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | } /* exit_tcic */ | 
|  | 559 |  | 
|  | 560 | /*====================================================================*/ | 
|  | 561 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 562 | static irqreturn_t tcic_interrupt(int irq, void *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | { | 
|  | 564 | int i, quick = 0; | 
|  | 565 | u_char latch, sstat; | 
|  | 566 | u_short psock; | 
|  | 567 | u_int events; | 
|  | 568 | static volatile int active = 0; | 
|  | 569 |  | 
|  | 570 | if (active) { | 
|  | 571 | printk(KERN_NOTICE "tcic: reentered interrupt handler!\n"); | 
|  | 572 | return IRQ_NONE; | 
|  | 573 | } else | 
|  | 574 | active = 1; | 
|  | 575 |  | 
|  | 576 | debug(2, "tcic_interrupt()\n"); | 
|  | 577 |  | 
|  | 578 | for (i = 0; i < sockets; i++) { | 
|  | 579 | psock = socket_table[i].psock; | 
|  | 580 | tcic_setl(TCIC_ADDR, (psock << TCIC_ADDR_SS_SHFT) | 
|  | 581 | | TCIC_ADDR_INDREG | TCIC_SCF1(psock)); | 
|  | 582 | sstat = tcic_getb(TCIC_SSTAT); | 
|  | 583 | latch = sstat ^ socket_table[psock].last_sstat; | 
|  | 584 | socket_table[i].last_sstat = sstat; | 
|  | 585 | if (tcic_getb(TCIC_ICSR) & TCIC_ICSR_CDCHG) { | 
|  | 586 | tcic_setb(TCIC_ICSR, TCIC_ICSR_CLEAR); | 
|  | 587 | quick = 1; | 
|  | 588 | } | 
|  | 589 | if (latch == 0) | 
|  | 590 | continue; | 
|  | 591 | events = (latch & TCIC_SSTAT_CD) ? SS_DETECT : 0; | 
|  | 592 | events |= (latch & TCIC_SSTAT_WP) ? SS_WRPROT : 0; | 
|  | 593 | if (tcic_getw(TCIC_DATA) & TCIC_SCF1_IOSTS) { | 
|  | 594 | events |= (latch & TCIC_SSTAT_LBAT1) ? SS_STSCHG : 0; | 
|  | 595 | } else { | 
|  | 596 | events |= (latch & TCIC_SSTAT_RDY) ? SS_READY : 0; | 
|  | 597 | events |= (latch & TCIC_SSTAT_LBAT1) ? SS_BATDEAD : 0; | 
|  | 598 | events |= (latch & TCIC_SSTAT_LBAT2) ? SS_BATWARN : 0; | 
|  | 599 | } | 
|  | 600 | if (events) { | 
|  | 601 | pcmcia_parse_events(&socket_table[i].socket, events); | 
|  | 602 | } | 
|  | 603 | } | 
|  | 604 |  | 
|  | 605 | /* Schedule next poll, if needed */ | 
|  | 606 | if (((cs_irq == 0) || quick) && (!tcic_timer_pending)) { | 
|  | 607 | poll_timer.expires = jiffies + (quick ? poll_quick : poll_interval); | 
|  | 608 | add_timer(&poll_timer); | 
|  | 609 | tcic_timer_pending = 1; | 
|  | 610 | } | 
|  | 611 | active = 0; | 
|  | 612 |  | 
|  | 613 | debug(2, "interrupt done\n"); | 
|  | 614 | return IRQ_HANDLED; | 
|  | 615 | } /* tcic_interrupt */ | 
|  | 616 |  | 
|  | 617 | static void tcic_timer(u_long data) | 
|  | 618 | { | 
|  | 619 | debug(2, "tcic_timer()\n"); | 
|  | 620 | tcic_timer_pending = 0; | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 621 | tcic_interrupt(0, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 622 | } /* tcic_timer */ | 
|  | 623 |  | 
|  | 624 | /*====================================================================*/ | 
|  | 625 |  | 
|  | 626 | static int tcic_get_status(struct pcmcia_socket *sock, u_int *value) | 
|  | 627 | { | 
|  | 628 | u_short psock = container_of(sock, struct tcic_socket, socket)->psock; | 
|  | 629 | u_char reg; | 
|  | 630 |  | 
|  | 631 | tcic_setl(TCIC_ADDR, (psock << TCIC_ADDR_SS_SHFT) | 
|  | 632 | | TCIC_ADDR_INDREG | TCIC_SCF1(psock)); | 
|  | 633 | reg = tcic_getb(TCIC_SSTAT); | 
|  | 634 | *value  = (reg & TCIC_SSTAT_CD) ? SS_DETECT : 0; | 
|  | 635 | *value |= (reg & TCIC_SSTAT_WP) ? SS_WRPROT : 0; | 
|  | 636 | if (tcic_getw(TCIC_DATA) & TCIC_SCF1_IOSTS) { | 
|  | 637 | *value |= (reg & TCIC_SSTAT_LBAT1) ? SS_STSCHG : 0; | 
|  | 638 | } else { | 
|  | 639 | *value |= (reg & TCIC_SSTAT_RDY) ? SS_READY : 0; | 
|  | 640 | *value |= (reg & TCIC_SSTAT_LBAT1) ? SS_BATDEAD : 0; | 
|  | 641 | *value |= (reg & TCIC_SSTAT_LBAT2) ? SS_BATWARN : 0; | 
|  | 642 | } | 
|  | 643 | reg = tcic_getb(TCIC_PWR); | 
|  | 644 | if (reg & (TCIC_PWR_VCC(psock)|TCIC_PWR_VPP(psock))) | 
|  | 645 | *value |= SS_POWERON; | 
|  | 646 | debug(1, "GetStatus(%d) = %#2.2x\n", psock, *value); | 
|  | 647 | return 0; | 
|  | 648 | } /* tcic_get_status */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 |  | 
|  | 650 | /*====================================================================*/ | 
|  | 651 |  | 
|  | 652 | static int tcic_set_socket(struct pcmcia_socket *sock, socket_state_t *state) | 
|  | 653 | { | 
|  | 654 | u_short psock = container_of(sock, struct tcic_socket, socket)->psock; | 
|  | 655 | u_char reg; | 
|  | 656 | u_short scf1, scf2; | 
|  | 657 |  | 
|  | 658 | debug(1, "SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, " | 
|  | 659 | "io_irq %d, csc_mask %#2.2x)\n", psock, state->flags, | 
|  | 660 | state->Vcc, state->Vpp, state->io_irq, state->csc_mask); | 
|  | 661 | tcic_setw(TCIC_ADDR+2, (psock << TCIC_SS_SHFT) | TCIC_ADR2_INDREG); | 
|  | 662 |  | 
|  | 663 | reg = tcic_getb(TCIC_PWR); | 
|  | 664 | reg &= ~(TCIC_PWR_VCC(psock) | TCIC_PWR_VPP(psock)); | 
|  | 665 |  | 
|  | 666 | if (state->Vcc == 50) { | 
|  | 667 | switch (state->Vpp) { | 
|  | 668 | case 0:   reg |= TCIC_PWR_VCC(psock) | TCIC_PWR_VPP(psock); break; | 
|  | 669 | case 50:  reg |= TCIC_PWR_VCC(psock); break; | 
|  | 670 | case 120: reg |= TCIC_PWR_VPP(psock); break; | 
|  | 671 | default:  return -EINVAL; | 
|  | 672 | } | 
|  | 673 | } else if (state->Vcc != 0) | 
|  | 674 | return -EINVAL; | 
|  | 675 |  | 
|  | 676 | if (reg != tcic_getb(TCIC_PWR)) | 
|  | 677 | tcic_setb(TCIC_PWR, reg); | 
|  | 678 |  | 
|  | 679 | reg = TCIC_ILOCK_HOLD_CCLK | TCIC_ILOCK_CWAIT; | 
|  | 680 | if (state->flags & SS_OUTPUT_ENA) { | 
|  | 681 | tcic_setb(TCIC_SCTRL, TCIC_SCTRL_ENA); | 
|  | 682 | reg |= TCIC_ILOCK_CRESENA; | 
|  | 683 | } else | 
|  | 684 | tcic_setb(TCIC_SCTRL, 0); | 
|  | 685 | if (state->flags & SS_RESET) | 
|  | 686 | reg |= TCIC_ILOCK_CRESET; | 
|  | 687 | tcic_aux_setb(TCIC_AUX_ILOCK, reg); | 
|  | 688 |  | 
|  | 689 | tcic_setw(TCIC_ADDR, TCIC_SCF1(psock)); | 
|  | 690 | scf1 = TCIC_SCF1_FINPACK; | 
|  | 691 | scf1 |= TCIC_IRQ(state->io_irq); | 
|  | 692 | if (state->flags & SS_IOCARD) { | 
|  | 693 | scf1 |= TCIC_SCF1_IOSTS; | 
|  | 694 | if (state->flags & SS_SPKR_ENA) | 
|  | 695 | scf1 |= TCIC_SCF1_SPKR; | 
|  | 696 | if (state->flags & SS_DMA_MODE) | 
|  | 697 | scf1 |= TCIC_SCF1_DREQ2 << TCIC_SCF1_DMA_SHIFT; | 
|  | 698 | } | 
|  | 699 | tcic_setw(TCIC_DATA, scf1); | 
|  | 700 |  | 
|  | 701 | /* Some general setup stuff, and configure status interrupt */ | 
|  | 702 | reg = TCIC_WAIT_ASYNC | TCIC_WAIT_SENSE | to_cycles(250); | 
|  | 703 | tcic_aux_setb(TCIC_AUX_WCTL, reg); | 
|  | 704 | tcic_aux_setw(TCIC_AUX_SYSCFG, TCIC_SYSCFG_AUTOBUSY|0x0a00| | 
|  | 705 | TCIC_IRQ(cs_irq)); | 
|  | 706 |  | 
|  | 707 | /* Card status change interrupt mask */ | 
|  | 708 | tcic_setw(TCIC_ADDR, TCIC_SCF2(psock)); | 
|  | 709 | scf2 = TCIC_SCF2_MALL; | 
|  | 710 | if (state->csc_mask & SS_DETECT) scf2 &= ~TCIC_SCF2_MCD; | 
|  | 711 | if (state->flags & SS_IOCARD) { | 
|  | 712 | if (state->csc_mask & SS_STSCHG) reg &= ~TCIC_SCF2_MLBAT1; | 
|  | 713 | } else { | 
|  | 714 | if (state->csc_mask & SS_BATDEAD) reg &= ~TCIC_SCF2_MLBAT1; | 
|  | 715 | if (state->csc_mask & SS_BATWARN) reg &= ~TCIC_SCF2_MLBAT2; | 
|  | 716 | if (state->csc_mask & SS_READY) reg &= ~TCIC_SCF2_MRDY; | 
|  | 717 | } | 
|  | 718 | tcic_setw(TCIC_DATA, scf2); | 
|  | 719 | /* For the ISA bus, the irq should be active-high totem-pole */ | 
|  | 720 | tcic_setb(TCIC_IENA, TCIC_IENA_CDCHG | TCIC_IENA_CFG_HIGH); | 
|  | 721 |  | 
|  | 722 | return 0; | 
|  | 723 | } /* tcic_set_socket */ | 
|  | 724 |  | 
|  | 725 | /*====================================================================*/ | 
|  | 726 |  | 
|  | 727 | static int tcic_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io) | 
|  | 728 | { | 
|  | 729 | u_short psock = container_of(sock, struct tcic_socket, socket)->psock; | 
|  | 730 | u_int addr; | 
|  | 731 | u_short base, len, ioctl; | 
|  | 732 |  | 
|  | 733 | debug(1, "SetIOMap(%d, %d, %#2.2x, %d ns, " | 
| Olof Johansson | 906da80 | 2008-02-04 22:27:35 -0800 | [diff] [blame] | 734 | "%#x-%#x)\n", psock, io->map, io->flags, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 735 | io->speed, io->start, io->stop); | 
|  | 736 | if ((io->map > 1) || (io->start > 0xffff) || (io->stop > 0xffff) || | 
|  | 737 | (io->stop < io->start)) return -EINVAL; | 
|  | 738 | tcic_setw(TCIC_ADDR+2, TCIC_ADR2_INDREG | (psock << TCIC_SS_SHFT)); | 
|  | 739 | addr = TCIC_IWIN(psock, io->map); | 
|  | 740 |  | 
|  | 741 | base = io->start; len = io->stop - io->start; | 
|  | 742 | /* Check to see that len+1 is power of two, etc */ | 
|  | 743 | if ((len & (len+1)) || (base & len)) return -EINVAL; | 
|  | 744 | base |= (len+1)>>1; | 
|  | 745 | tcic_setw(TCIC_ADDR, addr + TCIC_IBASE_X); | 
|  | 746 | tcic_setw(TCIC_DATA, base); | 
|  | 747 |  | 
|  | 748 | ioctl  = (psock << TCIC_ICTL_SS_SHFT); | 
|  | 749 | ioctl |= (len == 0) ? TCIC_ICTL_TINY : 0; | 
|  | 750 | ioctl |= (io->flags & MAP_ACTIVE) ? TCIC_ICTL_ENA : 0; | 
|  | 751 | ioctl |= to_cycles(io->speed) & TCIC_ICTL_WSCNT_MASK; | 
|  | 752 | if (!(io->flags & MAP_AUTOSZ)) { | 
|  | 753 | ioctl |= TCIC_ICTL_QUIET; | 
|  | 754 | ioctl |= (io->flags & MAP_16BIT) ? TCIC_ICTL_BW_16 : TCIC_ICTL_BW_8; | 
|  | 755 | } | 
|  | 756 | tcic_setw(TCIC_ADDR, addr + TCIC_ICTL_X); | 
|  | 757 | tcic_setw(TCIC_DATA, ioctl); | 
|  | 758 |  | 
|  | 759 | return 0; | 
|  | 760 | } /* tcic_set_io_map */ | 
|  | 761 |  | 
|  | 762 | /*====================================================================*/ | 
|  | 763 |  | 
|  | 764 | static int tcic_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *mem) | 
|  | 765 | { | 
|  | 766 | u_short psock = container_of(sock, struct tcic_socket, socket)->psock; | 
|  | 767 | u_short addr, ctl; | 
|  | 768 | u_long base, len, mmap; | 
|  | 769 |  | 
|  | 770 | debug(1, "SetMemMap(%d, %d, %#2.2x, %d ns, " | 
| Greg Kroah-Hartman | 490ab72 | 2006-06-12 15:17:34 -0700 | [diff] [blame] | 771 | "%#llx-%#llx, %#x)\n", psock, mem->map, mem->flags, | 
|  | 772 | mem->speed, (unsigned long long)mem->res->start, | 
|  | 773 | (unsigned long long)mem->res->end, mem->card_start); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 774 | if ((mem->map > 3) || (mem->card_start > 0x3ffffff) || | 
|  | 775 | (mem->res->start > 0xffffff) || (mem->res->end > 0xffffff) || | 
|  | 776 | (mem->res->start > mem->res->end) || (mem->speed > 1000)) | 
|  | 777 | return -EINVAL; | 
|  | 778 | tcic_setw(TCIC_ADDR+2, TCIC_ADR2_INDREG | (psock << TCIC_SS_SHFT)); | 
|  | 779 | addr = TCIC_MWIN(psock, mem->map); | 
|  | 780 |  | 
|  | 781 | base = mem->res->start; len = mem->res->end - mem->res->start; | 
|  | 782 | if ((len & (len+1)) || (base & len)) return -EINVAL; | 
|  | 783 | if (len == 0x0fff) | 
|  | 784 | base = (base >> TCIC_MBASE_HA_SHFT) | TCIC_MBASE_4K_BIT; | 
|  | 785 | else | 
|  | 786 | base = (base | (len+1)>>1) >> TCIC_MBASE_HA_SHFT; | 
|  | 787 | tcic_setw(TCIC_ADDR, addr + TCIC_MBASE_X); | 
|  | 788 | tcic_setw(TCIC_DATA, base); | 
|  | 789 |  | 
|  | 790 | mmap = mem->card_start - mem->res->start; | 
|  | 791 | mmap = (mmap >> TCIC_MMAP_CA_SHFT) & TCIC_MMAP_CA_MASK; | 
|  | 792 | if (mem->flags & MAP_ATTRIB) mmap |= TCIC_MMAP_REG; | 
|  | 793 | tcic_setw(TCIC_ADDR, addr + TCIC_MMAP_X); | 
|  | 794 | tcic_setw(TCIC_DATA, mmap); | 
|  | 795 |  | 
|  | 796 | ctl  = TCIC_MCTL_QUIET | (psock << TCIC_MCTL_SS_SHFT); | 
|  | 797 | ctl |= to_cycles(mem->speed) & TCIC_MCTL_WSCNT_MASK; | 
|  | 798 | ctl |= (mem->flags & MAP_16BIT) ? 0 : TCIC_MCTL_B8; | 
|  | 799 | ctl |= (mem->flags & MAP_WRPROT) ? TCIC_MCTL_WP : 0; | 
|  | 800 | ctl |= (mem->flags & MAP_ACTIVE) ? TCIC_MCTL_ENA : 0; | 
|  | 801 | tcic_setw(TCIC_ADDR, addr + TCIC_MCTL_X); | 
|  | 802 | tcic_setw(TCIC_DATA, ctl); | 
|  | 803 |  | 
|  | 804 | return 0; | 
|  | 805 | } /* tcic_set_mem_map */ | 
|  | 806 |  | 
|  | 807 | /*====================================================================*/ | 
|  | 808 |  | 
|  | 809 | static int tcic_init(struct pcmcia_socket *s) | 
|  | 810 | { | 
|  | 811 | int i; | 
|  | 812 | struct resource res = { .start = 0, .end = 0x1000 }; | 
|  | 813 | pccard_io_map io = { 0, 0, 0, 0, 1 }; | 
|  | 814 | pccard_mem_map mem = { .res = &res, }; | 
|  | 815 |  | 
|  | 816 | for (i = 0; i < 2; i++) { | 
|  | 817 | io.map = i; | 
|  | 818 | tcic_set_io_map(s, &io); | 
|  | 819 | } | 
|  | 820 | for (i = 0; i < 5; i++) { | 
|  | 821 | mem.map = i; | 
|  | 822 | tcic_set_mem_map(s, &mem); | 
|  | 823 | } | 
|  | 824 | return 0; | 
|  | 825 | } | 
|  | 826 |  | 
|  | 827 | static struct pccard_operations tcic_operations = { | 
|  | 828 | .init		   = tcic_init, | 
|  | 829 | .get_status	   = tcic_get_status, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 830 | .set_socket	   = tcic_set_socket, | 
|  | 831 | .set_io_map	   = tcic_set_io_map, | 
|  | 832 | .set_mem_map	   = tcic_set_mem_map, | 
|  | 833 | }; | 
|  | 834 |  | 
|  | 835 | /*====================================================================*/ | 
|  | 836 |  | 
|  | 837 | module_init(init_tcic); | 
|  | 838 | module_exit(exit_tcic); |