regulator: da9211: Check return value of devm_kzalloc()
[firefly-linux-kernel-4.4.55.git] / 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 __initconst = {
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 bool 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");