Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/jbarnes...
[linux-2.6] / drivers / ide / ppc / mpc8xx.c
1 /*
2  *  Copyright (C) 2000, 2001 Wolfgang Denk, wd@denx.de
3  *  Modified for direct IDE interface
4  *      by Thomas Lange, thomas@corelatus.com
5  *  Modified for direct IDE interface on 8xx without using the PCMCIA
6  *  controller
7  *      by Steven.Scholz@imc-berlin.de
8  *  Moved out of arch/ppc/kernel/m8xx_setup.c, other minor cleanups
9  *      by Mathew Locke <mattl@mvista.com>
10  */
11
12 #include <linux/errno.h>
13 #include <linux/kernel.h>
14 #include <linux/mm.h>
15 #include <linux/stddef.h>
16 #include <linux/unistd.h>
17 #include <linux/ptrace.h>
18 #include <linux/slab.h>
19 #include <linux/user.h>
20 #include <linux/tty.h>
21 #include <linux/major.h>
22 #include <linux/interrupt.h>
23 #include <linux/reboot.h>
24 #include <linux/init.h>
25 #include <linux/ioport.h>
26 #include <linux/ide.h>
27 #include <linux/bootmem.h>
28
29 #include <asm/mpc8xx.h>
30 #include <asm/mmu.h>
31 #include <asm/processor.h>
32 #include <asm/io.h>
33 #include <asm/pgtable.h>
34 #include <asm/ide.h>
35 #include <asm/8xx_immap.h>
36 #include <asm/machdep.h>
37 #include <asm/irq.h>
38
39 #define DRV_NAME "ide-mpc8xx"
40
41 static int identify  (volatile u8 *p);
42 static void print_fixed (volatile u8 *p);
43 static void print_funcid (int func);
44 static int check_ide_device (unsigned long base);
45
46 static void ide_interrupt_ack (void *dev);
47 static void m8xx_ide_set_pio_mode(ide_drive_t *drive, const u8 pio);
48
49 typedef struct ide_ioport_desc {
50         unsigned long   base_off;               /* Offset to PCMCIA memory      */
51         unsigned long   reg_off[IDE_NR_PORTS];  /* controller register offsets  */
52         int             irq;                    /* IRQ                          */
53 } ide_ioport_desc_t;
54
55 ide_ioport_desc_t ioport_dsc[MAX_HWIFS] = {
56 #ifdef IDE0_BASE_OFFSET
57         { IDE0_BASE_OFFSET,
58             {
59                 IDE0_DATA_REG_OFFSET,
60                 IDE0_ERROR_REG_OFFSET,
61                 IDE0_NSECTOR_REG_OFFSET,
62                 IDE0_SECTOR_REG_OFFSET,
63                 IDE0_LCYL_REG_OFFSET,
64                 IDE0_HCYL_REG_OFFSET,
65                 IDE0_SELECT_REG_OFFSET,
66                 IDE0_STATUS_REG_OFFSET,
67                 IDE0_CONTROL_REG_OFFSET,
68                 IDE0_IRQ_REG_OFFSET,
69             },
70             IDE0_INTERRUPT,
71         },
72 #ifdef IDE1_BASE_OFFSET
73         { IDE1_BASE_OFFSET,
74             {
75                 IDE1_DATA_REG_OFFSET,
76                 IDE1_ERROR_REG_OFFSET,
77                 IDE1_NSECTOR_REG_OFFSET,
78                 IDE1_SECTOR_REG_OFFSET,
79                 IDE1_LCYL_REG_OFFSET,
80                 IDE1_HCYL_REG_OFFSET,
81                 IDE1_SELECT_REG_OFFSET,
82                 IDE1_STATUS_REG_OFFSET,
83                 IDE1_CONTROL_REG_OFFSET,
84                 IDE1_IRQ_REG_OFFSET,
85             },
86             IDE1_INTERRUPT,
87         },
88 #endif /* IDE1_BASE_OFFSET */
89 #endif  /* IDE0_BASE_OFFSET */
90 };
91
92 ide_pio_timings_t ide_pio_clocks[6];
93 int hold_time[6] =  {30, 20, 15, 10, 10, 10 };   /* PIO Mode 5 with IORDY (nonstandard) */
94
95 /*
96  * Warning: only 1 (ONE) PCMCIA slot supported here,
97  * which must be correctly initialized by the firmware (PPCBoot).
98  */
99 static int _slot_ = -1;                 /* will be read from PCMCIA registers   */
100
101 /* Make clock cycles and always round up */
102 #define PCMCIA_MK_CLKS( t, T ) (( (t) * ((T)/1000000) + 999U ) / 1000U )
103
104 #define M8XX_PCMCIA_CD2(slot)      (0x10000000 >> (slot << 4))
105 #define M8XX_PCMCIA_CD1(slot)      (0x08000000 >> (slot << 4))
106
107 /*
108  * The TQM850L hardware has two pins swapped! Grrrrgh!
109  */
110 #ifdef  CONFIG_TQM850L
111 #define __MY_PCMCIA_GCRX_CXRESET        PCMCIA_GCRX_CXOE
112 #define __MY_PCMCIA_GCRX_CXOE           PCMCIA_GCRX_CXRESET
113 #else
114 #define __MY_PCMCIA_GCRX_CXRESET        PCMCIA_GCRX_CXRESET
115 #define __MY_PCMCIA_GCRX_CXOE           PCMCIA_GCRX_CXOE
116 #endif
117
118 #if defined(CONFIG_BLK_DEV_MPC8xx_IDE) && defined(CONFIG_IDE_8xx_PCCARD)
119 #define PCMCIA_SCHLVL IDE0_INTERRUPT    /* Status Change Interrupt Level        */
120 static int pcmcia_schlvl = PCMCIA_SCHLVL;
121 #endif
122
123 /*
124  * See include/linux/ide.h for definition of hw_regs_t (p, base)
125  */
126
127 /*
128  * m8xx_ide_init_ports() for a direct IDE interface _using_
129  * MPC8xx's internal PCMCIA interface
130  */
131 #if defined(CONFIG_IDE_8xx_PCCARD) || defined(CONFIG_IDE_8xx_DIRECT)
132 static int __init m8xx_ide_init_ports(hw_regs_t *hw, unsigned long data_port)
133 {
134         unsigned long *p = hw->io_ports_array;
135         int i;
136
137         typedef struct {
138                 ulong br;
139                 ulong or;
140         } pcmcia_win_t;
141         volatile pcmcia_win_t *win;
142         volatile pcmconf8xx_t *pcmp;
143
144         uint *pgcrx;
145         u32 pcmcia_phy_base;
146         u32 pcmcia_phy_end;
147         static unsigned long pcmcia_base = 0;
148         unsigned long base;
149
150         *p = 0;
151
152         pcmp = (pcmconf8xx_t *)(&(((immap_t *)IMAP_ADDR)->im_pcmcia));
153
154         if (!pcmcia_base) {
155                 /*
156                  * Read out PCMCIA registers. Since the reset values
157                  * are undefined, we sure hope that they have been
158                  * set up by firmware
159                  */
160
161                 /* Scan all registers for valid settings */
162                 pcmcia_phy_base = 0xFFFFFFFF;
163                 pcmcia_phy_end = 0;
164                 /* br0 is start of brX and orX regs */
165                 win = (pcmcia_win_t *) \
166                         (&(((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0));
167                 for (i = 0; i < 8; i++) {
168                         if (win->or & 1) {      /* This bank is marked as valid */
169                                 if (win->br < pcmcia_phy_base) {
170                                         pcmcia_phy_base = win->br;
171                                 }
172                                 if ((win->br + PCMCIA_MEM_SIZE) > pcmcia_phy_end) {
173                                         pcmcia_phy_end  = win->br + PCMCIA_MEM_SIZE;
174                                 }
175                                 /* Check which slot that has been defined */
176                                 _slot_ = (win->or >> 2) & 1;
177
178                         }                                       /* Valid bank */
179                         win++;
180                 }                                               /* for */
181
182                 printk ("PCMCIA slot %c: phys mem %08x...%08x (size %08x)\n",
183                         'A' + _slot_,
184                         pcmcia_phy_base, pcmcia_phy_end,
185                         pcmcia_phy_end - pcmcia_phy_base);
186
187                 if (!request_mem_region(pcmcia_phy_base,
188                                         pcmcia_phy_end - pcmcia_phy_base,
189                                         DRV_NAME)) {
190                         printk(KERN_ERR "%s: resources busy\n", DRV_NAME);
191                         return -EBUSY;
192                 }
193
194                 pcmcia_base=(unsigned long)ioremap(pcmcia_phy_base,
195                                                    pcmcia_phy_end-pcmcia_phy_base);
196
197 #ifdef DEBUG
198                 printk ("PCMCIA virt base: %08lx\n", pcmcia_base);
199 #endif
200                 /* Compute clock cycles for PIO timings */
201                 for (i=0; i<6; ++i) {
202                         bd_t    *binfo = (bd_t *)__res;
203
204                         hold_time[i]   =
205                                 PCMCIA_MK_CLKS (hold_time[i],
206                                                 binfo->bi_busfreq);
207                         ide_pio_clocks[i].setup_time  =
208                                 PCMCIA_MK_CLKS (ide_pio_timings[i].setup_time,
209                                                 binfo->bi_busfreq);
210                         ide_pio_clocks[i].active_time =
211                                 PCMCIA_MK_CLKS (ide_pio_timings[i].active_time,
212                                                 binfo->bi_busfreq);
213                         ide_pio_clocks[i].cycle_time  =
214                                 PCMCIA_MK_CLKS (ide_pio_timings[i].cycle_time,
215                                                 binfo->bi_busfreq);
216 #if 0
217                         printk ("PIO mode %d timings: %d/%d/%d => %d/%d/%d\n",
218                                 i,
219                                 ide_pio_clocks[i].setup_time,
220                                 ide_pio_clocks[i].active_time,
221                                 ide_pio_clocks[i].hold_time,
222                                 ide_pio_clocks[i].cycle_time,
223                                 ide_pio_timings[i].setup_time,
224                                 ide_pio_timings[i].active_time,
225                                 ide_pio_timings[i].hold_time,
226                                 ide_pio_timings[i].cycle_time);
227 #endif
228                 }
229         }
230
231         if (_slot_ == -1) {
232                 printk ("PCMCIA slot has not been defined! Using A as default\n");
233                 _slot_ = 0;
234         }
235
236 #ifdef CONFIG_IDE_8xx_PCCARD
237
238 #ifdef DEBUG
239         printk ("PIPR = 0x%08X  slot %c ==> mask = 0x%X\n",
240                 pcmp->pcmc_pipr,
241                 'A' + _slot_,
242                 M8XX_PCMCIA_CD1(_slot_) | M8XX_PCMCIA_CD2(_slot_) );
243 #endif /* DEBUG */
244
245         if (pcmp->pcmc_pipr & (M8XX_PCMCIA_CD1(_slot_)|M8XX_PCMCIA_CD2(_slot_))) {
246                 printk ("No card in slot %c: PIPR=%08x\n",
247                         'A' + _slot_, (u32) pcmp->pcmc_pipr);
248                 return -ENODEV;         /* No card in slot */
249         }
250
251         check_ide_device (pcmcia_base);
252
253 #endif  /* CONFIG_IDE_8xx_PCCARD */
254
255         base = pcmcia_base + ioport_dsc[data_port].base_off;
256 #ifdef DEBUG
257         printk ("base: %08x + %08x = %08x\n",
258                         pcmcia_base, ioport_dsc[data_port].base_off, base);
259 #endif
260
261         for (i = 0; i < IDE_NR_PORTS; ++i) {
262 #ifdef DEBUG
263                 printk ("port[%d]: %08x + %08x = %08x\n",
264                         i,
265                         base,
266                         ioport_dsc[data_port].reg_off[i],
267                         i, base + ioport_dsc[data_port].reg_off[i]);
268 #endif
269                 *p++ = base + ioport_dsc[data_port].reg_off[i];
270         }
271
272         hw->irq = ioport_dsc[data_port].irq;
273         hw->ack_intr = (ide_ack_intr_t *)ide_interrupt_ack;
274
275 #ifdef CONFIG_IDE_8xx_PCCARD
276         {
277                 unsigned int reg;
278
279                 if (_slot_)
280                         pgcrx = &((immap_t *) IMAP_ADDR)->im_pcmcia.pcmc_pgcrb;
281                 else
282                         pgcrx = &((immap_t *) IMAP_ADDR)->im_pcmcia.pcmc_pgcra;
283
284                 reg = *pgcrx;
285                 reg |= mk_int_int_mask (pcmcia_schlvl) << 24;
286                 reg |= mk_int_int_mask (pcmcia_schlvl) << 16;
287                 *pgcrx = reg;
288         }
289 #endif  /* CONFIG_IDE_8xx_PCCARD */
290
291         /* Enable Harddisk Interrupt,
292          * and make it edge sensitive
293          */
294         /* (11-18) Set edge detect for irq, no wakeup from low power mode */
295         ((immap_t *)IMAP_ADDR)->im_siu_conf.sc_siel |=
296                                         (0x80000000 >> ioport_dsc[data_port].irq);
297
298 #ifdef CONFIG_IDE_8xx_PCCARD
299         /* Make sure we don't get garbage irq */
300         ((immap_t *) IMAP_ADDR)->im_pcmcia.pcmc_pscr = 0xFFFF;
301
302         /* Enable falling edge irq */
303         pcmp->pcmc_per = 0x100000 >> (16 * _slot_);
304 #endif  /* CONFIG_IDE_8xx_PCCARD */
305
306         hw->chipset = ide_generic;
307
308         return 0;
309 }
310 #endif /* CONFIG_IDE_8xx_PCCARD || CONFIG_IDE_8xx_DIRECT */
311
312 /*
313  * m8xx_ide_init_ports() for a direct IDE interface _not_ using
314  * MPC8xx's internal PCMCIA interface
315  */
316 #if defined(CONFIG_IDE_EXT_DIRECT)
317 static int __init m8xx_ide_init_ports(hw_regs_t *hw, unsigned long data_port)
318 {
319         unsigned long *p = hw->io_ports_array;
320         int i;
321
322         u32 ide_phy_base;
323         u32 ide_phy_end;
324         static unsigned long ide_base = 0;
325         unsigned long base;
326
327         *p = 0;
328
329         if (!ide_base) {
330
331                 /* TODO:
332                  * - add code to read ORx, BRx
333                  */
334                 ide_phy_base = CFG_ATA_BASE_ADDR;
335                 ide_phy_end  = CFG_ATA_BASE_ADDR + 0x200;
336
337                 printk ("IDE phys mem : %08x...%08x (size %08x)\n",
338                         ide_phy_base, ide_phy_end,
339                         ide_phy_end - ide_phy_base);
340
341                 if (!request_mem_region(ide_phy_base, 0x200, DRV_NAME)) {
342                         printk(KERN_ERR "%s: resources busy\n", DRV_NAME);
343                         return -EBUSY;
344                 }
345
346                 ide_base=(unsigned long)ioremap(ide_phy_base,
347                                                 ide_phy_end-ide_phy_base);
348
349 #ifdef DEBUG
350                 printk ("IDE virt base: %08lx\n", ide_base);
351 #endif
352         }
353
354         base = ide_base + ioport_dsc[data_port].base_off;
355 #ifdef DEBUG
356         printk ("base: %08x + %08x = %08x\n",
357                 ide_base, ioport_dsc[data_port].base_off, base);
358 #endif
359
360         for (i = 0; i < IDE_NR_PORTS; ++i) {
361 #ifdef DEBUG
362                 printk ("port[%d]: %08x + %08x = %08x\n",
363                         i,
364                         base,
365                         ioport_dsc[data_port].reg_off[i],
366                         i, base + ioport_dsc[data_port].reg_off[i]);
367 #endif
368                 *p++ = base + ioport_dsc[data_port].reg_off[i];
369         }
370
371         /* direct connected IDE drive, i.e. external IRQ */
372         hw->irq = ioport_dsc[data_port].irq;
373         hw->ack_intr = (ide_ack_intr_t *)ide_interrupt_ack;
374
375         /* Enable Harddisk Interrupt,
376          * and make it edge sensitive
377          */
378         /* (11-18) Set edge detect for irq, no wakeup from low power mode */
379         ((immap_t *) IMAP_ADDR)->im_siu_conf.sc_siel |=
380                         (0x80000000 >> ioport_dsc[data_port].irq);
381
382         hw->chipset = ide_generic;
383
384         return 0;
385 }
386 #endif  /* CONFIG_IDE_8xx_DIRECT */
387
388
389 /* -------------------------------------------------------------------- */
390
391
392 /* PCMCIA Timing */
393 #ifndef PCMCIA_SHT
394 #define PCMCIA_SHT(t)   ((t & 0x0F)<<16)        /* Strobe Hold  Time    */
395 #define PCMCIA_SST(t)   ((t & 0x0F)<<12)        /* Strobe Setup Time    */
396 #define PCMCIA_SL(t) ((t==32) ? 0 : ((t & 0x1F)<<7)) /* Strobe Length   */
397 #endif
398
399 /* Calculate PIO timings */
400 static void m8xx_ide_set_pio_mode(ide_drive_t *drive, const u8 pio)
401 {
402 #if defined(CONFIG_IDE_8xx_PCCARD) || defined(CONFIG_IDE_8xx_DIRECT)
403         volatile pcmconf8xx_t   *pcmp;
404         ulong timing, mask, reg;
405
406         pcmp = (pcmconf8xx_t *)(&(((immap_t *)IMAP_ADDR)->im_pcmcia));
407
408         mask = ~(PCMCIA_SHT(0xFF) | PCMCIA_SST(0xFF) | PCMCIA_SL(0xFF));
409
410         timing  = PCMCIA_SHT(hold_time[pio]  )
411                 | PCMCIA_SST(ide_pio_clocks[pio].setup_time )
412                 | PCMCIA_SL (ide_pio_clocks[pio].active_time)
413                 ;
414
415 #if 1
416         printk ("Setting timing bits 0x%08lx in PCMCIA controller\n", timing);
417 #endif
418         if ((reg = pcmp->pcmc_por0 & mask) != 0)
419                 pcmp->pcmc_por0 = reg | timing;
420
421         if ((reg = pcmp->pcmc_por1 & mask) != 0)
422                 pcmp->pcmc_por1 = reg | timing;
423
424         if ((reg = pcmp->pcmc_por2 & mask) != 0)
425                 pcmp->pcmc_por2 = reg | timing;
426
427         if ((reg = pcmp->pcmc_por3 & mask) != 0)
428                 pcmp->pcmc_por3 = reg | timing;
429
430         if ((reg = pcmp->pcmc_por4 & mask) != 0)
431                 pcmp->pcmc_por4 = reg | timing;
432
433         if ((reg = pcmp->pcmc_por5 & mask) != 0)
434                 pcmp->pcmc_por5 = reg | timing;
435
436         if ((reg = pcmp->pcmc_por6 & mask) != 0)
437                 pcmp->pcmc_por6 = reg | timing;
438
439         if ((reg = pcmp->pcmc_por7 & mask) != 0)
440                 pcmp->pcmc_por7 = reg | timing;
441
442 #elif defined(CONFIG_IDE_EXT_DIRECT)
443
444         printk("%s[%d] %s: not implemented yet!\n",
445                 __FILE__, __LINE__, __func__);
446 #endif /* defined(CONFIG_IDE_8xx_PCCARD) || defined(CONFIG_IDE_8xx_PCMCIA */
447 }
448
449 static const struct ide_port_ops m8xx_port_ops = {
450         .set_pio_mode           = m8xx_ide_set_pio_mode,
451 };
452
453 static void
454 ide_interrupt_ack (void *dev)
455 {
456 #ifdef CONFIG_IDE_8xx_PCCARD
457         u_int pscr, pipr;
458
459 #if (PCMCIA_SOCKETS_NO == 2)
460         u_int _slot_;
461 #endif
462
463         /* get interrupt sources */
464
465         pscr = ((volatile immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr;
466         pipr = ((volatile immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pipr;
467
468         /*
469          * report only if both card detect signals are the same
470          * not too nice done,
471          * we depend on that CD2 is the bit to the left of CD1...
472          */
473
474         if(_slot_==-1){
475           printk("PCMCIA slot has not been defined! Using A as default\n");
476           _slot_=0;
477         }
478
479         if(((pipr & M8XX_PCMCIA_CD2(_slot_)) >> 1) ^
480            (pipr & M8XX_PCMCIA_CD1(_slot_))         ) {
481           printk ("card detect interrupt\n");
482         }
483         /* clear the interrupt sources */
484         ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr = pscr;
485
486 #else /* ! CONFIG_IDE_8xx_PCCARD */
487         /*
488          * Only CONFIG_IDE_8xx_PCCARD is using the interrupt of the
489          * MPC8xx's PCMCIA controller, so there is nothing to be done here
490          * for CONFIG_IDE_8xx_DIRECT and CONFIG_IDE_EXT_DIRECT.
491          * The interrupt is handled somewhere else.     -- Steven
492          */
493 #endif /* CONFIG_IDE_8xx_PCCARD */
494 }
495
496
497
498 /*
499  * CIS Tupel codes
500  */
501 #define CISTPL_NULL             0x00
502 #define CISTPL_DEVICE           0x01
503 #define CISTPL_LONGLINK_CB      0x02
504 #define CISTPL_INDIRECT         0x03
505 #define CISTPL_CONFIG_CB        0x04
506 #define CISTPL_CFTABLE_ENTRY_CB 0x05
507 #define CISTPL_LONGLINK_MFC     0x06
508 #define CISTPL_BAR              0x07
509 #define CISTPL_PWR_MGMNT        0x08
510 #define CISTPL_EXTDEVICE        0x09
511 #define CISTPL_CHECKSUM         0x10
512 #define CISTPL_LONGLINK_A       0x11
513 #define CISTPL_LONGLINK_C       0x12
514 #define CISTPL_LINKTARGET       0x13
515 #define CISTPL_NO_LINK          0x14
516 #define CISTPL_VERS_1           0x15
517 #define CISTPL_ALTSTR           0x16
518 #define CISTPL_DEVICE_A         0x17
519 #define CISTPL_JEDEC_C          0x18
520 #define CISTPL_JEDEC_A          0x19
521 #define CISTPL_CONFIG           0x1a
522 #define CISTPL_CFTABLE_ENTRY    0x1b
523 #define CISTPL_DEVICE_OC        0x1c
524 #define CISTPL_DEVICE_OA        0x1d
525 #define CISTPL_DEVICE_GEO       0x1e
526 #define CISTPL_DEVICE_GEO_A     0x1f
527 #define CISTPL_MANFID           0x20
528 #define CISTPL_FUNCID           0x21
529 #define CISTPL_FUNCE            0x22
530 #define CISTPL_SWIL             0x23
531 #define CISTPL_END              0xff
532
533 /*
534  * CIS Function ID codes
535  */
536 #define CISTPL_FUNCID_MULTI     0x00
537 #define CISTPL_FUNCID_MEMORY    0x01
538 #define CISTPL_FUNCID_SERIAL    0x02
539 #define CISTPL_FUNCID_PARALLEL  0x03
540 #define CISTPL_FUNCID_FIXED     0x04
541 #define CISTPL_FUNCID_VIDEO     0x05
542 #define CISTPL_FUNCID_NETWORK   0x06
543 #define CISTPL_FUNCID_AIMS      0x07
544 #define CISTPL_FUNCID_SCSI      0x08
545
546 /*
547  * Fixed Disk FUNCE codes
548  */
549 #define CISTPL_IDE_INTERFACE    0x01
550
551 #define CISTPL_FUNCE_IDE_IFACE  0x01
552 #define CISTPL_FUNCE_IDE_MASTER 0x02
553 #define CISTPL_FUNCE_IDE_SLAVE  0x03
554
555 /* First feature byte */
556 #define CISTPL_IDE_SILICON      0x04
557 #define CISTPL_IDE_UNIQUE       0x08
558 #define CISTPL_IDE_DUAL         0x10
559
560 /* Second feature byte */
561 #define CISTPL_IDE_HAS_SLEEP    0x01
562 #define CISTPL_IDE_HAS_STANDBY  0x02
563 #define CISTPL_IDE_HAS_IDLE     0x04
564 #define CISTPL_IDE_LOW_POWER    0x08
565 #define CISTPL_IDE_REG_INHIBIT  0x10
566 #define CISTPL_IDE_HAS_INDEX    0x20
567 #define CISTPL_IDE_IOIS16       0x40
568
569
570 /* -------------------------------------------------------------------- */
571
572
573 #define MAX_TUPEL_SZ    512
574 #define MAX_FEATURES    4
575
576 static int check_ide_device (unsigned long base)
577 {
578         volatile u8 *ident = NULL;
579         volatile u8 *feature_p[MAX_FEATURES];
580         volatile u8 *p, *start;
581         int n_features = 0;
582         u8 func_id = ~0;
583         u8 code, len;
584         unsigned short config_base = 0;
585         int found = 0;
586         int i;
587
588 #ifdef DEBUG
589         printk ("PCMCIA MEM: %08lX\n", base);
590 #endif
591         start = p = (volatile u8 *) base;
592
593         while ((p - start) < MAX_TUPEL_SZ) {
594
595                 code = *p; p += 2;
596
597                 if (code == 0xFF) { /* End of chain */
598                         break;
599                 }
600
601                 len = *p; p += 2;
602 #ifdef  DEBUG_PCMCIA
603                 { volatile u8 *q = p;
604                         printk ("\nTuple code %02x  length %d\n\tData:",
605                                 code, len);
606
607                         for (i = 0; i < len; ++i) {
608                                 printk (" %02x", *q);
609                                 q+= 2;
610                         }
611                 }
612 #endif  /* DEBUG_PCMCIA */
613                 switch (code) {
614                 case CISTPL_VERS_1:
615                         ident = p + 4;
616                         break;
617                 case CISTPL_FUNCID:
618                         func_id = *p;
619                         break;
620                 case CISTPL_FUNCE:
621                         if (n_features < MAX_FEATURES)
622                                 feature_p[n_features++] = p;
623                         break;
624                 case CISTPL_CONFIG:
625                         config_base = (*(p+6) << 8) + (*(p+4));
626                 default:
627                         break;
628                 }
629                 p += 2 * len;
630         }
631
632         found = identify (ident);
633
634         if (func_id != ((u8)~0)) {
635                 print_funcid (func_id);
636
637                 if (func_id == CISTPL_FUNCID_FIXED)
638                         found = 1;
639                 else
640                         return (1);     /* no disk drive */
641         }
642
643         for (i=0; i<n_features; ++i) {
644                 print_fixed (feature_p[i]);
645         }
646
647         if (!found) {
648                 printk ("unknown card type\n");
649                 return (1);
650         }
651
652         /* set level mode irq and I/O mapped device in config reg*/
653         *((u8 *)(base + config_base)) = 0x41;
654
655         return (0);
656 }
657
658 /* ------------------------------------------------------------------------- */
659
660 static void print_funcid (int func)
661 {
662         switch (func) {
663         case CISTPL_FUNCID_MULTI:
664                 printk (" Multi-Function");
665                 break;
666         case CISTPL_FUNCID_MEMORY:
667                 printk (" Memory");
668                 break;
669         case CISTPL_FUNCID_SERIAL:
670                 printk (" Serial Port");
671                 break;
672         case CISTPL_FUNCID_PARALLEL:
673                 printk (" Parallel Port");
674                 break;
675         case CISTPL_FUNCID_FIXED:
676                 printk (" Fixed Disk");
677                 break;
678         case CISTPL_FUNCID_VIDEO:
679                 printk (" Video Adapter");
680                 break;
681         case CISTPL_FUNCID_NETWORK:
682                 printk (" Network Adapter");
683                 break;
684         case CISTPL_FUNCID_AIMS:
685                 printk (" AIMS Card");
686                 break;
687         case CISTPL_FUNCID_SCSI:
688                 printk (" SCSI Adapter");
689                 break;
690         default:
691                 printk (" Unknown");
692                 break;
693         }
694         printk (" Card\n");
695 }
696
697 /* ------------------------------------------------------------------------- */
698
699 static void print_fixed (volatile u8 *p)
700 {
701         if (p == NULL)
702                 return;
703
704         switch (*p) {
705         case CISTPL_FUNCE_IDE_IFACE:
706             {   u8 iface = *(p+2);
707
708                 printk ((iface == CISTPL_IDE_INTERFACE) ? " IDE" : " unknown");
709                 printk (" interface ");
710                 break;
711             }
712         case CISTPL_FUNCE_IDE_MASTER:
713         case CISTPL_FUNCE_IDE_SLAVE:
714             {   u8 f1 = *(p+2);
715                 u8 f2 = *(p+4);
716
717                 printk ((f1 & CISTPL_IDE_SILICON) ? " [silicon]" : " [rotating]");
718
719                 if (f1 & CISTPL_IDE_UNIQUE)
720                         printk (" [unique]");
721
722                 printk ((f1 & CISTPL_IDE_DUAL) ? " [dual]" : " [single]");
723
724                 if (f2 & CISTPL_IDE_HAS_SLEEP)
725                         printk (" [sleep]");
726
727                 if (f2 & CISTPL_IDE_HAS_STANDBY)
728                         printk (" [standby]");
729
730                 if (f2 & CISTPL_IDE_HAS_IDLE)
731                         printk (" [idle]");
732
733                 if (f2 & CISTPL_IDE_LOW_POWER)
734                         printk (" [low power]");
735
736                 if (f2 & CISTPL_IDE_REG_INHIBIT)
737                         printk (" [reg inhibit]");
738
739                 if (f2 & CISTPL_IDE_HAS_INDEX)
740                         printk (" [index]");
741
742                 if (f2 & CISTPL_IDE_IOIS16)
743                         printk (" [IOis16]");
744
745                 break;
746             }
747         }
748         printk ("\n");
749 }
750
751 /* ------------------------------------------------------------------------- */
752
753
754 #define MAX_IDENT_CHARS         64
755 #define MAX_IDENT_FIELDS        4
756
757 static u8 *known_cards[] = {
758         "ARGOSY PnPIDE D5",
759         NULL
760 };
761
762 static int identify  (volatile u8 *p)
763 {
764         u8 id_str[MAX_IDENT_CHARS];
765         u8 data;
766         u8 *t;
767         u8 **card;
768         int i, done;
769
770         if (p == NULL)
771                 return (0);     /* Don't know */
772
773         t = id_str;
774         done =0;
775
776         for (i=0; i<=4 && !done; ++i, p+=2) {
777                 while ((data = *p) != '\0') {
778                         if (data == 0xFF) {
779                                 done = 1;
780                                 break;
781                         }
782                         *t++ = data;
783                         if (t == &id_str[MAX_IDENT_CHARS-1]) {
784                                 done = 1;
785                                 break;
786                         }
787                         p += 2;
788                 }
789                 if (!done)
790                         *t++ = ' ';
791         }
792         *t = '\0';
793         while (--t > id_str) {
794                 if (*t == ' ')
795                         *t = '\0';
796                 else
797                         break;
798         }
799         printk ("Card ID: %s\n", id_str);
800
801         for (card=known_cards; *card; ++card) {
802                 if (strcmp(*card, id_str) == 0) {       /* found! */
803                         return (1);
804                 }
805         }
806
807         return (0);     /* don't know */
808 }
809
810 static int __init mpc8xx_ide_probe(void)
811 {
812         hw_regs_t hw;
813         u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
814
815 #ifdef IDE0_BASE_OFFSET
816         memset(&hw, 0, sizeof(hw));
817         if (!m8xx_ide_init_ports(&hw, 0)) {
818                 ide_hwif_t *hwif = ide_find_port();
819
820                 if (hwif) {
821                         ide_init_port_hw(hwif, &hw);
822                         hwif->pio_mask = ATA_PIO4;
823                         hwif->port_ops = &m8xx_port_ops;
824
825                         idx[0] = hwif->index;
826                 }
827         }
828 #ifdef IDE1_BASE_OFFSET
829         memset(&hw, 0, sizeof(hw));
830         if (!m8xx_ide_init_ports(&hw, 1)) {
831                 ide_hwif_t *mate = ide_find_port();
832
833                 if (mate) {
834                         ide_init_port_hw(mate, &hw);
835                         mate->pio_mask = ATA_PIO4;
836                         mate->port_ops = &m8xx_port_ops;
837
838                         idx[1] = mate->index;
839                 }
840         }
841 #endif
842 #endif
843
844         ide_device_add(idx, NULL);
845
846         return 0;
847 }
848
849 module_init(mpc8xx_ide_probe);
850
851 MODULE_LICENSE("GPL");