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