git.oblomov.eu Git - linux-2.6/blob - drivers/block/hd.c

   1 /*
   2  *  Copyright (C) 1991, 1992  Linus Torvalds
   3  *
   4  * This is the low-level hd interrupt support. It traverses the
   5  * request-list, using interrupts to jump between functions. As
   6  * all the functions are called within interrupts, we may not
   7  * sleep. Special care is recommended.
   8  *
   9  *  modified by Drew Eckhardt to check nr of hd's from the CMOS.
  10  *
  11  *  Thanks to Branko Lankester, lankeste@fwi.uva.nl, who found a bug
  12  *  in the early extended-partition checks and added DM partitions
  13  *
  14  *  IRQ-unmask, drive-id, multiple-mode, support for ">16 heads",
  15  *  and general streamlining by Mark Lord.
  16  *
  17  *  Removed 99% of above. Use Mark's ide driver for those options.
  18  *  This is now a lightweight ST-506 driver. (Paul Gortmaker)
  19  *
  20  *  Modified 1995 Russell King for ARM processor.
  21  *
  22  *  Bugfix: max_sectors must be <= 255 or the wheels tend to come
  23  *  off in a hurry once you queue things up - Paul G. 02/2001
  24  */
  25
  26 /* Uncomment the following if you want verbose error reports. */
  27 /* #define VERBOSE_ERRORS */
  28
  29 #include <linux/blkdev.h>
  30 #include <linux/errno.h>
  31 #include <linux/signal.h>
  32 #include <linux/interrupt.h>
  33 #include <linux/timer.h>
  34 #include <linux/fs.h>
  35 #include <linux/kernel.h>
  36 #include <linux/genhd.h>
  37 #include <linux/slab.h>
  38 #include <linux/string.h>
  39 #include <linux/ioport.h>
  40 #include <linux/init.h>
  41 #include <linux/blkpg.h>
  42 #include <linux/ata.h>
  43 #include <linux/hdreg.h>
  44
  45 #define HD_IRQ 14
  46
  47 #define REALLY_SLOW_IO
  48 #include <asm/system.h>
  49 #include <asm/io.h>
  50 #include <asm/uaccess.h>
  51
  52 #ifdef __arm__
  53 #undef  HD_IRQ
  54 #endif
  55 #include <asm/irq.h>
  56 #ifdef __arm__
  57 #define HD_IRQ IRQ_HARDDISK
  58 #endif
  59
  60 /* Hd controller regster ports */
  61
  62 #define HD_DATA         0x1f0           /* _CTL when writing */
  63 #define HD_ERROR        0x1f1           /* see err-bits */
  64 #define HD_NSECTOR      0x1f2           /* nr of sectors to read/write */
  65 #define HD_SECTOR       0x1f3           /* starting sector */
  66 #define HD_LCYL         0x1f4           /* starting cylinder */
  67 #define HD_HCYL         0x1f5           /* high byte of starting cyl */
  68 #define HD_CURRENT      0x1f6           /* 101dhhhh , d=drive, hhhh=head */
  69 #define HD_STATUS       0x1f7           /* see status-bits */
  70 #define HD_FEATURE      HD_ERROR        /* same io address, read=error, write=feature */
  71 #define HD_PRECOMP      HD_FEATURE      /* obsolete use of this port - predates IDE */
  72 #define HD_COMMAND      HD_STATUS       /* same io address, read=status, write=cmd */
  73
  74 #define HD_CMD          0x3f6           /* used for resets */
  75 #define HD_ALTSTATUS    0x3f6           /* same as HD_STATUS but doesn't clear irq */
  76
  77 /* Bits of HD_STATUS */
  78 #define ERR_STAT                0x01
  79 #define INDEX_STAT              0x02
  80 #define ECC_STAT                0x04    /* Corrected error */
  81 #define DRQ_STAT                0x08
  82 #define SEEK_STAT               0x10
  83 #define SERVICE_STAT            SEEK_STAT
  84 #define WRERR_STAT              0x20
  85 #define READY_STAT              0x40
  86 #define BUSY_STAT               0x80
  87
  88 /* Bits for HD_ERROR */
  89 #define MARK_ERR                0x01    /* Bad address mark */
  90 #define TRK0_ERR                0x02    /* couldn't find track 0 */
  91 #define ABRT_ERR                0x04    /* Command aborted */
  92 #define MCR_ERR                 0x08    /* media change request */
  93 #define ID_ERR                  0x10    /* ID field not found */
  94 #define MC_ERR                  0x20    /* media changed */
  95 #define ECC_ERR                 0x40    /* Uncorrectable ECC error */
  96 #define BBD_ERR                 0x80    /* pre-EIDE meaning:  block marked bad */
  97 #define ICRC_ERR                0x80    /* new meaning:  CRC error during transfer */
  98
  99 static DEFINE_SPINLOCK(hd_lock);
 100 static struct request_queue *hd_queue;
 101 static struct request *hd_req;
 102
 103 #define MAJOR_NR HD_MAJOR
 104
 105 #define TIMEOUT_VALUE   (6*HZ)
 106 #define HD_DELAY        0
 107
 108 #define MAX_ERRORS     16       /* Max read/write errors/sector */
 109 #define RESET_FREQ      8       /* Reset controller every 8th retry */
 110 #define RECAL_FREQ      4       /* Recalibrate every 4th retry */
 111 #define MAX_HD          2
 112
 113 #define STAT_OK         (READY_STAT|SEEK_STAT)
 114 #define OK_STATUS(s)    (((s)&(STAT_OK|(BUSY_STAT|WRERR_STAT|ERR_STAT)))==STAT_OK)
 115
 116 static void recal_intr(void);
 117 static void bad_rw_intr(void);
 118
 119 static int reset;
 120 static int hd_error;
 121
 122 /*
 123  *  This struct defines the HD's and their types.
 124  */
 125 struct hd_i_struct {
 126         unsigned int head, sect, cyl, wpcom, lzone, ctl;
 127         int unit;
 128         int recalibrate;
 129         int special_op;
 130 };
 131
 132 #ifdef HD_TYPE
 133 static struct hd_i_struct hd_info[] = { HD_TYPE };
 134 static int NR_HD = ARRAY_SIZE(hd_info);
 135 #else
 136 static struct hd_i_struct hd_info[MAX_HD];
 137 static int NR_HD;
 138 #endif
 139
 140 static struct gendisk *hd_gendisk[MAX_HD];
 141
 142 static struct timer_list device_timer;
 143
 144 #define TIMEOUT_VALUE (6*HZ)
 145
 146 #define SET_TIMER                                                       \
 147         do {                                                            \
 148                 mod_timer(&device_timer, jiffies + TIMEOUT_VALUE);      \
 149         } while (0)
 150
 151 static void (*do_hd)(void) = NULL;
 152 #define SET_HANDLER(x) \
 153 if ((do_hd = (x)) != NULL) \
 154         SET_TIMER; \
 155 else \
 156         del_timer(&device_timer);
 157
 158
 159 #if (HD_DELAY > 0)
 160
 161 #include <asm/i8253.h>
 162
 163 unsigned long last_req;
 164
 165 unsigned long read_timer(void)
 166 {
 167         unsigned long t, flags;
 168         int i;
 169
 170         spin_lock_irqsave(&i8253_lock, flags);
 171         t = jiffies * 11932;
 172         outb_p(0, 0x43);
 173         i = inb_p(0x40);
 174         i |= inb(0x40) << 8;
 175         spin_unlock_irqrestore(&i8253_lock, flags);
 176         return(t - i);
 177 }
 178 #endif
 179
 180 static void __init hd_setup(char *str, int *ints)
 181 {
 182         int hdind = 0;
 183
 184         if (ints[0] != 3)
 185                 return;
 186         if (hd_info[0].head != 0)
 187                 hdind = 1;
 188         hd_info[hdind].head = ints[2];
 189         hd_info[hdind].sect = ints[3];
 190         hd_info[hdind].cyl = ints[1];
 191         hd_info[hdind].wpcom = 0;
 192         hd_info[hdind].lzone = ints[1];
 193         hd_info[hdind].ctl = (ints[2] > 8 ? 8 : 0);
 194         NR_HD = hdind+1;
 195 }
 196
 197 static bool hd_end_request(int err, unsigned int bytes)
 198 {
 199         if (__blk_end_request(hd_req, err, bytes))
 200                 return true;
 201         hd_req = NULL;
 202         return false;
 203 }
 204
 205 static bool hd_end_request_cur(int err)
 206 {
 207         return hd_end_request(err, blk_rq_cur_bytes(hd_req));
 208 }
 209
 210 static void dump_status(const char *msg, unsigned int stat)
 211 {
 212         char *name = "hd?";
 213         if (hd_req)
 214                 name = hd_req->rq_disk->disk_name;
 215
 216 #ifdef VERBOSE_ERRORS
 217         printk("%s: %s: status=0x%02x { ", name, msg, stat & 0xff);
 218         if (stat & BUSY_STAT)   printk("Busy ");
 219         if (stat & READY_STAT)  printk("DriveReady ");
 220         if (stat & WRERR_STAT)  printk("WriteFault ");
 221         if (stat & SEEK_STAT)   printk("SeekComplete ");
 222         if (stat & DRQ_STAT)    printk("DataRequest ");
 223         if (stat & ECC_STAT)    printk("CorrectedError ");
 224         if (stat & INDEX_STAT)  printk("Index ");
 225         if (stat & ERR_STAT)    printk("Error ");
 226         printk("}\n");
 227         if ((stat & ERR_STAT) == 0) {
 228                 hd_error = 0;
 229         } else {
 230                 hd_error = inb(HD_ERROR);
 231                 printk("%s: %s: error=0x%02x { ", name, msg, hd_error & 0xff);
 232                 if (hd_error & BBD_ERR)         printk("BadSector ");
 233                 if (hd_error & ECC_ERR)         printk("UncorrectableError ");
 234                 if (hd_error & ID_ERR)          printk("SectorIdNotFound ");
 235                 if (hd_error & ABRT_ERR)        printk("DriveStatusError ");
 236                 if (hd_error & TRK0_ERR)        printk("TrackZeroNotFound ");
 237                 if (hd_error & MARK_ERR)        printk("AddrMarkNotFound ");
 238                 printk("}");
 239                 if (hd_error & (BBD_ERR|ECC_ERR|ID_ERR|MARK_ERR)) {
 240                         printk(", CHS=%d/%d/%d", (inb(HD_HCYL)<<8) + inb(HD_LCYL),
 241                                 inb(HD_CURRENT) & 0xf, inb(HD_SECTOR));
 242                         if (hd_req)
 243                                 printk(", sector=%ld", blk_rq_pos(hd_req));
 244                 }
 245                 printk("\n");
 246         }
 247 #else
 248         printk("%s: %s: status=0x%02x.\n", name, msg, stat & 0xff);
 249         if ((stat & ERR_STAT) == 0) {
 250                 hd_error = 0;
 251         } else {
 252                 hd_error = inb(HD_ERROR);
 253                 printk("%s: %s: error=0x%02x.\n", name, msg, hd_error & 0xff);
 254         }
 255 #endif
 256 }
 257
 258 static void check_status(void)
 259 {
 260         int i = inb_p(HD_STATUS);
 261
 262         if (!OK_STATUS(i)) {
 263                 dump_status("check_status", i);
 264                 bad_rw_intr();
 265         }
 266 }
 267
 268 static int controller_busy(void)
 269 {
 270         int retries = 100000;
 271         unsigned char status;
 272
 273         do {
 274                 status = inb_p(HD_STATUS);
 275         } while ((status & BUSY_STAT) && --retries);
 276         return status;
 277 }
 278
 279 static int status_ok(void)
 280 {
 281         unsigned char status = inb_p(HD_STATUS);
 282
 283         if (status & BUSY_STAT)
 284                 return 1;       /* Ancient, but does it make sense??? */
 285         if (status & WRERR_STAT)
 286                 return 0;
 287         if (!(status & READY_STAT))
 288                 return 0;
 289         if (!(status & SEEK_STAT))
 290                 return 0;
 291         return 1;
 292 }
 293
 294 static int controller_ready(unsigned int drive, unsigned int head)
 295 {
 296         int retry = 100;
 297
 298         do {
 299                 if (controller_busy() & BUSY_STAT)
 300                         return 0;
 301                 outb_p(0xA0 | (drive<<4) | head, HD_CURRENT);
 302                 if (status_ok())
 303                         return 1;
 304         } while (--retry);
 305         return 0;
 306 }
 307
 308 static void hd_out(struct hd_i_struct *disk,
 309                    unsigned int nsect,
 310                    unsigned int sect,
 311                    unsigned int head,
 312                    unsigned int cyl,
 313                    unsigned int cmd,
 314                    void (*intr_addr)(void))
 315 {
 316         unsigned short port;
 317
 318 #if (HD_DELAY > 0)
 319         while (read_timer() - last_req < HD_DELAY)
 320                 /* nothing */;
 321 #endif
 322         if (reset)
 323                 return;
 324         if (!controller_ready(disk->unit, head)) {
 325                 reset = 1;
 326                 return;
 327         }
 328         SET_HANDLER(intr_addr);
 329         outb_p(disk->ctl, HD_CMD);
 330         port = HD_DATA;
 331         outb_p(disk->wpcom >> 2, ++port);
 332         outb_p(nsect, ++port);
 333         outb_p(sect, ++port);
 334         outb_p(cyl, ++port);
 335         outb_p(cyl >> 8, ++port);
 336         outb_p(0xA0 | (disk->unit << 4) | head, ++port);
 337         outb_p(cmd, ++port);
 338 }
 339
 340 static void hd_request (void);
 341
 342 static int drive_busy(void)
 343 {
 344         unsigned int i;
 345         unsigned char c;
 346
 347         for (i = 0; i < 500000 ; i++) {
 348                 c = inb_p(HD_STATUS);
 349                 if ((c & (BUSY_STAT | READY_STAT | SEEK_STAT)) == STAT_OK)
 350                         return 0;
 351         }
 352         dump_status("reset timed out", c);
 353         return 1;
 354 }
 355
 356 static void reset_controller(void)
 357 {
 358         int     i;
 359
 360         outb_p(4, HD_CMD);
 361         for (i = 0; i < 1000; i++) barrier();
 362         outb_p(hd_info[0].ctl & 0x0f, HD_CMD);
 363         for (i = 0; i < 1000; i++) barrier();
 364         if (drive_busy())
 365                 printk("hd: controller still busy\n");
 366         else if ((hd_error = inb(HD_ERROR)) != 1)
 367                 printk("hd: controller reset failed: %02x\n", hd_error);
 368 }
 369
 370 static void reset_hd(void)
 371 {
 372         static int i;
 373
 374 repeat:
 375         if (reset) {
 376                 reset = 0;
 377                 i = -1;
 378                 reset_controller();
 379         } else {
 380                 check_status();
 381                 if (reset)
 382                         goto repeat;
 383         }
 384         if (++i < NR_HD) {
 385                 struct hd_i_struct *disk = &hd_info[i];
 386                 disk->special_op = disk->recalibrate = 1;
 387                 hd_out(disk, disk->sect, disk->sect, disk->head-1,
 388                         disk->cyl, ATA_CMD_INIT_DEV_PARAMS, &reset_hd);
 389                 if (reset)
 390                         goto repeat;
 391         } else
 392                 hd_request();
 393 }
 394
 395 /*
 396  * Ok, don't know what to do with the unexpected interrupts: on some machines
 397  * doing a reset and a retry seems to result in an eternal loop. Right now I
 398  * ignore it, and just set the timeout.
 399  *
 400  * On laptops (and "green" PCs), an unexpected interrupt occurs whenever the
 401  * drive enters "idle", "standby", or "sleep" mode, so if the status looks
 402  * "good", we just ignore the interrupt completely.
 403  */
 404 static void unexpected_hd_interrupt(void)
 405 {
 406         unsigned int stat = inb_p(HD_STATUS);
 407
 408         if (stat & (BUSY_STAT|DRQ_STAT|ECC_STAT|ERR_STAT)) {
 409                 dump_status("unexpected interrupt", stat);
 410                 SET_TIMER;
 411         }
 412 }
 413
 414 /*
 415  * bad_rw_intr() now tries to be a bit smarter and does things
 416  * according to the error returned by the controller.
 417  * -Mika Liljeberg (liljeber@cs.Helsinki.FI)
 418  */
 419 static void bad_rw_intr(void)
 420 {
 421         struct request *req = hd_req;
 422
 423         if (req != NULL) {
 424                 struct hd_i_struct *disk = req->rq_disk->private_data;
 425                 if (++req->errors >= MAX_ERRORS || (hd_error & BBD_ERR)) {
 426                         hd_end_request_cur(-EIO);
 427                         disk->special_op = disk->recalibrate = 1;
 428                 } else if (req->errors % RESET_FREQ == 0)
 429                         reset = 1;
 430                 else if ((hd_error & TRK0_ERR) || req->errors % RECAL_FREQ == 0)
 431                         disk->special_op = disk->recalibrate = 1;
 432                 /* Otherwise just retry */
 433         }
 434 }
 435
 436 static inline int wait_DRQ(void)
 437 {
 438         int retries;
 439         int stat;
 440
 441         for (retries = 0; retries < 100000; retries++) {
 442                 stat = inb_p(HD_STATUS);
 443                 if (stat & DRQ_STAT)
 444                         return 0;
 445         }
 446         dump_status("wait_DRQ", stat);
 447         return -1;
 448 }
 449
 450 static void read_intr(void)
 451 {
 452         struct request *req;
 453         int i, retries = 100000;
 454
 455         do {
 456                 i = (unsigned) inb_p(HD_STATUS);
 457                 if (i & BUSY_STAT)
 458                         continue;
 459                 if (!OK_STATUS(i))
 460                         break;
 461                 if (i & DRQ_STAT)
 462                         goto ok_to_read;
 463         } while (--retries > 0);
 464         dump_status("read_intr", i);
 465         bad_rw_intr();
 466         hd_request();
 467         return;
 468
 469 ok_to_read:
 470         req = hd_req;
 471         insw(HD_DATA, req->buffer, 256);
 472 #ifdef DEBUG
 473         printk("%s: read: sector %ld, remaining = %u, buffer=%p\n",
 474                req->rq_disk->disk_name, blk_rq_pos(req) + 1,
 475                blk_rq_sectors(req) - 1, req->buffer+512);
 476 #endif
 477         if (hd_end_request(0, 512)) {
 478                 SET_HANDLER(&read_intr);
 479                 return;
 480         }
 481
 482         (void) inb_p(HD_STATUS);
 483 #if (HD_DELAY > 0)
 484         last_req = read_timer();
 485 #endif
 486         hd_request();
 487 }
 488
 489 static void write_intr(void)
 490 {
 491         struct request *req = hd_req;
 492         int i;
 493         int retries = 100000;
 494
 495         do {
 496                 i = (unsigned) inb_p(HD_STATUS);
 497                 if (i & BUSY_STAT)
 498                         continue;
 499                 if (!OK_STATUS(i))
 500                         break;
 501                 if ((blk_rq_sectors(req) <= 1) || (i & DRQ_STAT))
 502                         goto ok_to_write;
 503         } while (--retries > 0);
 504         dump_status("write_intr", i);
 505         bad_rw_intr();
 506         hd_request();
 507         return;
 508
 509 ok_to_write:
 510         if (hd_end_request(0, 512)) {
 511                 SET_HANDLER(&write_intr);
 512                 outsw(HD_DATA, req->buffer, 256);
 513                 return;
 514         }
 515
 516 #if (HD_DELAY > 0)
 517         last_req = read_timer();
 518 #endif
 519         hd_request();
 520 }
 521
 522 static void recal_intr(void)
 523 {
 524         check_status();
 525 #if (HD_DELAY > 0)
 526         last_req = read_timer();
 527 #endif
 528         hd_request();
 529 }
 530
 531 /*
 532  * This is another of the error-routines I don't know what to do with. The
 533  * best idea seems to just set reset, and start all over again.
 534  */
 535 static void hd_times_out(unsigned long dummy)
 536 {
 537         char *name;
 538
 539         do_hd = NULL;
 540
 541         if (!hd_req)
 542                 return;
 543
 544         spin_lock_irq(hd_queue->queue_lock);
 545         reset = 1;
 546         name = hd_req->rq_disk->disk_name;
 547         printk("%s: timeout\n", name);
 548         if (++hd_req->errors >= MAX_ERRORS) {
 549 #ifdef DEBUG
 550                 printk("%s: too many errors\n", name);
 551 #endif
 552                 hd_end_request_cur(-EIO);
 553         }
 554         hd_request();
 555         spin_unlock_irq(hd_queue->queue_lock);
 556 }
 557
 558 static int do_special_op(struct hd_i_struct *disk, struct request *req)
 559 {
 560         if (disk->recalibrate) {
 561                 disk->recalibrate = 0;
 562                 hd_out(disk, disk->sect, 0, 0, 0, ATA_CMD_RESTORE, &recal_intr);
 563                 return reset;
 564         }
 565         if (disk->head > 16) {
 566                 printk("%s: cannot handle device with more than 16 heads - giving up\n", req->rq_disk->disk_name);
 567                 hd_end_request_cur(-EIO);
 568         }
 569         disk->special_op = 0;
 570         return 1;
 571 }
 572
 573 /*
 574  * The driver enables interrupts as much as possible.  In order to do this,
 575  * (a) the device-interrupt is disabled before entering hd_request(),
 576  * and (b) the timeout-interrupt is disabled before the sti().
 577  *
 578  * Interrupts are still masked (by default) whenever we are exchanging
 579  * data/cmds with a drive, because some drives seem to have very poor
 580  * tolerance for latency during I/O. The IDE driver has support to unmask
 581  * interrupts for non-broken hardware, so use that driver if required.
 582  */
 583 static void hd_request(void)
 584 {
 585         unsigned int block, nsect, sec, track, head, cyl;
 586         struct hd_i_struct *disk;
 587         struct request *req;
 588
 589         if (do_hd)
 590                 return;
 591 repeat:
 592         del_timer(&device_timer);
 593
 594         if (!hd_req) {
 595                 hd_req = blk_fetch_request(hd_queue);
 596                 if (!hd_req) {
 597                         do_hd = NULL;
 598                         return;
 599                 }
 600         }
 601         req = hd_req;
 602
 603         if (reset) {
 604                 reset_hd();
 605                 return;
 606         }
 607         disk = req->rq_disk->private_data;
 608         block = blk_rq_pos(req);
 609         nsect = blk_rq_sectors(req);
 610         if (block >= get_capacity(req->rq_disk) ||
 611             ((block+nsect) > get_capacity(req->rq_disk))) {
 612                 printk("%s: bad access: block=%d, count=%d\n",
 613                         req->rq_disk->disk_name, block, nsect);
 614                 hd_end_request_cur(-EIO);
 615                 goto repeat;
 616         }
 617
 618         if (disk->special_op) {
 619                 if (do_special_op(disk, req))
 620                         goto repeat;
 621                 return;
 622         }
 623         sec   = block % disk->sect + 1;
 624         track = block / disk->sect;
 625         head  = track % disk->head;
 626         cyl   = track / disk->head;
 627 #ifdef DEBUG
 628         printk("%s: %sing: CHS=%d/%d/%d, sectors=%d, buffer=%p\n",
 629                 req->rq_disk->disk_name,
 630                 req_data_dir(req) == READ ? "read" : "writ",
 631                 cyl, head, sec, nsect, req->buffer);
 632 #endif
 633         if (blk_fs_request(req)) {
 634                 switch (rq_data_dir(req)) {
 635                 case READ:
 636                         hd_out(disk, nsect, sec, head, cyl, ATA_CMD_PIO_READ,
 637                                 &read_intr);
 638                         if (reset)
 639                                 goto repeat;
 640                         break;
 641                 case WRITE:
 642                         hd_out(disk, nsect, sec, head, cyl, ATA_CMD_PIO_WRITE,
 643                                 &write_intr);
 644                         if (reset)
 645                                 goto repeat;
 646                         if (wait_DRQ()) {
 647                                 bad_rw_intr();
 648                                 goto repeat;
 649                         }
 650                         outsw(HD_DATA, req->buffer, 256);
 651                         break;
 652                 default:
 653                         printk("unknown hd-command\n");
 654                         hd_end_request_cur(-EIO);
 655                         break;
 656                 }
 657         }
 658 }
 659
 660 static void do_hd_request(struct request_queue *q)
 661 {
 662         hd_request();
 663 }
 664
 665 static int hd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
 666 {
 667         struct hd_i_struct *disk = bdev->bd_disk->private_data;
 668
 669         geo->heads = disk->head;
 670         geo->sectors = disk->sect;
 671         geo->cylinders = disk->cyl;
 672         return 0;
 673 }
 674
 675 /*
 676  * Releasing a block device means we sync() it, so that it can safely
 677  * be forgotten about...
 678  */
 679
 680 static irqreturn_t hd_interrupt(int irq, void *dev_id)
 681 {
 682         void (*handler)(void) = do_hd;
 683
 684         spin_lock(hd_queue->queue_lock);
 685
 686         do_hd = NULL;
 687         del_timer(&device_timer);
 688         if (!handler)
 689                 handler = unexpected_hd_interrupt;
 690         handler();
 691
 692         spin_unlock(hd_queue->queue_lock);
 693
 694         return IRQ_HANDLED;
 695 }
 696
 697 static struct block_device_operations hd_fops = {
 698         .getgeo =       hd_getgeo,
 699 };
 700
 701 /*
 702  * This is the hard disk IRQ description. The IRQF_DISABLED in sa_flags
 703  * means we run the IRQ-handler with interrupts disabled:  this is bad for
 704  * interrupt latency, but anything else has led to problems on some
 705  * machines.
 706  *
 707  * We enable interrupts in some of the routines after making sure it's
 708  * safe.
 709  */
 710
 711 static int __init hd_init(void)
 712 {
 713         int drive;
 714
 715         if (register_blkdev(MAJOR_NR, "hd"))
 716                 return -1;
 717
 718         hd_queue = blk_init_queue(do_hd_request, &hd_lock);
 719         if (!hd_queue) {
 720                 unregister_blkdev(MAJOR_NR, "hd");
 721                 return -ENOMEM;
 722         }
 723
 724         blk_queue_max_sectors(hd_queue, 255);
 725         init_timer(&device_timer);
 726         device_timer.function = hd_times_out;
 727         blk_queue_logical_block_size(hd_queue, 512);
 728
 729         if (!NR_HD) {
 730                 /*
 731                  * We don't know anything about the drive.  This means
 732                  * that you *MUST* specify the drive parameters to the
 733                  * kernel yourself.
 734                  *
 735                  * If we were on an i386, we used to read this info from
 736                  * the BIOS or CMOS.  This doesn't work all that well,
 737                  * since this assumes that this is a primary or secondary
 738                  * drive, and if we're using this legacy driver, it's
 739                  * probably an auxilliary controller added to recover
 740                  * legacy data off an ST-506 drive.  Either way, it's
 741                  * definitely safest to have the user explicitly specify
 742                  * the information.
 743                  */
 744                 printk("hd: no drives specified - use hd=cyl,head,sectors"
 745                         " on kernel command line\n");
 746                 goto out;
 747         }
 748
 749         for (drive = 0 ; drive < NR_HD ; drive++) {
 750                 struct gendisk *disk = alloc_disk(64);
 751                 struct hd_i_struct *p = &hd_info[drive];
 752                 if (!disk)
 753                         goto Enomem;
 754                 disk->major = MAJOR_NR;
 755                 disk->first_minor = drive << 6;
 756                 disk->fops = &hd_fops;
 757                 sprintf(disk->disk_name, "hd%c", 'a'+drive);
 758                 disk->private_data = p;
 759                 set_capacity(disk, p->head * p->sect * p->cyl);
 760                 disk->queue = hd_queue;
 761                 p->unit = drive;
 762                 hd_gendisk[drive] = disk;
 763                 printk("%s: %luMB, CHS=%d/%d/%d\n",
 764                         disk->disk_name, (unsigned long)get_capacity(disk)/2048,
 765                         p->cyl, p->head, p->sect);
 766         }
 767
 768         if (request_irq(HD_IRQ, hd_interrupt, IRQF_DISABLED, "hd", NULL)) {
 769                 printk("hd: unable to get IRQ%d for the hard disk driver\n",
 770                         HD_IRQ);
 771                 goto out1;
 772         }
 773         if (!request_region(HD_DATA, 8, "hd")) {
 774                 printk(KERN_WARNING "hd: port 0x%x busy\n", HD_DATA);
 775                 goto out2;
 776         }
 777         if (!request_region(HD_CMD, 1, "hd(cmd)")) {
 778                 printk(KERN_WARNING "hd: port 0x%x busy\n", HD_CMD);
 779                 goto out3;
 780         }
 781
 782         /* Let them fly */
 783         for (drive = 0; drive < NR_HD; drive++)
 784                 add_disk(hd_gendisk[drive]);
 785
 786         return 0;
 787
 788 out3:
 789         release_region(HD_DATA, 8);
 790 out2:
 791         free_irq(HD_IRQ, NULL);
 792 out1:
 793         for (drive = 0; drive < NR_HD; drive++)
 794                 put_disk(hd_gendisk[drive]);
 795         NR_HD = 0;
 796 out:
 797         del_timer(&device_timer);
 798         unregister_blkdev(MAJOR_NR, "hd");
 799         blk_cleanup_queue(hd_queue);
 800         return -1;
 801 Enomem:
 802         while (drive--)
 803                 put_disk(hd_gendisk[drive]);
 804         goto out;
 805 }
 806
 807 static int __init parse_hd_setup(char *line)
 808 {
 809         int ints[6];
 810
 811         (void) get_options(line, ARRAY_SIZE(ints), ints);
 812         hd_setup(NULL, ints);
 813
 814         return 1;
 815 }
 816 __setup("hd=", parse_hd_setup);
 817
 818 late_initcall(hd_init);