2 * Copyright (C) 1994-1998 Linus Torvalds & authors (see below)
3 * Copyright (C) 1998-2002 Linux ATA Development
4 * Andre Hedrick <andre@linux-ide.org>
5 * Copyright (C) 2003 Red Hat <alan@redhat.com>
6 * Copyright (C) 2003-2005, 2007 Bartlomiej Zolnierkiewicz
10 * Mostly written by Mark Lord <mlord@pobox.com>
11 * and Gadi Oxman <gadio@netvision.net.il>
12 * and Andre Hedrick <andre@linux-ide.org>
14 * This is the IDE/ATA disk driver, as evolved from hd.c and ide.c.
17 #define IDEDISK_VERSION "1.18"
21 #include <linux/module.h>
22 #include <linux/types.h>
23 #include <linux/string.h>
24 #include <linux/kernel.h>
25 #include <linux/timer.h>
27 #include <linux/interrupt.h>
28 #include <linux/major.h>
29 #include <linux/errno.h>
30 #include <linux/genhd.h>
31 #include <linux/slab.h>
32 #include <linux/delay.h>
33 #include <linux/mutex.h>
34 #include <linux/leds.h>
38 #include <linux/ide.h>
40 #include <asm/byteorder.h>
42 #include <asm/uaccess.h>
44 #include <asm/div64.h>
51 unsigned int openers; /* protected by BKL for now */
54 static DEFINE_MUTEX(idedisk_ref_mutex);
56 #define to_ide_disk(obj) container_of(obj, struct ide_disk_obj, kref)
58 #define ide_disk_g(disk) \
59 container_of((disk)->private_data, struct ide_disk_obj, driver)
61 static struct ide_disk_obj *ide_disk_get(struct gendisk *disk)
63 struct ide_disk_obj *idkp = NULL;
65 mutex_lock(&idedisk_ref_mutex);
66 idkp = ide_disk_g(disk);
68 kref_get(&idkp->kref);
69 mutex_unlock(&idedisk_ref_mutex);
73 static void ide_disk_release(struct kref *);
75 static void ide_disk_put(struct ide_disk_obj *idkp)
77 mutex_lock(&idedisk_ref_mutex);
78 kref_put(&idkp->kref, ide_disk_release);
79 mutex_unlock(&idedisk_ref_mutex);
83 * lba_capacity_is_ok() performs a sanity check on the claimed "lba_capacity"
84 * value for this drive (from its reported identification information).
86 * Returns: 1 if lba_capacity looks sensible
89 * It is called only once for each drive.
91 static int lba_capacity_is_ok (struct hd_driveid *id)
93 unsigned long lba_sects, chs_sects, head, tail;
95 /* No non-LBA info .. so valid! */
100 * The ATA spec tells large drives to return
101 * C/H/S = 16383/16/63 independent of their size.
102 * Some drives can be jumpered to use 15 heads instead of 16.
103 * Some drives can be jumpered to use 4092 cyls instead of 16383.
105 if ((id->cyls == 16383
106 || (id->cyls == 4092 && id->cur_cyls == 16383)) &&
108 (id->heads == 15 || id->heads == 16) &&
109 (id->lba_capacity >= 16383*63*id->heads))
112 lba_sects = id->lba_capacity;
113 chs_sects = id->cyls * id->heads * id->sectors;
115 /* perform a rough sanity check on lba_sects: within 10% is OK */
116 if ((lba_sects - chs_sects) < chs_sects/10)
119 /* some drives have the word order reversed */
120 head = ((lba_sects >> 16) & 0xffff);
121 tail = (lba_sects & 0xffff);
122 lba_sects = (head | (tail << 16));
123 if ((lba_sects - chs_sects) < chs_sects/10) {
124 id->lba_capacity = lba_sects;
125 return 1; /* lba_capacity is (now) good */
128 return 0; /* lba_capacity value may be bad */
131 static const u8 ide_rw_cmds[] = {
146 static const u8 ide_data_phases[] = {
155 static void ide_tf_set_cmd(ide_drive_t *drive, ide_task_t *task, u8 dma)
157 u8 index, lba48, write;
159 lba48 = (task->tf_flags & IDE_TFLAG_LBA48) ? 2 : 0;
160 write = (task->tf_flags & IDE_TFLAG_WRITE) ? 1 : 0;
163 index = drive->vdma ? 4 : 8;
165 index = drive->mult_count ? 0 : 4;
167 task->tf.command = ide_rw_cmds[index + lba48 + write];
170 index = 8; /* fixup index */
172 task->data_phase = ide_data_phases[index / 2 + write];
176 * __ide_do_rw_disk() issues READ and WRITE commands to a disk,
177 * using LBA if supported, or CHS otherwise, to address sectors.
179 static ide_startstop_t __ide_do_rw_disk(ide_drive_t *drive, struct request *rq, sector_t block)
181 ide_hwif_t *hwif = HWIF(drive);
182 unsigned int dma = drive->using_dma;
183 u16 nsectors = (u16)rq->nr_sectors;
184 u8 lba48 = (drive->addressing == 1) ? 1 : 0;
186 struct ide_taskfile *tf = &task.tf;
189 if ((hwif->host_flags & IDE_HFLAG_NO_LBA48_DMA) && lba48 && dma) {
190 if (block + rq->nr_sectors > 1ULL << 28)
197 ide_init_sg_cmd(drive, rq);
198 ide_map_sg(drive, rq);
201 memset(&task, 0, sizeof(task));
202 task.tf_flags = IDE_TFLAG_NO_SELECT_MASK; /* FIXME? */
203 task.tf_flags |= (IDE_TFLAG_TF | IDE_TFLAG_DEVICE);
205 if (drive->select.b.lba) {
207 pr_debug("%s: LBA=0x%012llx\n", drive->name,
208 (unsigned long long)block);
210 tf->hob_nsect = (nsectors >> 8) & 0xff;
211 tf->hob_lbal = (u8)(block >> 24);
212 if (sizeof(block) != 4) {
213 tf->hob_lbam = (u8)((u64)block >> 32);
214 tf->hob_lbah = (u8)((u64)block >> 40);
217 tf->nsect = nsectors & 0xff;
218 tf->lbal = (u8) block;
219 tf->lbam = (u8)(block >> 8);
220 tf->lbah = (u8)(block >> 16);
222 task.tf_flags |= (IDE_TFLAG_LBA48 | IDE_TFLAG_HOB);
224 tf->nsect = nsectors & 0xff;
226 tf->lbam = block >>= 8;
227 tf->lbah = block >>= 8;
228 tf->device = (block >> 8) & 0xf;
231 unsigned int sect,head,cyl,track;
232 track = (int)block / drive->sect;
233 sect = (int)block % drive->sect + 1;
234 head = track % drive->head;
235 cyl = track / drive->head;
237 pr_debug("%s: CHS=%u/%u/%u\n", drive->name, cyl, head, sect);
239 tf->nsect = nsectors & 0xff;
247 task.tf_flags |= IDE_TFLAG_WRITE;
249 ide_tf_set_cmd(drive, &task, dma);
251 hwif->data_phase = task.data_phase;
254 rc = do_rw_taskfile(drive, &task);
256 if (rc == ide_stopped && dma) {
257 /* fallback to PIO */
258 task.tf_flags |= IDE_TFLAG_DMA_PIO_FALLBACK;
259 ide_tf_set_cmd(drive, &task, 0);
260 hwif->data_phase = task.data_phase;
261 ide_init_sg_cmd(drive, rq);
262 rc = do_rw_taskfile(drive, &task);
269 * 268435455 == 137439 MB or 28bit limit
270 * 320173056 == 163929 MB or 48bit addressing
271 * 1073741822 == 549756 MB or 48bit addressing fake drive
274 static ide_startstop_t ide_do_rw_disk (ide_drive_t *drive, struct request *rq, sector_t block)
276 ide_hwif_t *hwif = HWIF(drive);
278 BUG_ON(drive->blocked);
280 if (!blk_fs_request(rq)) {
281 blk_dump_rq_flags(rq, "ide_do_rw_disk - bad command");
282 ide_end_request(drive, 0, 0);
286 ledtrig_ide_activity();
288 pr_debug("%s: %sing: block=%llu, sectors=%lu, buffer=0x%08lx\n",
289 drive->name, rq_data_dir(rq) == READ ? "read" : "writ",
290 (unsigned long long)block, rq->nr_sectors,
291 (unsigned long)rq->buffer);
294 hwif->rw_disk(drive, rq);
296 return __ide_do_rw_disk(drive, rq, block);
300 * Queries for true maximum capacity of the drive.
301 * Returns maximum LBA address (> 0) of the drive, 0 if failed.
303 static u64 idedisk_read_native_max_address(ide_drive_t *drive, int lba48)
306 struct ide_taskfile *tf = &args.tf;
309 /* Create IDE/ATA command request structure */
310 memset(&args, 0, sizeof(ide_task_t));
312 tf->command = WIN_READ_NATIVE_MAX_EXT;
314 tf->command = WIN_READ_NATIVE_MAX;
315 tf->device = ATA_LBA;
316 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
318 args.tf_flags |= (IDE_TFLAG_LBA48 | IDE_TFLAG_HOB);
319 /* submit command request */
320 ide_no_data_taskfile(drive, &args);
322 /* if OK, compute maximum address value */
323 if ((tf->status & 0x01) == 0)
324 addr = ide_get_lba_addr(tf, lba48) + 1;
330 * Sets maximum virtual LBA address of the drive.
331 * Returns new maximum virtual LBA address (> 0) or 0 on failure.
333 static u64 idedisk_set_max_address(ide_drive_t *drive, u64 addr_req, int lba48)
336 struct ide_taskfile *tf = &args.tf;
340 /* Create IDE/ATA command request structure */
341 memset(&args, 0, sizeof(ide_task_t));
342 tf->lbal = (addr_req >> 0) & 0xff;
343 tf->lbam = (addr_req >>= 8) & 0xff;
344 tf->lbah = (addr_req >>= 8) & 0xff;
346 tf->hob_lbal = (addr_req >>= 8) & 0xff;
347 tf->hob_lbam = (addr_req >>= 8) & 0xff;
348 tf->hob_lbah = (addr_req >>= 8) & 0xff;
349 tf->command = WIN_SET_MAX_EXT;
351 tf->device = (addr_req >>= 8) & 0x0f;
352 tf->command = WIN_SET_MAX;
354 tf->device |= ATA_LBA;
355 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
357 args.tf_flags |= (IDE_TFLAG_LBA48 | IDE_TFLAG_HOB);
358 /* submit command request */
359 ide_no_data_taskfile(drive, &args);
360 /* if OK, compute maximum address value */
361 if ((tf->status & 0x01) == 0)
362 addr_set = ide_get_lba_addr(tf, lba48) + 1;
367 static unsigned long long sectors_to_MB(unsigned long long n)
369 n <<= 9; /* make it bytes */
370 do_div(n, 1000000); /* make it MB */
375 * Bits 10 of command_set_1 and cfs_enable_1 must be equal,
376 * so on non-buggy drives we need test only one.
377 * However, we should also check whether these fields are valid.
379 static inline int idedisk_supports_hpa(const struct hd_driveid *id)
381 return (id->command_set_1 & 0x0400) && (id->cfs_enable_1 & 0x0400);
387 static inline int idedisk_supports_lba48(const struct hd_driveid *id)
389 return (id->command_set_2 & 0x0400) && (id->cfs_enable_2 & 0x0400)
390 && id->lba_capacity_2;
394 * Some disks report total number of sectors instead of
395 * maximum sector address. We list them here.
397 static const struct drive_list_entry hpa_list[] = {
398 { "ST340823A", NULL },
399 { "ST320413A", NULL },
400 { "ST310211A", NULL },
404 static void idedisk_check_hpa(ide_drive_t *drive)
406 unsigned long long capacity, set_max;
407 int lba48 = idedisk_supports_lba48(drive->id);
409 capacity = drive->capacity64;
411 set_max = idedisk_read_native_max_address(drive, lba48);
413 if (ide_in_drive_list(drive->id, hpa_list)) {
415 * Since we are inclusive wrt to firmware revisions do this
416 * extra check and apply the workaround only when needed.
418 if (set_max == capacity + 1)
422 if (set_max <= capacity)
425 printk(KERN_INFO "%s: Host Protected Area detected.\n"
426 "\tcurrent capacity is %llu sectors (%llu MB)\n"
427 "\tnative capacity is %llu sectors (%llu MB)\n",
429 capacity, sectors_to_MB(capacity),
430 set_max, sectors_to_MB(set_max));
432 set_max = idedisk_set_max_address(drive, set_max, lba48);
435 drive->capacity64 = set_max;
436 printk(KERN_INFO "%s: Host Protected Area disabled.\n",
442 * Compute drive->capacity, the full capacity of the drive
443 * Called with drive->id != NULL.
445 * To compute capacity, this uses either of
447 * 1. CHS value set by user (whatever user sets will be trusted)
448 * 2. LBA value from target drive (require new ATA feature)
449 * 3. LBA value from system BIOS (new one is OK, old one may break)
450 * 4. CHS value from system BIOS (traditional style)
452 * in above order (i.e., if value of higher priority is available,
453 * reset will be ignored).
455 static void init_idedisk_capacity (ide_drive_t *drive)
457 struct hd_driveid *id = drive->id;
459 * If this drive supports the Host Protected Area feature set,
460 * then we may need to change our opinion about the drive's capacity.
462 int hpa = idedisk_supports_hpa(id);
464 if (idedisk_supports_lba48(id)) {
465 /* drive speaks 48-bit LBA */
466 drive->select.b.lba = 1;
467 drive->capacity64 = id->lba_capacity_2;
469 idedisk_check_hpa(drive);
470 } else if ((id->capability & 2) && lba_capacity_is_ok(id)) {
471 /* drive speaks 28-bit LBA */
472 drive->select.b.lba = 1;
473 drive->capacity64 = id->lba_capacity;
475 idedisk_check_hpa(drive);
477 /* drive speaks boring old 28-bit CHS */
478 drive->capacity64 = drive->cyl * drive->head * drive->sect;
482 static sector_t idedisk_capacity (ide_drive_t *drive)
484 return drive->capacity64 - drive->sect0;
487 #ifdef CONFIG_IDE_PROC_FS
488 static int smart_enable(ide_drive_t *drive)
491 struct ide_taskfile *tf = &args.tf;
493 memset(&args, 0, sizeof(ide_task_t));
494 tf->feature = SMART_ENABLE;
495 tf->lbam = SMART_LCYL_PASS;
496 tf->lbah = SMART_HCYL_PASS;
497 tf->command = WIN_SMART;
498 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
499 return ide_no_data_taskfile(drive, &args);
502 static int get_smart_data(ide_drive_t *drive, u8 *buf, u8 sub_cmd)
505 struct ide_taskfile *tf = &args.tf;
507 memset(&args, 0, sizeof(ide_task_t));
508 tf->feature = sub_cmd;
510 tf->lbam = SMART_LCYL_PASS;
511 tf->lbah = SMART_HCYL_PASS;
512 tf->command = WIN_SMART;
513 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
514 args.data_phase = TASKFILE_IN;
515 (void) smart_enable(drive);
516 return ide_raw_taskfile(drive, &args, buf, 1);
519 static int proc_idedisk_read_cache
520 (char *page, char **start, off_t off, int count, int *eof, void *data)
522 ide_drive_t *drive = (ide_drive_t *) data;
527 len = sprintf(out,"%i\n", drive->id->buf_size / 2);
529 len = sprintf(out,"(none)\n");
530 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
533 static int proc_idedisk_read_capacity
534 (char *page, char **start, off_t off, int count, int *eof, void *data)
536 ide_drive_t*drive = (ide_drive_t *)data;
539 len = sprintf(page,"%llu\n", (long long)idedisk_capacity(drive));
540 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
543 static int proc_idedisk_read_smart(char *page, char **start, off_t off,
544 int count, int *eof, void *data, u8 sub_cmd)
546 ide_drive_t *drive = (ide_drive_t *)data;
549 if (get_smart_data(drive, page, sub_cmd) == 0) {
550 unsigned short *val = (unsigned short *) page;
551 char *out = ((char *)val) + (SECTOR_WORDS * 4);
554 out += sprintf(out, "%04x%c", le16_to_cpu(*val), (++i & 7) ? ' ' : '\n');
556 } while (i < (SECTOR_WORDS * 2));
559 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
562 static int proc_idedisk_read_sv
563 (char *page, char **start, off_t off, int count, int *eof, void *data)
565 return proc_idedisk_read_smart(page, start, off, count, eof, data,
569 static int proc_idedisk_read_st
570 (char *page, char **start, off_t off, int count, int *eof, void *data)
572 return proc_idedisk_read_smart(page, start, off, count, eof, data,
573 SMART_READ_THRESHOLDS);
576 static ide_proc_entry_t idedisk_proc[] = {
577 { "cache", S_IFREG|S_IRUGO, proc_idedisk_read_cache, NULL },
578 { "capacity", S_IFREG|S_IRUGO, proc_idedisk_read_capacity, NULL },
579 { "geometry", S_IFREG|S_IRUGO, proc_ide_read_geometry, NULL },
580 { "smart_values", S_IFREG|S_IRUSR, proc_idedisk_read_sv, NULL },
581 { "smart_thresholds", S_IFREG|S_IRUSR, proc_idedisk_read_st, NULL },
582 { NULL, 0, NULL, NULL }
584 #endif /* CONFIG_IDE_PROC_FS */
586 static void idedisk_prepare_flush(struct request_queue *q, struct request *rq)
588 ide_drive_t *drive = q->queuedata;
589 ide_task_t *task = kmalloc(sizeof(*task), GFP_ATOMIC);
591 /* FIXME: map struct ide_taskfile on rq->cmd[] */
592 BUG_ON(task == NULL);
594 memset(task, 0, sizeof(*task));
595 if (ide_id_has_flush_cache_ext(drive->id) &&
596 (drive->capacity64 >= (1UL << 28)))
597 task->tf.command = WIN_FLUSH_CACHE_EXT;
599 task->tf.command = WIN_FLUSH_CACHE;
600 task->tf_flags = IDE_TFLAG_OUT_TF | IDE_TFLAG_OUT_DEVICE |
602 task->data_phase = TASKFILE_NO_DATA;
604 rq->cmd_type = REQ_TYPE_ATA_TASKFILE;
605 rq->cmd_flags |= REQ_SOFTBARRIER;
610 * This is tightly woven into the driver->do_special can not touch.
611 * DON'T do it again until a total personality rewrite is committed.
613 static int set_multcount(ide_drive_t *drive, int arg)
617 if (arg < 0 || arg > drive->id->max_multsect)
620 if (drive->special.b.set_multmode)
623 ide_init_drive_cmd (&rq);
624 rq.cmd_type = REQ_TYPE_ATA_TASKFILE;
626 drive->mult_req = arg;
627 drive->special.b.set_multmode = 1;
628 (void) ide_do_drive_cmd (drive, &rq, ide_wait);
629 return (drive->mult_count == arg) ? 0 : -EIO;
632 static int set_nowerr(ide_drive_t *drive, int arg)
634 if (arg < 0 || arg > 1)
637 if (ide_spin_wait_hwgroup(drive))
640 drive->bad_wstat = arg ? BAD_R_STAT : BAD_W_STAT;
641 spin_unlock_irq(&ide_lock);
645 static void update_ordered(ide_drive_t *drive)
647 struct hd_driveid *id = drive->id;
648 unsigned ordered = QUEUE_ORDERED_NONE;
649 prepare_flush_fn *prep_fn = NULL;
652 unsigned long long capacity;
655 * We must avoid issuing commands a drive does not
656 * understand or we may crash it. We check flush cache
657 * is supported. We also check we have the LBA48 flush
658 * cache if the drive capacity is too large. By this
659 * time we have trimmed the drive capacity if LBA48 is
660 * not available so we don't need to recheck that.
662 capacity = idedisk_capacity(drive);
663 barrier = ide_id_has_flush_cache(id) && !drive->noflush &&
664 (drive->addressing == 0 || capacity <= (1ULL << 28) ||
665 ide_id_has_flush_cache_ext(id));
667 printk(KERN_INFO "%s: cache flushes %ssupported\n",
668 drive->name, barrier ? "" : "not ");
671 ordered = QUEUE_ORDERED_DRAIN_FLUSH;
672 prep_fn = idedisk_prepare_flush;
675 ordered = QUEUE_ORDERED_DRAIN;
677 blk_queue_ordered(drive->queue, ordered, prep_fn);
680 static int write_cache(ide_drive_t *drive, int arg)
685 if (arg < 0 || arg > 1)
688 if (ide_id_has_flush_cache(drive->id)) {
689 memset(&args, 0, sizeof(ide_task_t));
690 args.tf.feature = arg ?
691 SETFEATURES_EN_WCACHE : SETFEATURES_DIS_WCACHE;
692 args.tf.command = WIN_SETFEATURES;
693 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
694 err = ide_no_data_taskfile(drive, &args);
699 update_ordered(drive);
704 static int do_idedisk_flushcache (ide_drive_t *drive)
708 memset(&args, 0, sizeof(ide_task_t));
709 if (ide_id_has_flush_cache_ext(drive->id))
710 args.tf.command = WIN_FLUSH_CACHE_EXT;
712 args.tf.command = WIN_FLUSH_CACHE;
713 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
714 return ide_no_data_taskfile(drive, &args);
717 static int set_acoustic (ide_drive_t *drive, int arg)
721 if (arg < 0 || arg > 254)
724 memset(&args, 0, sizeof(ide_task_t));
725 args.tf.feature = arg ? SETFEATURES_EN_AAM : SETFEATURES_DIS_AAM;
727 args.tf.command = WIN_SETFEATURES;
728 args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
729 ide_no_data_taskfile(drive, &args);
730 drive->acoustic = arg;
738 * 2: 48-bit capable doing 28-bit
740 static int set_lba_addressing(ide_drive_t *drive, int arg)
742 if (arg < 0 || arg > 2)
745 drive->addressing = 0;
747 if (drive->hwif->host_flags & IDE_HFLAG_NO_LBA48)
750 if (!idedisk_supports_lba48(drive->id))
752 drive->addressing = arg;
756 #ifdef CONFIG_IDE_PROC_FS
757 static void idedisk_add_settings(ide_drive_t *drive)
759 struct hd_driveid *id = drive->id;
761 ide_add_setting(drive, "bios_cyl", SETTING_RW, TYPE_INT, 0, 65535, 1, 1, &drive->bios_cyl, NULL);
762 ide_add_setting(drive, "bios_head", SETTING_RW, TYPE_BYTE, 0, 255, 1, 1, &drive->bios_head, NULL);
763 ide_add_setting(drive, "bios_sect", SETTING_RW, TYPE_BYTE, 0, 63, 1, 1, &drive->bios_sect, NULL);
764 ide_add_setting(drive, "address", SETTING_RW, TYPE_BYTE, 0, 2, 1, 1, &drive->addressing, set_lba_addressing);
765 ide_add_setting(drive, "multcount", SETTING_RW, TYPE_BYTE, 0, id->max_multsect, 1, 1, &drive->mult_count, set_multcount);
766 ide_add_setting(drive, "nowerr", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->nowerr, set_nowerr);
767 ide_add_setting(drive, "lun", SETTING_RW, TYPE_INT, 0, 7, 1, 1, &drive->lun, NULL);
768 ide_add_setting(drive, "wcache", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->wcache, write_cache);
769 ide_add_setting(drive, "acoustic", SETTING_RW, TYPE_BYTE, 0, 254, 1, 1, &drive->acoustic, set_acoustic);
770 ide_add_setting(drive, "failures", SETTING_RW, TYPE_INT, 0, 65535, 1, 1, &drive->failures, NULL);
771 ide_add_setting(drive, "max_failures", SETTING_RW, TYPE_INT, 0, 65535, 1, 1, &drive->max_failures, NULL);
774 static inline void idedisk_add_settings(ide_drive_t *drive) { ; }
777 static void idedisk_setup (ide_drive_t *drive)
779 ide_hwif_t *hwif = drive->hwif;
780 struct hd_driveid *id = drive->id;
781 unsigned long long capacity;
783 idedisk_add_settings(drive);
785 if (drive->id_read == 0)
788 if (drive->removable) {
790 * Removable disks (eg. SYQUEST); ignore 'WD' drives
792 if (id->model[0] != 'W' || id->model[1] != 'D') {
793 drive->doorlocking = 1;
797 (void)set_lba_addressing(drive, 1);
799 if (drive->addressing == 1) {
802 if (max_s > hwif->rqsize)
803 max_s = hwif->rqsize;
805 blk_queue_max_sectors(drive->queue, max_s);
808 printk(KERN_INFO "%s: max request size: %dKiB\n", drive->name, drive->queue->max_sectors / 2);
810 /* calculate drive capacity, and select LBA if possible */
811 init_idedisk_capacity (drive);
813 /* limit drive capacity to 137GB if LBA48 cannot be used */
814 if (drive->addressing == 0 && drive->capacity64 > 1ULL << 28) {
815 printk(KERN_WARNING "%s: cannot use LBA48 - full capacity "
816 "%llu sectors (%llu MB)\n",
817 drive->name, (unsigned long long)drive->capacity64,
818 sectors_to_MB(drive->capacity64));
819 drive->capacity64 = 1ULL << 28;
822 if ((hwif->host_flags & IDE_HFLAG_NO_LBA48_DMA) && drive->addressing) {
823 if (drive->capacity64 > 1ULL << 28) {
824 printk(KERN_INFO "%s: cannot use LBA48 DMA - PIO mode will"
825 " be used for accessing sectors > %u\n",
826 drive->name, 1 << 28);
828 drive->addressing = 0;
832 * if possible, give fdisk access to more of the drive,
833 * by correcting bios_cyls:
835 capacity = idedisk_capacity (drive);
836 if (!drive->forced_geom) {
838 if (idedisk_supports_lba48(drive->id)) {
840 drive->bios_sect = 63;
841 drive->bios_head = 255;
844 if (drive->bios_sect && drive->bios_head) {
845 unsigned int cap0 = capacity; /* truncate to 32 bits */
846 unsigned int cylsz, cyl;
848 if (cap0 != capacity)
849 drive->bios_cyl = 65535;
851 cylsz = drive->bios_sect * drive->bios_head;
855 if (cyl > drive->bios_cyl)
856 drive->bios_cyl = cyl;
860 printk(KERN_INFO "%s: %llu sectors (%llu MB)",
861 drive->name, capacity, sectors_to_MB(capacity));
863 /* Only print cache size when it was specified */
865 printk(KERN_CONT " w/%dKiB Cache", id->buf_size / 2);
867 printk(KERN_CONT ", CHS=%d/%d/%d\n",
868 drive->bios_cyl, drive->bios_head, drive->bios_sect);
870 /* write cache enabled? */
871 if ((id->csfo & 1) || (id->cfs_enable_1 & (1 << 5)))
874 write_cache(drive, 1);
877 static void ide_cacheflush_p(ide_drive_t *drive)
879 if (!drive->wcache || !ide_id_has_flush_cache(drive->id))
882 if (do_idedisk_flushcache(drive))
883 printk(KERN_INFO "%s: wcache flush failed!\n", drive->name);
886 static void ide_disk_remove(ide_drive_t *drive)
888 struct ide_disk_obj *idkp = drive->driver_data;
889 struct gendisk *g = idkp->disk;
891 ide_proc_unregister_driver(drive, idkp->driver);
895 ide_cacheflush_p(drive);
900 static void ide_disk_release(struct kref *kref)
902 struct ide_disk_obj *idkp = to_ide_disk(kref);
903 ide_drive_t *drive = idkp->drive;
904 struct gendisk *g = idkp->disk;
906 drive->driver_data = NULL;
907 g->private_data = NULL;
912 static int ide_disk_probe(ide_drive_t *drive);
915 * On HPA drives the capacity needs to be
916 * reinitilized on resume otherwise the disk
917 * can not be used and a hard reset is required
919 static void ide_disk_resume(ide_drive_t *drive)
921 if (idedisk_supports_hpa(drive->id))
922 init_idedisk_capacity(drive);
925 static void ide_device_shutdown(ide_drive_t *drive)
928 /* On Alpha, halt(8) doesn't actually turn the machine off,
929 it puts you into the sort of firmware monitor. Typically,
930 it's used to boot another kernel image, so it's not much
931 different from reboot(8). Therefore, we don't need to
932 spin down the disk in this case, especially since Alpha
933 firmware doesn't handle disks in standby mode properly.
934 On the other hand, it's reasonably safe to turn the power
935 off when the shutdown process reaches the firmware prompt,
936 as the firmware initialization takes rather long time -
937 at least 10 seconds, which should be sufficient for
938 the disk to expire its write cache. */
939 if (system_state != SYSTEM_POWER_OFF) {
941 if (system_state == SYSTEM_RESTART) {
943 ide_cacheflush_p(drive);
947 printk(KERN_INFO "Shutdown: %s\n", drive->name);
949 drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
952 static ide_driver_t idedisk_driver = {
954 .owner = THIS_MODULE,
956 .bus = &ide_bus_type,
958 .probe = ide_disk_probe,
959 .remove = ide_disk_remove,
960 .resume = ide_disk_resume,
961 .shutdown = ide_device_shutdown,
962 .version = IDEDISK_VERSION,
964 .supports_dsc_overlap = 0,
965 .do_request = ide_do_rw_disk,
966 .end_request = ide_end_request,
967 .error = __ide_error,
968 .abort = __ide_abort,
969 #ifdef CONFIG_IDE_PROC_FS
970 .proc = idedisk_proc,
974 static int idedisk_set_doorlock(ide_drive_t *drive, int on)
978 memset(&task, 0, sizeof(task));
979 task.tf.command = on ? WIN_DOORLOCK : WIN_DOORUNLOCK;
980 task.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
982 return ide_no_data_taskfile(drive, &task);
985 static int idedisk_open(struct inode *inode, struct file *filp)
987 struct gendisk *disk = inode->i_bdev->bd_disk;
988 struct ide_disk_obj *idkp;
991 if (!(idkp = ide_disk_get(disk)))
998 if (drive->removable && idkp->openers == 1) {
999 check_disk_change(inode->i_bdev);
1001 * Ignore the return code from door_lock,
1002 * since the open() has already succeeded,
1003 * and the door_lock is irrelevant at this point.
1005 if (drive->doorlocking && idedisk_set_doorlock(drive, 1))
1006 drive->doorlocking = 0;
1011 static int idedisk_release(struct inode *inode, struct file *filp)
1013 struct gendisk *disk = inode->i_bdev->bd_disk;
1014 struct ide_disk_obj *idkp = ide_disk_g(disk);
1015 ide_drive_t *drive = idkp->drive;
1017 if (idkp->openers == 1)
1018 ide_cacheflush_p(drive);
1020 if (drive->removable && idkp->openers == 1) {
1021 if (drive->doorlocking && idedisk_set_doorlock(drive, 0))
1022 drive->doorlocking = 0;
1032 static int idedisk_getgeo(struct block_device *bdev, struct hd_geometry *geo)
1034 struct ide_disk_obj *idkp = ide_disk_g(bdev->bd_disk);
1035 ide_drive_t *drive = idkp->drive;
1037 geo->heads = drive->bios_head;
1038 geo->sectors = drive->bios_sect;
1039 geo->cylinders = (u16)drive->bios_cyl; /* truncate */
1043 static int idedisk_ioctl(struct inode *inode, struct file *file,
1044 unsigned int cmd, unsigned long arg)
1046 unsigned long flags;
1047 struct block_device *bdev = inode->i_bdev;
1048 struct ide_disk_obj *idkp = ide_disk_g(bdev->bd_disk);
1049 ide_drive_t *drive = idkp->drive;
1050 int err, (*setfunc)(ide_drive_t *, int);
1054 case HDIO_GET_ADDRESS: val = &drive->addressing; goto read_val;
1055 case HDIO_GET_MULTCOUNT: val = &drive->mult_count; goto read_val;
1056 case HDIO_GET_NOWERR: val = &drive->nowerr; goto read_val;
1057 case HDIO_GET_WCACHE: val = &drive->wcache; goto read_val;
1058 case HDIO_GET_ACOUSTIC: val = &drive->acoustic; goto read_val;
1059 case HDIO_SET_ADDRESS: setfunc = set_lba_addressing; goto set_val;
1060 case HDIO_SET_MULTCOUNT: setfunc = set_multcount; goto set_val;
1061 case HDIO_SET_NOWERR: setfunc = set_nowerr; goto set_val;
1062 case HDIO_SET_WCACHE: setfunc = write_cache; goto set_val;
1063 case HDIO_SET_ACOUSTIC: setfunc = set_acoustic; goto set_val;
1066 return generic_ide_ioctl(drive, file, bdev, cmd, arg);
1069 mutex_lock(&ide_setting_mtx);
1070 spin_lock_irqsave(&ide_lock, flags);
1072 spin_unlock_irqrestore(&ide_lock, flags);
1073 mutex_unlock(&ide_setting_mtx);
1074 return err >= 0 ? put_user(err, (long __user *)arg) : err;
1077 if (bdev != bdev->bd_contains)
1080 if (!capable(CAP_SYS_ADMIN))
1083 mutex_lock(&ide_setting_mtx);
1084 err = setfunc(drive, arg);
1085 mutex_unlock(&ide_setting_mtx);
1091 static int idedisk_media_changed(struct gendisk *disk)
1093 struct ide_disk_obj *idkp = ide_disk_g(disk);
1094 ide_drive_t *drive = idkp->drive;
1096 /* do not scan partitions twice if this is a removable device */
1097 if (drive->attach) {
1101 /* if removable, always assume it was changed */
1102 return drive->removable;
1105 static int idedisk_revalidate_disk(struct gendisk *disk)
1107 struct ide_disk_obj *idkp = ide_disk_g(disk);
1108 set_capacity(disk, idedisk_capacity(idkp->drive));
1112 static struct block_device_operations idedisk_ops = {
1113 .owner = THIS_MODULE,
1114 .open = idedisk_open,
1115 .release = idedisk_release,
1116 .ioctl = idedisk_ioctl,
1117 .getgeo = idedisk_getgeo,
1118 .media_changed = idedisk_media_changed,
1119 .revalidate_disk= idedisk_revalidate_disk
1122 MODULE_DESCRIPTION("ATA DISK Driver");
1124 static int ide_disk_probe(ide_drive_t *drive)
1126 struct ide_disk_obj *idkp;
1129 /* strstr("foo", "") is non-NULL */
1130 if (!strstr("ide-disk", drive->driver_req))
1132 if (!drive->present)
1134 if (drive->media != ide_disk)
1137 idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
1141 g = alloc_disk_node(1 << PARTN_BITS,
1142 hwif_to_node(drive->hwif));
1146 ide_init_disk(g, drive);
1148 ide_proc_register_driver(drive, &idedisk_driver);
1150 kref_init(&idkp->kref);
1152 idkp->drive = drive;
1153 idkp->driver = &idedisk_driver;
1156 g->private_data = &idkp->driver;
1158 drive->driver_data = idkp;
1160 idedisk_setup(drive);
1161 if ((!drive->head || drive->head > 16) && !drive->select.b.lba) {
1162 printk(KERN_ERR "%s: INVALID GEOMETRY: %d PHYSICAL HEADS?\n",
1163 drive->name, drive->head);
1168 g->minors = 1 << PARTN_BITS;
1169 g->driverfs_dev = &drive->gendev;
1170 g->flags = drive->removable ? GENHD_FL_REMOVABLE : 0;
1171 set_capacity(g, idedisk_capacity(drive));
1172 g->fops = &idedisk_ops;
1182 static void __exit idedisk_exit (void)
1184 driver_unregister(&idedisk_driver.gen_driver);
1187 static int __init idedisk_init(void)
1189 return driver_register(&idedisk_driver.gen_driver);
1192 MODULE_ALIAS("ide:*m-disk*");
1193 module_init(idedisk_init);
1194 module_exit(idedisk_exit);
1195 MODULE_LICENSE("GPL");