2 * This file contains the driver for an XT hard disk controller
3 * (at least the DTC 5150X) for Linux.
5 * Author: Pat Mackinlay, pat@it.com.au
8 * Revised: 01/01/93, ...
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
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,
21 * Modularized: 04/10/96 by Todd Fries, tfries@umr.edu
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)
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.
32 * Bugfix: 15/02/01, Paul G. - inform queue layer of tiny xd_maxsect.
36 #include <linux/module.h>
37 #include <linux/errno.h>
38 #include <linux/interrupt.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>
50 #include <linux/delay.h>
53 #include <asm/system.h>
54 #include <asm/uaccess.h>
59 static void __init do_xd_setup (int *integers);
61 static int xd[5] = { -1,-1,-1,-1, };
64 #define XD_DONT_USE_DMA 0 /* Initial value. may be overriden using
65 "nodma" module option */
66 #define XD_INIT_DISK_DELAY (30) /* 30 ms delay during disk initialization */
68 /* Above may need to be increased if a problem with the 2nd drive detection
69 (ST11M controller) or resetting a controller (WD) appears */
71 static XD_INFO xd_info[XD_MAXDRIVES];
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:
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:
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
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>.
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"). */
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))
100 static char *xd_dma_buffer;
102 static 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 */
118 static unsigned int xd_bases[] __initdata =
120 0xC8000, 0xCA000, 0xCC000,
121 0xCE000, 0xD0000, 0xD2000,
122 0xD4000, 0xD6000, 0xD8000,
123 0xDA000, 0xDC000, 0xDE000,
127 static DEFINE_SPINLOCK(xd_lock);
129 static struct gendisk *xd_gendisk[2];
131 static int xd_getgeo(struct block_device *bdev, struct hd_geometry *geo);
133 static struct block_device_operations xd_fops = {
134 .owner = THIS_MODULE,
135 .locked_ioctl = xd_ioctl,
138 static DECLARE_WAIT_QUEUE_HEAD(xd_wait_int);
139 static u_char xd_drives, xd_irq = 5, xd_dma = 3, xd_maxsectors;
140 static u_char xd_override __initdata = 0, xd_type __initdata = 0;
141 static u_short xd_iobase = 0x320;
142 static int xd_geo[XD_MAXDRIVES*3] __initdata = { 0, };
144 static volatile int xdc_busy;
145 static struct timer_list xd_watchdog_int;
147 static volatile u_char xd_error;
148 static int nodma = XD_DONT_USE_DMA;
150 static struct request_queue *xd_queue;
152 /* xd_init: register the block device number and set up pointer tables */
153 static int __init xd_init(void)
156 unsigned int address;
162 for (i = 4; i > 0; i--)
163 if (((xd[i] = xd[i-1]) >= 0) && !count)
170 init_timer (&xd_watchdog_int); xd_watchdog_int.function = xd_watchdog;
173 xd_dma_buffer = (char *)xd_dma_mem_alloc(xd_maxsectors * 0x200);
174 if (!xd_dma_buffer) {
175 printk(KERN_ERR "xd: Out of memory.\n");
180 if (register_blkdev(XT_DISK_MAJOR, "xd"))
184 xd_queue = blk_init_queue(do_xd_request, &xd_lock);
188 if (xd_detect(&controller,&address)) {
190 printk("Detected a%s controller (type %d) at address %06x\n",
191 xd_sigs[controller].name,controller,address);
192 if (!request_region(xd_iobase,4,"xd")) {
193 printk("xd: Ports at 0x%x are not available\n",
198 xd_sigs[controller].init_controller(address);
199 xd_drives = xd_initdrives(xd_sigs[controller].init_drive);
201 printk("Detected %d hard drive%s (using IRQ%d & DMA%d)\n",
202 xd_drives,xd_drives == 1 ? "" : "s",xd_irq,xd_dma);
209 for (i = 0; i < xd_drives; i++) {
210 XD_INFO *p = &xd_info[i];
211 struct gendisk *disk = alloc_disk(64);
215 disk->major = XT_DISK_MAJOR;
216 disk->first_minor = i<<6;
217 sprintf(disk->disk_name, "xd%c", i+'a');
218 disk->fops = &xd_fops;
219 disk->private_data = p;
220 disk->queue = xd_queue;
221 set_capacity(disk, p->heads * p->cylinders * p->sectors);
222 printk(" %s: CHS=%d/%d/%d\n", disk->disk_name,
223 p->cylinders, p->heads, p->sectors);
224 xd_gendisk[i] = disk;
228 if (request_irq(xd_irq,xd_interrupt_handler, 0, "XT hard disk", NULL)) {
229 printk("xd: unable to get IRQ%d\n",xd_irq);
233 if (request_dma(xd_dma,"xd")) {
234 printk("xd: unable to get DMA%d\n",xd_dma);
238 /* xd_maxsectors depends on controller - so set after detection */
239 blk_queue_max_sectors(xd_queue, xd_maxsectors);
241 for (i = 0; i < xd_drives; i++)
242 add_disk(xd_gendisk[i]);
247 free_irq(xd_irq, NULL);
249 for (i = 0; i < xd_drives; i++)
250 put_disk(xd_gendisk[i]);
252 release_region(xd_iobase,4);
254 blk_cleanup_queue(xd_queue);
256 unregister_blkdev(XT_DISK_MAJOR, "xd");
259 xd_dma_mem_free((unsigned long)xd_dma_buffer,
260 xd_maxsectors * 0x200);
265 put_disk(xd_gendisk[i]);
269 /* xd_detect: scan the possible BIOS ROM locations for the signature strings */
270 static u_char __init xd_detect (u_char *controller, unsigned int *address)
276 *controller = xd_type;
281 for (i = 0; i < ARRAY_SIZE(xd_bases); i++) {
282 void __iomem *p = ioremap(xd_bases[i], 0x2000);
285 for (j = 1; j < ARRAY_SIZE(xd_sigs); j++) {
286 const char *s = xd_sigs[j].string;
287 if (check_signature(p + xd_sigs[j].offset, s, strlen(s))) {
290 *address = xd_bases[i];
300 /* do_xd_request: handle an incoming request */
301 static void do_xd_request (struct request_queue * q)
308 while ((req = elv_next_request(q)) != NULL) {
309 unsigned block = blk_rq_pos(req);
310 unsigned count = blk_rq_sectors(req);
311 XD_INFO *disk = req->rq_disk->private_data;
315 if (!blk_fs_request(req)) {
316 __blk_end_request_cur(req, -EIO);
319 if (block + count > get_capacity(req->rq_disk)) {
320 __blk_end_request_cur(req, -EIO);
323 for (retry = 0; (retry < XD_RETRIES) && !res; retry++)
324 res = xd_readwrite(rq_data_dir(req), disk, req->buffer,
326 /* wrap up, 0 = success, -errno = fail */
327 __blk_end_request_cur(req, res);
331 static int xd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
333 XD_INFO *p = bdev->bd_disk->private_data;
335 geo->heads = p->heads;
336 geo->sectors = p->sectors;
337 geo->cylinders = p->cylinders;
341 /* xd_ioctl: handle device ioctl's */
342 static int xd_ioctl(struct block_device *bdev, fmode_t mode, u_int cmd, u_long arg)
346 if (!capable(CAP_SYS_ADMIN)) return -EACCES;
347 if (xdc_busy) return -EBUSY;
349 if (nodma && xd_dma_buffer) {
350 xd_dma_mem_free((unsigned long)xd_dma_buffer,
351 xd_maxsectors * 0x200);
352 xd_dma_buffer = NULL;
353 } else if (!nodma && !xd_dma_buffer) {
354 xd_dma_buffer = (char *)xd_dma_mem_alloc(xd_maxsectors * 0x200);
355 if (!xd_dma_buffer) {
356 nodma = XD_DONT_USE_DMA;
362 return put_user(!nodma, (long __user *) arg);
363 case HDIO_GET_MULTCOUNT:
364 return put_user(xd_maxsectors, (long __user *) arg);
370 /* xd_readwrite: handle a read/write request */
371 static int xd_readwrite (u_char operation,XD_INFO *p,char *buffer,u_int block,u_int count)
374 u_char cmdblk[6],sense[4];
375 u_short track,cylinder;
376 u_char head,sector,control,mode = PIO_MODE,temp;
380 #ifdef DEBUG_READWRITE
381 printk("xd_readwrite: operation = %s, drive = %d, buffer = 0x%X, block = %d, count = %d\n",operation == READ ? "read" : "write",drive,buffer,block,count);
382 #endif /* DEBUG_READWRITE */
384 spin_unlock_irq(&xd_lock);
386 control = p->control;
388 xd_dma_buffer = (char *)xd_dma_mem_alloc(xd_maxsectors * 0x200);
390 temp = count < xd_maxsectors ? count : xd_maxsectors;
392 track = block / p->sectors;
393 head = track % p->heads;
394 cylinder = track / p->heads;
395 sector = block % p->sectors;
397 #ifdef DEBUG_READWRITE
398 printk("xd_readwrite: drive = %d, head = %d, cylinder = %d, sector = %d, count = %d\n",drive,head,cylinder,sector,temp);
399 #endif /* DEBUG_READWRITE */
402 mode = xd_setup_dma(operation == READ ? DMA_MODE_READ : DMA_MODE_WRITE,(u_char *)(xd_dma_buffer),temp * 0x200);
403 real_buffer = &xd_dma_buffer;
404 for (i=0; i < (temp * 0x200); i++)
405 xd_dma_buffer[i] = buffer[i];
408 real_buffer = &buffer;
410 xd_build(cmdblk,operation == READ ? CMD_READ : CMD_WRITE,drive,head,cylinder,sector,temp & 0xFF,control);
412 switch (xd_command(cmdblk,mode,(u_char *)(*real_buffer),(u_char *)(*real_buffer),sense,XD_TIMEOUT)) {
414 printk("xd%c: %s timeout, recalibrating drive\n",'a'+drive,(operation == READ ? "read" : "write"));
415 xd_recalibrate(drive);
416 spin_lock_irq(&xd_lock);
419 if (sense[0] & 0x30) {
420 printk("xd%c: %s - ",'a'+drive,(operation == READ ? "reading" : "writing"));
421 switch ((sense[0] & 0x30) >> 4) {
422 case 0: printk("drive error, code = 0x%X",sense[0] & 0x0F);
424 case 1: printk("controller error, code = 0x%X",sense[0] & 0x0F);
426 case 2: printk("command error, code = 0x%X",sense[0] & 0x0F);
428 case 3: printk("miscellaneous error, code = 0x%X",sense[0] & 0x0F);
433 printk(" - CHS = %d/%d/%d\n",((sense[2] & 0xC0) << 2) | sense[3],sense[1] & 0x1F,sense[2] & 0x3F);
434 /* reported drive number = (sense[1] & 0xE0) >> 5 */
436 printk(" - no valid disk address\n");
437 spin_lock_irq(&xd_lock);
441 for (i=0; i < (temp * 0x200); i++)
442 buffer[i] = xd_dma_buffer[i];
444 count -= temp, buffer += temp * 0x200, block += temp;
446 spin_lock_irq(&xd_lock);
450 /* xd_recalibrate: recalibrate a given drive and reset controller if necessary */
451 static void xd_recalibrate (u_char drive)
455 xd_build(cmdblk,CMD_RECALIBRATE,drive,0,0,0,0,0);
456 if (xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT * 8))
457 printk("xd%c: warning! error recalibrating, controller may be unstable\n", 'a'+drive);
460 /* xd_interrupt_handler: interrupt service routine */
461 static irqreturn_t xd_interrupt_handler(int irq, void *dev_id)
463 if (inb(XD_STATUS) & STAT_INTERRUPT) { /* check if it was our device */
465 printk("xd_interrupt_handler: interrupt detected\n");
466 #endif /* DEBUG_OTHER */
467 outb(0,XD_CONTROL); /* acknowledge interrupt */
468 wake_up(&xd_wait_int); /* and wake up sleeping processes */
472 printk("xd: unexpected interrupt\n");
476 /* xd_setup_dma: set up the DMA controller for a data transfer */
477 static u_char xd_setup_dma (u_char mode,u_char *buffer,u_int count)
483 if (((unsigned long) buffer & 0xFFFF0000) != (((unsigned long) buffer + count) & 0xFFFF0000)) {
485 printk("xd_setup_dma: using PIO, transfer overlaps 64k boundary\n");
486 #endif /* DEBUG_OTHER */
492 clear_dma_ff(xd_dma);
493 set_dma_mode(xd_dma,mode);
494 set_dma_addr(xd_dma, (unsigned long) buffer);
495 set_dma_count(xd_dma,count);
499 return (DMA_MODE); /* use DMA and INT */
502 /* xd_build: put stuff into an array in a format suitable for the controller */
503 static 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)
506 cmdblk[1] = ((drive & 0x07) << 5) | (head & 0x1F);
507 cmdblk[2] = ((cylinder & 0x300) >> 2) | (sector & 0x3F);
508 cmdblk[3] = cylinder & 0xFF;
515 static void xd_watchdog (unsigned long unused)
518 wake_up(&xd_wait_int);
521 /* xd_waitport: waits until port & mask == flags or a timeout occurs. return 1 for a timeout */
522 static inline u_char xd_waitport (u_short port,u_char flags,u_char mask,u_long timeout)
524 u_long expiry = jiffies + timeout;
528 while ((success = ((inb(port) & mask) != flags)) && time_before(jiffies, expiry))
529 schedule_timeout_uninterruptible(1);
534 static inline u_int xd_wait_for_IRQ (void)
537 xd_watchdog_int.expires = jiffies + 8 * HZ;
538 add_timer(&xd_watchdog_int);
540 flags=claim_dma_lock();
542 release_dma_lock(flags);
544 sleep_on(&xd_wait_int);
545 del_timer(&xd_watchdog_int);
548 flags=claim_dma_lock();
550 release_dma_lock(flags);
553 printk("xd: missed IRQ - command aborted\n");
560 /* xd_command: handle all data transfers necessary for a single command */
561 static u_int xd_command (u_char *command,u_char mode,u_char *indata,u_char *outdata,u_char *sense,u_long timeout)
563 u_char cmdblk[6],csb,complete = 0;
566 printk("xd_command: command = 0x%X, mode = 0x%X, indata = 0x%X, outdata = 0x%X, sense = 0x%X\n",command,mode,indata,outdata,sense);
567 #endif /* DEBUG_COMMAND */
570 outb(mode,XD_CONTROL);
572 if (xd_waitport(XD_STATUS,STAT_SELECT,STAT_SELECT,timeout))
576 if (xd_waitport(XD_STATUS,STAT_READY,STAT_READY,timeout))
579 switch (inb(XD_STATUS) & (STAT_COMMAND | STAT_INPUT)) {
581 if (mode == DMA_MODE) {
582 if (xd_wait_for_IRQ())
585 outb(outdata ? *outdata++ : 0,XD_DATA);
588 if (mode == DMA_MODE) {
589 if (xd_wait_for_IRQ())
593 *indata++ = inb(XD_DATA);
598 outb(command ? *command++ : 0,XD_DATA);
600 case STAT_COMMAND | STAT_INPUT:
607 if (xd_waitport(XD_STATUS,0,STAT_SELECT,timeout)) /* wait until deselected */
610 if (csb & CSB_ERROR) { /* read sense data if error */
611 xd_build(cmdblk,CMD_SENSE,(csb & CSB_LUN) >> 5,0,0,0,0,0);
612 if (xd_command(cmdblk,0,sense,NULL,NULL,XD_TIMEOUT))
613 printk("xd: warning! sense command failed!\n");
617 printk("xd_command: completed with csb = 0x%X\n",csb);
618 #endif /* DEBUG_COMMAND */
620 return (csb & CSB_ERROR);
623 static u_char __init xd_initdrives (void (*init_drive)(u_char drive))
625 u_char cmdblk[6],i,count = 0;
627 for (i = 0; i < XD_MAXDRIVES; i++) {
628 xd_build(cmdblk,CMD_TESTREADY,i,0,0,0,0,0);
629 if (!xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT*8)) {
630 msleep_interruptible(XD_INIT_DISK_DELAY);
635 msleep_interruptible(XD_INIT_DISK_DELAY);
641 static void __init xd_manual_geo_set (u_char drive)
643 xd_info[drive].heads = (u_char)(xd_geo[3 * drive + 1]);
644 xd_info[drive].cylinders = (u_short)(xd_geo[3 * drive]);
645 xd_info[drive].sectors = (u_char)(xd_geo[3 * drive + 2]);
648 static void __init xd_dtc_init_controller (unsigned int address)
652 case 0xC8000: break; /*initial: 0x320 */
653 case 0xCA000: xd_iobase = 0x324;
654 case 0xD0000: /*5150CX*/
655 case 0xD8000: break; /*5150CX & 5150XL*/
656 default: printk("xd_dtc_init_controller: unsupported BIOS address %06x\n",address);
659 xd_maxsectors = 0x01; /* my card seems to have trouble doing multi-block transfers? */
661 outb(0,XD_RESET); /* reset the controller */
665 static void __init xd_dtc5150cx_init_drive (u_char drive)
667 /* values from controller's BIOS - BIOS chip may be removed */
668 static u_short geometry_table[][4] = {
669 {0x200,8,0x200,0x100},
670 {0x267,2,0x267,0x267},
671 {0x264,4,0x264,0x80},
673 {0x132,2,0x80, 0x132},
677 {0x132,6,0x80, 0x100},
678 {0x200,6,0x100,0x100},
679 {0x264,2,0x264,0x80},
680 {0x280,4,0x280,0x100},
681 {0x2B9,3,0x2B9,0x2B9},
682 {0x2B9,5,0x2B9,0x2B9},
683 {0x280,6,0x280,0x100},
684 {0x132,4,0x132,0x0}};
688 n = (drive ? n : (n >> 2)) & 0x33;
689 n = (n | (n >> 2)) & 0x0F;
691 xd_manual_geo_set(drive);
694 xd_info[drive].heads = (u_char)(geometry_table[n][1]); /* heads */
695 xd_info[drive].cylinders = geometry_table[n][0]; /* cylinders */
696 xd_info[drive].sectors = 17; /* sectors */
698 xd_info[drive].rwrite = geometry_table[n][2]; /* reduced write */
699 xd_info[drive].precomp = geometry_table[n][3] /* write precomp */
700 xd_info[drive].ecc = 0x0B; /* ecc length */
704 printk("xd%c: undetermined drive geometry\n",'a'+drive);
707 xd_info[drive].control = 5; /* control byte */
708 xd_setparam(CMD_DTCSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,geometry_table[n][2],geometry_table[n][3],0x0B);
709 xd_recalibrate(drive);
712 static void __init xd_dtc_init_drive (u_char drive)
714 u_char cmdblk[6],buf[64];
716 xd_build(cmdblk,CMD_DTCGETGEOM,drive,0,0,0,0,0);
717 if (!xd_command(cmdblk,PIO_MODE,buf,NULL,NULL,XD_TIMEOUT * 2)) {
718 xd_info[drive].heads = buf[0x0A]; /* heads */
719 xd_info[drive].cylinders = ((u_short *) (buf))[0x04]; /* cylinders */
720 xd_info[drive].sectors = 17; /* sectors */
722 xd_manual_geo_set(drive);
724 xd_info[drive].rwrite = ((u_short *) (buf + 1))[0x05]; /* reduced write */
725 xd_info[drive].precomp = ((u_short *) (buf + 1))[0x06]; /* write precomp */
726 xd_info[drive].ecc = buf[0x0F]; /* ecc length */
728 xd_info[drive].control = 0; /* control byte */
730 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]);
731 xd_build(cmdblk,CMD_DTCSETSTEP,drive,0,0,0,0,7);
732 if (xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT * 2))
733 printk("xd_dtc_init_drive: error setting step rate for xd%c\n", 'a'+drive);
736 printk("xd_dtc_init_drive: error reading geometry for xd%c\n", 'a'+drive);
739 static void __init xd_wd_init_controller (unsigned int address)
743 case 0xC8000: break; /*initial: 0x320 */
744 case 0xCA000: xd_iobase = 0x324; break;
745 case 0xCC000: xd_iobase = 0x328; break;
746 case 0xCE000: xd_iobase = 0x32C; break;
747 case 0xD0000: xd_iobase = 0x328; break; /* ? */
748 case 0xD8000: xd_iobase = 0x32C; break; /* ? */
749 default: printk("xd_wd_init_controller: unsupported BIOS address %06x\n",address);
752 xd_maxsectors = 0x01; /* this one doesn't wrap properly either... */
754 outb(0,XD_RESET); /* reset the controller */
756 msleep(XD_INIT_DISK_DELAY);
759 static void __init xd_wd_init_drive (u_char drive)
761 /* values from controller's BIOS - BIOS may be disabled */
762 static u_short geometry_table[][4] = {
763 {0x264,4,0x1C2,0x1C2}, /* common part */
765 {0x267,2,0x1C2,0x1C2},
766 {0x267,4,0x1C2,0x1C2},
768 {0x334,6,0x335,0x335}, /* 1004 series RLL */
769 {0x30E,4,0x30F,0x3DC},
770 {0x30E,2,0x30F,0x30F},
771 {0x267,4,0x268,0x268},
773 {0x3D5,5,0x3D6,0x3D6}, /* 1002 series RLL */
774 {0x3DB,7,0x3DC,0x3DC},
775 {0x264,4,0x265,0x265},
776 {0x267,4,0x268,0x268}};
778 u_char cmdblk[6],buf[0x200];
779 u_char n = 0,rll,jumper_state,use_jumper_geo;
780 u_char wd_1002 = (xd_sigs[xd_type].string[7] == '6');
782 jumper_state = ~(inb(0x322));
783 if (jumper_state & 0x40)
785 rll = (jumper_state & 0x30) ? (0x04 << wd_1002) : 0;
786 xd_build(cmdblk,CMD_READ,drive,0,0,0,1,0);
787 if (!xd_command(cmdblk,PIO_MODE,buf,NULL,NULL,XD_TIMEOUT * 2)) {
788 xd_info[drive].heads = buf[0x1AF]; /* heads */
789 xd_info[drive].cylinders = ((u_short *) (buf + 1))[0xD6]; /* cylinders */
790 xd_info[drive].sectors = 17; /* sectors */
792 xd_manual_geo_set(drive);
794 xd_info[drive].rwrite = ((u_short *) (buf))[0xD8]; /* reduced write */
795 xd_info[drive].wprecomp = ((u_short *) (buf))[0xDA]; /* write precomp */
796 xd_info[drive].ecc = buf[0x1B4]; /* ecc length */
798 xd_info[drive].control = buf[0x1B5]; /* control byte */
799 use_jumper_geo = !(xd_info[drive].heads) || !(xd_info[drive].cylinders);
800 if (xd_geo[3*drive]) {
801 xd_manual_geo_set(drive);
802 xd_info[drive].control = rll ? 7 : 5;
804 else if (use_jumper_geo) {
805 n = (((jumper_state & 0x0F) >> (drive << 1)) & 0x03) | rll;
806 xd_info[drive].cylinders = geometry_table[n][0];
807 xd_info[drive].heads = (u_char)(geometry_table[n][1]);
808 xd_info[drive].control = rll ? 7 : 5;
810 xd_info[drive].rwrite = geometry_table[n][2];
811 xd_info[drive].wprecomp = geometry_table[n][3];
812 xd_info[drive].ecc = 0x0B;
817 xd_setparam(CMD_WDSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,
818 geometry_table[n][2],geometry_table[n][3],0x0B);
820 xd_setparam(CMD_WDSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,
821 ((u_short *) (buf))[0xD8],((u_short *) (buf))[0xDA],buf[0x1B4]);
823 /* 1002 based RLL controller requests converted addressing, but reports physical
824 (physical 26 sec., logical 17 sec.)
827 if ((xd_info[drive].cylinders *= 26,
828 xd_info[drive].cylinders /= 17) > 1023)
829 xd_info[drive].cylinders = 1023; /* 1024 ? */
831 xd_info[drive].rwrite *= 26;
832 xd_info[drive].rwrite /= 17;
833 xd_info[drive].wprecomp *= 26
834 xd_info[drive].wprecomp /= 17;
839 printk("xd_wd_init_drive: error reading geometry for xd%c\n",'a'+drive);
843 static void __init xd_seagate_init_controller (unsigned int address)
847 case 0xC8000: break; /*initial: 0x320 */
848 case 0xD0000: xd_iobase = 0x324; break;
849 case 0xD8000: xd_iobase = 0x328; break;
850 case 0xE0000: xd_iobase = 0x32C; break;
851 default: printk("xd_seagate_init_controller: unsupported BIOS address %06x\n",address);
854 xd_maxsectors = 0x40;
856 outb(0,XD_RESET); /* reset the controller */
859 static void __init xd_seagate_init_drive (u_char drive)
861 u_char cmdblk[6],buf[0x200];
863 xd_build(cmdblk,CMD_ST11GETGEOM,drive,0,0,0,1,0);
864 if (!xd_command(cmdblk,PIO_MODE,buf,NULL,NULL,XD_TIMEOUT * 2)) {
865 xd_info[drive].heads = buf[0x04]; /* heads */
866 xd_info[drive].cylinders = (buf[0x02] << 8) | buf[0x03]; /* cylinders */
867 xd_info[drive].sectors = buf[0x05]; /* sectors */
868 xd_info[drive].control = 0; /* control byte */
871 printk("xd_seagate_init_drive: error reading geometry from xd%c\n", 'a'+drive);
874 /* Omti support courtesy Dirk Melchers */
875 static void __init xd_omti_init_controller (unsigned int address)
879 case 0xC8000: break; /*initial: 0x320 */
880 case 0xD0000: xd_iobase = 0x324; break;
881 case 0xD8000: xd_iobase = 0x328; break;
882 case 0xE0000: xd_iobase = 0x32C; break;
883 default: printk("xd_omti_init_controller: unsupported BIOS address %06x\n",address);
887 xd_maxsectors = 0x40;
889 outb(0,XD_RESET); /* reset the controller */
892 static void __init xd_omti_init_drive (u_char drive)
894 /* gets infos from drive */
895 xd_override_init_drive(drive);
897 /* set other parameters, Hardcoded, not that nice :-) */
898 xd_info[drive].control = 2;
901 /* Xebec support (AK) */
902 static void __init xd_xebec_init_controller (unsigned int address)
904 /* iobase may be set manually in range 0x300 - 0x33C
905 irq may be set manually to 2(9),3,4,5,6,7
906 dma may be set manually to 1,2,3
907 (How to detect them ???)
908 BIOS address may be set manually in range 0x0 - 0xF8000
909 If you need non-standard settings use the xd=... command */
913 case 0xC8000: /* initially: xd_iobase==0x320 */
923 default: printk("xd_xebec_init_controller: unsupported BIOS address %06x\n",address);
927 xd_maxsectors = 0x01;
928 outb(0,XD_RESET); /* reset the controller */
930 msleep(XD_INIT_DISK_DELAY);
933 static void __init xd_xebec_init_drive (u_char drive)
935 /* values from controller's BIOS - BIOS chip may be removed */
936 static u_short geometry_table[][5] = {
937 {0x132,4,0x080,0x080,0x7},
938 {0x132,4,0x080,0x080,0x17},
939 {0x264,2,0x100,0x100,0x7},
940 {0x264,2,0x100,0x100,0x17},
941 {0x132,8,0x080,0x080,0x7},
942 {0x132,8,0x080,0x080,0x17},
943 {0x264,4,0x100,0x100,0x6},
944 {0x264,4,0x100,0x100,0x17},
945 {0x2BC,5,0x2BC,0x12C,0x6},
946 {0x3A5,4,0x3A5,0x3A5,0x7},
947 {0x26C,6,0x26C,0x26C,0x7},
948 {0x200,8,0x200,0x100,0x17},
949 {0x400,5,0x400,0x400,0x7},
950 {0x400,6,0x400,0x400,0x7},
951 {0x264,8,0x264,0x200,0x17},
952 {0x33E,7,0x33E,0x200,0x7}};
955 n = inb(XD_JUMPER) & 0x0F; /* BIOS's drive number: same geometry
956 is assumed for BOTH drives */
958 xd_manual_geo_set(drive);
960 xd_info[drive].heads = (u_char)(geometry_table[n][1]); /* heads */
961 xd_info[drive].cylinders = geometry_table[n][0]; /* cylinders */
962 xd_info[drive].sectors = 17; /* sectors */
964 xd_info[drive].rwrite = geometry_table[n][2]; /* reduced write */
965 xd_info[drive].precomp = geometry_table[n][3] /* write precomp */
966 xd_info[drive].ecc = 0x0B; /* ecc length */
969 xd_info[drive].control = geometry_table[n][4]; /* control byte */
970 xd_setparam(CMD_XBSETPARAM,drive,xd_info[drive].heads,xd_info[drive].cylinders,geometry_table[n][2],geometry_table[n][3],0x0B);
971 xd_recalibrate(drive);
974 /* xd_override_init_drive: this finds disk geometry in a "binary search" style, narrowing in on the "correct" number of heads
975 etc. by trying values until it gets the highest successful value. Idea courtesy Salvador Abreu (spa@fct.unl.pt). */
976 static void __init xd_override_init_drive (u_char drive)
978 u_short min[] = { 0,0,0 },max[] = { 16,1024,64 },test[] = { 0,0,0 };
982 xd_manual_geo_set(drive);
984 for (i = 0; i < 3; i++) {
985 while (min[i] != max[i] - 1) {
986 test[i] = (min[i] + max[i]) / 2;
987 xd_build(cmdblk,CMD_SEEK,drive,(u_char) test[0],(u_short) test[1],(u_char) test[2],0,0);
988 if (!xd_command(cmdblk,PIO_MODE,NULL,NULL,NULL,XD_TIMEOUT * 2))
995 xd_info[drive].heads = (u_char) min[0] + 1;
996 xd_info[drive].cylinders = (u_short) min[1] + 1;
997 xd_info[drive].sectors = (u_char) min[2] + 1;
999 xd_info[drive].control = 0;
1002 /* xd_setup: initialise controller from command line parameters */
1003 static void __init do_xd_setup (int *integers)
1005 switch (integers[0]) {
1006 case 4: if (integers[4] < 0)
1008 else if (integers[4] < 8)
1009 xd_dma = integers[4];
1010 case 3: if ((integers[3] > 0) && (integers[3] <= 0x3FC))
1011 xd_iobase = integers[3];
1012 case 2: if ((integers[2] > 0) && (integers[2] < 16))
1013 xd_irq = integers[2];
1014 case 1: xd_override = 1;
1015 if ((integers[1] >= 0) && (integers[1] < ARRAY_SIZE(xd_sigs)))
1016 xd_type = integers[1];
1018 default:printk("xd: too many parameters for xd\n");
1020 xd_maxsectors = 0x01;
1023 /* xd_setparam: set the drive characteristics */
1024 static 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)
1028 xd_build(cmdblk,command,drive,0,0,0,0,0);
1029 cmdblk[6] = (u_char) (cylinders >> 8) & 0x03;
1030 cmdblk[7] = (u_char) (cylinders & 0xFF);
1031 cmdblk[8] = heads & 0x1F;
1032 cmdblk[9] = (u_char) (rwrite >> 8) & 0x03;
1033 cmdblk[10] = (u_char) (rwrite & 0xFF);
1034 cmdblk[11] = (u_char) (wprecomp >> 8) & 0x03;
1035 cmdblk[12] = (u_char) (wprecomp & 0xFF);
1038 /* Some controllers require geometry info as data, not command */
1040 if (xd_command(cmdblk,PIO_MODE,NULL,&cmdblk[6],NULL,XD_TIMEOUT * 2))
1041 printk("xd: error setting characteristics for xd%c\n", 'a'+drive);
1047 module_param_array(xd, int, NULL, 0);
1048 module_param_array(xd_geo, int, NULL, 0);
1049 module_param(nodma, bool, 0);
1051 MODULE_LICENSE("GPL");
1053 void cleanup_module(void)
1056 unregister_blkdev(XT_DISK_MAJOR, "xd");
1057 for (i = 0; i < xd_drives; i++) {
1058 del_gendisk(xd_gendisk[i]);
1059 put_disk(xd_gendisk[i]);
1061 blk_cleanup_queue(xd_queue);
1062 release_region(xd_iobase,4);
1064 free_irq(xd_irq, NULL);
1067 xd_dma_mem_free((unsigned long)xd_dma_buffer, xd_maxsectors * 0x200);
1072 static int __init xd_setup (char *str)
1075 get_options (str, ARRAY_SIZE (ints), ints);
1080 /* xd_manual_geo_init: initialise drive geometry from command line parameters
1081 (used only for WD drives) */
1082 static int __init xd_manual_geo_init (char *str)
1084 int i, integers[1 + 3*XD_MAXDRIVES];
1086 get_options (str, ARRAY_SIZE (integers), integers);
1087 if (integers[0]%3 != 0) {
1088 printk("xd: incorrect number of parameters for xd_geo\n");
1091 for (i = 0; (i < integers[0]) && (i < 3*XD_MAXDRIVES); i++)
1092 xd_geo[i] = integers[i+1];
1096 __setup ("xd=", xd_setup);
1097 __setup ("xd_geo=", xd_manual_geo_init);
1101 module_init(xd_init);
1102 MODULE_ALIAS_BLOCKDEV_MAJOR(XT_DISK_MAJOR);