1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38#define REALLY_SLOW_IO
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
57
58#define UMC_DRIVE0 1
59#define UMC_DRIVE1 1
60#define UMC_DRIVE2 1
61#define UMC_DRIVE3 1
62
63static u8 current_speeds[4] = {UMC_DRIVE0, UMC_DRIVE1, UMC_DRIVE2, UMC_DRIVE3};
64static const u8 pio_to_umc [5] = {0, 3, 7, 10, 11};
65
66
67static 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
73static void out_umc(char port, char wert)
74{
75 outb_p(port, 0x108);
76 outb_p(wert, 0x109);
77}
78
79static inline u8 in_umc(char port)
80{
81 outb_p(port, 0x108);
82 return inb_p(0x109);
83}
84
85static void umc_set_speeds(u8 speeds[])
86{
87 int i, tmp;
88
89 outb_p(0x5A, 0x108);
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);
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
107static 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
127static const struct ide_port_ops umc8672_port_ops = {
128 .set_pio_mode = umc_set_pio_mode,
129};
130
131static 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
139static 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);
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);
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
163static bool probe_umc8672;
164
165module_param_named(probe, probe_umc8672, bool, 0);
166MODULE_PARM_DESC(probe, "probe for UMC8672 chipset");
167
168static int __init umc8672_init(void)
169{
170 if (probe_umc8672 == 0)
171 goto out;
172
173 if (umc8672_probe() == 0)
174 return 0;
175out:
176 return -ENODEV;
177}
178
179module_init(umc8672_init);
180
181MODULE_AUTHOR("Wolfram Podien");
182MODULE_DESCRIPTION("Support for UMC 8672 IDE chipset");
183MODULE_LICENSE("GPL");
184