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"
19 #include <linux/module.h>
20 #include <linux/types.h>
21 #include <linux/string.h>
22 #include <linux/kernel.h>
23 #include <linux/timer.h>
25 #include <linux/interrupt.h>
26 #include <linux/major.h>
27 #include <linux/errno.h>
28 #include <linux/genhd.h>
29 #include <linux/slab.h>
30 #include <linux/delay.h>
31 #include <linux/mutex.h>
32 #include <linux/leds.h>
36 #include <linux/ide.h>
38 #include <asm/byteorder.h>
40 #include <asm/uaccess.h>
42 #include <asm/div64.h>
44 #if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
45 #define IDE_DISK_MINORS (1 << PARTN_BITS)
47 #define IDE_DISK_MINORS 0
55 unsigned int openers
; /* protected by BKL for now */
58 static DEFINE_MUTEX(idedisk_ref_mutex
);
60 #define to_ide_disk(obj) container_of(obj, struct ide_disk_obj, kref)
62 #define ide_disk_g(disk) \
63 container_of((disk)->private_data, struct ide_disk_obj, driver)
65 static void ide_disk_release(struct kref
*);
67 static struct ide_disk_obj
*ide_disk_get(struct gendisk
*disk
)
69 struct ide_disk_obj
*idkp
= NULL
;
71 mutex_lock(&idedisk_ref_mutex
);
72 idkp
= ide_disk_g(disk
);
74 if (ide_device_get(idkp
->drive
))
77 kref_get(&idkp
->kref
);
79 mutex_unlock(&idedisk_ref_mutex
);
83 static void ide_disk_put(struct ide_disk_obj
*idkp
)
85 ide_drive_t
*drive
= idkp
->drive
;
87 mutex_lock(&idedisk_ref_mutex
);
88 kref_put(&idkp
->kref
, ide_disk_release
);
89 ide_device_put(drive
);
90 mutex_unlock(&idedisk_ref_mutex
);
94 * lba_capacity_is_ok() performs a sanity check on the claimed "lba_capacity"
95 * value for this drive (from its reported identification information).
97 * Returns: 1 if lba_capacity looks sensible
100 * It is called only once for each drive.
102 static int lba_capacity_is_ok(u16
*id
)
104 struct hd_driveid
*driveid
= (struct hd_driveid
*)id
;
105 unsigned long lba_sects
, chs_sects
, head
, tail
;
107 /* No non-LBA info .. so valid! */
108 if (id
[ATA_ID_CYLS
] == 0)
112 * The ATA spec tells large drives to return
113 * C/H/S = 16383/16/63 independent of their size.
114 * Some drives can be jumpered to use 15 heads instead of 16.
115 * Some drives can be jumpered to use 4092 cyls instead of 16383.
117 if ((id
[ATA_ID_CYLS
] == 16383 ||
118 (id
[ATA_ID_CYLS
] == 4092 && id
[ATA_ID_CUR_CYLS
] == 16383)) &&
119 id
[ATA_ID_SECTORS
] == 63 &&
120 (id
[ATA_ID_HEADS
] == 15 || id
[ATA_ID_HEADS
] == 16) &&
121 (driveid
->lba_capacity
>= 16383 * 63 * id
[ATA_ID_HEADS
]))
124 lba_sects
= driveid
->lba_capacity
;
125 chs_sects
= id
[ATA_ID_CYLS
] * id
[ATA_ID_HEADS
] * id
[ATA_ID_SECTORS
];
127 /* perform a rough sanity check on lba_sects: within 10% is OK */
128 if ((lba_sects
- chs_sects
) < chs_sects
/10)
131 /* some drives have the word order reversed */
132 head
= ((lba_sects
>> 16) & 0xffff);
133 tail
= (lba_sects
& 0xffff);
134 lba_sects
= (head
| (tail
<< 16));
135 if ((lba_sects
- chs_sects
) < chs_sects
/10) {
136 driveid
->lba_capacity
= lba_sects
;
137 return 1; /* lba_capacity is (now) good */
140 return 0; /* lba_capacity value may be bad */
143 static const u8 ide_rw_cmds
[] = {
158 static const u8 ide_data_phases
[] = {
167 static void ide_tf_set_cmd(ide_drive_t
*drive
, ide_task_t
*task
, u8 dma
)
169 u8 index
, lba48
, write
;
171 lba48
= (task
->tf_flags
& IDE_TFLAG_LBA48
) ? 2 : 0;
172 write
= (task
->tf_flags
& IDE_TFLAG_WRITE
) ? 1 : 0;
177 index
= drive
->mult_count
? 0 : 4;
179 task
->tf
.command
= ide_rw_cmds
[index
+ lba48
+ write
];
182 index
= 8; /* fixup index */
184 task
->data_phase
= ide_data_phases
[index
/ 2 + write
];
188 * __ide_do_rw_disk() issues READ and WRITE commands to a disk,
189 * using LBA if supported, or CHS otherwise, to address sectors.
191 static ide_startstop_t
__ide_do_rw_disk(ide_drive_t
*drive
, struct request
*rq
,
194 ide_hwif_t
*hwif
= HWIF(drive
);
195 unsigned int dma
= drive
->using_dma
;
196 u16 nsectors
= (u16
)rq
->nr_sectors
;
197 u8 lba48
= (drive
->addressing
== 1) ? 1 : 0;
199 struct ide_taskfile
*tf
= &task
.tf
;
202 if ((hwif
->host_flags
& IDE_HFLAG_NO_LBA48_DMA
) && lba48
&& dma
) {
203 if (block
+ rq
->nr_sectors
> 1ULL << 28)
210 ide_init_sg_cmd(drive
, rq
);
211 ide_map_sg(drive
, rq
);
214 memset(&task
, 0, sizeof(task
));
215 task
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
217 if (drive
->select
.b
.lba
) {
219 pr_debug("%s: LBA=0x%012llx\n", drive
->name
,
220 (unsigned long long)block
);
222 tf
->hob_nsect
= (nsectors
>> 8) & 0xff;
223 tf
->hob_lbal
= (u8
)(block
>> 24);
224 if (sizeof(block
) != 4) {
225 tf
->hob_lbam
= (u8
)((u64
)block
>> 32);
226 tf
->hob_lbah
= (u8
)((u64
)block
>> 40);
229 tf
->nsect
= nsectors
& 0xff;
230 tf
->lbal
= (u8
) block
;
231 tf
->lbam
= (u8
)(block
>> 8);
232 tf
->lbah
= (u8
)(block
>> 16);
234 task
.tf_flags
|= (IDE_TFLAG_LBA48
| IDE_TFLAG_HOB
);
236 tf
->nsect
= nsectors
& 0xff;
238 tf
->lbam
= block
>>= 8;
239 tf
->lbah
= block
>>= 8;
240 tf
->device
= (block
>> 8) & 0xf;
243 unsigned int sect
, head
, cyl
, track
;
245 track
= (int)block
/ drive
->sect
;
246 sect
= (int)block
% drive
->sect
+ 1;
247 head
= track
% drive
->head
;
248 cyl
= track
/ drive
->head
;
250 pr_debug("%s: CHS=%u/%u/%u\n", drive
->name
, cyl
, head
, sect
);
252 tf
->nsect
= nsectors
& 0xff;
260 task
.tf_flags
|= IDE_TFLAG_WRITE
;
262 ide_tf_set_cmd(drive
, &task
, dma
);
264 hwif
->data_phase
= task
.data_phase
;
267 rc
= do_rw_taskfile(drive
, &task
);
269 if (rc
== ide_stopped
&& dma
) {
270 /* fallback to PIO */
271 task
.tf_flags
|= IDE_TFLAG_DMA_PIO_FALLBACK
;
272 ide_tf_set_cmd(drive
, &task
, 0);
273 hwif
->data_phase
= task
.data_phase
;
274 ide_init_sg_cmd(drive
, rq
);
275 rc
= do_rw_taskfile(drive
, &task
);
282 * 268435455 == 137439 MB or 28bit limit
283 * 320173056 == 163929 MB or 48bit addressing
284 * 1073741822 == 549756 MB or 48bit addressing fake drive
287 static ide_startstop_t
ide_do_rw_disk(ide_drive_t
*drive
, struct request
*rq
,
290 ide_hwif_t
*hwif
= HWIF(drive
);
292 BUG_ON(drive
->blocked
);
294 if (!blk_fs_request(rq
)) {
295 blk_dump_rq_flags(rq
, "ide_do_rw_disk - bad command");
296 ide_end_request(drive
, 0, 0);
300 ledtrig_ide_activity();
302 pr_debug("%s: %sing: block=%llu, sectors=%lu, buffer=0x%08lx\n",
303 drive
->name
, rq_data_dir(rq
) == READ
? "read" : "writ",
304 (unsigned long long)block
, rq
->nr_sectors
,
305 (unsigned long)rq
->buffer
);
308 hwif
->rw_disk(drive
, rq
);
310 return __ide_do_rw_disk(drive
, rq
, block
);
314 * Queries for true maximum capacity of the drive.
315 * Returns maximum LBA address (> 0) of the drive, 0 if failed.
317 static u64
idedisk_read_native_max_address(ide_drive_t
*drive
, int lba48
)
320 struct ide_taskfile
*tf
= &args
.tf
;
323 /* Create IDE/ATA command request structure */
324 memset(&args
, 0, sizeof(ide_task_t
));
326 tf
->command
= WIN_READ_NATIVE_MAX_EXT
;
328 tf
->command
= WIN_READ_NATIVE_MAX
;
329 tf
->device
= ATA_LBA
;
330 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
332 args
.tf_flags
|= (IDE_TFLAG_LBA48
| IDE_TFLAG_HOB
);
333 /* submit command request */
334 ide_no_data_taskfile(drive
, &args
);
336 /* if OK, compute maximum address value */
337 if ((tf
->status
& 0x01) == 0)
338 addr
= ide_get_lba_addr(tf
, lba48
) + 1;
344 * Sets maximum virtual LBA address of the drive.
345 * Returns new maximum virtual LBA address (> 0) or 0 on failure.
347 static u64
idedisk_set_max_address(ide_drive_t
*drive
, u64 addr_req
, int lba48
)
350 struct ide_taskfile
*tf
= &args
.tf
;
354 /* Create IDE/ATA command request structure */
355 memset(&args
, 0, sizeof(ide_task_t
));
356 tf
->lbal
= (addr_req
>> 0) & 0xff;
357 tf
->lbam
= (addr_req
>>= 8) & 0xff;
358 tf
->lbah
= (addr_req
>>= 8) & 0xff;
360 tf
->hob_lbal
= (addr_req
>>= 8) & 0xff;
361 tf
->hob_lbam
= (addr_req
>>= 8) & 0xff;
362 tf
->hob_lbah
= (addr_req
>>= 8) & 0xff;
363 tf
->command
= WIN_SET_MAX_EXT
;
365 tf
->device
= (addr_req
>>= 8) & 0x0f;
366 tf
->command
= WIN_SET_MAX
;
368 tf
->device
|= ATA_LBA
;
369 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
371 args
.tf_flags
|= (IDE_TFLAG_LBA48
| IDE_TFLAG_HOB
);
372 /* submit command request */
373 ide_no_data_taskfile(drive
, &args
);
374 /* if OK, compute maximum address value */
375 if ((tf
->status
& 0x01) == 0)
376 addr_set
= ide_get_lba_addr(tf
, lba48
) + 1;
381 static unsigned long long sectors_to_MB(unsigned long long n
)
383 n
<<= 9; /* make it bytes */
384 do_div(n
, 1000000); /* make it MB */
389 * Bits 10 of command_set_1 and cfs_enable_1 must be equal,
390 * so on non-buggy drives we need test only one.
391 * However, we should also check whether these fields are valid.
393 static inline int idedisk_supports_hpa(const u16
*id
)
395 return (id
[ATA_ID_COMMAND_SET_1
] & 0x0400) &&
396 (id
[ATA_ID_CFS_ENABLE_1
] & 0x0400);
402 static inline int idedisk_supports_lba48(const u16
*id
)
404 return (id
[ATA_ID_COMMAND_SET_2
] & 0x0400) &&
405 (id
[ATA_ID_CFS_ENABLE_2
] & 0x0400) &&
406 ((struct hd_driveid
*)id
)->lba_capacity_2
;
410 * Some disks report total number of sectors instead of
411 * maximum sector address. We list them here.
413 static const struct drive_list_entry hpa_list
[] = {
414 { "ST340823A", NULL
},
415 { "ST320413A", NULL
},
416 { "ST310211A", NULL
},
420 static void idedisk_check_hpa(ide_drive_t
*drive
)
422 unsigned long long capacity
, set_max
;
423 int lba48
= idedisk_supports_lba48(drive
->id
);
425 capacity
= drive
->capacity64
;
427 set_max
= idedisk_read_native_max_address(drive
, lba48
);
429 if (ide_in_drive_list(drive
->id
, hpa_list
)) {
431 * Since we are inclusive wrt to firmware revisions do this
432 * extra check and apply the workaround only when needed.
434 if (set_max
== capacity
+ 1)
438 if (set_max
<= capacity
)
441 printk(KERN_INFO
"%s: Host Protected Area detected.\n"
442 "\tcurrent capacity is %llu sectors (%llu MB)\n"
443 "\tnative capacity is %llu sectors (%llu MB)\n",
445 capacity
, sectors_to_MB(capacity
),
446 set_max
, sectors_to_MB(set_max
));
448 set_max
= idedisk_set_max_address(drive
, set_max
, lba48
);
451 drive
->capacity64
= set_max
;
452 printk(KERN_INFO
"%s: Host Protected Area disabled.\n",
457 static void init_idedisk_capacity(ide_drive_t
*drive
)
459 struct hd_driveid
*driveid
= drive
->driveid
;
462 * If this drive supports the Host Protected Area feature set,
463 * then we may need to change our opinion about the drive's capacity.
465 int hpa
= idedisk_supports_hpa(id
);
467 if (idedisk_supports_lba48(id
)) {
468 /* drive speaks 48-bit LBA */
469 drive
->select
.b
.lba
= 1;
470 drive
->capacity64
= driveid
->lba_capacity_2
;
472 idedisk_check_hpa(drive
);
473 } else if ((driveid
->capability
& 2) && lba_capacity_is_ok(id
)) {
474 /* drive speaks 28-bit LBA */
475 drive
->select
.b
.lba
= 1;
476 drive
->capacity64
= driveid
->lba_capacity
;
478 idedisk_check_hpa(drive
);
480 /* drive speaks boring old 28-bit CHS */
481 drive
->capacity64
= drive
->cyl
* drive
->head
* drive
->sect
;
485 static sector_t
idedisk_capacity(ide_drive_t
*drive
)
487 return drive
->capacity64
- drive
->sect0
;
490 #ifdef CONFIG_IDE_PROC_FS
491 static int smart_enable(ide_drive_t
*drive
)
494 struct ide_taskfile
*tf
= &args
.tf
;
496 memset(&args
, 0, sizeof(ide_task_t
));
497 tf
->feature
= SMART_ENABLE
;
498 tf
->lbam
= SMART_LCYL_PASS
;
499 tf
->lbah
= SMART_HCYL_PASS
;
500 tf
->command
= WIN_SMART
;
501 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
502 return ide_no_data_taskfile(drive
, &args
);
505 static int get_smart_data(ide_drive_t
*drive
, u8
*buf
, u8 sub_cmd
)
508 struct ide_taskfile
*tf
= &args
.tf
;
510 memset(&args
, 0, sizeof(ide_task_t
));
511 tf
->feature
= sub_cmd
;
513 tf
->lbam
= SMART_LCYL_PASS
;
514 tf
->lbah
= SMART_HCYL_PASS
;
515 tf
->command
= WIN_SMART
;
516 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
517 args
.data_phase
= TASKFILE_IN
;
518 (void) smart_enable(drive
);
519 return ide_raw_taskfile(drive
, &args
, buf
, 1);
522 static int proc_idedisk_read_cache
523 (char *page
, char **start
, off_t off
, int count
, int *eof
, void *data
)
525 ide_drive_t
*drive
= (ide_drive_t
*) data
;
530 len
= sprintf(out
, "%i\n", drive
->id
[ATA_ID_BUF_SIZE
] / 2);
532 len
= sprintf(out
, "(none)\n");
534 PROC_IDE_READ_RETURN(page
, start
, off
, count
, eof
, len
);
537 static int proc_idedisk_read_capacity
538 (char *page
, char **start
, off_t off
, int count
, int *eof
, void *data
)
540 ide_drive_t
*drive
= (ide_drive_t
*)data
;
543 len
= sprintf(page
, "%llu\n", (long long)idedisk_capacity(drive
));
545 PROC_IDE_READ_RETURN(page
, start
, off
, count
, eof
, len
);
548 static int proc_idedisk_read_smart(char *page
, char **start
, off_t off
,
549 int count
, int *eof
, void *data
, u8 sub_cmd
)
551 ide_drive_t
*drive
= (ide_drive_t
*)data
;
554 if (get_smart_data(drive
, page
, sub_cmd
) == 0) {
555 unsigned short *val
= (unsigned short *) page
;
556 char *out
= ((char *)val
) + (SECTOR_WORDS
* 4);
559 out
+= sprintf(out
, "%04x%c", le16_to_cpu(*val
),
560 (++i
& 7) ? ' ' : '\n');
562 } while (i
< (SECTOR_WORDS
* 2));
566 PROC_IDE_READ_RETURN(page
, start
, off
, count
, eof
, len
);
569 static int proc_idedisk_read_sv
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
,
576 static int proc_idedisk_read_st
577 (char *page
, char **start
, off_t off
, int count
, int *eof
, void *data
)
579 return proc_idedisk_read_smart(page
, start
, off
, count
, eof
, data
,
580 SMART_READ_THRESHOLDS
);
583 static ide_proc_entry_t idedisk_proc
[] = {
584 { "cache", S_IFREG
|S_IRUGO
, proc_idedisk_read_cache
, NULL
},
585 { "capacity", S_IFREG
|S_IRUGO
, proc_idedisk_read_capacity
, NULL
},
586 { "geometry", S_IFREG
|S_IRUGO
, proc_ide_read_geometry
, NULL
},
587 { "smart_values", S_IFREG
|S_IRUSR
, proc_idedisk_read_sv
, NULL
},
588 { "smart_thresholds", S_IFREG
|S_IRUSR
, proc_idedisk_read_st
, NULL
},
589 { NULL
, 0, NULL
, NULL
}
591 #endif /* CONFIG_IDE_PROC_FS */
593 static void idedisk_prepare_flush(struct request_queue
*q
, struct request
*rq
)
595 ide_drive_t
*drive
= q
->queuedata
;
596 ide_task_t
*task
= kmalloc(sizeof(*task
), GFP_ATOMIC
);
598 /* FIXME: map struct ide_taskfile on rq->cmd[] */
599 BUG_ON(task
== NULL
);
601 memset(task
, 0, sizeof(*task
));
602 if (ide_id_has_flush_cache_ext(drive
->id
) &&
603 (drive
->capacity64
>= (1UL << 28)))
604 task
->tf
.command
= WIN_FLUSH_CACHE_EXT
;
606 task
->tf
.command
= WIN_FLUSH_CACHE
;
607 task
->tf_flags
= IDE_TFLAG_OUT_TF
| IDE_TFLAG_OUT_DEVICE
|
609 task
->data_phase
= TASKFILE_NO_DATA
;
611 rq
->cmd_type
= REQ_TYPE_ATA_TASKFILE
;
612 rq
->cmd_flags
|= REQ_SOFTBARRIER
;
617 * This is tightly woven into the driver->do_special can not touch.
618 * DON'T do it again until a total personality rewrite is committed.
620 static int set_multcount(ide_drive_t
*drive
, int arg
)
625 if (arg
< 0 || arg
> drive
->driveid
->max_multsect
)
628 if (drive
->special
.b
.set_multmode
)
631 rq
= blk_get_request(drive
->queue
, READ
, __GFP_WAIT
);
632 rq
->cmd_type
= REQ_TYPE_ATA_TASKFILE
;
634 drive
->mult_req
= arg
;
635 drive
->special
.b
.set_multmode
= 1;
636 error
= blk_execute_rq(drive
->queue
, NULL
, rq
, 0);
639 return (drive
->mult_count
== arg
) ? 0 : -EIO
;
642 static int set_nowerr(ide_drive_t
*drive
, int arg
)
644 if (arg
< 0 || arg
> 1)
647 if (ide_spin_wait_hwgroup(drive
))
650 drive
->bad_wstat
= arg
? BAD_R_STAT
: BAD_W_STAT
;
651 spin_unlock_irq(&ide_lock
);
655 static void update_ordered(ide_drive_t
*drive
)
658 unsigned ordered
= QUEUE_ORDERED_NONE
;
659 prepare_flush_fn
*prep_fn
= NULL
;
662 unsigned long long capacity
;
665 * We must avoid issuing commands a drive does not
666 * understand or we may crash it. We check flush cache
667 * is supported. We also check we have the LBA48 flush
668 * cache if the drive capacity is too large. By this
669 * time we have trimmed the drive capacity if LBA48 is
670 * not available so we don't need to recheck that.
672 capacity
= idedisk_capacity(drive
);
673 barrier
= ide_id_has_flush_cache(id
) && !drive
->noflush
&&
674 (drive
->addressing
== 0 || capacity
<= (1ULL << 28) ||
675 ide_id_has_flush_cache_ext(id
));
677 printk(KERN_INFO
"%s: cache flushes %ssupported\n",
678 drive
->name
, barrier
? "" : "not ");
681 ordered
= QUEUE_ORDERED_DRAIN_FLUSH
;
682 prep_fn
= idedisk_prepare_flush
;
685 ordered
= QUEUE_ORDERED_DRAIN
;
687 blk_queue_ordered(drive
->queue
, ordered
, prep_fn
);
690 static int write_cache(ide_drive_t
*drive
, int arg
)
695 if (arg
< 0 || arg
> 1)
698 if (ide_id_has_flush_cache(drive
->id
)) {
699 memset(&args
, 0, sizeof(ide_task_t
));
700 args
.tf
.feature
= arg
?
701 SETFEATURES_EN_WCACHE
: SETFEATURES_DIS_WCACHE
;
702 args
.tf
.command
= WIN_SETFEATURES
;
703 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
704 err
= ide_no_data_taskfile(drive
, &args
);
709 update_ordered(drive
);
714 static int do_idedisk_flushcache(ide_drive_t
*drive
)
718 memset(&args
, 0, sizeof(ide_task_t
));
719 if (ide_id_has_flush_cache_ext(drive
->id
))
720 args
.tf
.command
= WIN_FLUSH_CACHE_EXT
;
722 args
.tf
.command
= WIN_FLUSH_CACHE
;
723 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
724 return ide_no_data_taskfile(drive
, &args
);
727 static int set_acoustic(ide_drive_t
*drive
, int arg
)
731 if (arg
< 0 || arg
> 254)
734 memset(&args
, 0, sizeof(ide_task_t
));
735 args
.tf
.feature
= arg
? SETFEATURES_EN_AAM
: SETFEATURES_DIS_AAM
;
737 args
.tf
.command
= WIN_SETFEATURES
;
738 args
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
739 ide_no_data_taskfile(drive
, &args
);
740 drive
->acoustic
= arg
;
748 * 2: 48-bit capable doing 28-bit
750 static int set_lba_addressing(ide_drive_t
*drive
, int arg
)
752 if (arg
< 0 || arg
> 2)
755 drive
->addressing
= 0;
757 if (drive
->hwif
->host_flags
& IDE_HFLAG_NO_LBA48
)
760 if (!idedisk_supports_lba48(drive
->id
))
762 drive
->addressing
= arg
;
766 #ifdef CONFIG_IDE_PROC_FS
767 static void idedisk_add_settings(ide_drive_t
*drive
)
769 ide_add_setting(drive
, "bios_cyl", SETTING_RW
, TYPE_INT
, 0, 65535, 1, 1,
770 &drive
->bios_cyl
, NULL
);
771 ide_add_setting(drive
, "bios_head", SETTING_RW
, TYPE_BYTE
, 0, 255, 1, 1,
772 &drive
->bios_head
, NULL
);
773 ide_add_setting(drive
, "bios_sect", SETTING_RW
, TYPE_BYTE
, 0, 63, 1, 1,
774 &drive
->bios_sect
, NULL
);
775 ide_add_setting(drive
, "address", SETTING_RW
, TYPE_BYTE
, 0, 2, 1, 1,
776 &drive
->addressing
, set_lba_addressing
);
777 ide_add_setting(drive
, "multcount", SETTING_RW
, TYPE_BYTE
, 0,
778 drive
->driveid
->max_multsect
, 1, 1, &drive
->mult_count
,
780 ide_add_setting(drive
, "nowerr", SETTING_RW
, TYPE_BYTE
, 0, 1, 1, 1,
781 &drive
->nowerr
, set_nowerr
);
782 ide_add_setting(drive
, "lun", SETTING_RW
, TYPE_INT
, 0, 7, 1, 1,
784 ide_add_setting(drive
, "wcache", SETTING_RW
, TYPE_BYTE
, 0, 1, 1, 1,
785 &drive
->wcache
, write_cache
);
786 ide_add_setting(drive
, "acoustic", SETTING_RW
, TYPE_BYTE
, 0, 254, 1, 1,
787 &drive
->acoustic
, set_acoustic
);
788 ide_add_setting(drive
, "failures", SETTING_RW
, TYPE_INT
, 0, 65535, 1, 1,
789 &drive
->failures
, NULL
);
790 ide_add_setting(drive
, "max_failures", SETTING_RW
, TYPE_INT
, 0, 65535,
791 1, 1, &drive
->max_failures
, NULL
);
794 static inline void idedisk_add_settings(ide_drive_t
*drive
) { ; }
797 static void idedisk_setup(ide_drive_t
*drive
)
799 ide_hwif_t
*hwif
= drive
->hwif
;
801 char *m
= (char *)&id
[ATA_ID_PROD
];
802 unsigned long long capacity
;
804 idedisk_add_settings(drive
);
806 if (drive
->id_read
== 0)
809 if (drive
->removable
) {
811 * Removable disks (eg. SYQUEST); ignore 'WD' drives
813 if (m
[0] != 'W' || m
[1] != 'D')
814 drive
->doorlocking
= 1;
817 (void)set_lba_addressing(drive
, 1);
819 if (drive
->addressing
== 1) {
822 if (max_s
> hwif
->rqsize
)
823 max_s
= hwif
->rqsize
;
825 blk_queue_max_sectors(drive
->queue
, max_s
);
828 printk(KERN_INFO
"%s: max request size: %dKiB\n", drive
->name
,
829 drive
->queue
->max_sectors
/ 2);
831 /* calculate drive capacity, and select LBA if possible */
832 init_idedisk_capacity(drive
);
834 /* limit drive capacity to 137GB if LBA48 cannot be used */
835 if (drive
->addressing
== 0 && drive
->capacity64
> 1ULL << 28) {
836 printk(KERN_WARNING
"%s: cannot use LBA48 - full capacity "
837 "%llu sectors (%llu MB)\n",
838 drive
->name
, (unsigned long long)drive
->capacity64
,
839 sectors_to_MB(drive
->capacity64
));
840 drive
->capacity64
= 1ULL << 28;
843 if ((hwif
->host_flags
& IDE_HFLAG_NO_LBA48_DMA
) && drive
->addressing
) {
844 if (drive
->capacity64
> 1ULL << 28) {
845 printk(KERN_INFO
"%s: cannot use LBA48 DMA - PIO mode"
846 " will be used for accessing sectors "
847 "> %u\n", drive
->name
, 1 << 28);
849 drive
->addressing
= 0;
853 * if possible, give fdisk access to more of the drive,
854 * by correcting bios_cyls:
856 capacity
= idedisk_capacity(drive
);
858 if (!drive
->forced_geom
) {
860 if (idedisk_supports_lba48(drive
->id
)) {
862 drive
->bios_sect
= 63;
863 drive
->bios_head
= 255;
866 if (drive
->bios_sect
&& drive
->bios_head
) {
867 unsigned int cap0
= capacity
; /* truncate to 32 bits */
868 unsigned int cylsz
, cyl
;
870 if (cap0
!= capacity
)
871 drive
->bios_cyl
= 65535;
873 cylsz
= drive
->bios_sect
* drive
->bios_head
;
877 if (cyl
> drive
->bios_cyl
)
878 drive
->bios_cyl
= cyl
;
882 printk(KERN_INFO
"%s: %llu sectors (%llu MB)",
883 drive
->name
, capacity
, sectors_to_MB(capacity
));
885 /* Only print cache size when it was specified */
886 if (id
[ATA_ID_BUF_SIZE
])
887 printk(KERN_CONT
" w/%dKiB Cache", id
[ATA_ID_BUF_SIZE
] / 2);
889 printk(KERN_CONT
", CHS=%d/%d/%d\n",
890 drive
->bios_cyl
, drive
->bios_head
, drive
->bios_sect
);
892 /* write cache enabled? */
893 if ((id
[ATA_ID_CSFO
] & 1) || (id
[ATA_ID_CFS_ENABLE_1
] & (1 << 5)))
896 write_cache(drive
, 1);
899 static void ide_cacheflush_p(ide_drive_t
*drive
)
901 if (!drive
->wcache
|| !ide_id_has_flush_cache(drive
->id
))
904 if (do_idedisk_flushcache(drive
))
905 printk(KERN_INFO
"%s: wcache flush failed!\n", drive
->name
);
908 static void ide_disk_remove(ide_drive_t
*drive
)
910 struct ide_disk_obj
*idkp
= drive
->driver_data
;
911 struct gendisk
*g
= idkp
->disk
;
913 ide_proc_unregister_driver(drive
, idkp
->driver
);
917 ide_cacheflush_p(drive
);
922 static void ide_disk_release(struct kref
*kref
)
924 struct ide_disk_obj
*idkp
= to_ide_disk(kref
);
925 ide_drive_t
*drive
= idkp
->drive
;
926 struct gendisk
*g
= idkp
->disk
;
928 drive
->driver_data
= NULL
;
929 g
->private_data
= NULL
;
934 static int ide_disk_probe(ide_drive_t
*drive
);
937 * On HPA drives the capacity needs to be
938 * reinitilized on resume otherwise the disk
939 * can not be used and a hard reset is required
941 static void ide_disk_resume(ide_drive_t
*drive
)
943 if (idedisk_supports_hpa(drive
->id
))
944 init_idedisk_capacity(drive
);
947 static void ide_device_shutdown(ide_drive_t
*drive
)
950 /* On Alpha, halt(8) doesn't actually turn the machine off,
951 it puts you into the sort of firmware monitor. Typically,
952 it's used to boot another kernel image, so it's not much
953 different from reboot(8). Therefore, we don't need to
954 spin down the disk in this case, especially since Alpha
955 firmware doesn't handle disks in standby mode properly.
956 On the other hand, it's reasonably safe to turn the power
957 off when the shutdown process reaches the firmware prompt,
958 as the firmware initialization takes rather long time -
959 at least 10 seconds, which should be sufficient for
960 the disk to expire its write cache. */
961 if (system_state
!= SYSTEM_POWER_OFF
) {
963 if (system_state
== SYSTEM_RESTART
) {
965 ide_cacheflush_p(drive
);
969 printk(KERN_INFO
"Shutdown: %s\n", drive
->name
);
971 drive
->gendev
.bus
->suspend(&drive
->gendev
, PMSG_SUSPEND
);
974 static ide_driver_t idedisk_driver
= {
976 .owner
= THIS_MODULE
,
978 .bus
= &ide_bus_type
,
980 .probe
= ide_disk_probe
,
981 .remove
= ide_disk_remove
,
982 .resume
= ide_disk_resume
,
983 .shutdown
= ide_device_shutdown
,
984 .version
= IDEDISK_VERSION
,
986 .supports_dsc_overlap
= 0,
987 .do_request
= ide_do_rw_disk
,
988 .end_request
= ide_end_request
,
989 .error
= __ide_error
,
990 #ifdef CONFIG_IDE_PROC_FS
991 .proc
= idedisk_proc
,
995 static int idedisk_set_doorlock(ide_drive_t
*drive
, int on
)
999 memset(&task
, 0, sizeof(task
));
1000 task
.tf
.command
= on
? WIN_DOORLOCK
: WIN_DOORUNLOCK
;
1001 task
.tf_flags
= IDE_TFLAG_TF
| IDE_TFLAG_DEVICE
;
1003 return ide_no_data_taskfile(drive
, &task
);
1006 static int idedisk_open(struct inode
*inode
, struct file
*filp
)
1008 struct gendisk
*disk
= inode
->i_bdev
->bd_disk
;
1009 struct ide_disk_obj
*idkp
;
1012 idkp
= ide_disk_get(disk
);
1016 drive
= idkp
->drive
;
1020 if (drive
->removable
&& idkp
->openers
== 1) {
1021 check_disk_change(inode
->i_bdev
);
1023 * Ignore the return code from door_lock,
1024 * since the open() has already succeeded,
1025 * and the door_lock is irrelevant at this point.
1027 if (drive
->doorlocking
&& idedisk_set_doorlock(drive
, 1))
1028 drive
->doorlocking
= 0;
1033 static int idedisk_release(struct inode
*inode
, struct file
*filp
)
1035 struct gendisk
*disk
= inode
->i_bdev
->bd_disk
;
1036 struct ide_disk_obj
*idkp
= ide_disk_g(disk
);
1037 ide_drive_t
*drive
= idkp
->drive
;
1039 if (idkp
->openers
== 1)
1040 ide_cacheflush_p(drive
);
1042 if (drive
->removable
&& idkp
->openers
== 1) {
1043 if (drive
->doorlocking
&& idedisk_set_doorlock(drive
, 0))
1044 drive
->doorlocking
= 0;
1054 static int idedisk_getgeo(struct block_device
*bdev
, struct hd_geometry
*geo
)
1056 struct ide_disk_obj
*idkp
= ide_disk_g(bdev
->bd_disk
);
1057 ide_drive_t
*drive
= idkp
->drive
;
1059 geo
->heads
= drive
->bios_head
;
1060 geo
->sectors
= drive
->bios_sect
;
1061 geo
->cylinders
= (u16
)drive
->bios_cyl
; /* truncate */
1065 static int idedisk_ioctl(struct inode
*inode
, struct file
*file
,
1066 unsigned int cmd
, unsigned long arg
)
1068 unsigned long flags
;
1069 struct block_device
*bdev
= inode
->i_bdev
;
1070 struct ide_disk_obj
*idkp
= ide_disk_g(bdev
->bd_disk
);
1071 ide_drive_t
*drive
= idkp
->drive
;
1072 int err
, (*setfunc
)(ide_drive_t
*, int);
1076 case HDIO_GET_ADDRESS
: val
= &drive
->addressing
; goto read_val
;
1077 case HDIO_GET_MULTCOUNT
: val
= &drive
->mult_count
; goto read_val
;
1078 case HDIO_GET_NOWERR
: val
= &drive
->nowerr
; goto read_val
;
1079 case HDIO_GET_WCACHE
: val
= &drive
->wcache
; goto read_val
;
1080 case HDIO_GET_ACOUSTIC
: val
= &drive
->acoustic
; goto read_val
;
1081 case HDIO_SET_ADDRESS
: setfunc
= set_lba_addressing
; goto set_val
;
1082 case HDIO_SET_MULTCOUNT
: setfunc
= set_multcount
; goto set_val
;
1083 case HDIO_SET_NOWERR
: setfunc
= set_nowerr
; goto set_val
;
1084 case HDIO_SET_WCACHE
: setfunc
= write_cache
; goto set_val
;
1085 case HDIO_SET_ACOUSTIC
: setfunc
= set_acoustic
; goto set_val
;
1088 return generic_ide_ioctl(drive
, file
, bdev
, cmd
, arg
);
1091 mutex_lock(&ide_setting_mtx
);
1092 spin_lock_irqsave(&ide_lock
, flags
);
1094 spin_unlock_irqrestore(&ide_lock
, flags
);
1095 mutex_unlock(&ide_setting_mtx
);
1096 return err
>= 0 ? put_user(err
, (long __user
*)arg
) : err
;
1099 if (bdev
!= bdev
->bd_contains
)
1102 if (!capable(CAP_SYS_ADMIN
))
1105 mutex_lock(&ide_setting_mtx
);
1106 err
= setfunc(drive
, arg
);
1107 mutex_unlock(&ide_setting_mtx
);
1113 static int idedisk_media_changed(struct gendisk
*disk
)
1115 struct ide_disk_obj
*idkp
= ide_disk_g(disk
);
1116 ide_drive_t
*drive
= idkp
->drive
;
1118 /* do not scan partitions twice if this is a removable device */
1119 if (drive
->attach
) {
1123 /* if removable, always assume it was changed */
1124 return drive
->removable
;
1127 static int idedisk_revalidate_disk(struct gendisk
*disk
)
1129 struct ide_disk_obj
*idkp
= ide_disk_g(disk
);
1130 set_capacity(disk
, idedisk_capacity(idkp
->drive
));
1134 static struct block_device_operations idedisk_ops
= {
1135 .owner
= THIS_MODULE
,
1136 .open
= idedisk_open
,
1137 .release
= idedisk_release
,
1138 .ioctl
= idedisk_ioctl
,
1139 .getgeo
= idedisk_getgeo
,
1140 .media_changed
= idedisk_media_changed
,
1141 .revalidate_disk
= idedisk_revalidate_disk
1144 MODULE_DESCRIPTION("ATA DISK Driver");
1146 static int ide_disk_probe(ide_drive_t
*drive
)
1148 struct ide_disk_obj
*idkp
;
1151 /* strstr("foo", "") is non-NULL */
1152 if (!strstr("ide-disk", drive
->driver_req
))
1154 if (!drive
->present
)
1156 if (drive
->media
!= ide_disk
)
1159 idkp
= kzalloc(sizeof(*idkp
), GFP_KERNEL
);
1163 g
= alloc_disk_node(IDE_DISK_MINORS
, hwif_to_node(drive
->hwif
));
1167 ide_init_disk(g
, drive
);
1169 ide_proc_register_driver(drive
, &idedisk_driver
);
1171 kref_init(&idkp
->kref
);
1173 idkp
->drive
= drive
;
1174 idkp
->driver
= &idedisk_driver
;
1177 g
->private_data
= &idkp
->driver
;
1179 drive
->driver_data
= idkp
;
1181 idedisk_setup(drive
);
1182 if ((!drive
->head
|| drive
->head
> 16) && !drive
->select
.b
.lba
) {
1183 printk(KERN_ERR
"%s: INVALID GEOMETRY: %d PHYSICAL HEADS?\n",
1184 drive
->name
, drive
->head
);
1189 g
->minors
= IDE_DISK_MINORS
;
1190 g
->driverfs_dev
= &drive
->gendev
;
1191 g
->flags
|= GENHD_FL_EXT_DEVT
;
1192 if (drive
->removable
)
1193 g
->flags
|= GENHD_FL_REMOVABLE
;
1194 set_capacity(g
, idedisk_capacity(drive
));
1195 g
->fops
= &idedisk_ops
;
1205 static void __exit
idedisk_exit(void)
1207 driver_unregister(&idedisk_driver
.gen_driver
);
1210 static int __init
idedisk_init(void)
1212 return driver_register(&idedisk_driver
.gen_driver
);
1215 MODULE_ALIAS("ide:*m-disk*");
1216 module_init(idedisk_init
);
1217 module_exit(idedisk_exit
);
1218 MODULE_LICENSE("GPL");