Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
  3  *
  4  * (C) 1999-2000 Magnus Damm <damm@opensource.se>
  5  * (C) 2001-2002 Montavista Software, Inc.
  6  *     <mlocke@mvista.com>
  7  *
  8  * Support for two slots by Cyclades Corporation
  9  *     <oliver.kurth@cyclades.de>
 10  * Further fixes, v2.6 kernel port
 11  *     <marcelo.tosatti@cyclades.com>
 12  * 
 13  * Some fixes, additions (C) 2005-2007 Montavista Software, Inc.
 14  *     <vbordug@ru.mvista.com>
 15  *
 16  * "The ExCA standard specifies that socket controllers should provide
 17  * two IO and five memory windows per socket, which can be independently
 18  * configured and positioned in the host address space and mapped to
 19  * arbitrary segments of card address space. " - David A Hinds. 1999
 20  *
 21  * This controller does _not_ meet the ExCA standard.
 22  *
 23  * m8xx pcmcia controller brief info:
 24  * + 8 windows (attrib, mem, i/o)
 25  * + up to two slots (SLOT_A and SLOT_B)
 26  * + inputpins, outputpins, event and mask registers.
 27  * - no offset register. sigh.
 28  *
 29  * Because of the lacking offset register we must map the whole card.
 30  * We assign each memory window PCMCIA_MEM_WIN_SIZE address space.
 31  * Make sure there is (PCMCIA_MEM_WIN_SIZE * PCMCIA_MEM_WIN_NO
 32  * * PCMCIA_SOCKETS_NO) bytes at PCMCIA_MEM_WIN_BASE.
 33  * The i/o windows are dynamically allocated at PCMCIA_IO_WIN_BASE.
 34  * They are maximum 64KByte each...
 35  */
 36 
 37 #include <linux/module.h>
 38 #include <linux/init.h>
 39 #include <linux/types.h>
 40 #include <linux/fcntl.h>
 41 #include <linux/string.h>
 42 
 43 #include <linux/kernel.h>
 44 #include <linux/errno.h>
 45 #include <linux/slab.h>
 46 #include <linux/timer.h>
 47 #include <linux/ioport.h>
 48 #include <linux/delay.h>
 49 #include <linux/interrupt.h>
 50 #include <linux/fsl_devices.h>
 51 #include <linux/bitops.h>
 52 #include <linux/of_device.h>
 53 #include <linux/of_platform.h>
 54 
 55 #include <asm/io.h>
 56 #include <asm/system.h>
 57 #include <asm/time.h>
 58 #include <asm/mpc8xx.h>
 59 #include <asm/8xx_immap.h>
 60 #include <asm/irq.h>
 61 #include <asm/fs_pd.h>
 62 
 63 #include <pcmcia/cs_types.h>
 64 #include <pcmcia/cs.h>
 65 #include <pcmcia/ss.h>
 66 
 67 #ifdef CONFIG_PCMCIA_DEBUG
 68 static int pc_debug;
 69 module_param(pc_debug, int, 0);
 70 #define dprintk(args...) printk(KERN_DEBUG "m8xx_pcmcia: " args);
 71 #else
 72 #define dprintk(args...)
 73 #endif
 74 
 75 #define pcmcia_info(args...) printk(KERN_INFO "m8xx_pcmcia: "args)
 76 #define pcmcia_error(args...) printk(KERN_ERR "m8xx_pcmcia: "args)
 77 
 78 static const char *version = "Version 0.06, Aug 2005";
 79 MODULE_LICENSE("Dual MPL/GPL");
 80 
 81 #if !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B)
 82 
 83 /* The RPX series use SLOT_B */
 84 #if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
 85 #define CONFIG_PCMCIA_SLOT_B
 86 #define CONFIG_BD_IS_MHZ
 87 #endif
 88 
 89 /* The ADS board use SLOT_A */
 90 #ifdef CONFIG_ADS
 91 #define CONFIG_PCMCIA_SLOT_A
 92 #define CONFIG_BD_IS_MHZ
 93 #endif
 94 
 95 /* The FADS series are a mess */
 96 #ifdef CONFIG_FADS
 97 #if defined(CONFIG_MPC860T) || defined(CONFIG_MPC860) || defined(CONFIG_MPC821)
 98 #define CONFIG_PCMCIA_SLOT_A
 99 #else
