git.oblomov.eu Git - linux-2.6/blob - drivers/ide/legacy/q40ide.c

   1 /*
   2  *  Q40 I/O port IDE Driver
   3  *
   4  *     (c) Richard Zidlicky
   5  *
   6  *  This file is subject to the terms and conditions of the GNU General Public
   7  *  License.  See the file COPYING in the main directory of this archive for
   8  *  more details.
   9  *
  10  *
  11  */
  12
  13 #include <linux/types.h>
  14 #include <linux/mm.h>
  15 #include <linux/interrupt.h>
  16 #include <linux/blkdev.h>
  17 #include <linux/hdreg.h>
  18
  19 #include <linux/ide.h>
  20
  21     /*
  22      *  Bases of the IDE interfaces
  23      */
  24
  25 #define Q40IDE_NUM_HWIFS        2
  26
  27 #define PCIDE_BASE1     0x1f0
  28 #define PCIDE_BASE2     0x170
  29 #define PCIDE_BASE3     0x1e8
  30 #define PCIDE_BASE4     0x168
  31 #define PCIDE_BASE5     0x1e0
  32 #define PCIDE_BASE6     0x160
  33
  34 static const unsigned long pcide_bases[Q40IDE_NUM_HWIFS] = {
  35     PCIDE_BASE1, PCIDE_BASE2, /* PCIDE_BASE3, PCIDE_BASE4  , PCIDE_BASE5,
  36     PCIDE_BASE6 */
  37 };
  38
  39 static int q40ide_default_irq(unsigned long base)
  40 {
  41            switch (base) {
  42                     case 0x1f0: return 14;
  43                     case 0x170: return 15;
  44                     case 0x1e8: return 11;
  45                     default:
  46                         return 0;
  47            }
  48 }
  49
  50
  51 /*
  52  * Addresses are pretranslated for Q40 ISA access.
  53  */
  54 static void q40_ide_setup_ports(hw_regs_t *hw, unsigned long base,
  55                         ide_ack_intr_t *ack_intr,
  56                         int irq)
  57 {
  58         memset(hw, 0, sizeof(hw_regs_t));
  59         /* BIG FAT WARNING:
  60            assumption: only DATA port is ever used in 16 bit mode */
  61         hw->io_ports.data_addr = Q40_ISA_IO_W(base);
  62         hw->io_ports.error_addr = Q40_ISA_IO_B(base + 1);
  63         hw->io_ports.nsect_addr = Q40_ISA_IO_B(base + 2);
  64         hw->io_ports.lbal_addr = Q40_ISA_IO_B(base + 3);
  65         hw->io_ports.lbam_addr = Q40_ISA_IO_B(base + 4);
  66         hw->io_ports.lbah_addr = Q40_ISA_IO_B(base + 5);
  67         hw->io_ports.device_addr = Q40_ISA_IO_B(base + 6);
  68         hw->io_ports.status_addr = Q40_ISA_IO_B(base + 7);
  69         hw->io_ports.ctl_addr = Q40_ISA_IO_B(base + 0x206);
  70
  71         hw->irq = irq;
  72         hw->ack_intr = ack_intr;
  73
  74         hw->chipset = ide_generic;
  75 }
  76
  77 static void q40ide_input_data(ide_drive_t *drive, struct request *rq,
  78                               void *buf, unsigned int len)
  79 {
  80         unsigned long data_addr = drive->hwif->io_ports.data_addr;
  81
  82         if (drive->media == ide_disk && rq && rq->cmd_type == REQ_TYPE_FS)
  83                 return insw(data_addr, buf, (len + 1) / 2);
  84
  85         insw_swapw(data_addr, buf, (len + 1) / 2);
  86 }
  87
  88 static void q40ide_output_data(ide_drive_t *drive, struct request *rq,
  89                                void *buf, unsigned int len)
  90 {
  91         unsigned long data_addr = drive->hwif->io_ports.data_addr;
  92
  93         if (drive->media == ide_disk && rq && rq->cmd_type == REQ_TYPE_FS)
  94                 return outsw(data_addr, buf, (len + 1) / 2);
  95
  96         outsw_swapw(data_addr, buf, (len + 1) / 2);
  97 }
  98
  99 /*
 100  * the static array is needed to have the name reported in /proc/ioports,
 101  * hwif->name unfortunately isn't available yet
 102  */
 103 static const char *q40_ide_names[Q40IDE_NUM_HWIFS]={
 104         "ide0", "ide1"
 105 };
 106
 107 /*
 108  *  Probe for Q40 IDE interfaces
 109  */
 110
 111 static int __init q40ide_init(void)
 112 {
 113     int i;
 114     ide_hwif_t *hwif;
 115     const char *name;
 116     u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
 117
 118     if (!MACH_IS_Q40)
 119       return -ENODEV;
 120
 121     printk(KERN_INFO "ide: Q40 IDE controller\n");
 122
 123     for (i = 0; i < Q40IDE_NUM_HWIFS; i++) {
 124         hw_regs_t hw;
 125
 126         name = q40_ide_names[i];
 127         if (!request_region(pcide_bases[i], 8, name)) {
 128                 printk("could not reserve ports %lx-%lx for %s\n",
 129                        pcide_bases[i],pcide_bases[i]+8,name);
 130                 continue;
 131         }
 132         if (!request_region(pcide_bases[i]+0x206, 1, name)) {
 133                 printk("could not reserve port %lx for %s\n",
 134                        pcide_bases[i]+0x206,name);
 135                 release_region(pcide_bases[i], 8);
 136                 continue;
 137         }
 138         q40_ide_setup_ports(&hw, pcide_bases[i],
 139                         NULL,
 140 //                      m68kide_iops,
 141                         q40ide_default_irq(pcide_bases[i]));
 142
 143         hwif = ide_find_port();
 144         if (hwif) {
 145                 ide_init_port_data(hwif, hwif->index);
 146                 ide_init_port_hw(hwif, &hw);
 147
 148                 /* Q40 has a byte-swapped IDE interface */
 149                 hwif->input_data  = q40ide_input_data;
 150                 hwif->output_data = q40ide_output_data;
 151
 152                 idx[i] = hwif->index;
 153         }
 154     }
 155
 156     ide_device_add(idx, NULL);
 157
 158     return 0;
 159 }
 160
 161 module_init(q40ide_init);
 162
 163 MODULE_LICENSE("GPL");