release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/ide/umc8672.c

   1 /*
   2  *  Copyright (C) 1995-1996  Linus Torvalds & author (see below)
   3  */
   4
   5 /*
   6  *  Principal Author/Maintainer:  PODIEN@hml2.atlas.de (Wolfram Podien)
   7  *
   8  *  This file provides support for the advanced features
   9  *  of the UMC 8672 IDE interface.
  10  *
  11  *  Version 0.01        Initial version, hacked out of ide.c,
  12  *                      and #include'd rather than compiled separately.
  13  *                      This will get cleaned up in a subsequent release.
  14  *
  15  *  Version 0.02        now configs/compiles separate from ide.c  -ml
  16  *  Version 0.03        enhanced auto-tune, fix display bug
  17  *  Version 0.05        replace sti() with restore_flags()  -ml
  18  *                      add detection of possible race condition  -ml
  19  */
  20
  21 /*
  22  * VLB Controller Support from
  23  * Wolfram Podien
  24  * Rohoefe 3
  25  * D28832 Achim
  26  * Germany
  27  *
  28  * To enable UMC8672 support there must a lilo line like
  29  * append="ide0=umc8672"...
  30  * To set the speed according to the abilities of the hardware there must be a
  31  * line like
  32  * #define UMC_DRIVE0 11
  33  * in the beginning of the driver, which sets the speed of drive 0 to 11 (there
  34  * are some lines present). 0 - 11 are allowed speed values. These values are
  35  * the results from the DOS speed test program supplied from UMC. 11 is the
  36  * highest speed (about PIO mode 3)
  37  */
  38 #define REALLY_SLOW_IO          /* some systems can safely undef this */
  39
  40 #include <linux/module.h>
  41 #include <linux/types.h>
  42 #include <linux/kernel.h>
  43 #include <linux/delay.h>
  44 #include <linux/timer.h>
  45 #include <linux/mm.h>
  46 #include <linux/ioport.h>
  47 #include <linux/blkdev.h>
  48 #include <linux/ide.h>
  49 #include <linux/init.h>
  50
  51 #include <asm/io.h>
  52
  53 #define DRV_NAME "umc8672"
  54
  55 /*
  56  * Default speeds.  These can be changed with "auto-tune" and/or hdparm.
  57  */
  58 #define UMC_DRIVE0      1              /* DOS measured drive speeds */
  59 #define UMC_DRIVE1      1              /* 0 to 11 allowed */
  60 #define UMC_DRIVE2      1              /* 11 = Fastest Speed */
  61 #define UMC_DRIVE3      1              /* In case of crash reduce speed */
  62
  63 static u8 current_speeds[4] = {UMC_DRIVE0, UMC_DRIVE1, UMC_DRIVE2, UMC_DRIVE3};
  64 static const u8 pio_to_umc [5] = {0, 3, 7, 10, 11};     /* rough guesses */
  65
  66 /*       0    1    2    3    4    5    6    7    8    9    10   11      */
  67 static const u8 speedtab [3][12] = {
  68         {0x0f, 0x0b, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x1},
  69         {0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x1},
  70         {0xff, 0xcb, 0xc0, 0x58, 0x36, 0x33, 0x23, 0x22, 0x21, 0x11, 0x10, 0x0}
  71 };
  72
  73 static void out_umc(char port, char wert)
  74 {
  75         outb_p(port, 0x108);
  76         outb_p(wert, 0x109);
  77 }
  78
  79 static inline u8 in_umc(char port)
  80 {
  81         outb_p(port, 0x108);
  82         return inb_p(0x109);
  83 }
  84
  85 static void umc_set_speeds(u8 speeds[])
  86 {
  87         int i, tmp;
  88
  89         outb_p(0x5A, 0x108); /* enable umc */
  90
  91         out_umc(0xd7, (speedtab[0][speeds[2]] | (speedtab[0][speeds[3]]<<4)));
  92         out_umc(0xd6, (speedtab[0][speeds[0]] | (speedtab[0][speeds[1]]<<4)));
  93         tmp = 0;
  94         for (i = 3; i >= 0; i--)
  95                 tmp = (tmp << 2) | speedtab[1][speeds[i]];
  96         out_umc(0xdc, tmp);
  97         for (i = 0; i < 4; i++) {
  98                 out_umc(0xd0 + i, speedtab[2][speeds[i]]);
  99                 out_umc(0xd8 + i, speedtab[2][speeds[i]]);
 100         }
 101         outb_p(0xa5, 0x108); /* disable umc */
 102
 103         printk("umc8672: drive speeds [0 to 11]: %d %d %d %d\n",
 104                 speeds[0], speeds[1], speeds[2], speeds[3]);
 105 }
 106
 107 static void umc_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
 108 {
 109         ide_hwif_t *mate = hwif->mate;
 110         unsigned long uninitialized_var(flags);
 111         const u8 pio = drive->pio_mode - XFER_PIO_0;
 112
 113         printk("%s: setting umc8672 to PIO mode%d (speed %d)\n",
 114                 drive->name, pio, pio_to_umc[pio]);
 115         if (mate)
 116                 spin_lock_irqsave(&mate->lock, flags);
 117         if (mate && mate->handler) {
 118                 printk(KERN_ERR "umc8672: other interface is busy: exiting tune_umc()\n");
 119         } else {
 120                 current_speeds[drive->name[2] - 'a'] = pio_to_umc[pio];
 121                 umc_set_speeds(current_speeds);
 122         }
 123         if (mate)
 124                 spin_unlock_irqrestore(&mate->lock, flags);
 125 }
 126
 127 static const struct ide_port_ops umc8672_port_ops = {
 128         .set_pio_mode           = umc_set_pio_mode,
 129 };
 130
 131 static const struct ide_port_info umc8672_port_info __initdata = {
 132         .name                   = DRV_NAME,
 133         .chipset                = ide_umc8672,
 134         .port_ops               = &umc8672_port_ops,
 135         .host_flags             = IDE_HFLAG_NO_DMA,
 136         .pio_mask               = ATA_PIO4,
 137 };
 138
 139 static int __init umc8672_probe(void)
 140 {
 141         unsigned long flags;
 142
 143         if (!request_region(0x108, 2, "umc8672")) {
 144                 printk(KERN_ERR "umc8672: ports 0x108-0x109 already in use.\n");
 145                 return 1;
 146         }
 147         local_irq_save(flags);
 148         outb_p(0x5A, 0x108); /* enable umc */
 149         if (in_umc (0xd5) != 0xa0) {
 150                 local_irq_restore(flags);
 151                 printk(KERN_ERR "umc8672: not found\n");
 152                 release_region(0x108, 2);
 153                 return 1;
 154         }
 155         outb_p(0xa5, 0x108); /* disable umc */
 156
 157         umc_set_speeds(current_speeds);
 158         local_irq_restore(flags);
 159
 160         return ide_legacy_device_add(&umc8672_port_info, 0);
 161 }
 162
 163 static int probe_umc8672;
 164
 165 module_param_named(probe, probe_umc8672, bool, 0);
 166 MODULE_PARM_DESC(probe, "probe for UMC8672 chipset");
 167
 168 static int __init umc8672_init(void)
 169 {
 170         if (probe_umc8672 == 0)
 171                 goto out;
 172
 173         if (umc8672_probe() == 0)
 174                 return 0;
 175 out:
 176         return -ENODEV;
 177 }
 178
 179 module_init(umc8672_init);
 180
 181 MODULE_AUTHOR("Wolfram Podien");
 182 MODULE_DESCRIPTION("Support for UMC 8672 IDE chipset");
 183 MODULE_LICENSE("GPL");