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