blob: 2c6d3423496b34db28e9f52ccf0592ca69d9892c [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * This file contains the driver for an XT hard disk controller
3 * (at least the DTC 5150X) for Linux.
4 *
5 * Author: Pat Mackinlay, pat@it.com.au
6 * Date: 29/09/92
7 *
8 * Revised: 01/01/93, ...
9 *
10 * Ref: DTC 5150X Controller Specification (thanks to Kevin Fowler,
11 * kevinf@agora.rain.com)
12 * Also thanks to: Salvador Abreu, Dave Thaler, Risto Kankkunen and
13 * Wim Van Dorst.
14 *
15 * Revised: 04/04/94 by Risto Kankkunen
16 * Moved the detection code from xd_init() to xd_geninit() as it needed
17 * interrupts enabled and Linus didn't want to enable them in that first
18 * phase. xd_geninit() is the place to do these kinds of things anyway,
19 * he says.
20 *
21 * Modularized: 04/10/96 by Todd Fries, tfries@umr.edu
22 *
23 * Revised: 13/12/97 by Andrzej Krzysztofowicz, ankry@mif.pg.gda.pl
24 * Fixed some problems with disk initialization and module initiation.
25 * Added support for manual geometry setting (except Seagate controllers)
26 * in form:
27 * xd_geo=<cyl_xda>,<head_xda>,<sec_xda>[,<cyl_xdb>,<head_xdb>,<sec_xdb>]
28 * Recovered DMA access. Abridged messages. Added support for DTC5051CX,
29 * WD1002-27X & XEBEC controllers. Driver uses now some jumper settings.
30 * Extended ioctl() support.
31 *
32 * Bugfix: 15/02/01, Paul G. - inform queue layer of tiny xd_maxsect.
33 *
34 */
35
36#include <linux/module.h>
37#include <linux/errno.h>
38#include <linux/interrupt.h>
39#include <linux/mm.h>
40#include <linux/fs.h>
41#include <linux/kernel.h>
42#include <linux/timer.h>
43#include <linux/genhd.h>
44#include <linux/hdreg.h>
45#include <linux/ioport.h>
46#include <linux/init.h>
47#include <linux/wait.h>
48#include <linux/blkdev.h>
49#include <linux/blkpg.h>
Nishanth Aravamudanf6a2f342005-09-10 00:27:14 -070050#include <linux/delay.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
52#include <asm/system.h>
53#include <asm/io.h>
54#include <asm/uaccess.h>
55#include <asm/dma.h>
56
57#include "xd.h"
58
59static void __init do_xd_setup (int *integers);
60#ifdef MODULE
61static int xd[5] = { -1,-1,-1,-1, };
62#endif
63
64#define XD_DONT_USE_DMA 0 /* Initial value. may be overriden using
65 "nodma" module option */
Nishanth Aravamudanf6a2f342005-09-10 00:27:14 -070066#define XD_INIT_DISK_DELAY (30) /* 30 ms delay during disk initialization */
Linus Torvalds1da177e2005-04-16 15:20:36 -070067
68/* Above may need to be increased if a problem with the 2nd drive detection
69 (ST11M controller) or resetting a controller (WD) appears */
70
71static XD_INFO xd_info[XD_MAXDRIVES];
72
73/* If you try this driver and find that your card is not detected by the driver at bootup, you need to add your BIOS
74 signature and details to the following list of signatures. A BIOS signature is a string embedded into the first
75 few bytes of your controller's on-board ROM BIOS. To find out what yours is, use something like MS-DOS's DEBUG
76 command. Run DEBUG, and then you can examine your BIOS signature with:
77
78 d xxxx:0000
79
80 where xxxx is the segment of your controller (like C800 or D000 or something). On the ASCII dump at the right, you should
81 be able to see a string mentioning the manufacturer's copyright etc. Add this string into the table below. The parameters
82 in the table are, in order:
83
84 offset ; this is the offset (in bytes) from the start of your ROM where the signature starts
85 signature ; this is the actual text of the signature
86 xd_?_init_controller ; this is the controller init routine used by your controller
87 xd_?_init_drive ; this is the drive init routine used by your controller
88
89 The controllers directly supported at the moment are: DTC 5150x, WD 1004A27X, ST11M/R and override. If your controller is
90 made by the same manufacturer as one of these, try using the same init routines as they do. If that doesn't work, your
91 best bet is to use the "override" routines. These routines use a "portable" method of getting the disk's geometry, and
92 may work with your card. If none of these seem to work, try sending me some email and I'll see what I can do <grin>.
93
94 NOTE: You can now specify your XT controller's parameters from the command line in the form xd=TYPE,IRQ,IO,DMA. The driver
95 should be able to detect your drive's geometry from this info. (eg: xd=0,5,0x320,3 is the "standard"). */
96
97#include <asm/page.h>
98#define xd_dma_mem_alloc(size) __get_dma_pages(GFP_KERNEL,get_order(size))
99#define xd_dma_mem_free(addr, size) free_pages(addr, get_order(size))
100static char *xd_dma_buffer;
101
102static XD_SIGNATURE xd_sigs[] __initdata = {
103 { 0x0000,"Override geometry handler",NULL,xd_override_init_drive,"n unknown" }, /* Pat Mackinlay, pat@it.com.au */
104 { 0x0008,"[BXD06 (C) DTC 17-MAY-1985]",xd_dtc_init_controller,xd_dtc5150cx_init_drive," DTC 5150CX" }, /* Andrzej Krzysztofowicz, ankry@mif.pg.gda.pl */
105 { 0x000B,"CRD18A Not an IBM rom. (C) Copyright Data Technology Corp. 05/31/88",xd_dtc_init_controller,xd_dtc_init_drive," DTC 5150X" }, /* Todd Fries, tfries@umr.edu */
106 { 0x000B,"CXD23A Not an IBM ROM (C)Copyright Data Technology Corp 12/03/88",xd_dtc_init_controller,xd_dtc_init_drive," DTC 5150X" }, /* Pat Mackinlay, pat@it.com.au */
107 { 0x0008,"07/15/86(C) Copyright 1986 Western Digital Corp.",xd_wd_init_controller,xd_wd_init_drive," Western Dig. 1002-27X" }, /* Andrzej Krzysztofowicz, ankry@mif.pg.gda.pl */
108 { 0x0008,"06/24/88(C) Copyright 1988 Western Digital Corp.",xd_wd_init_controller,xd_wd_init_drive," Western Dig. WDXT-GEN2" }, /* Dan Newcombe, newcombe@aa.csc.peachnet.edu */
109 { 0x0015,"SEAGATE ST11 BIOS REVISION",xd_seagate_init_controller,xd_seagate_init_drive," Seagate ST11M/R" }, /* Salvador Abreu, spa@fct.unl.pt */
110 { 0x0010,"ST11R BIOS",xd_seagate_init_controller,xd_seagate_init_drive," Seagate ST11M/R" }, /* Risto Kankkunen, risto.kankkunen@cs.helsinki.fi */
111 { 0x0010,"ST11 BIOS v1.7",xd_seagate_init_controller,xd_seagate_init_drive," Seagate ST11R" }, /* Alan Hourihane, alanh@fairlite.demon.co.uk */
112 { 0x1000,"(c)Copyright 1987 SMS",xd_omti_init_controller,xd_omti_init_drive,"n OMTI 5520" }, /* Dirk Melchers, dirk@merlin.nbg.sub.org */
113 { 0x0006,"COPYRIGHT XEBEC (C) 1984",xd_xebec_init_controller,xd_xebec_init_drive," XEBEC" }, /* Andrzej Krzysztofowicz, ankry@mif.pg.gda.pl */
114 { 0x0008,"(C) Copyright 1984 Western Digital Corp", xd_wd_init_controller, xd_wd_init_drive," Western Dig. 1002s-wx2" },
115 { 0x0008,"(C) Copyright 1986 Western Digital Corporation", xd_wd_init_controller, xd_wd_init_drive," 1986 Western Digital" }, /* jfree@sovereign.org */
116};
117
118static unsigned int xd_bases[] __initdata =
119{
120 0xC8000, 0xCA000, 0xCC000,
121 0xCE000, 0xD0000, 0xD2000,
122 0xD4000, 0xD6000, 0xD8000,
123 0xDA000, 0xDC000, 0xDE000,
124 0xE0000
125};
126
127static DEFINE_SPINLOCK(xd_lock);
128
129static struct gendisk *xd_gendisk[2];
130
131static struct block_device_operations xd_fops = {
132 .owner = THIS_MODULE,
133 .ioctl = xd_ioctl,
134};
135static DECLARE_WAIT_QUEUE_HEAD(xd_wait_int);
136static u_char xd_drives, xd_irq = 5, xd_dma = 3, xd_maxsectors;
137static u_char xd_override __initdata = 0, xd_type __initdata = 0;
138static u_short xd_iobase = 0x320;
139static int xd_geo[XD_MAXDRIVES*3] __initdata = { 0, };
140
141static volatile int xdc_busy;
142static struct timer_list xd_watchdog_int;
143
144static volatile u_char xd_error;
145static int nodma = XD_DONT_USE_DMA;
146
147static struct request_queue *xd_queue;
148
149/* xd_init: register the block device number and set up pointer tables */
150static int __init xd_init(void)
151{
152 u_char i,controller;
153 unsigned int address;
154 int err;
155
156#ifdef MODULE
157 {
158 u_char count = 0;
159 for (i = 4; i > 0; i--)
160 if (((xd[i] = xd[i-1]) >= 0) && !count)
161 count = i;
162 if ((xd[0] = count))
163 do_xd_setup(xd);
164 }
165#endif
166
167 init_timer (&xd_watchdog_int); xd_watchdog_int.function = xd_watchdog;
168
169 if (!xd_dma_buffer)
170 xd_dma_buffer = (char *)xd_dma_mem_alloc(xd_maxsectors * 0x200);
171 if (!xd_dma_buffer) {
172 printk(KERN_ERR "xd: Out of memory.\n");
173 return -ENOMEM;
174 }
175
176 err = -EBUSY;
177 if (register_blkdev(XT_DISK_MAJOR, "xd"))
178 goto out1;
179
180 err = -ENOMEM;
181 xd_queue = blk_init_queue(do_xd_request, &xd_lock);
182 if (!xd_queue)
183 goto out1a;
184
185 if (xd_detect(&controller,&address)) {
186
187 printk("Detected a%s controller (type %d) at address %06x\n",
188 xd_sigs[controller].name,controller,address);
189 if (!request_region(xd_iobase,4,"xd")) {
190 printk("xd: Ports at 0x%x are not available\n",
191 xd_iobase);
192 goto out2;
193 }
194 if (controller)
195 xd_sigs[controller].init_controller(address);
196 xd_drives = xd_initdrives(xd_sigs[controller].init_drive);
197
198 printk("Detected %d hard drive%s (using IRQ%d & DMA%d)\n",
199 xd_drives,xd_drives == 1 ? "" : "s",xd_irq,xd_dma);
200 }
201
202 err = -ENODEV;
203 if (!xd_drives)
204 goto out3;
205
206 for (i = 0; i < xd_drives; i++) {
207 XD_INFO *p = &xd_info[i];
208 struct gendisk *disk = alloc_disk(64);
209 if (!disk)
210 goto Enomem;
211 p->unit = i;
212 disk->major = XT_DISK_MAJOR;
213 disk->first_minor = i<<6;
214 sprintf(disk->disk_name, "xd%c", i+'a');
215 sprintf(disk->devfs_name, "xd/target%d", i);
216 disk->fops = &xd_fops;
217 disk->private_data = p;
218 disk->queue = xd_queue;
219 set_capacity(disk, p->heads * p->cylinders * p->sectors);
220 printk(" %s: CHS=%d/%d/%d\n", disk->disk_name,
221 p->cylinders, p->heads, p->sectors);
222 xd_gendisk[i] = disk;
223 }
224
225 err = -EBUSY;
226 if (request_irq(xd_irq,xd_interrupt_handler, 0, "XT hard disk", NULL)) {
227 printk("xd: unable to get IRQ%d\n",xd_irq);
228 goto out4;
229 }
230
231 if (request_dma(xd_dma,"xd")) {
232 printk("xd: unable to get DMA%d\n",xd_dma);
233 goto out5;
234 }
235
236 /* xd_maxsectors depends on controller - so set after detection */
237 blk_queue_max_sectors(xd_queue, xd_maxsectors);
238
239 for (i = 0; i < xd_drives; i++)
240 add_disk(xd_gendisk[i]);
241
242 return 0;
243
244out5:
245 free_irq(xd_irq, NULL);
246out4:
247 for (i = 0; i < xd_drives; i++)
248 put_disk(xd_gendisk[i]);
249out3:
250 release_region(xd_iobase,4);
251out2:
252 blk_cleanup_queue(xd_queue);
253out1a:
254 unregister_blkdev(XT_DISK_MAJOR, "xd");
255out1:
256 if (xd_dma_buffer)
257 xd_dma_mem_free((unsigned long)xd_dma_buffer,
258 xd_maxsectors * 0x200);
259 return err;
260Enomem:
261 err = -ENOMEM;
262 while (i--)
263 put_disk(xd_gendisk[i]);
264 goto out3;
265}
266
267/* xd_detect: scan the possible BIOS ROM locations for the signature strings */
268static u_char __init xd_detect (u_char *controller, unsigned int *address)
269{
270 int i, j;
271
272 if (xd_override)
273 {
274 *controller = xd_type;
275 *address = 0;
276 return(1);
277 }
278
279 for (i = 0; i < (sizeof(xd_bases) / sizeof(xd_bases[0])); i++) {
280 void __iomem *p = ioremap(xd_bases[i], 0x2000);
281 if (!p)
282 continue;
283 for (j = 1; j < (sizeof(xd_sigs) / sizeof(xd_sigs[0])); j++) {
284 const char *s = xd_sigs[j].string;
285 if (check_signature(p + xd_sigs[j].offset, s, strlen(s))) {
286 *controller = j;
287 xd_type = j;
288 *address = xd_bases[i];
289 iounmap(p);
290 return 1;
291 }
292 }
293 iounmap(p);
294 }
295 return 0;
296}
297
298/* do_xd_request: handle an incoming request */
299static void do_xd_request (request_queue_t * q)
300{
301 struct request *req;
302
303 if (xdc_busy)
304 return;
305
306 while ((req = elv_next_request(q)) != NULL) {
307 unsigned block = req->sector;
308 unsigned count = req->nr_sectors;
309 int rw = rq_data_dir(req);
310 XD_INFO *disk = req->rq_disk->private_data;
311 int res = 0;
312 int retry;
313
314 if (!(req->flags & REQ_CMD)) {
315 end_request(req, 0);
316 continue;
317 }
318 if (block + count > get_capacity(req->rq_disk)) {
319 end_request(req, 0);
320 continue;
321 }
322 if (rw != READ && rw != WRITE) {
323 printk("do_xd_request: unknown request\n");
324 end_request(req, 0);
325 continue;
326 }
327 for (retry = 0; (retry < XD_RETRIES) && !res; retry++)
328 res = xd_readwrite(rw, disk, req->buffer, block, count);
329 end_request(req, res); /* wrap up, 0 = fail, 1 = success */
330 }
331}
332
333/* xd_ioctl: handle device ioctl's */
334static int xd_ioctl (struct inode *inode,struct file *file,u_int cmd,u_long arg)
335{
336 XD_INFO *p = inode->i_bdev->bd_disk->private_data;
337
338 switch (cmd) {
339 case HDIO_GETGEO:
340 {
341 struct hd_geometry g;
342 struct hd_geometry __user *geom= (void __user *)arg;
343 g.heads = p->heads;
344 g.sectors = p->sectors;
345 g.cylinders = p->cylinders;
346 g.start = get_start_sect(inode->i_bdev);
347 return copy_to_user(geom, &g, sizeof(g)) ? -EFAULT : 0;
348 }
349 case HDIO_SET_DMA:
350 if (!capable(CAP_SYS_ADMIN)) return -EACCES;
351 if (xdc_busy) return -EBUSY;
352 nodma = !arg;
353 if (nodma && xd_dma_buffer) {
354 xd_dma_mem_free((unsigned long)xd_dma_buffer,
355 xd_maxsectors * 0x200);
356 xd_dma_buffer = NULL;
357 } else if (!nodma && !xd_dma_buffer) {
358 xd_dma_buffer = (char *)xd_dma_mem_alloc(xd_maxsectors * 0x200);
359 if (!xd_dma_buffer) {
360 nodma = XD_DONT_USE_DMA;
361 return -ENOMEM;
362 }
363 }
364 return 0;
365 case HDIO_GET_DMA:
366 return put_user(!nodma, (long __user *) arg);
367 case HDIO_GET_MULTCOUNT:
368 return put_user(xd_maxsectors, (long __user *) arg);
369 default:
370 return -EINVAL;
371 }
372}
373
374/* xd_readwrite: handle a read/write request */
375static int xd_readwrite (u_char operation,XD_INFO *p,char *buffer,u_int block,u_int count)
376{
377 int drive = p->unit;
378 u_char cmdblk[6],sense[4];
379 u_short track,cylinder;
380 u_char head,sector,control,mode = PIO_MODE,temp;
381 char **real_buffer;
382 register int i;
383
384#ifdef DEBUG_READWRITE
385 printk("xd_readwrite: operation = %s, drive = %d, buffer = 0x%X, block = %d, count = %d\n",operation == READ ? "read" : "write",drive,buffer,block,count);
386#endif /* DEBUG_READWRITE */
387
388 spin_unlock_irq(&xd_lock);
389
390 control = p->control;
391 if (!xd_dma_buffer)
392 xd_dma_buffer = (char *)xd_dma_mem_alloc(xd_maxsectors * 0x200);
393 while (count) {
394 temp = count < xd_maxsectors ? count : xd_maxsectors;
395
396 track = block / p->sectors;
397 head = track % p->heads;
398 cylinder = track / p->heads;
399 sector = block % p->sectors;
400
401#ifdef DEBUG_READWRITE
402 printk("xd_readwrite: drive = %d, head = %d, cylinder = %d, sector = %d, count = %d\n",drive,head,cylinder,sector,temp);
403#endif /* DEBUG_READWRITE */
404
405 if (xd_dma_buffer) {
406 mode = xd_setup_dma(operation == READ ? DMA_MODE_READ : DMA_MODE_WRITE,(u_char *)(xd_dma_buffer),temp * 0x200);
407 real_buffer = &xd_dma_buffer;
408 for (i=0; i < (temp * 0x200); i++)
409 xd_dma_buffer[i] = buffer[i];
410 }
411 else
412 real_buffer = &buffer;
413
414 xd_build(cmdblk,operation == READ ? CMD_READ : CMD_WRITE,drive,head,cylinder,sector,temp & 0xFF,control);
415
416 switch (xd_command(cmdblk,mode,(u_char *)(*real_buffer),(u_char *)(*real_buffer),sense,XD_TIMEOUT)) {
417 case 1:
418 printk("xd%c: %s timeout, recalibrating drive\n",'a'+drive,(operation == READ ? "read" : "write"));
419 xd_recalibrate(drive);
420 spin_lock_irq(&xd_lock);
421 return (0);
422 case 2:
423 if (sense[0] & 0x30) {
424 printk("xd%c: %s - ",'a'+drive,(operation == READ ? "reading" : "writing"));
425 switch ((sense[0] & 0x30) >> 4) {
426 case 0: printk("drive error, code = 0x%X",sense[0] & 0x0F);
427 break;
428 case 1: printk("controller error, code = 0x%X",sense[0] & 0x0F);
429 break;
430 case 2: printk("command error, code = 0x%X",sense[0] & 0x0F);
431 break;
432 case 3: printk("miscellaneous error, code = 0x%X",sense[0] & 0x0F);
433 break;
434 }
435 }
436 if (sense[0] & 0x80)
437 printk(" - CHS = %d/%d/%d\n",((sense[2] & 0xC0) << 2) | sense[3],sense[1] & 0x1F,sense[2] & 0x3F);
438 /* reported drive number = (sense[1] & 0xE0) >> 5 */
439 else
440 printk(" - no valid disk address\n");
441 spin_lock_irq(&xd_lock);
442 return (0);
443 }
444 if (xd_dma_buffer)
445 for (i=0; i < (temp * 0x200); i++)
446 buffer[i] = xd_dma_buffer[i];
447
448 count -= temp, buffer += temp * 0x200, block += temp;
449 }
450 spin_lock_irq(&xd_lock);
451 return (1);
452}
453
454/* xd_recalibrate: recalibrate a given drive and reset controller if necessary */
455static void xd_recalibrate (u_char drive)
456{
457 u_char cmdblk[6];
458
459 xd_build(cmdblk,CMD_RECALIBRATE,drive,0,0,0,0,0);
460 if (xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT * 8))
461 printk("xd%c: warning! error recalibrating, controller may be unstable\n", 'a'+drive);
462}
463
464/* xd_interrupt_handler: interrupt service routine */
465static irqreturn_t xd_interrupt_handler(int irq, void *dev_id,
466 struct pt_regs *regs)
467{
468 if (inb(XD_STATUS) & STAT_INTERRUPT) { /* check if it was our device */
469#ifdef DEBUG_OTHER
470 printk("xd_interrupt_handler: interrupt detected\n");
471#endif /* DEBUG_OTHER */
472 outb(0,XD_CONTROL); /* acknowledge interrupt */
473 wake_up(&xd_wait_int); /* and wake up sleeping processes */
474 return IRQ_HANDLED;
475 }
476 else
477 printk("xd: unexpected interrupt\n");
478 return IRQ_NONE;
479}
480
481/* xd_setup_dma: set up the DMA controller for a data transfer */
482static u_char xd_setup_dma (u_char mode,u_char *buffer,u_int count)
483{
484 unsigned long f;
485
486 if (nodma)
487 return (PIO_MODE);
488 if (((unsigned long) buffer & 0xFFFF0000) != (((unsigned long) buffer + count) & 0xFFFF0000)) {
489#ifdef DEBUG_OTHER
490 printk("xd_setup_dma: using PIO, transfer overlaps 64k boundary\n");
491#endif /* DEBUG_OTHER */
492 return (PIO_MODE);
493 }
494
495 f=claim_dma_lock();
496 disable_dma(xd_dma);
497 clear_dma_ff(xd_dma);
498 set_dma_mode(xd_dma,mode);
499 set_dma_addr(xd_dma, (unsigned long) buffer);
500 set_dma_count(xd_dma,count);
501
502 release_dma_lock(f);
503
504 return (DMA_MODE); /* use DMA and INT */
505}
506
507/* xd_build: put stuff into an array in a format suitable for the controller */
508static u_char *xd_build (u_char *cmdblk,u_char command,u_char drive,u_char head,u_short cylinder,u_char sector,u_char count,u_char control)
509{
510 cmdblk[0] = command;
511 cmdblk[1] = ((drive & 0x07) << 5) | (head & 0x1F);
512 cmdblk[2] = ((cylinder & 0x300) >> 2) | (sector & 0x3F);
513 cmdblk[3] = cylinder & 0xFF;
514 cmdblk[4] = count;
515 cmdblk[5] = control;
516
517 return (cmdblk);
518}
519
520static void xd_watchdog (unsigned long unused)
521{
522 xd_error = 1;
523 wake_up(&xd_wait_int);
524}
525
526/* xd_waitport: waits until port & mask == flags or a timeout occurs. return 1 for a timeout */
527static inline u_char xd_waitport (u_short port,u_char flags,u_char mask,u_long timeout)
528{
529 u_long expiry = jiffies + timeout;
530 int success;
531
532 xdc_busy = 1;
533 while ((success = ((inb(port) & mask) != flags)) && time_before(jiffies, expiry)) {
534 set_current_state(TASK_UNINTERRUPTIBLE);
535 schedule_timeout(1);
536 }
537 xdc_busy = 0;
538 return (success);
539}
540
541static inline u_int xd_wait_for_IRQ (void)
542{
543 unsigned long flags;
544 xd_watchdog_int.expires = jiffies + 8 * HZ;
545 add_timer(&xd_watchdog_int);
546
547 flags=claim_dma_lock();
548 enable_dma(xd_dma);
549 release_dma_lock(flags);
550
551 sleep_on(&xd_wait_int);
552 del_timer(&xd_watchdog_int);
553 xdc_busy = 0;
554
555 flags=claim_dma_lock();
556 disable_dma(xd_dma);
557 release_dma_lock(flags);
558
559 if (xd_error) {
560 printk("xd: missed IRQ - command aborted\n");
561 xd_error = 0;
562 return (1);
563 }
564 return (0);
565}
566
567/* xd_command: handle all data transfers necessary for a single command */
568static u_int xd_command (u_char *command,u_char mode,u_char *indata,u_char *outdata,u_char *sense,u_long timeout)
569{
570 u_char cmdblk[6],csb,complete = 0;
571
572#ifdef DEBUG_COMMAND
573 printk("xd_command: command = 0x%X, mode = 0x%X, indata = 0x%X, outdata = 0x%X, sense = 0x%X\n",command,mode,indata,outdata,sense);
574#endif /* DEBUG_COMMAND */
575
576 outb(0,XD_SELECT);
577 outb(mode,XD_CONTROL);
578
579 if (xd_waitport(XD_STATUS,STAT_SELECT,STAT_SELECT,timeout))
580 return (1);
581
582 while (!complete) {
583 if (xd_waitport(XD_STATUS,STAT_READY,STAT_READY,timeout))
584 return (1);
585
586 switch (inb(XD_STATUS) & (STAT_COMMAND | STAT_INPUT)) {
587 case 0:
588 if (mode == DMA_MODE) {
589 if (xd_wait_for_IRQ())
590 return (1);
591 } else
592 outb(outdata ? *outdata++ : 0,XD_DATA);
593 break;
594 case STAT_INPUT:
595 if (mode == DMA_MODE) {
596 if (xd_wait_for_IRQ())
597 return (1);
598 } else
599 if (indata)
600 *indata++ = inb(XD_DATA);
601 else
602 inb(XD_DATA);
603 break;
604 case STAT_COMMAND:
605 outb(command ? *command++ : 0,XD_DATA);
606 break;
607 case STAT_COMMAND | STAT_INPUT:
608 complete = 1;
609 break;
610 }
611 }
612 csb = inb(XD_DATA);
613
614 if (xd_waitport(XD_STATUS,0,STAT_SELECT,timeout)) /* wait until deselected */
615 return (1);
616
617 if (csb & CSB_ERROR) { /* read sense data if error */
618 xd_build(cmdblk,CMD_SENSE,(csb & CSB_LUN) >> 5,0,0,0,0,0);
619 if (xd_command(cmdblk,0,sense,NULL,NULL,XD_TIMEOUT))
620 printk("xd: warning! sense command failed!\n");
621 }
622
623#ifdef DEBUG_COMMAND
624 printk("xd_command: completed with csb = 0x%X\n",csb);
625#endif /* DEBUG_COMMAND */
626
627 return (csb & CSB_ERROR);
628}
629
630static u_char __init xd_initdrives (void (*init_drive)(u_char drive))
631{
632 u_char cmdblk[6],i,count = 0;
633
634 for (i = 0; i < XD_MAXDRIVES; i++) {
635 xd_build(cmdblk,CMD_TESTREADY,i,0,0,0,0,0);
636 if (!xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT*8)) {
Nishanth Aravamudanf6a2f342005-09-10 00:27:14 -0700637 msleep_interruptible(XD_INIT_DISK_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638
639 init_drive(count);
640 count++;
641
Nishanth Aravamudanf6a2f342005-09-10 00:27:14 -0700642 msleep_interruptible(XD_INIT_DISK_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643 }
644 }
645 return (count);
646}
647
648static void __init xd_manual_geo_set (u_char drive)
649{
650 xd_info[drive].heads = (u_char)(xd_geo[3 * drive + 1]);
651 xd_info[drive].cylinders = (u_short)(xd_geo[3 * drive]);
652 xd_info[drive].sectors = (u_char)(xd_geo[3 * drive + 2]);
653}
654
655static void __init xd_dtc_init_controller (unsigned int address)
656{
657 switch (address) {
658 case 0x00000:
659 case 0xC8000: break; /*initial: 0x320 */
660 case 0xCA000: xd_iobase = 0x324;
661 case 0xD0000: /*5150CX*/
662 case 0xD8000: break; /*5150CX & 5150XL*/
663 default: printk("xd_dtc_init_controller: unsupported BIOS address %06x\n",address);
664 break;
665 }
666 xd_maxsectors = 0x01; /* my card seems to have trouble doing multi-block transfers? */
667
668 outb(0,XD_RESET); /* reset the controller */
669}
670
671
672static void __init xd_dtc5150cx_init_drive (u_char drive)
673{
674 /* values from controller's BIOS - BIOS chip may be removed */
675 static u_short geometry_table[][4] = {
676 {0x200,8,0x200,0x100},
677 {0x267,2,0x267,0x267},
678 {0x264,4,0x264,0x80},
679 {0x132,4,0x132,0x0},
680 {0x132,2,0x80, 0x132},
681 {0x177,8,0x177,0x0},
682 {0x132,8,0x84, 0x0},
683 {}, /* not used */
684 {0x132,6,0x80, 0x100},
685 {0x200,6,0x100,0x100},
686 {0x264,2,0x264,0x80},
687 {0x280,4,0x280,0x100},
688 {0x2B9,3,0x2B9,0x2B9},
689 {0x2B9,5,0x2B9,0x2B9},
690 {0x280,6,0x280,0x100},
691 {0x132,4,0x132,0x0}};
692 u_char n;
693
694 n = inb(XD_JUMPER);
695 n = (drive ? n : (n >> 2)) & 0x33;
696 n = (n | (n >> 2)) & 0x0F;
697 if (xd_geo[3*drive])
698 xd_manual_geo_set(drive);
699 else
700 if (n != 7) {
701 xd_info[drive].heads = (u_char)(geometry_table[n][1]); /* heads */
702 xd_info[drive].cylinders = geometry_table[n][0]; /* cylinders */
703 xd_info[drive].sectors = 17; /* sectors */
704#if 0
705 xd_info[drive].rwrite = geometry_table[n][2]; /* reduced write */
706 xd_info[drive].precomp = geometry_table[n][3] /* write precomp */
707 xd_info[drive].ecc = 0x0B; /* ecc length */
708#endif /* 0 */
709 }
710 else {
711 printk("xd%c: undetermined drive geometry\n",'a'+drive);
712 return;
713 }
714 xd_info[drive].control = 5; /* control byte */
715 xd_setparam(CMD_DTCSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,geometry_table[n][2],geometry_table[n][3],0x0B);
716 xd_recalibrate(drive);
717}
718
719static void __init xd_dtc_init_drive (u_char drive)
720{
721 u_char cmdblk[6],buf[64];
722
723 xd_build(cmdblk,CMD_DTCGETGEOM,drive,0,0,0,0,0);
724 if (!xd_command(cmdblk,PIO_MODE,buf,NULL,NULL,XD_TIMEOUT * 2)) {
725 xd_info[drive].heads = buf[0x0A]; /* heads */
726 xd_info[drive].cylinders = ((u_short *) (buf))[0x04]; /* cylinders */
727 xd_info[drive].sectors = 17; /* sectors */
728 if (xd_geo[3*drive])
729 xd_manual_geo_set(drive);
730#if 0
731 xd_info[drive].rwrite = ((u_short *) (buf + 1))[0x05]; /* reduced write */
732 xd_info[drive].precomp = ((u_short *) (buf + 1))[0x06]; /* write precomp */
733 xd_info[drive].ecc = buf[0x0F]; /* ecc length */
734#endif /* 0 */
735 xd_info[drive].control = 0; /* control byte */
736
737 xd_setparam(CMD_DTCSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,((u_short *) (buf + 1))[0x05],((u_short *) (buf + 1))[0x06],buf[0x0F]);
738 xd_build(cmdblk,CMD_DTCSETSTEP,drive,0,0,0,0,7);
739 if (xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT * 2))
740 printk("xd_dtc_init_drive: error setting step rate for xd%c\n", 'a'+drive);
741 }
742 else
743 printk("xd_dtc_init_drive: error reading geometry for xd%c\n", 'a'+drive);
744}
745
746static void __init xd_wd_init_controller (unsigned int address)
747{
748 switch (address) {
749 case 0x00000:
750 case 0xC8000: break; /*initial: 0x320 */
751 case 0xCA000: xd_iobase = 0x324; break;
752 case 0xCC000: xd_iobase = 0x328; break;
753 case 0xCE000: xd_iobase = 0x32C; break;
754 case 0xD0000: xd_iobase = 0x328; break; /* ? */
755 case 0xD8000: xd_iobase = 0x32C; break; /* ? */
756 default: printk("xd_wd_init_controller: unsupported BIOS address %06x\n",address);
757 break;
758 }
759 xd_maxsectors = 0x01; /* this one doesn't wrap properly either... */
760
761 outb(0,XD_RESET); /* reset the controller */
762
Nishanth Aravamudanf6a2f342005-09-10 00:27:14 -0700763 msleep(XD_INIT_DISK_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700764}
765
766static void __init xd_wd_init_drive (u_char drive)
767{
768 /* values from controller's BIOS - BIOS may be disabled */
769 static u_short geometry_table[][4] = {
770 {0x264,4,0x1C2,0x1C2}, /* common part */
771 {0x132,4,0x099,0x0},
772 {0x267,2,0x1C2,0x1C2},
773 {0x267,4,0x1C2,0x1C2},
774
775 {0x334,6,0x335,0x335}, /* 1004 series RLL */
776 {0x30E,4,0x30F,0x3DC},
777 {0x30E,2,0x30F,0x30F},
778 {0x267,4,0x268,0x268},
779
780 {0x3D5,5,0x3D6,0x3D6}, /* 1002 series RLL */
781 {0x3DB,7,0x3DC,0x3DC},
782 {0x264,4,0x265,0x265},
783 {0x267,4,0x268,0x268}};
784
785 u_char cmdblk[6],buf[0x200];
786 u_char n = 0,rll,jumper_state,use_jumper_geo;
787 u_char wd_1002 = (xd_sigs[xd_type].string[7] == '6');
788
789 jumper_state = ~(inb(0x322));
790 if (jumper_state & 0x40)
791 xd_irq = 9;
792 rll = (jumper_state & 0x30) ? (0x04 << wd_1002) : 0;
793 xd_build(cmdblk,CMD_READ,drive,0,0,0,1,0);
794 if (!xd_command(cmdblk,PIO_MODE,buf,NULL,NULL,XD_TIMEOUT * 2)) {
795 xd_info[drive].heads = buf[0x1AF]; /* heads */
796 xd_info[drive].cylinders = ((u_short *) (buf + 1))[0xD6]; /* cylinders */
797 xd_info[drive].sectors = 17; /* sectors */
798 if (xd_geo[3*drive])
799 xd_manual_geo_set(drive);
800#if 0
801 xd_info[drive].rwrite = ((u_short *) (buf))[0xD8]; /* reduced write */
802 xd_info[drive].wprecomp = ((u_short *) (buf))[0xDA]; /* write precomp */
803 xd_info[drive].ecc = buf[0x1B4]; /* ecc length */
804#endif /* 0 */
805 xd_info[drive].control = buf[0x1B5]; /* control byte */
806 use_jumper_geo = !(xd_info[drive].heads) || !(xd_info[drive].cylinders);
807 if (xd_geo[3*drive]) {
808 xd_manual_geo_set(drive);
809 xd_info[drive].control = rll ? 7 : 5;
810 }
811 else if (use_jumper_geo) {
812 n = (((jumper_state & 0x0F) >> (drive << 1)) & 0x03) | rll;
813 xd_info[drive].cylinders = geometry_table[n][0];
814 xd_info[drive].heads = (u_char)(geometry_table[n][1]);
815 xd_info[drive].control = rll ? 7 : 5;
816#if 0
817 xd_info[drive].rwrite = geometry_table[n][2];
818 xd_info[drive].wprecomp = geometry_table[n][3];
819 xd_info[drive].ecc = 0x0B;
820#endif /* 0 */
821 }
822 if (!wd_1002) {
823 if (use_jumper_geo)
824 xd_setparam(CMD_WDSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,
825 geometry_table[n][2],geometry_table[n][3],0x0B);
826 else
827 xd_setparam(CMD_WDSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,
828 ((u_short *) (buf))[0xD8],((u_short *) (buf))[0xDA],buf[0x1B4]);
829 }
830 /* 1002 based RLL controller requests converted addressing, but reports physical
831 (physical 26 sec., logical 17 sec.)
832 1004 based ???? */
833 if (rll & wd_1002) {
834 if ((xd_info[drive].cylinders *= 26,
835 xd_info[drive].cylinders /= 17) > 1023)
836 xd_info[drive].cylinders = 1023; /* 1024 ? */
837#if 0
838 xd_info[drive].rwrite *= 26;
839 xd_info[drive].rwrite /= 17;
840 xd_info[drive].wprecomp *= 26
841 xd_info[drive].wprecomp /= 17;
842#endif /* 0 */
843 }
844 }
845 else
846 printk("xd_wd_init_drive: error reading geometry for xd%c\n",'a'+drive);
847
848}
849
850static void __init xd_seagate_init_controller (unsigned int address)
851{
852 switch (address) {
853 case 0x00000:
854 case 0xC8000: break; /*initial: 0x320 */
855 case 0xD0000: xd_iobase = 0x324; break;
856 case 0xD8000: xd_iobase = 0x328; break;
857 case 0xE0000: xd_iobase = 0x32C; break;
858 default: printk("xd_seagate_init_controller: unsupported BIOS address %06x\n",address);
859 break;
860 }
861 xd_maxsectors = 0x40;
862
863 outb(0,XD_RESET); /* reset the controller */
864}
865
866static void __init xd_seagate_init_drive (u_char drive)
867{
868 u_char cmdblk[6],buf[0x200];
869
870 xd_build(cmdblk,CMD_ST11GETGEOM,drive,0,0,0,1,0);
871 if (!xd_command(cmdblk,PIO_MODE,buf,NULL,NULL,XD_TIMEOUT * 2)) {
872 xd_info[drive].heads = buf[0x04]; /* heads */
873 xd_info[drive].cylinders = (buf[0x02] << 8) | buf[0x03]; /* cylinders */
874 xd_info[drive].sectors = buf[0x05]; /* sectors */
875 xd_info[drive].control = 0; /* control byte */
876 }
877 else
878 printk("xd_seagate_init_drive: error reading geometry from xd%c\n", 'a'+drive);
879}
880
881/* Omti support courtesy Dirk Melchers */
882static void __init xd_omti_init_controller (unsigned int address)
883{
884 switch (address) {
885 case 0x00000:
886 case 0xC8000: break; /*initial: 0x320 */
887 case 0xD0000: xd_iobase = 0x324; break;
888 case 0xD8000: xd_iobase = 0x328; break;
889 case 0xE0000: xd_iobase = 0x32C; break;
890 default: printk("xd_omti_init_controller: unsupported BIOS address %06x\n",address);
891 break;
892 }
893
894 xd_maxsectors = 0x40;
895
896 outb(0,XD_RESET); /* reset the controller */
897}
898
899static void __init xd_omti_init_drive (u_char drive)
900{
901 /* gets infos from drive */
902 xd_override_init_drive(drive);
903
904 /* set other parameters, Hardcoded, not that nice :-) */
905 xd_info[drive].control = 2;
906}
907
908/* Xebec support (AK) */
909static void __init xd_xebec_init_controller (unsigned int address)
910{
911/* iobase may be set manually in range 0x300 - 0x33C
912 irq may be set manually to 2(9),3,4,5,6,7
913 dma may be set manually to 1,2,3
914 (How to detect them ???)
915BIOS address may be set manually in range 0x0 - 0xF8000
916If you need non-standard settings use the xd=... command */
917
918 switch (address) {
919 case 0x00000:
920 case 0xC8000: /* initially: xd_iobase==0x320 */
921 case 0xD0000:
922 case 0xD2000:
923 case 0xD4000:
924 case 0xD6000:
925 case 0xD8000:
926 case 0xDA000:
927 case 0xDC000:
928 case 0xDE000:
929 case 0xE0000: break;
930 default: printk("xd_xebec_init_controller: unsupported BIOS address %06x\n",address);
931 break;
932 }
933
934 xd_maxsectors = 0x01;
935 outb(0,XD_RESET); /* reset the controller */
936
Nishanth Aravamudanf6a2f342005-09-10 00:27:14 -0700937 msleep(XD_INIT_DISK_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938}
939
940static void __init xd_xebec_init_drive (u_char drive)
941{
942 /* values from controller's BIOS - BIOS chip may be removed */
943 static u_short geometry_table[][5] = {
944 {0x132,4,0x080,0x080,0x7},
945 {0x132,4,0x080,0x080,0x17},
946 {0x264,2,0x100,0x100,0x7},
947 {0x264,2,0x100,0x100,0x17},
948 {0x132,8,0x080,0x080,0x7},
949 {0x132,8,0x080,0x080,0x17},
950 {0x264,4,0x100,0x100,0x6},
951 {0x264,4,0x100,0x100,0x17},
952 {0x2BC,5,0x2BC,0x12C,0x6},
953 {0x3A5,4,0x3A5,0x3A5,0x7},
954 {0x26C,6,0x26C,0x26C,0x7},
955 {0x200,8,0x200,0x100,0x17},
956 {0x400,5,0x400,0x400,0x7},
957 {0x400,6,0x400,0x400,0x7},
958 {0x264,8,0x264,0x200,0x17},
959 {0x33E,7,0x33E,0x200,0x7}};
960 u_char n;
961
962 n = inb(XD_JUMPER) & 0x0F; /* BIOS's drive number: same geometry
963 is assumed for BOTH drives */
964 if (xd_geo[3*drive])
965 xd_manual_geo_set(drive);
966 else {
967 xd_info[drive].heads = (u_char)(geometry_table[n][1]); /* heads */
968 xd_info[drive].cylinders = geometry_table[n][0]; /* cylinders */
969 xd_info[drive].sectors = 17; /* sectors */
970#if 0
971 xd_info[drive].rwrite = geometry_table[n][2]; /* reduced write */
972 xd_info[drive].precomp = geometry_table[n][3] /* write precomp */
973 xd_info[drive].ecc = 0x0B; /* ecc length */
974#endif /* 0 */
975 }
976 xd_info[drive].control = geometry_table[n][4]; /* control byte */
977 xd_setparam(CMD_XBSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,geometry_table[n][2],geometry_table[n][3],0x0B);
978 xd_recalibrate(drive);
979}
980
981/* xd_override_init_drive: this finds disk geometry in a "binary search" style, narrowing in on the "correct" number of heads
982 etc. by trying values until it gets the highest successful value. Idea courtesy Salvador Abreu (spa@fct.unl.pt). */
983static void __init xd_override_init_drive (u_char drive)
984{
985 u_short min[] = { 0,0,0 },max[] = { 16,1024,64 },test[] = { 0,0,0 };
986 u_char cmdblk[6],i;
987
988 if (xd_geo[3*drive])
989 xd_manual_geo_set(drive);
990 else {
991 for (i = 0; i < 3; i++) {
992 while (min[i] != max[i] - 1) {
993 test[i] = (min[i] + max[i]) / 2;
994 xd_build(cmdblk,CMD_SEEK,drive,(u_char) test[0],(u_short) test[1],(u_char) test[2],0,0);
995 if (!xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT * 2))
996 min[i] = test[i];
997 else
998 max[i] = test[i];
999 }
1000 test[i] = min[i];
1001 }
1002 xd_info[drive].heads = (u_char) min[0] + 1;
1003 xd_info[drive].cylinders = (u_short) min[1] + 1;
1004 xd_info[drive].sectors = (u_char) min[2] + 1;
1005 }
1006 xd_info[drive].control = 0;
1007}
1008
1009/* xd_setup: initialise controller from command line parameters */
1010static void __init do_xd_setup (int *integers)
1011{
1012 switch (integers[0]) {
1013 case 4: if (integers[4] < 0)
1014 nodma = 1;
1015 else if (integers[4] < 8)
1016 xd_dma = integers[4];
1017 case 3: if ((integers[3] > 0) && (integers[3] <= 0x3FC))
1018 xd_iobase = integers[3];
1019 case 2: if ((integers[2] > 0) && (integers[2] < 16))
1020 xd_irq = integers[2];
1021 case 1: xd_override = 1;
1022 if ((integers[1] >= 0) && (integers[1] < (sizeof(xd_sigs) / sizeof(xd_sigs[0]))))
1023 xd_type = integers[1];
1024 case 0: break;
1025 default:printk("xd: too many parameters for xd\n");
1026 }
1027 xd_maxsectors = 0x01;
1028}
1029
1030/* xd_setparam: set the drive characteristics */
1031static void __init xd_setparam (u_char command,u_char drive,u_char heads,u_short cylinders,u_short rwrite,u_short wprecomp,u_char ecc)
1032{
1033 u_char cmdblk[14];
1034
1035 xd_build(cmdblk,command,drive,0,0,0,0,0);
1036 cmdblk[6] = (u_char) (cylinders >> 8) & 0x03;
1037 cmdblk[7] = (u_char) (cylinders & 0xFF);
1038 cmdblk[8] = heads & 0x1F;
1039 cmdblk[9] = (u_char) (rwrite >> 8) & 0x03;
1040 cmdblk[10] = (u_char) (rwrite & 0xFF);
1041 cmdblk[11] = (u_char) (wprecomp >> 8) & 0x03;
1042 cmdblk[12] = (u_char) (wprecomp & 0xFF);
1043 cmdblk[13] = ecc;
1044
1045 /* Some controllers require geometry info as data, not command */
1046
1047 if (xd_command(cmdblk,PIO_MODE,NULL,&cmdblk[6],NULL,XD_TIMEOUT * 2))
1048 printk("xd: error setting characteristics for xd%c\n", 'a'+drive);
1049}
1050
1051
1052#ifdef MODULE
1053
1054module_param_array(xd, int, NULL, 0);
1055module_param_array(xd_geo, int, NULL, 0);
1056module_param(nodma, bool, 0);
1057
1058MODULE_LICENSE("GPL");
1059
1060void cleanup_module(void)
1061{
1062 int i;
1063 unregister_blkdev(XT_DISK_MAJOR, "xd");
1064 for (i = 0; i < xd_drives; i++) {
1065 del_gendisk(xd_gendisk[i]);
1066 put_disk(xd_gendisk[i]);
1067 }
1068 blk_cleanup_queue(xd_queue);
1069 release_region(xd_iobase,4);
1070 if (xd_drives) {
1071 free_irq(xd_irq, NULL);
1072 free_dma(xd_dma);
1073 if (xd_dma_buffer)
1074 xd_dma_mem_free((unsigned long)xd_dma_buffer, xd_maxsectors * 0x200);
1075 }
1076}
1077#else
1078
1079static int __init xd_setup (char *str)
1080{
1081 int ints[5];
1082 get_options (str, ARRAY_SIZE (ints), ints);
1083 do_xd_setup (ints);
1084 return 1;
1085}
1086
1087/* xd_manual_geo_init: initialise drive geometry from command line parameters
1088 (used only for WD drives) */
1089static int __init xd_manual_geo_init (char *str)
1090{
1091 int i, integers[1 + 3*XD_MAXDRIVES];
1092
1093 get_options (str, ARRAY_SIZE (integers), integers);
1094 if (integers[0]%3 != 0) {
1095 printk("xd: incorrect number of parameters for xd_geo\n");
1096 return 1;
1097 }
1098 for (i = 0; (i < integers[0]) && (i < 3*XD_MAXDRIVES); i++)
1099 xd_geo[i] = integers[i+1];
1100 return 1;
1101}
1102
1103__setup ("xd=", xd_setup);
1104__setup ("xd_geo=", xd_manual_geo_init);
1105
1106#endif /* MODULE */
1107
1108module_init(xd_init);
1109MODULE_ALIAS_BLOCKDEV_MAJOR(XT_DISK_MAJOR);