100 #define CONFIG_PCMCIA_SLOT_B
101 #endif
102 #endif
103 
104 #if defined(CONFIG_MPC885ADS)
105 #define CONFIG_PCMCIA_SLOT_A
106 #define PCMCIA_GLITCHY_CD
107 #endif
108 
109 /* Cyclades ACS uses both slots */
110 #ifdef CONFIG_PRxK
111 #define CONFIG_PCMCIA_SLOT_A
112 #define CONFIG_PCMCIA_SLOT_B
113 #endif
114 
115 #endif                          /* !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B) */
116 
117 #if defined(CONFIG_PCMCIA_SLOT_A) && defined(CONFIG_PCMCIA_SLOT_B)
118 
119 #define PCMCIA_SOCKETS_NO 2
120 /* We have only 8 windows, dualsocket support will be limited. */
121 #define PCMCIA_MEM_WIN_NO 2
122 #define PCMCIA_IO_WIN_NO  2
123 #define PCMCIA_SLOT_MSG "SLOT_A and SLOT_B"
124 
125 #elif defined(CONFIG_PCMCIA_SLOT_A) || defined(CONFIG_PCMCIA_SLOT_B)
126 
127 #define PCMCIA_SOCKETS_NO 1
128 /* full support for one slot */
129 #define PCMCIA_MEM_WIN_NO 5
130 #define PCMCIA_IO_WIN_NO  2
131 
132 /* define _slot_ to be able to optimize macros */
133 
134 #ifdef CONFIG_PCMCIA_SLOT_A
135 #define _slot_ 0
136 #define PCMCIA_SLOT_MSG "SLOT_A"
137 #else
138 #define _slot_ 1
139 #define PCMCIA_SLOT_MSG "SLOT_B"
140 #endif
141 
142 #else
143 #error m8xx_pcmcia: Bad configuration!
144 #endif
145 
146 /* ------------------------------------------------------------------------- */
147 
148 #define PCMCIA_MEM_WIN_BASE 0xe0000000  /* base address for memory window 0   */
149 #define PCMCIA_MEM_WIN_SIZE 0x04000000  /* each memory window is 64 MByte     */
150 #define PCMCIA_IO_WIN_BASE  _IO_BASE    /* base address for io window 0       */
151 /* ------------------------------------------------------------------------- */
152 
153 static int pcmcia_schlvl;
154 
155 static DEFINE_SPINLOCK(events_lock);
156 
157 #define PCMCIA_SOCKET_KEY_5V 1
158 #define PCMCIA_SOCKET_KEY_LV 2
159 
160 /* look up table for pgcrx registers */
161 static u32 *m8xx_pgcrx[2];
162 
163 /*
164  * This structure is used to address each window in the PCMCIA controller.
165  *
166  * Keep in mind that we assume that pcmcia_win[n+1] is mapped directly
167  * after pcmcia_win[n]...
168  */
169 
170 struct pcmcia_win {
171         u32 br;
172         u32 or;
173 };
174 
175 /*
176  * For some reason the hardware guys decided to make both slots share
177  * some registers.
178  *
179  * Could someone invent object oriented hardware ?
180  *
181  * The macros are used to get the right bit from the registers.
182  * SLOT_A : slot = 0
183  * SLOT_B : slot = 1
184  */
185 
186 #define M8XX_PCMCIA_VS1(slot)      (0x80000000 >> (slot << 4))
187 #define M8XX_PCMCIA_VS2(slot)      (0x40000000 >> (slot << 4))
188 #define M8XX_PCMCIA_VS_MASK(slot)  (0xc0000000 >> (slot << 4))
189 #define M8XX_PCMCIA_VS_SHIFT(slot) (30 - (slot << 4))
190 
191 #define M8XX_PCMCIA_WP(slot)       (0x20000000 >> (slot << 4))
192 #define M8XX_PCMCIA_CD2(slot)      (0x10000000 >> (slot << 4))
193 #define M8XX_PCMCIA_CD1(slot)      (0x08000000 >> (slot << 4))
194 #define M8XX_PCMCIA_BVD2(slot)     (0x04000000 >> (slot << 4))
195 #define M8XX_PCMCIA_BVD1(slot)     (0x02000000 >> (slot << 4))
196 #define M8XX_PCMCIA_RDY(slot)      (0x01000000 >> (slot << 4))
197 #define M8XX_PCMCIA_RDY_L(slot)    (0x00800000 >> (slot << 4))
198 #define M8XX_PCMCIA_RDY_H(slot)    (0x00400000 >> (slot << 4))
199 #define M8XX_PCMCIA_RDY_R(slot)    (0x00200000 >> (slot << 4))
200 #define M8XX_PCMCIA_RDY_F(slot)    (0x00100000 >> (slot << 4))
201 #define M8XX_PCMCIA_MASK(slot)     (0xFFFF0000 >> (slot << 4))
202 
203 #define M8XX_PCMCIA_POR_VALID    0x00000001
204 #define M8XX_PCMCIA_POR_WRPROT   0x00000002
205 #define M8XX_PCMCIA_POR_ATTRMEM  0x00000010
206 #define M8XX_PCMCIA_POR_IO       0x00000018
207 #define M8XX_PCMCIA_POR_16BIT    0x00000040
208 
209 #define M8XX_PGCRX(slot)  m8xx_pgcrx[slot]
210 
211 #define M8XX_PGCRX_CXOE    0x00000080
212 #define M8XX_PGCRX_CXRESET 0x00000040
213 
214 /* we keep one lookup table per socket to check flags */
215 
216 #define PCMCIA_EVENTS_MAX 5     /* 4 max at a time + termination */
217 
218 struct event_table {
219         u32 regbit;
220         u32 eventbit;
221 };
222 
223 static const char driver_name[] = "m8xx-pcmcia";
224 
225 struct socket_info {
226         void (*handler) (void *info, u32 events);
227         void *info;
228 
229         u32 slot;
230         pcmconf8xx_t *pcmcia;
231         u32 bus_freq;
232         int hwirq;
233 
234         socket_state_t state;
235         struct pccard_mem_map mem_win[PCMCIA_MEM_WIN_NO];
236         struct pccard_io_map io_win[PCMCIA_IO_WIN_NO];
237         struct event_table events[PCMCIA_EVENTS_MAX];
238         struct pcmcia_socket socket;
239 };
240 
241 static struct socket_info socket[PCMCIA_SOCKETS_NO];
242 
243 /*
244  * Search this table to see if the windowsize is
245  * supported...
246  */
247 
248 #define M8XX_SIZES_NO 32
249 
250 static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] = {
251         0x00000001, 0x00000002, 0x00000008, 0x00000004,
252         0x00000080, 0x00000040, 0x00000010, 0x00000020,
253         0x00008000, 0x00004000, 0x00001000, 0x00002000,
254         0x00000100, 0x00000200, 0x00000800, 0x00000400,
255 
256         0x0fffffff, 0xffffffff, 0xffffffff, 0xffffffff,
257         0x01000000, 0x02000000, 0xffffffff, 0x04000000,
258         0x00010000, 0x00020000, 0x00080000, 0x00040000,
259         0x00800000, 0x00400000, 0x00100000, 0x00200000
260 };
261 
262 /* ------------------------------------------------------------------------- */
263 
264 static irqreturn_t m8xx_interrupt(int irq, void *dev);
265 
266 #define PCMCIA_BMT_LIMIT (15*4) /* Bus Monitor Timeout value */
267 
268 /* ------------------------------------------------------------------------- */
269 /* board specific stuff:                                                     */
270 /* voltage_set(), hardware_enable() and hardware_disable()                   */
271 /* ------------------------------------------------------------------------- */
272 /* RPX Boards from Embedded Planet                                           */
273 
274 #if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
275 
276 /* The RPX boards seems to have it's bus monitor timeout set to 6*8 clocks.
277  * SYPCR is write once only, therefore must the slowest memory be faster
278  * than the bus monitor or we will get a machine check due to the bus timeout.
279  */
280 
281 #define PCMCIA_BOARD_MSG "RPX CLASSIC or RPX LITE"
282 
283 #undef PCMCIA_BMT_LIMIT
284 #define PCMCIA_BMT_LIMIT (6*8)
285 
286 static int voltage_set(int slot, int vcc, int vpp)
287 {
288         u32 reg = 0;
289 
290         switch (vcc) {
291         case 0:
292                 break;
293         case 33:
294                 reg |= BCSR1_PCVCTL4;
295                 break;
296         case 50:
297                 reg |= BCSR1_PCVCTL5;
298                 break;
299         default:
300                 return 1;
301         }
302 
303         switch (vpp) {
304         case 0:
305                 break;
306         case 33:
307         case 50:
308                 if (vcc == vpp)
309                         reg |= BCSR1_PCVCTL6;
310                 else
311                         return 1;
312                 break;
313         case 120:
314                 reg |= BCSR1_PCVCTL7;
315         default:
316                 return 1;
317         }
318 
319         if (!((vcc == 50) || (vcc == 0)))
320                 return 1;
321 
322         /* first, turn off all power */
323 
324         out_be32(((u32 *) RPX_CSR_ADDR),
325                  in_be32(((u32 *) RPX_CSR_ADDR)) & ~(BCSR1_PCVCTL4 |
326                                                      BCSR1_PCVCTL5 |
327                                                      BCSR1_PCVCTL6 |
328                                                      BCSR1_PCVCTL7));
329 
330         /* enable new powersettings */
331 
332         out_be32(((u32 *) RPX_CSR_ADDR), in_be32(((u32 *) RPX_CSR_ADDR)) | reg);
333 
334         return 0;
335 }
336 
337 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
338 #define hardware_enable(_slot_) /* No hardware to enable */
339 #define hardware_disable(_slot_)        /* No hardware to disable */
340 
341 #endif                          /* CONFIG_RPXCLASSIC */
342 
343 /* FADS Boards from Motorola                                               */
344 
345 #if defined(CONFIG_FADS)
346 
347 #define PCMCIA_BOARD_MSG "FADS"
348 
349 static int voltage_set(int slot, int vcc, int vpp)
350 {
351         u32 reg = 0;
352 
353         switch (vcc) {
354         case 0:
355                 break;
356         case 33:
357                 reg |= BCSR1_PCCVCC0;
358                 break;
359         case 50:
360                 reg |= BCSR1_PCCVCC1;
361                 break;
362         default:
363                 return 1;
364         }
365 
366         switch (vpp) {
367         case 0:
368                 break;
369         case 33:
370         case 50:
371                 if (vcc == vpp)
372                         reg |= BCSR1_PCCVPP1;
373                 else
374                         return 1;
375                 break;
376         case 120:
377                 if ((vcc == 33) || (vcc == 50))
378                         reg |= BCSR1_PCCVPP0;
379                 else
380                         return 1;
381         default:
382                 return 1;
383         }
384 
385         /* first, turn off all power */
386         out_be32((u32 *) BCSR1,
387                  in_be32((u32 *) BCSR1) & ~(BCSR1_PCCVCC_MASK |
388                                             BCSR1_PCCVPP_MASK));
389 
390         /* enable new powersettings */
391         out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | reg);
392 
393         return 0;
394 }
395 
396 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
397 
398 static void hardware_enable(int slot)
399 {
400         out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) & ~BCSR1_PCCEN);
401 }
402 
403 static void hardware_disable(int slot)
404 {
405         out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | BCSR1_PCCEN);
406 }
407 
408 #endif
409 
410 /* MPC885ADS Boards */
411 
412 #if defined(CONFIG_MPC885ADS)
413 
414 #define PCMCIA_BOARD_MSG "MPC885ADS"
415 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
416 
417 static inline void hardware_enable(int slot)
418 {
419         m8xx_pcmcia_ops.hw_ctrl(slot, 1);
420 }
421 
422 static inline void hardware_disable(int slot)
423 {
424         m8xx_pcmcia_ops.hw_ctrl(slot, 0);
425 }
426 
427 static inline int voltage_set(int slot, int vcc, int vpp)
428 {
429         return m8xx_pcmcia_ops.voltage_set(slot, vcc, vpp);
430 }
431 
432 #endif
433 
434 /* ------------------------------------------------------------------------- */
435 /* Motorola MBX860                                                           */
436 
437 #if defined(CONFIG_MBX)
438 
439 #define PCMCIA_BOARD_MSG "MBX"
440 
441 static int voltage_set(int slot, int vcc, int vpp)
442 {
443         u8 reg = 0;
444 
445         switch (vcc) {
446         case 0:
447                 break;
448         case 33:
449                 reg |= CSR2_VCC_33;
450                 break;
451         case 50:
452                 reg |= CSR2_VCC_50;
453                 break;
454         default:
455                 return 1;
456         }
457 
458         switch (vpp) {
459         case 0:
460                 break;
461         case 33:
462         case 50:
463                 if (vcc == vpp)
464                         reg |= CSR2_VPP_VCC;
465                 else
466                         return 1;
467                 break;
468         case 120:
469                 if ((vcc == 33) || (vcc == 50))
470                         reg |= CSR2_VPP_12;
471                 else
472                         return 1;
473         default:
474                 return 1;
475         }
476 
477         /* first, turn off all power */
478         out_8((u8 *) MBX_CSR2_ADDR,
479               in_8((u8 *) MBX_CSR2_ADDR) & ~(CSR2_VCC_MASK | CSR2_VPP_MASK));
480 
481         /* enable new powersettings */
482         out_8((u8 *) MBX_CSR2_ADDR, in_8((u8 *) MBX_CSR2_ADDR) | reg);
483 
484         return 0;
485 }
486 
487 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
488 #define hardware_enable(_slot_) /* No hardware to enable */
489 #define hardware_disable(_slot_)        /* No hardware to disable */
490 
491 #endif                          /* CONFIG_MBX */
492 
493 #if defined(CONFIG_PRxK)
494 #include <asm/cpld.h>
495 extern volatile fpga_pc_regs *fpga_pc;
496 
497 #define PCMCIA_BOARD_MSG "MPC855T"
498 
499 static int voltage_set(int slot, int vcc, int vpp)
500 {
501         u8 reg = 0;
502         u8 regread;
503         cpld_regs *ccpld = get_cpld();
504 
505         switch (vcc) {
506         case 0:
507                 break;
508         case 33:
509                 reg |= PCMCIA_VCC_33;
510                 break;
511         case 50:
512                 reg |= PCMCIA_VCC_50;
513                 break;
514         default:
515                 return 1;
516         }
517 
518         switch (vpp) {
519         case 0:
520                 break;
521         case 33:
522         case 50:
523                 if (vcc == vpp)
524                         reg |= PCMCIA_VPP_VCC;
525                 else
526                         return 1;
527                 break;
528         case 120:
529                 if ((vcc == 33) || (vcc == 50))
530                         reg |= PCMCIA_VPP_12;
531                 else
532                         return 1;
533         default:
534                 return 1;
535         }
536 
537         reg = reg >> (slot << 2);
538         regread = in_8(&ccpld->fpga_pc_ctl);
539         if (reg !=
540             (regread & ((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2)))) {
541                 /* enable new powersettings */
542                 regread =
543                     regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >>
544                                 (slot << 2));
545                 out_8(&ccpld->fpga_pc_ctl, reg | regread);
546                 msleep(100);
547         }
548 
549         return 0;
550 }
551 
552 #define socket_get(_slot_) PCMCIA_SOCKET_KEY_LV
553 #define hardware_enable(_slot_) /* No hardware to enable */
554 #define hardware_disable(_slot_)        /* No hardware to disable */
555 
556 #endif                          /* CONFIG_PRxK */
557 
558 static u32 pending_events[PCMCIA_SOCKETS_NO];
559 static DEFINE_SPINLOCK(pending_event_lock);
560 
561 static irqreturn_t m8xx_interrupt(int irq, void *dev)
562 {
563         struct socket_info *s;
564         struct event_table *e;
565         unsigned int i, events, pscr, pipr, per;
566         pcmconf8xx_t *pcmcia = socket[0].pcmcia;
567 
568         dprintk("Interrupt!\n");
569         /* get interrupt sources */
570 
571         pscr = in_be32(&pcmcia->pcmc_pscr);
572         pipr = in_be32(&pcmcia->pcmc_pipr);
573         per = in_be32(&pcmcia->pcmc_per);
574 
575         for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
576                 s = &socket[i];
577                 e = &s->events[0];
578                 events = 0;
579 
580                 while (e->regbit) {
581                         if (pscr & e->regbit)
582                                 events |= e->eventbit;
583 
584                         e++;
585                 }
586 
587                 /*
588                  * report only if both card detect signals are the same
589                  * not too nice done,
590                  * we depend on that CD2 is the bit to the left of CD1...
591                  */
592                 if (events & SS_DETECT)
593                         if (((pipr & M8XX_PCMCIA_CD2(i)) >> 1) ^
594                             (pipr & M8XX_PCMCIA_CD1(i))) {
595                                 events &= ~SS_DETECT;
596                         }
597 #ifdef PCMCIA_GLITCHY_CD
598                 /*
599                  * I've experienced CD problems with my ADS board.
600                  * We make an extra check to see if there was a
601                  * real change of Card detection.
602                  */
603 
604                 if ((events & SS_DETECT) &&
605                     ((pipr &
606                       (M8XX_PCMCIA_CD2(i) | M8XX_PCMCIA_CD1(i))) == 0) &&
607                     (s->state.Vcc | s->state.Vpp)) {
608                         events &= ~SS_DETECT;
609                         /*printk( "CD glitch workaround - CD = 0x%08x!\n",
610                            (pipr & (M8XX_PCMCIA_CD2(i)
611                            | M8XX_PCMCIA_CD1(i)))); */
612                 }
613 #endif
614 
615                 /* call the handler */
616 
617                 dprintk("slot %u: events = 0x%02x, pscr = 0x%08x, "
618                         "pipr = 0x%08x\n", i, events, pscr, pipr);
619 
620                 if (events) {
621                         spin_lock(&pending_event_lock);
622                         pending_events[i] |= events;
623                         spin_unlock(&pending_event_lock);
624                         /*
625                          * Turn off RDY_L bits in the PER mask on
626                          * CD interrupt receival.
627                          *
628                          * They can generate bad interrupts on the
629                          * ACS4,8,16,32.   - marcelo
630                          */
631                         per &= ~M8XX_PCMCIA_RDY_L(0);
632                         per &= ~M8XX_PCMCIA_RDY_L(1);
633 
634                         out_be32(&pcmcia->pcmc_per, per);
635 
636                         if (events)
637                                 pcmcia_parse_events(&socket[i].socket, events);
638                 }
639         }
640 
641         /* clear the interrupt sources */
642         out_be32(&pcmcia->pcmc_pscr, pscr);
643 
644         dprintk("Interrupt done.\n");
645 
646         return IRQ_HANDLED;
647 }
648 
649 static u32 m8xx_get_graycode(u32 size)
650 {
651         u32 k;
652 
653         for (k = 0; k < M8XX_SIZES_NO; k++)
654                 if (m8xx_size_to_gray[k] == size)
655                         break;
656 
657         if ((k == M8XX_SIZES_NO) || (m8xx_size_to_gray[k] == -1))
658                 k = -1;
659 
660         return k;
661 }
662 
663 static u32 m8xx_get_speed(u32 ns, u32 is_io, u32 bus_freq)
664 {
665         u32 reg, clocks, psst, psl, psht;
666 
667         if (!ns) {
668 
669                 /*
670                  * We get called with IO maps setup to 0ns
671                  * if not specified by the user.
672                  * They should be 255ns.
673                  */
674 
675                 if (is_io)
676                         ns = 255;
677                 else
678                         ns = 100;       /* fast memory if 0 */
679         }
680 
681         /*
682          * In PSST, PSL, PSHT fields we tell the controller
683          * timing parameters in CLKOUT clock cycles.
684          * CLKOUT is the same as GCLK2_50.
685          */
686 
687 /* how we want to adjust the timing - in percent */
688 
689 #define ADJ 180                 /* 80 % longer accesstime - to be sure */
690 
691         clocks = ((bus_freq / 1000) * ns) / 1000;
692         clocks = (clocks * ADJ) / (100 * 1000);
693         if (clocks >= PCMCIA_BMT_LIMIT) {
694                 printk("Max access time limit reached\n");
695                 clocks = PCMCIA_BMT_LIMIT - 1;
696         }
697 
698         psst = clocks / 7;      /* setup time */
699         psht = clocks / 7;      /* hold time */
700         psl = (clocks * 5) / 7; /* strobe length */
701 
702         psst += clocks - (psst + psht + psl);
703 
704         reg = psst << 12;
705         reg |= psl << 7;
706         reg |= psht << 16;
707 
708         return reg;
709 }
710 
711 static int m8xx_get_status(struct pcmcia_socket *sock, unsigned int *value)
712 {
713         int lsock = container_of(sock, struct socket_info, socket)->slot;
714         struct socket_info *s = &socket[lsock];
715         unsigned int pipr, reg;
716         pcmconf8xx_t *pcmcia = s->pcmcia;
717 
718         pipr = in_be32(&pcmcia->pcmc_pipr);
719 
720         *value = ((pipr & (M8XX_PCMCIA_CD1(lsock)
721                            | M8XX_PCMCIA_CD2(lsock))) == 0) ? SS_DETECT : 0;
722         *value |= (pipr & M8XX_PCMCIA_WP(lsock)) ? SS_WRPROT : 0;
723 
724         if (s->state.flags & SS_IOCARD)
725                 *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_STSCHG : 0;
726         else {
727                 *value |= (pipr & M8XX_PCMCIA_RDY(lsock)) ? SS_READY : 0;
728                 *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_BATDEAD : 0;
729                 *value |= (pipr & M8XX_PCMCIA_BVD2(lsock)) ? SS_BATWARN : 0;
730         }
731 
732         if (s->state.Vcc | s->state.Vpp)
733                 *value |= SS_POWERON;
734 
735         /*
736          * Voltage detection:
737          * This driver only supports 16-Bit pc-cards.
738          * Cardbus is not handled here.
739          *
740          * To determine what voltage to use we must read the VS1 and VS2 pin.
741          * Depending on what socket type is present,
742          * different combinations mean different things.
743          *
744          * Card Key  Socket Key   VS1   VS2   Card         Vcc for CIS parse
745          *
746          * 5V        5V, LV*      NC    NC    5V only       5V (if available)
747          *
748          * 5V        5V, LV*      GND   NC    5 or 3.3V     as low as possible
749          *
750          * 5V        5V, LV*      GND   GND   5, 3.3, x.xV  as low as possible
751          *
752          * LV*       5V            -     -    shall not fit into socket
753          *
754          * LV*       LV*          GND   NC    3.3V only     3.3V
755          *
756          * LV*       LV*          NC    GND   x.xV          x.xV (if avail.)
757          *
758          * LV*       LV*          GND   GND   3.3 or x.xV   as low as possible
759          *
760          * *LV means Low Voltage
761          *
762          *
763          * That gives us the following table:
764          *
765          * Socket    VS1  VS2   Voltage
766          *
767          * 5V        NC   NC    5V
768          * 5V        NC   GND   none (should not be possible)
769          * 5V        GND  NC    >= 3.3V
770          * 5V        GND  GND   >= x.xV
771          *
772          * LV        NC   NC    5V   (if available)
773          * LV        NC   GND   x.xV (if available)
774          * LV        GND  NC    3.3V
775          * LV        GND  GND   >= x.xV
776          *
777          * So, how do I determine if I have a 5V or a LV
778          * socket on my board?  Look at the socket!
779          *
780          *
781          * Socket with 5V key:
782          * ++--------------------------------------------+
783          * ||                                            |
784          * ||                                           ||
785          * ||                                           ||
786          * |                                             |
787          * +---------------------------------------------+
788          *
789          * Socket with LV key:
790          * ++--------------------------------------------+
791          * ||                                            |
792          * |                                            ||
793          * |                                            ||
794          * |                                             |
795          * +---------------------------------------------+
796          *
797          *
798          * With other words - LV only cards does not fit
799          * into the 5V socket!
800          */
801 
802         /* read out VS1 and VS2 */
803 
804         reg = (pipr & M8XX_PCMCIA_VS_MASK(lsock))
805             >> M8XX_PCMCIA_VS_SHIFT(lsock);
806 
807         if (socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
808                 switch (reg) {
809                 case 1:
810                         *value |= SS_3VCARD;
811                         break;  /* GND, NC - 3.3V only */
812                 case 2:
813                         *value |= SS_XVCARD;
814                         break;  /* NC. GND - x.xV only */
815                 };
816         }
817 
818         dprintk("GetStatus(%d) = %#2.2x\n", lsock, *value);
819         return 0;
820 }
821 
822 static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t * state)
823 {
824         int lsock = container_of(sock, struct socket_info, socket)->slot;
825         struct socket_info *s = &socket[lsock];
826         struct event_table *e;
827         unsigned int reg;
828         unsigned long flags;
829         pcmconf8xx_t *pcmcia = socket[0].pcmcia;
830 
831         dprintk("SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
832                 "io_irq %d, csc_mask %#2.2x)\n", lsock, state->flags,
833                 state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
834 
835         /* First, set voltage - bail out if invalid */
836         if (voltage_set(lsock, state->Vcc, state->Vpp))
837                 return -EINVAL;
838 
839         /* Take care of reset... */
840         if (state->flags & SS_RESET)
841                 out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXRESET);   /* active high */
842         else
843                 out_be32(M8XX_PGCRX(lsock),
844                          in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXRESET);
845 
846         /* ... and output enable. */
847 
848         /* The CxOE signal is connected to a 74541 on the ADS.
849            I guess most other boards used the ADS as a reference.
850            I tried to control the CxOE signal with SS_OUTPUT_ENA,
851            but the reset signal seems connected via the 541.
852            If the CxOE is left high are some signals tristated and
853            no pullups are present -> the cards act weird.
854            So right now the buffers are enabled if the power is on. */
855 
856         if (state->Vcc || state->Vpp)
857                 out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXOE);     /* active low */
858         else
859                 out_be32(M8XX_PGCRX(lsock),
860                          in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXOE);
861 
862         /*
863          * We'd better turn off interrupts before
864          * we mess with the events-table..
865          */
866 
867         spin_lock_irqsave(&events_lock, flags);
868 
869         /*
870          * Play around with the interrupt mask to be able to
871          * give the events the generic pcmcia driver wants us to.
872          */
873 
874         e = &s->events[0];
875         reg = 0;
876 
877         if (state->csc_mask & SS_DETECT) {
878                 e->eventbit = SS_DETECT;
879                 reg |= e->regbit = (M8XX_PCMCIA_CD2(lsock)
880                                     | M8XX_PCMCIA_CD1(lsock));
881                 e++;
882         }
883         if (state->flags & SS_IOCARD) {
884                 /*
885                  * I/O card
886                  */
887                 if (state->csc_mask & SS_STSCHG) {
888                         e->eventbit = SS_STSCHG;
889                         reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
890                         e++;
891                 }
892                 /*
893                  * If io_irq is non-zero we should enable irq.
894                  */
895                 if (state->io_irq) {
896                         out_be32(M8XX_PGCRX(lsock),
897                                  in_be32(M8XX_PGCRX(lsock)) |
898                                  mk_int_int_mask(s->hwirq) << 24);
899                         /*
900                          * Strange thing here:
901                          * The manual does not tell us which interrupt
902                          * the sources generate.
903                          * Anyhow, I found out that RDY_L generates IREQLVL.
904                          *
905                          * We use level triggerd interrupts, and they don't
906                          * have to be cleared in PSCR in the interrupt handler.
907                          */
908                         reg |= M8XX_PCMCIA_RDY_L(lsock);
909                 } else
910                         out_be32(M8XX_PGCRX(lsock),
911                                  in_be32(M8XX_PGCRX(lsock)) & 0x00ffffff);
912         } else {
913                 /*
914                  * Memory card
915                  */
916                 if (state->csc_mask & SS_BATDEAD) {
917                         e->eventbit = SS_BATDEAD;
918                         reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
919                         e++;
920                 }
921                 if (state->csc_mask & SS_BATWARN) {
922                         e->eventbit = SS_BATWARN;
923                         reg |= e->regbit = M8XX_PCMCIA_BVD2(lsock);
924                         e++;
925                 }
926                 /* What should I trigger on - low/high,raise,fall? */
927                 if (state->csc_mask & SS_READY) {
928                         e->eventbit = SS_READY;
929                         reg |= e->regbit = 0;   //??
930                         e++;
931                 }
932         }
933 
934         e->regbit = 0;          /* terminate list */
935 
936         /*
937          * Clear the status changed .
938          * Port A and Port B share the same port.
939          * Writing ones will clear the bits.
940          */
941 
942         out_be32(&pcmcia->pcmc_pscr, reg);
943 
944         /*
945          * Write the mask.
946          * Port A and Port B share the same port.
947          * Need for read-modify-write.
948          * Ones will enable the interrupt.
949          */
950 
951         reg |=
952             in_be32(&pcmcia->
953                     pcmc_per) & (M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
954         out_be32(&pcmcia->pcmc_per, reg);
955 
956         spin_unlock_irqrestore(&events_lock, flags);
957 
958         /* copy the struct and modify the copy */
959 
960         s->state = *state;
961 
962         return 0;
963 }
964 
965 static int m8xx_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
966 {
967         int lsock = container_of(sock, struct socket_info, socket)->slot;
968 
969         struct socket_info *s = &socket[lsock];
970         struct pcmcia_win *w;
971         unsigned int reg, winnr;
972         pcmconf8xx_t *pcmcia = s->pcmcia;
973 
974 #define M8XX_SIZE (io->stop - io->start + 1)
975 #define M8XX_BASE (PCMCIA_IO_WIN_BASE + io->start)
976 
977         dprintk("SetIOMap(%d, %d, %#2.2x, %d ns, "
978                 "%#4.4x-%#4.4x)\n", lsock, io->map, io->flags,
979                 io->speed, io->start, io->stop);
980 
981         if ((io->map >= PCMCIA_IO_WIN_NO) || (io->start > 0xffff)
982             || (io->stop > 0xffff) || (io->stop < io->start))
983                 return -EINVAL;
984 
985         if ((reg = m8xx_get_graycode(M8XX_SIZE)) == -1)
986                 return -EINVAL;
987 
988         if (io->flags & MAP_ACTIVE) {
989 
990                 dprintk("io->flags & MAP_ACTIVE\n");
991 
992                 winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
993                     + (lsock * PCMCIA_IO_WIN_NO) + io->map;
994 
995                 /* setup registers */
996 
997                 w = (void *)&pcmcia->pcmc_pbr0;
998                 w += winnr;
999 
1000                 out_be32(&w->or, 0);    /* turn off window first */
1001                 out_be32(&w->br, M8XX_BASE);
1002 
1003                 reg <<= 27;
1004                 reg |= M8XX_PCMCIA_POR_IO | (lsock << 2);
1005 
1006                 reg |= m8xx_get_speed(io->speed, 1, s->bus_freq);
1007 
1008                 if (io->flags & MAP_WRPROT)
1009                         reg |= M8XX_PCMCIA_POR_WRPROT;
1010 
1011                 /*if(io->flags & (MAP_16BIT | MAP_AUTOSZ)) */
1012                 if (io->flags & MAP_16BIT)
1013                         reg |= M8XX_PCMCIA_POR_16BIT;
1014 
1015                 if (io->flags & MAP_ACTIVE)
1016                         reg |= M8XX_PCMCIA_POR_VALID;
1017 
1018                 out_be32(&w->or, reg);
1019 
1020                 dprintk("Socket %u: Mapped io window %u at %#8.8x, "
1021                         "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
1022         } else {
1023                 /* shutdown IO window */
1024                 winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
1025                     + (lsock * PCMCIA_IO_WIN_NO) + io->map;
1026 
1027                 /* setup registers */
1028 
1029                 w = (void *)&pcmcia->pcmc_pbr0;
1030                 w += winnr;
1031 
1032                 out_be32(&w->or, 0);    /* turn off window */
1033                 out_be32(&w->br, 0);    /* turn off base address */
1034 
1035                 dprintk("Socket %u: Unmapped io window %u at %#8.8x, "
1036                         "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
1037         }
1038 
1039         /* copy the struct and modify the copy */
1040         s->io_win[io->map] = *io;
1041         s->io_win[io->map].flags &= (MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
1042         dprintk("SetIOMap exit\n");
1043 
1044         return 0;
1045 }
1046 
1047 static int m8xx_set_mem_map(struct pcmcia_socket *sock,
1048                             struct pccard_mem_map *mem)
1049 {
1050         int lsock = container_of(sock, struct socket_info, socket)->slot;
1051         struct socket_info *s = &socket[lsock];
1052         struct pcmcia_win *w;
1053         struct pccard_mem_map *old;
1054         unsigned int reg, winnr;
1055         pcmconf8xx_t *pcmcia = s->pcmcia;
1056 
1057         dprintk("SetMemMap(%d, %d, %#2.2x, %d ns, "
1058                 "%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
1059                 mem->speed, mem->static_start, mem->card_start);
1060 
1061         if ((mem->map >= PCMCIA_MEM_WIN_NO)
1062 //          || ((mem->s) >= PCMCIA_MEM_WIN_SIZE)
1063             || (mem->card_start >= 0x04000000)
1064             || (mem->static_start & 0xfff)      /* 4KByte resolution */
1065             ||(mem->card_start & 0xfff))
1066                 return -EINVAL;
1067 
1068         if ((reg = m8xx_get_graycode(PCMCIA_MEM_WIN_SIZE)) == -1) {
1069                 printk("Cannot set size to 0x%08x.\n", PCMCIA_MEM_WIN_SIZE);
1070                 return -EINVAL;
1071         }
1072         reg <<= 27;
1073 
1074         winnr = (lsock * PCMCIA_MEM_WIN_NO) + mem->map;
1075 
1076         /* Setup the window in the pcmcia controller */
1077 
1078         w = (void *)&pcmcia->pcmc_pbr0;
1079         w += winnr;
1080 
1081         reg |= lsock << 2;
1082 
1083         reg |= m8xx_get_speed(mem->speed, 0, s->bus_freq);
1084 
1085         if (mem->flags & MAP_ATTRIB)
1086                 reg |= M8XX_PCMCIA_POR_ATTRMEM;
1087 
1088         if (mem->flags & MAP_WRPROT)
1089                 reg |= M8XX_PCMCIA_POR_WRPROT;
1090 
1091         if (mem->flags & MAP_16BIT)
1092                 reg |= M8XX_PCMCIA_POR_16BIT;
1093 
1094         if (mem->flags & MAP_ACTIVE)
1095                 reg |= M8XX_PCMCIA_POR_VALID;
1096 
1097         out_be32(&w->or, reg);
1098 
1099         dprintk("Socket %u: Mapped memory window %u at %#8.8x, "
1100                 "OR = %#8.8x.\n", lsock, mem->map, w->br, w->or);
1101 
1102         if (mem->flags & MAP_ACTIVE) {
1103                 /* get the new base address */
1104                 mem->static_start = PCMCIA_MEM_WIN_BASE +
1105                     (PCMCIA_MEM_WIN_SIZE * winnr)
1106                     + mem->card_start;
1107         }
1108 
1109         dprintk("SetMemMap(%d, %d, %#2.2x, %d ns, "
1110                 "%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
1111                 mem->speed, mem->static_start, mem->card_start);
1112 
1113         /* copy the struct and modify the copy */
1114 
1115         old = &s->mem_win[mem->map];
1116 
1117         *old = *mem;
1118         old->flags &= (MAP_ATTRIB | MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
1119 
1120         return 0;
1121 }
1122 
1123 static int m8xx_sock_init(struct pcmcia_socket *sock)
1124 {
1125         int i;
1126         pccard_io_map io = { 0, 0, 0, 0, 1 };
1127         pccard_mem_map mem = { 0, 0, 0, 0, 0, 0 };
1128 
1129         dprintk("sock_init(%d)\n", s);
1130 
1131         m8xx_set_socket(sock, &dead_socket);
1132         for (i = 0; i < PCMCIA_IO_WIN_NO; i++) {
1133                 io.map = i;
1134                 m8xx_set_io_map(sock, &io);
1135         }
1136         for (i = 0; i < PCMCIA_MEM_WIN_NO; i++) {
1137                 mem.map = i;
1138                 m8xx_set_mem_map(sock, &mem);
1139         }
1140 
1141         return 0;
1142 
1143 }
1144 
1145 static int m8xx_sock_suspend(struct pcmcia_socket *sock)
1146 {
1147         return m8xx_set_socket(sock, &dead_socket);
1148 }
1149 
1150 static struct pccard_operations m8xx_services = {
1151         .init = m8xx_sock_init,
1152         .suspend = m8xx_sock_suspend,
1153         .get_status = m8xx_get_status,
1154         .set_socket = m8xx_set_socket,
1155         .set_io_map = m8xx_set_io_map,
1156         .set_mem_map = m8xx_set_mem_map,
1157 };
1158 
1159 static int __init m8xx_probe(struct of_device *ofdev,
1160                              const struct of_device_id *match)
1161 {
1162         struct pcmcia_win *w;
1163         unsigned int i, m, hwirq;
1164         pcmconf8xx_t *pcmcia;
1165         int status;
1166         struct device_node *np = ofdev->node;
1167 
1168         pcmcia_info("%s\n", version);
1169 
1170         pcmcia = of_iomap(np, 0);
1171         if (pcmcia == NULL)
1172                 return -EINVAL;
1173 
1174         pcmcia_schlvl = irq_of_parse_and_map(np, 0);
1175         hwirq = irq_map[pcmcia_schlvl].hwirq;
1176         if (pcmcia_schlvl < 0) {
1177                 iounmap(pcmcia);
1178                 return -EINVAL;
1179         }
1180 
1181         m8xx_pgcrx[0] = &pcmcia->pcmc_pgcra;
1182         m8xx_pgcrx[1] = &pcmcia->pcmc_pgcrb;
1183 
1184         pcmcia_info(PCMCIA_BOARD_MSG " using " PCMCIA_SLOT_MSG
1185                     " with IRQ %u  (%d). \n", pcmcia_schlvl, hwirq);
1186 
1187         /* Configure Status change interrupt */
1188 
1189         if (request_irq(pcmcia_schlvl, m8xx_interrupt, IRQF_SHARED,
1190                         driver_name, socket)) {
1191                 pcmcia_error("Cannot allocate IRQ %u for SCHLVL!\n",
1192                              pcmcia_schlvl);
1193                 iounmap(pcmcia);
1194                 return -1;
1195         }
1196 
1197         w = (void *)&pcmcia->pcmc_pbr0;
1198 
1199         out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
1200         clrbits32(&pcmcia->pcmc_per, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
1201 
1202         /* connect interrupt and disable CxOE */
1203 
1204         out_be32(M8XX_PGCRX(0),
1205                  M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
1206         out_be32(M8XX_PGCRX(1),
1207                  M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
1208 
1209         /* intialize the fixed memory windows */
1210 
1211         for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
1212                 for (m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
1213                         out_be32(&w->br, PCMCIA_MEM_WIN_BASE +
1214                                  (PCMCIA_MEM_WIN_SIZE
1215                                   * (m + i * PCMCIA_MEM_WIN_NO)));
1216 
1217                         out_be32(&w->or, 0);    /* set to not valid */
1218 
1219                         w++;
1220                 }
1221         }
1222 
1223         /* turn off voltage */
1224         voltage_set(0, 0, 0);
1225         voltage_set(1, 0, 0);
1226 
1227         /* Enable external hardware */
1228         hardware_enable(0);
1229         hardware_enable(1);
1230 
1231         for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
1232                 socket[i].slot = i;
1233                 socket[i].socket.owner = THIS_MODULE;
1234                 socket[i].socket.features =
1235                     SS_CAP_PCCARD | SS_CAP_MEM_ALIGN | SS_CAP_STATIC_MAP;
1236                 socket[i].socket.irq_mask = 0x000;
1237                 socket[i].socket.map_size = 0x1000;
1238                 socket[i].socket.io_offset = 0;
1239                 socket[i].socket.pci_irq = pcmcia_schlvl;
1240                 socket[i].socket.ops = &m8xx_services;
1241                 socket[i].socket.resource_ops = &pccard_nonstatic_ops;
1242                 socket[i].socket.cb_dev = NULL;
1243                 socket[i].socket.dev.parent = &ofdev->dev;
1244                 socket[i].pcmcia = pcmcia;
1245                 socket[i].bus_freq = ppc_proc_freq;
1246                 socket[i].hwirq = hwirq;
1247 
1248         }
1249 
1250         for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
1251                 status = pcmcia_register_socket(&socket[i].socket);
1252                 if (status < 0)
1253                         pcmcia_error("Socket register failed\n");
1254         }
1255 
1256         return 0;
1257 }
1258 
1259 static int m8xx_remove(struct of_device *ofdev)
1260 {
1261         u32 m, i;
1262         struct pcmcia_win *w;
1263         pcmconf8xx_t *pcmcia = socket[0].pcmcia;
1264 
1265         for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
1266                 w = (void *)&pcmcia->pcmc_pbr0;
1267 
1268                 out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(i));
1269                 out_be32(&pcmcia->pcmc_per,
1270                          in_be32(&pcmcia->pcmc_per) & ~M8XX_PCMCIA_MASK(i));
1271 
1272                 /* turn off interrupt and disable CxOE */
1273                 out_be32(M8XX_PGCRX(i), M8XX_PGCRX_CXOE);
1274 
1275                 /* turn off memory windows */
1276                 for (m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
1277                         out_be32(&w->or, 0);    /* set to not valid */
1278                         w++;
1279                 }
1280 
1281                 /* turn off voltage */
1282                 voltage_set(i, 0, 0);
1283 
1284                 /* disable external hardware */
1285                 hardware_disable(i);
1286         }
1287         for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
1288                 pcmcia_unregister_socket(&socket[i].socket);
1289         iounmap(pcmcia);
1290 
1291         free_irq(pcmcia_schlvl, NULL);
1292 
1293         return 0;
1294 }
1295 
1296 #ifdef CONFIG_PM
1297 static int m8xx_suspend(struct platform_device *pdev, pm_message_t state)
1298 {
1299         return pcmcia_socket_dev_suspend(&pdev->dev);
1300 }
1301 
1302 static int m8xx_resume(struct platform_device *pdev)
1303 {
1304         return pcmcia_socket_dev_resume(&pdev->dev);
1305 }
1306 #else
1307 #define m8xx_suspend NULL
1308 #define m8xx_resume NULL
1309 #endif
1310 
1311 static struct of_device_id m8xx_pcmcia_match[] = {
1312         {
1313          .type = "pcmcia",
1314          .compatible = "fsl,pq-pcmcia",
1315          },
1316         {},
1317 };
1318 
1319 MODULE_DEVICE_TABLE(of, m8xx_pcmcia_match);
1320 
1321 static struct of_platform_driver m8xx_pcmcia_driver = {
1322         .name = driver_name,
1323         .match_table = m8xx_pcmcia_match,
1324         .probe = m8xx_probe,
1325         .remove = m8xx_remove,
1326         .suspend = m8xx_suspend,
1327         .resume = m8xx_resume,
1328 };
1329 
1330 static int __init m8xx_init(void)
1331 {
1332         return of_register_platform_driver(&m8xx_pcmcia_driver);
1333 }
1334 
1335 static void __exit m8xx_exit(void)
1336 {
1337         of_unregister_platform_driver(&m8xx_pcmcia_driver);
1338 }
1339 
1340 module_init(m8xx_init);
1341 module_exit(m8xx_exit);
1342 
  This page was automatically generated by the LXR engine.