?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
fix bloat-o-meter for ppc64
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / ide / ide-disk.c
blobb1781908e1f2caffd4598a35c3037e1a60e59a85
1 /*
2 * linux/drivers/ide/ide-disk.c Version 1.18 Mar 05, 2003
3 *
4 * Copyright (C) 1994-1998 Linus Torvalds & authors (see below)
5 * Copyright (C) 1998-2002 Linux ATA Development
6 * Andre Hedrick <andre@linux-ide.org>
7 * Copyright (C) 2003 Red Hat <alan@redhat.com>
8 */
9
10 /*
11 * Mostly written by Mark Lord <mlord@pobox.com>
12 * and Gadi Oxman <gadio@netvision.net.il>
13 * and Andre Hedrick <andre@linux-ide.org>
14 *
15 * This is the IDE/ATA disk driver, as evolved from hd.c and ide.c.
16 */
17
18 #define IDEDISK_VERSION "1.18"
19
20 //#define DEBUG
21
22 #include <linux/module.h>
23 #include <linux/types.h>
24 #include <linux/string.h>
25 #include <linux/kernel.h>
26 #include <linux/timer.h>
27 #include <linux/mm.h>
28 #include <linux/interrupt.h>
29 #include <linux/major.h>
30 #include <linux/errno.h>
31 #include <linux/genhd.h>
32 #include <linux/slab.h>
33 #include <linux/delay.h>
34 #include <linux/mutex.h>
35 #include <linux/leds.h>
36
37 #define _IDE_DISK
38
39 #include <linux/ide.h>
40
41 #include <asm/byteorder.h>
42 #include <asm/irq.h>
43 #include <asm/uaccess.h>
44 #include <asm/io.h>
45 #include <asm/div64.h>
46
47 struct ide_disk_obj {
48 ide_drive_t *drive;
49 ide_driver_t *driver;
50 struct gendisk *disk;
51 struct kref kref;
52 unsigned int openers; /* protected by BKL for now */
53 };
54
55 static DEFINE_MUTEX(idedisk_ref_mutex);
56
57 #define to_ide_disk(obj) container_of(obj, struct ide_disk_obj, kref)
58
59 #define ide_disk_g(disk) \
60 container_of((disk)->private_data, struct ide_disk_obj, driver)
61
62 static struct ide_disk_obj *ide_disk_get(struct gendisk *disk)
63 {
64 struct ide_disk_obj *idkp = NULL;
65
66 mutex_lock(&idedisk_ref_mutex);
67 idkp = ide_disk_g(disk);
68 if (idkp)
69 kref_get(&idkp->kref);
70 mutex_unlock(&idedisk_ref_mutex);
71 return idkp;
72 }
73
74 static void ide_disk_release(struct kref *);
75
76 static void ide_disk_put(struct ide_disk_obj *idkp)
77 {
78 mutex_lock(&idedisk_ref_mutex);
79 kref_put(&idkp->kref, ide_disk_release);
80 mutex_unlock(&idedisk_ref_mutex);
81 }
82
83 /*
84 * lba_capacity_is_ok() performs a sanity check on the claimed "lba_capacity"
85 * value for this drive (from its reported identification information).
86 *
87 * Returns: 1 if lba_capacity looks sensible
88 * 0 otherwise
89 *
90 * It is called only once for each drive.
91 */
92 static int lba_capacity_is_ok (struct hd_driveid *id)
93 {
94 unsigned long lba_sects, chs_sects, head, tail;
95
96 /* No non-LBA info .. so valid! */
97 if (id->cyls == 0)
98 return 1;
99
100 /*
101 * The ATA spec tells large drives to return
102 * C/H/S = 16383/16/63 independent of their size.
103 * Some drives can be jumpered to use 15 heads instead of 16.
104 * Some drives can be jumpered to use 4092 cyls instead of 16383.
105 */
106 if ((id->cyls == 16383
107 || (id->cyls == 4092 && id->cur_cyls == 16383)) &&
108 id->sectors == 63 &&
109 (id->heads == 15 || id->heads == 16) &&
110 (id->lba_capacity >= 16383*63*id->heads))
111 return 1;
112
113 lba_sects = id->lba_capacity;
114 chs_sects = id->cyls * id->heads * id->sectors;
115
116 /* perform a rough sanity check on lba_sects: within 10% is OK */
117 if ((lba_sects - chs_sects) < chs_sects/10)
118 return 1;
119
120 /* some drives have the word order reversed */
121 head = ((lba_sects >> 16) & 0xffff);
122 tail = (lba_sects & 0xffff);
123 lba_sects = (head | (tail << 16));
124 if ((lba_sects - chs_sects) < chs_sects/10) {
125 id->lba_capacity = lba_sects;
126 return 1; /* lba_capacity is (now) good */
127 }
128
129 return 0; /* lba_capacity value may be bad */
130 }
131
132 /*
133 * __ide_do_rw_disk() issues READ and WRITE commands to a disk,
134 * using LBA if supported, or CHS otherwise, to address sectors.
135 */
136 static ide_startstop_t __ide_do_rw_disk(ide_drive_t *drive, struct request *rq, sector_t block)
137 {
138 ide_hwif_t *hwif = HWIF(drive);
139 unsigned int dma = drive->using_dma;
140 u8 lba48 = (drive->addressing == 1) ? 1 : 0;
141 task_ioreg_t command = WIN_NOP;
142 ata_nsector_t nsectors;
143
144 nsectors.all = (u16) rq->nr_sectors;
145
146 if ((hwif->host_flags & IDE_HFLAG_NO_LBA48_DMA) && lba48 && dma) {
147 if (block + rq->nr_sectors > 1ULL << 28)
148 dma = 0;
149 else
150 lba48 = 0;
151 }
152
153 if (!dma) {
154 ide_init_sg_cmd(drive, rq);
155 ide_map_sg(drive, rq);
156 }
157
158 if (IDE_CONTROL_REG)
159 hwif->OUTB(drive->ctl, IDE_CONTROL_REG);
160
161 /* FIXME: SELECT_MASK(drive, 0) ? */
162
163 if (drive->select.b.lba) {
164 if (lba48) {
165 task_ioreg_t tasklets[10];
166
167 pr_debug("%s: LBA=0x%012llx\n", drive->name,
168 (unsigned long long)block);
169
170 tasklets[0] = 0;
171 tasklets[1] = 0;
172 tasklets[2] = nsectors.b.low;
173 tasklets[3] = nsectors.b.high;
174 tasklets[4] = (task_ioreg_t) block;
175 tasklets[5] = (task_ioreg_t) (block>>8);
176 tasklets[6] = (task_ioreg_t) (block>>16);
177 tasklets[7] = (task_ioreg_t) (block>>24);
178 if (sizeof(block) == 4) {
179 tasklets[8] = (task_ioreg_t) 0;
180 tasklets[9] = (task_ioreg_t) 0;
181 } else {
182 tasklets[8] = (task_ioreg_t)((u64)block >> 32);
183 tasklets[9] = (task_ioreg_t)((u64)block >> 40);
184 }
185 #ifdef DEBUG
186 printk("%s: 0x%02x%02x 0x%02x%02x%02x%02x%02x%02x\n",
187 drive->name, tasklets[3], tasklets[2],
188 tasklets[9], tasklets[8], tasklets[7],
189 tasklets[6], tasklets[5], tasklets[4]);
190 #endif
191 hwif->OUTB(tasklets[1], IDE_FEATURE_REG);
192 hwif->OUTB(tasklets[3], IDE_NSECTOR_REG);
193 hwif->OUTB(tasklets[7], IDE_SECTOR_REG);
194 hwif->OUTB(tasklets[8], IDE_LCYL_REG);
195 hwif->OUTB(tasklets[9], IDE_HCYL_REG);
196
197 hwif->OUTB(tasklets[0], IDE_FEATURE_REG);
198 hwif->OUTB(tasklets[2], IDE_NSECTOR_REG);
199 hwif->OUTB(tasklets[4], IDE_SECTOR_REG);
200 hwif->OUTB(tasklets[5], IDE_LCYL_REG);
201 hwif->OUTB(tasklets[6], IDE_HCYL_REG);
202 hwif->OUTB(0x00|drive->select.all,IDE_SELECT_REG);
203 } else {
204 hwif->OUTB(0x00, IDE_FEATURE_REG);
205 hwif->OUTB(nsectors.b.low, IDE_NSECTOR_REG);
206 hwif->OUTB(block, IDE_SECTOR_REG);
207 hwif->OUTB(block>>=8, IDE_LCYL_REG);
208 hwif->OUTB(block>>=8, IDE_HCYL_REG);
209 hwif->OUTB(((block>>8)&0x0f)|drive->select.all,IDE_SELECT_REG);
210 }
211 } else {
212 unsigned int sect,head,cyl,track;
213 track = (int)block / drive->sect;
214 sect = (int)block % drive->sect + 1;
215 hwif->OUTB(sect, IDE_SECTOR_REG);
216 head = track % drive->head;
217 cyl = track / drive->head;
218
219 pr_debug("%s: CHS=%u/%u/%u\n", drive->name, cyl, head, sect);
220
221 hwif->OUTB(0x00, IDE_FEATURE_REG);
222 hwif->OUTB(nsectors.b.low, IDE_NSECTOR_REG);
223 hwif->OUTB(cyl, IDE_LCYL_REG);
224 hwif->OUTB(cyl>>8, IDE_HCYL_REG);
225 hwif->OUTB(head|drive->select.all,IDE_SELECT_REG);
226 }
227
228 if (dma) {
229 if (!hwif->dma_setup(drive)) {
230 if (rq_data_dir(rq)) {
231 command = lba48 ? WIN_WRITEDMA_EXT : WIN_WRITEDMA;
232 if (drive->vdma)
233 command = lba48 ? WIN_WRITE_EXT: WIN_WRITE;
234 } else {
235 command = lba48 ? WIN_READDMA_EXT : WIN_READDMA;
236 if (drive->vdma)
237 command = lba48 ? WIN_READ_EXT: WIN_READ;
238 }
239 hwif->dma_exec_cmd(drive, command);
240 hwif->dma_start(drive);
241 return ide_started;
242 }
243 /* fallback to PIO */
244 ide_init_sg_cmd(drive, rq);
245 }
246
247 if (rq_data_dir(rq) == READ) {
248
249 if (drive->mult_count) {
250 hwif->data_phase = TASKFILE_MULTI_IN;
251 command = lba48 ? WIN_MULTREAD_EXT : WIN_MULTREAD;
252 } else {
253 hwif->data_phase = TASKFILE_IN;
254 command = lba48 ? WIN_READ_EXT : WIN_READ;
255 }
256
257 ide_execute_command(drive, command, &task_in_intr, WAIT_CMD, NULL);
258 return ide_started;
259 } else {
260 if (drive->mult_count) {
261 hwif->data_phase = TASKFILE_MULTI_OUT;
262 command = lba48 ? WIN_MULTWRITE_EXT : WIN_MULTWRITE;
263 } else {
264 hwif->data_phase = TASKFILE_OUT;
265 command = lba48 ? WIN_WRITE_EXT : WIN_WRITE;
266 }
267
268 /* FIXME: ->OUTBSYNC ? */
269 hwif->OUTB(command, IDE_COMMAND_REG);
270
271 return pre_task_out_intr(drive, rq);
272 }
273 }
274
275 /*
276 * 268435455 == 137439 MB or 28bit limit
277 * 320173056 == 163929 MB or 48bit addressing
278 * 1073741822 == 549756 MB or 48bit addressing fake drive
279 */
280
281 static ide_startstop_t ide_do_rw_disk (ide_drive_t *drive, struct request *rq, sector_t block)
282 {
283 ide_hwif_t *hwif = HWIF(drive);
284
285 BUG_ON(drive->blocked);
286
287 if (!blk_fs_request(rq)) {
288 blk_dump_rq_flags(rq, "ide_do_rw_disk - bad command");
289 ide_end_request(drive, 0, 0);
290 return ide_stopped;
291 }
292
293 ledtrig_ide_activity();
294
295 pr_debug("%s: %sing: block=%llu, sectors=%lu, buffer=0x%08lx\n",
296 drive->name, rq_data_dir(rq) == READ ? "read" : "writ",
297 (unsigned long long)block, rq->nr_sectors,
298 (unsigned long)rq->buffer);
299
300 if (hwif->rw_disk)
301 hwif->rw_disk(drive, rq);
302
303 return __ide_do_rw_disk(drive, rq, block);
304 }
305
306 /*
307 * Queries for true maximum capacity of the drive.
308 * Returns maximum LBA address (> 0) of the drive, 0 if failed.
309 */
310 static unsigned long idedisk_read_native_max_address(ide_drive_t *drive)
311 {
312 ide_task_t args;
313 unsigned long addr = 0;
314
315 /* Create IDE/ATA command request structure */
316 memset(&args, 0, sizeof(ide_task_t));
317 args.tfRegister[IDE_SELECT_OFFSET] = 0x40;
318 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_READ_NATIVE_MAX;
319 args.command_type = IDE_DRIVE_TASK_NO_DATA;
320 args.handler = &task_no_data_intr;
321 /* submit command request */
322 ide_raw_taskfile(drive, &args, NULL);
323
324 /* if OK, compute maximum address value */
325 if ((args.tfRegister[IDE_STATUS_OFFSET] & 0x01) == 0) {
326 addr = ((args.tfRegister[IDE_SELECT_OFFSET] & 0x0f) << 24)
327 | ((args.tfRegister[ IDE_HCYL_OFFSET] ) << 16)
328 | ((args.tfRegister[ IDE_LCYL_OFFSET] ) << 8)
329 | ((args.tfRegister[IDE_SECTOR_OFFSET] ));
330 addr++; /* since the return value is (maxlba - 1), we add 1 */
331 }
332 return addr;
333 }
334
335 static unsigned long long idedisk_read_native_max_address_ext(ide_drive_t *drive)
336 {
337 ide_task_t args;
338 unsigned long long addr = 0;
339
340 /* Create IDE/ATA command request structure */
341 memset(&args, 0, sizeof(ide_task_t));
342
343 args.tfRegister[IDE_SELECT_OFFSET] = 0x40;
344 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_READ_NATIVE_MAX_EXT;
345 args.command_type = IDE_DRIVE_TASK_NO_DATA;
346 args.handler = &task_no_data_intr;
347 /* submit command request */
348 ide_raw_taskfile(drive, &args, NULL);
349
350 /* if OK, compute maximum address value */
351 if ((args.tfRegister[IDE_STATUS_OFFSET] & 0x01) == 0) {
352 u32 high = (args.hobRegister[IDE_HCYL_OFFSET] << 16) |
353 (args.hobRegister[IDE_LCYL_OFFSET] << 8) |
354 args.hobRegister[IDE_SECTOR_OFFSET];
355 u32 low = ((args.tfRegister[IDE_HCYL_OFFSET])<<16) |
356 ((args.tfRegister[IDE_LCYL_OFFSET])<<8) |
357 (args.tfRegister[IDE_SECTOR_OFFSET]);
358 addr = ((__u64)high << 24) | low;
359 addr++; /* since the return value is (maxlba - 1), we add 1 */
360 }
361 return addr;
362 }
363
364 /*
365 * Sets maximum virtual LBA address of the drive.
366 * Returns new maximum virtual LBA address (> 0) or 0 on failure.
367 */
368 static unsigned long idedisk_set_max_address(ide_drive_t *drive, unsigned long addr_req)
369 {
370 ide_task_t args;
371 unsigned long addr_set = 0;
372
373 addr_req--;
374 /* Create IDE/ATA command request structure */
375 memset(&args, 0, sizeof(ide_task_t));
376 args.tfRegister[IDE_SECTOR_OFFSET] = ((addr_req >> 0) & 0xff);
377 args.tfRegister[IDE_LCYL_OFFSET] = ((addr_req >> 8) & 0xff);
378 args.tfRegister[IDE_HCYL_OFFSET] = ((addr_req >> 16) & 0xff);
379 args.tfRegister[IDE_SELECT_OFFSET] = ((addr_req >> 24) & 0x0f) | 0x40;
380 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_SET_MAX;
381 args.command_type = IDE_DRIVE_TASK_NO_DATA;
382 args.handler = &task_no_data_intr;
383 /* submit command request */
384 ide_raw_taskfile(drive, &args, NULL);
385 /* if OK, read new maximum address value */
386 if ((args.tfRegister[IDE_STATUS_OFFSET] & 0x01) == 0) {
387 addr_set = ((args.tfRegister[IDE_SELECT_OFFSET] & 0x0f) << 24)
388 | ((args.tfRegister[ IDE_HCYL_OFFSET] ) << 16)
389 | ((args.tfRegister[ IDE_LCYL_OFFSET] ) << 8)
390 | ((args.tfRegister[IDE_SECTOR_OFFSET] ));
391 addr_set++;
392 }
393 return addr_set;
394 }
395
396 static unsigned long long idedisk_set_max_address_ext(ide_drive_t *drive, unsigned long long addr_req)
397 {
398 ide_task_t args;
399 unsigned long long addr_set = 0;
400
401 addr_req--;
402 /* Create IDE/ATA command request structure */
403 memset(&args, 0, sizeof(ide_task_t));
404 args.tfRegister[IDE_SECTOR_OFFSET] = ((addr_req >> 0) & 0xff);
405 args.tfRegister[IDE_LCYL_OFFSET] = ((addr_req >>= 8) & 0xff);
406 args.tfRegister[IDE_HCYL_OFFSET] = ((addr_req >>= 8) & 0xff);
407 args.tfRegister[IDE_SELECT_OFFSET] = 0x40;
408 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_SET_MAX_EXT;
409 args.hobRegister[IDE_SECTOR_OFFSET] = (addr_req >>= 8) & 0xff;
410 args.hobRegister[IDE_LCYL_OFFSET] = (addr_req >>= 8) & 0xff;
411 args.hobRegister[IDE_HCYL_OFFSET] = (addr_req >>= 8) & 0xff;
412 args.hobRegister[IDE_SELECT_OFFSET] = 0x40;
413 args.hobRegister[IDE_CONTROL_OFFSET_HOB]= (drive->ctl|0x80);
414 args.command_type = IDE_DRIVE_TASK_NO_DATA;
415 args.handler = &task_no_data_intr;
416 /* submit command request */
417 ide_raw_taskfile(drive, &args, NULL);
418 /* if OK, compute maximum address value */
419 if ((args.tfRegister[IDE_STATUS_OFFSET] & 0x01) == 0) {
420 u32 high = (args.hobRegister[IDE_HCYL_OFFSET] << 16) |
421 (args.hobRegister[IDE_LCYL_OFFSET] << 8) |
422 args.hobRegister[IDE_SECTOR_OFFSET];
423 u32 low = ((args.tfRegister[IDE_HCYL_OFFSET])<<16) |
424 ((args.tfRegister[IDE_LCYL_OFFSET])<<8) |
425 (args.tfRegister[IDE_SECTOR_OFFSET]);
426 addr_set = ((__u64)high << 24) | low;
427 addr_set++;
428 }
429 return addr_set;
430 }
431
432 static unsigned long long sectors_to_MB(unsigned long long n)
433 {
434 n <<= 9; /* make it bytes */
435 do_div(n, 1000000); /* make it MB */
436 return n;
437 }
438
439 /*
440 * Bits 10 of command_set_1 and cfs_enable_1 must be equal,
441 * so on non-buggy drives we need test only one.
442 * However, we should also check whether these fields are valid.
443 */
444 static inline int idedisk_supports_hpa(const struct hd_driveid *id)
445 {
446 return (id->command_set_1 & 0x0400) && (id->cfs_enable_1 & 0x0400);
447 }
448
449 /*
450 * The same here.
451 */
452 static inline int idedisk_supports_lba48(const struct hd_driveid *id)
453 {
454 return (id->command_set_2 & 0x0400) && (id->cfs_enable_2 & 0x0400)
455 && id->lba_capacity_2;
456 }
457
458 /*
459 * Some disks report total number of sectors instead of
460 * maximum sector address. We list them here.
461 */
462 static const struct drive_list_entry hpa_list[] = {
463 { "ST340823A", NULL },
464 { "ST320413A", NULL },
465 { NULL, NULL }
466 };
467
468 static void idedisk_check_hpa(ide_drive_t *drive)
469 {
470 unsigned long long capacity, set_max;
471 int lba48 = idedisk_supports_lba48(drive->id);
472
473 capacity = drive->capacity64;
474 if (lba48)
475 set_max = idedisk_read_native_max_address_ext(drive);
476 else
477 set_max = idedisk_read_native_max_address(drive);
478
479 if (ide_in_drive_list(drive->id, hpa_list)) {
480 /*
481 * Since we are inclusive wrt to firmware revisions do this
482 * extra check and apply the workaround only when needed.
483 */
484 if (set_max == capacity + 1)
485 set_max--;
486 }
487
488 if (set_max <= capacity)
489 return;
490
491 printk(KERN_INFO "%s: Host Protected Area detected.\n"
492 "\tcurrent capacity is %llu sectors (%llu MB)\n"
493 "\tnative capacity is %llu sectors (%llu MB)\n",
494 drive->name,
495 capacity, sectors_to_MB(capacity),
496 set_max, sectors_to_MB(set_max));
497
498 if (lba48)
499 set_max = idedisk_set_max_address_ext(drive, set_max);
500 else
501 set_max = idedisk_set_max_address(drive, set_max);
502 if (set_max) {
503 drive->capacity64 = set_max;
504 printk(KERN_INFO "%s: Host Protected Area disabled.\n",
505 drive->name);
506 }
507 }
508
509 /*
510 * Compute drive->capacity, the full capacity of the drive
511 * Called with drive->id != NULL.
512 *
513 * To compute capacity, this uses either of
514 *
515 * 1. CHS value set by user (whatever user sets will be trusted)
516 * 2. LBA value from target drive (require new ATA feature)
517 * 3. LBA value from system BIOS (new one is OK, old one may break)
518 * 4. CHS value from system BIOS (traditional style)
519 *
520 * in above order (i.e., if value of higher priority is available,
521 * reset will be ignored).
522 */
523 static void init_idedisk_capacity (ide_drive_t *drive)
524 {
525 struct hd_driveid *id = drive->id;
526 /*
527 * If this drive supports the Host Protected Area feature set,
528 * then we may need to change our opinion about the drive's capacity.
529 */
530 int hpa = idedisk_supports_hpa(id);
531
532 if (idedisk_supports_lba48(id)) {
533 /* drive speaks 48-bit LBA */
534 drive->select.b.lba = 1;
535 drive->capacity64 = id->lba_capacity_2;
536 if (hpa)
537 idedisk_check_hpa(drive);
538 } else if ((id->capability & 2) && lba_capacity_is_ok(id)) {
539 /* drive speaks 28-bit LBA */
540 drive->select.b.lba = 1;
541 drive->capacity64 = id->lba_capacity;
542 if (hpa)
543 idedisk_check_hpa(drive);
544 } else {
545 /* drive speaks boring old 28-bit CHS */
546 drive->capacity64 = drive->cyl * drive->head * drive->sect;
547 }
548 }
549
550 static sector_t idedisk_capacity (ide_drive_t *drive)
551 {
552 return drive->capacity64 - drive->sect0;
553 }
554
555 #ifdef CONFIG_IDE_PROC_FS
556 static int smart_enable(ide_drive_t *drive)
557 {
558 ide_task_t args;
559
560 memset(&args, 0, sizeof(ide_task_t));
561 args.tfRegister[IDE_FEATURE_OFFSET] = SMART_ENABLE;
562 args.tfRegister[IDE_LCYL_OFFSET] = SMART_LCYL_PASS;
563 args.tfRegister[IDE_HCYL_OFFSET] = SMART_HCYL_PASS;
564 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_SMART;
565 args.command_type = IDE_DRIVE_TASK_NO_DATA;
566 args.handler = &task_no_data_intr;
567 return ide_raw_taskfile(drive, &args, NULL);
568 }
569
570 static int get_smart_data(ide_drive_t *drive, u8 *buf, u8 sub_cmd)
571 {
572 ide_task_t args;
573
574 memset(&args, 0, sizeof(ide_task_t));
575 args.tfRegister[IDE_FEATURE_OFFSET] = sub_cmd;
576 args.tfRegister[IDE_NSECTOR_OFFSET] = 0x01;
577 args.tfRegister[IDE_LCYL_OFFSET] = SMART_LCYL_PASS;
578 args.tfRegister[IDE_HCYL_OFFSET] = SMART_HCYL_PASS;
579 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_SMART;
580 args.command_type = IDE_DRIVE_TASK_IN;
581 args.data_phase = TASKFILE_IN;
582 args.handler = &task_in_intr;
583 (void) smart_enable(drive);
584 return ide_raw_taskfile(drive, &args, buf);
585 }
586
587 static int proc_idedisk_read_cache
588 (char *page, char **start, off_t off, int count, int *eof, void *data)
589 {
590 ide_drive_t *drive = (ide_drive_t *) data;
591 char *out = page;
592 int len;
593
594 if (drive->id_read)
595 len = sprintf(out,"%i\n", drive->id->buf_size / 2);
596 else
597 len = sprintf(out,"(none)\n");
598 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
599 }
600
601 static int proc_idedisk_read_capacity
602 (char *page, char **start, off_t off, int count, int *eof, void *data)
603 {
604 ide_drive_t*drive = (ide_drive_t *)data;
605 int len;
606
607 len = sprintf(page,"%llu\n", (long long)idedisk_capacity(drive));
608 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
609 }
610
611 static int proc_idedisk_read_smart_thresholds
612 (char *page, char **start, off_t off, int count, int *eof, void *data)
613 {
614 ide_drive_t *drive = (ide_drive_t *)data;
615 int len = 0, i = 0;
616
617 if (get_smart_data(drive, page, SMART_READ_THRESHOLDS) == 0) {
618 unsigned short *val = (unsigned short *) page;
619 char *out = ((char *)val) + (SECTOR_WORDS * 4);
620 page = out;
621 do {
622 out += sprintf(out, "%04x%c", le16_to_cpu(*val), (++i & 7) ? ' ' : '\n');
623 val += 1;
624 } while (i < (SECTOR_WORDS * 2));
625 len = out - page;
626 }
627 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
628 }
629
630 static int proc_idedisk_read_smart_values
631 (char *page, char **start, off_t off, int count, int *eof, void *data)
632 {
633 ide_drive_t *drive = (ide_drive_t *)data;
634 int len = 0, i = 0;
635
636 if (get_smart_data(drive, page, SMART_READ_VALUES) == 0) {
637 unsigned short *val = (unsigned short *) page;
638 char *out = ((char *)val) + (SECTOR_WORDS * 4);
639 page = out;
640 do {
641 out += sprintf(out, "%04x%c", le16_to_cpu(*val), (++i & 7) ? ' ' : '\n');
642 val += 1;
643 } while (i < (SECTOR_WORDS * 2));
644 len = out - page;
645 }
646 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
647 }
648
649 static ide_proc_entry_t idedisk_proc[] = {
650 { "cache", S_IFREG|S_IRUGO, proc_idedisk_read_cache, NULL },
651 { "capacity", S_IFREG|S_IRUGO, proc_idedisk_read_capacity, NULL },
652 { "geometry", S_IFREG|S_IRUGO, proc_ide_read_geometry, NULL },
653 { "smart_values", S_IFREG|S_IRUSR, proc_idedisk_read_smart_values, NULL },
654 { "smart_thresholds", S_IFREG|S_IRUSR, proc_idedisk_read_smart_thresholds, NULL },
655 { NULL, 0, NULL, NULL }
656 };
657 #endif /* CONFIG_IDE_PROC_FS */
658
659 static void idedisk_prepare_flush(struct request_queue *q, struct request *rq)
660 {
661 ide_drive_t *drive = q->queuedata;
662
663 memset(rq->cmd, 0, sizeof(rq->cmd));
664
665 if (ide_id_has_flush_cache_ext(drive->id) &&
666 (drive->capacity64 >= (1UL << 28)))
667 rq->cmd[0] = WIN_FLUSH_CACHE_EXT;
668 else
669 rq->cmd[0] = WIN_FLUSH_CACHE;
670
671
672 rq->cmd_type = REQ_TYPE_ATA_TASK;
673 rq->cmd_flags |= REQ_SOFTBARRIER;
674 rq->buffer = rq->cmd;
675 }
676
677 /*
678 * This is tightly woven into the driver->do_special can not touch.
679 * DON'T do it again until a total personality rewrite is committed.
680 */
681 static int set_multcount(ide_drive_t *drive, int arg)
682 {
683 struct request rq;
684
685 if (arg < 0 || arg > drive->id->max_multsect)
686 return -EINVAL;
687
688 if (drive->special.b.set_multmode)
689 return -EBUSY;
690 ide_init_drive_cmd (&rq);
691 rq.cmd_type = REQ_TYPE_ATA_CMD;
692 drive->mult_req = arg;
693 drive->special.b.set_multmode = 1;
694 (void) ide_do_drive_cmd (drive, &rq, ide_wait);
695 return (drive->mult_count == arg) ? 0 : -EIO;
696 }
697
698 static int set_nowerr(ide_drive_t *drive, int arg)
699 {
700 if (arg < 0 || arg > 1)
701 return -EINVAL;
702
703 if (ide_spin_wait_hwgroup(drive))
704 return -EBUSY;
705 drive->nowerr = arg;
706 drive->bad_wstat = arg ? BAD_R_STAT : BAD_W_STAT;
707 spin_unlock_irq(&ide_lock);
708 return 0;
709 }
710
711 static void update_ordered(ide_drive_t *drive)
712 {
713 struct hd_driveid *id = drive->id;
714 unsigned ordered = QUEUE_ORDERED_NONE;
715 prepare_flush_fn *prep_fn = NULL;
716
717 if (drive->wcache) {
718 unsigned long long capacity;
719 int barrier;
720 /*
721 * We must avoid issuing commands a drive does not
722 * understand or we may crash it. We check flush cache
723 * is supported. We also check we have the LBA48 flush
724 * cache if the drive capacity is too large. By this
725 * time we have trimmed the drive capacity if LBA48 is
726 * not available so we don't need to recheck that.
727 */
728 capacity = idedisk_capacity(drive);
729 barrier = ide_id_has_flush_cache(id) && !drive->noflush &&
730 (drive->addressing == 0 || capacity <= (1ULL << 28) ||
731 ide_id_has_flush_cache_ext(id));
732
733 printk(KERN_INFO "%s: cache flushes %ssupported\n",
734 drive->name, barrier ? "" : "not ");
735
736 if (barrier) {
737 ordered = QUEUE_ORDERED_DRAIN_FLUSH;
738 prep_fn = idedisk_prepare_flush;
739 }
740 } else
741 ordered = QUEUE_ORDERED_DRAIN;
742
743 blk_queue_ordered(drive->queue, ordered, prep_fn);
744 }
745
746 static int write_cache(ide_drive_t *drive, int arg)
747 {
748 ide_task_t args;
749 int err = 1;
750
751 if (arg < 0 || arg > 1)
752 return -EINVAL;
753
754 if (ide_id_has_flush_cache(drive->id)) {
755 memset(&args, 0, sizeof(ide_task_t));
756 args.tfRegister[IDE_FEATURE_OFFSET] = (arg) ?
757 SETFEATURES_EN_WCACHE : SETFEATURES_DIS_WCACHE;
758 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_SETFEATURES;
759 args.command_type = IDE_DRIVE_TASK_NO_DATA;
760 args.handler = &task_no_data_intr;
761 err = ide_raw_taskfile(drive, &args, NULL);
762 if (err == 0)
763 drive->wcache = arg;
764 }
765
766 update_ordered(drive);
767
768 return err;
769 }
770
771 static int do_idedisk_flushcache (ide_drive_t *drive)
772 {
773 ide_task_t args;
774
775 memset(&args, 0, sizeof(ide_task_t));
776 if (ide_id_has_flush_cache_ext(drive->id))
777 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_FLUSH_CACHE_EXT;
778 else
779 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_FLUSH_CACHE;
780 args.command_type = IDE_DRIVE_TASK_NO_DATA;
781 args.handler = &task_no_data_intr;
782 return ide_raw_taskfile(drive, &args, NULL);
783 }
784
785 static int set_acoustic (ide_drive_t *drive, int arg)
786 {
787 ide_task_t args;
788
789 if (arg < 0 || arg > 254)
790 return -EINVAL;
791
792 memset(&args, 0, sizeof(ide_task_t));
793 args.tfRegister[IDE_FEATURE_OFFSET] = (arg) ? SETFEATURES_EN_AAM :
794 SETFEATURES_DIS_AAM;
795 args.tfRegister[IDE_NSECTOR_OFFSET] = arg;
796 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_SETFEATURES;
797 args.command_type = IDE_DRIVE_TASK_NO_DATA;
798 args.handler = &task_no_data_intr;
799 ide_raw_taskfile(drive, &args, NULL);
800 drive->acoustic = arg;
801 return 0;
802 }
803
804 /*
805 * drive->addressing:
806 * 0: 28-bit
807 * 1: 48-bit
808 * 2: 48-bit capable doing 28-bit
809 */
810 static int set_lba_addressing(ide_drive_t *drive, int arg)
811 {
812 if (arg < 0 || arg > 2)
813 return -EINVAL;
814
815 drive->addressing = 0;
816
817 if (drive->hwif->host_flags & IDE_HFLAG_NO_LBA48)
818 return 0;
819
820 if (!idedisk_supports_lba48(drive->id))
821 return -EIO;
822 drive->addressing = arg;
823 return 0;
824 }
825
826 #ifdef CONFIG_IDE_PROC_FS
827 static void idedisk_add_settings(ide_drive_t *drive)
828 {
829 struct hd_driveid *id = drive->id;
830
831 ide_add_setting(drive, "bios_cyl", SETTING_RW, TYPE_INT, 0, 65535, 1, 1, &drive->bios_cyl, NULL);
832 ide_add_setting(drive, "bios_head", SETTING_RW, TYPE_BYTE, 0, 255, 1, 1, &drive->bios_head, NULL);
833 ide_add_setting(drive, "bios_sect", SETTING_RW, TYPE_BYTE, 0, 63, 1, 1, &drive->bios_sect, NULL);
834 ide_add_setting(drive, "address", SETTING_RW, TYPE_BYTE, 0, 2, 1, 1, &drive->addressing, set_lba_addressing);
835 ide_add_setting(drive, "bswap", SETTING_READ, TYPE_BYTE, 0, 1, 1, 1, &drive->bswap, NULL);
836 ide_add_setting(drive, "multcount", SETTING_RW, TYPE_BYTE, 0, id->max_multsect, 1, 1, &drive->mult_count, set_multcount);
837 ide_add_setting(drive, "nowerr", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->nowerr, set_nowerr);
838 ide_add_setting(drive, "lun", SETTING_RW, TYPE_INT, 0, 7, 1, 1, &drive->lun, NULL);
839 ide_add_setting(drive, "wcache", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->wcache, write_cache);
840 ide_add_setting(drive, "acoustic", SETTING_RW, TYPE_BYTE, 0, 254, 1, 1, &drive->acoustic, set_acoustic);
841 ide_add_setting(drive, "failures", SETTING_RW, TYPE_INT, 0, 65535, 1, 1, &drive->failures, NULL);
842 ide_add_setting(drive, "max_failures", SETTING_RW, TYPE_INT, 0, 65535, 1, 1, &drive->max_failures, NULL);
843 }
844 #else
845 static inline void idedisk_add_settings(ide_drive_t *drive) { ; }
846 #endif
847
848 static void idedisk_setup (ide_drive_t *drive)
849 {
850 ide_hwif_t *hwif = drive->hwif;
851 struct hd_driveid *id = drive->id;
852 unsigned long long capacity;
853
854 idedisk_add_settings(drive);
855
856 if (drive->id_read == 0)
857 return;
858
859 if (drive->removable) {
860 /*
861 * Removable disks (eg. SYQUEST); ignore 'WD' drives
862 */
863 if (id->model[0] != 'W' || id->model[1] != 'D') {
864 drive->doorlocking = 1;
865 }
866 }
867
868 (void)set_lba_addressing(drive, 1);
869
870 if (drive->addressing == 1) {
871 int max_s = 2048;
872
873 if (max_s > hwif->rqsize)
874 max_s = hwif->rqsize;
875
876 blk_queue_max_sectors(drive->queue, max_s);
877 }
878
879 printk(KERN_INFO "%s: max request size: %dKiB\n", drive->name, drive->queue->max_sectors / 2);
880
881 /* calculate drive capacity, and select LBA if possible */
882 init_idedisk_capacity (drive);
883
884 /* limit drive capacity to 137GB if LBA48 cannot be used */
885 if (drive->addressing == 0 && drive->capacity64 > 1ULL << 28) {
886 printk(KERN_WARNING "%s: cannot use LBA48 - full capacity "
887 "%llu sectors (%llu MB)\n",
888 drive->name, (unsigned long long)drive->capacity64,
889 sectors_to_MB(drive->capacity64));
890 drive->capacity64 = 1ULL << 28;
891 }
892
893 if ((hwif->host_flags & IDE_HFLAG_NO_LBA48_DMA) && drive->addressing) {
894 if (drive->capacity64 > 1ULL << 28) {
895 printk(KERN_INFO "%s: cannot use LBA48 DMA - PIO mode will"
896 " be used for accessing sectors > %u\n",
897 drive->name, 1 << 28);
898 } else
899 drive->addressing = 0;
900 }
901
902 /*
903 * if possible, give fdisk access to more of the drive,
904 * by correcting bios_cyls:
905 */
906 capacity = idedisk_capacity (drive);
907 if (!drive->forced_geom) {
908
909 if (idedisk_supports_lba48(drive->id)) {
910 /* compatibility */
911 drive->bios_sect = 63;
912 drive->bios_head = 255;
913 }
914
915 if (drive->bios_sect && drive->bios_head) {
916 unsigned int cap0 = capacity; /* truncate to 32 bits */
917 unsigned int cylsz, cyl;
918
919 if (cap0 != capacity)
920 drive->bios_cyl = 65535;
921 else {
922 cylsz = drive->bios_sect * drive->bios_head;
923 cyl = cap0 / cylsz;
924 if (cyl > 65535)
925 cyl = 65535;
926 if (cyl > drive->bios_cyl)
927 drive->bios_cyl = cyl;
928 }
929 }
930 }
931 printk(KERN_INFO "%s: %llu sectors (%llu MB)",
932 drive->name, capacity, sectors_to_MB(capacity));
933
934 /* Only print cache size when it was specified */
935 if (id->buf_size)
936 printk (" w/%dKiB Cache", id->buf_size/2);
937
938 printk(KERN_CONT ", CHS=%d/%d/%d\n",
939 drive->bios_cyl, drive->bios_head, drive->bios_sect);
940
941 /* write cache enabled? */
942 if ((id->csfo & 1) || (id->cfs_enable_1 & (1 << 5)))
943 drive->wcache = 1;
944
945 write_cache(drive, 1);
946 }
947
948 static void ide_cacheflush_p(ide_drive_t *drive)
949 {
950 if (!drive->wcache || !ide_id_has_flush_cache(drive->id))
951 return;
952
953 if (do_idedisk_flushcache(drive))
954 printk(KERN_INFO "%s: wcache flush failed!\n", drive->name);
955 }
956
957 static void ide_disk_remove(ide_drive_t *drive)
958 {
959 struct ide_disk_obj *idkp = drive->driver_data;
960 struct gendisk *g = idkp->disk;
961
962 ide_proc_unregister_driver(drive, idkp->driver);
963
964 del_gendisk(g);
965
966 ide_cacheflush_p(drive);
967
968 ide_disk_put(idkp);
969 }
970
971 static void ide_disk_release(struct kref *kref)
972 {
973 struct ide_disk_obj *idkp = to_ide_disk(kref);
974 ide_drive_t *drive = idkp->drive;
975 struct gendisk *g = idkp->disk;
976
977 drive->driver_data = NULL;
978 g->private_data = NULL;
979 put_disk(g);
980 kfree(idkp);
981 }
982
983 static int ide_disk_probe(ide_drive_t *drive);
984
985 /*
986 * On HPA drives the capacity needs to be
987 * reinitilized on resume otherwise the disk
988 * can not be used and a hard reset is required
989 */
990 static void ide_disk_resume(ide_drive_t *drive)
991 {
992 if (idedisk_supports_hpa(drive->id))
993 init_idedisk_capacity(drive);
994 }
995
996 static void ide_device_shutdown(ide_drive_t *drive)
997 {
998 #ifdef CONFIG_ALPHA
999 /* On Alpha, halt(8) doesn't actually turn the machine off,
1000 it puts you into the sort of firmware monitor. Typically,
1001 it's used to boot another kernel image, so it's not much
1002 different from reboot(8). Therefore, we don't need to
1003 spin down the disk in this case, especially since Alpha
1004 firmware doesn't handle disks in standby mode properly.
1005 On the other hand, it's reasonably safe to turn the power
1006 off when the shutdown process reaches the firmware prompt,
1007 as the firmware initialization takes rather long time -
1008 at least 10 seconds, which should be sufficient for
1009 the disk to expire its write cache. */
1010 if (system_state != SYSTEM_POWER_OFF) {
1011 #else
1012 if (system_state == SYSTEM_RESTART) {
1013 #endif
1014 ide_cacheflush_p(drive);
1015 return;
1016 }
1017
1018 printk("Shutdown: %s\n", drive->name);
1019 drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
1020 }
1021
1022 static ide_driver_t idedisk_driver = {
1023 .gen_driver = {
1024 .owner = THIS_MODULE,
1025 .name = "ide-disk",
1026 .bus = &ide_bus_type,
1027 },
1028 .probe = ide_disk_probe,
1029 .remove = ide_disk_remove,
1030 .resume = ide_disk_resume,
1031 .shutdown = ide_device_shutdown,
1032 .version = IDEDISK_VERSION,
1033 .media = ide_disk,
1034 .supports_dsc_overlap = 0,
1035 .do_request = ide_do_rw_disk,
1036 .end_request = ide_end_request,
1037 .error = __ide_error,
1038 .abort = __ide_abort,
1039 #ifdef CONFIG_IDE_PROC_FS
1040 .proc = idedisk_proc,
1041 #endif
1042 };
1043
1044 static int idedisk_open(struct inode *inode, struct file *filp)
1045 {
1046 struct gendisk *disk = inode->i_bdev->bd_disk;
1047 struct ide_disk_obj *idkp;
1048 ide_drive_t *drive;
1049
1050 if (!(idkp = ide_disk_get(disk)))
1051 return -ENXIO;
1052
1053 drive = idkp->drive;
1054
1055 idkp->openers++;
1056
1057 if (drive->removable && idkp->openers == 1) {
1058 ide_task_t args;
1059 memset(&args, 0, sizeof(ide_task_t));
1060 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_DOORLOCK;
1061 args.command_type = IDE_DRIVE_TASK_NO_DATA;
1062 args.handler = &task_no_data_intr;
1063 check_disk_change(inode->i_bdev);
1064 /*
1065 * Ignore the return code from door_lock,
1066 * since the open() has already succeeded,
1067 * and the door_lock is irrelevant at this point.
1068 */
1069 if (drive->doorlocking && ide_raw_taskfile(drive, &args, NULL))
1070 drive->doorlocking = 0;
1071 }
1072 return 0;
1073 }
1074
1075 static int idedisk_release(struct inode *inode, struct file *filp)
1076 {
1077 struct gendisk *disk = inode->i_bdev->bd_disk;
1078 struct ide_disk_obj *idkp = ide_disk_g(disk);
1079 ide_drive_t *drive = idkp->drive;
1080
1081 if (idkp->openers == 1)
1082 ide_cacheflush_p(drive);
1083
1084 if (drive->removable && idkp->openers == 1) {
1085 ide_task_t args;
1086 memset(&args, 0, sizeof(ide_task_t));
1087 args.tfRegister[IDE_COMMAND_OFFSET] = WIN_DOORUNLOCK;
1088 args.command_type = IDE_DRIVE_TASK_NO_DATA;
1089 args.handler = &task_no_data_intr;
1090 if (drive->doorlocking && ide_raw_taskfile(drive, &args, NULL))
1091 drive->doorlocking = 0;
1092 }
1093
1094 idkp->openers--;
1095
1096 ide_disk_put(idkp);
1097
1098 return 0;
1099 }
1100
1101 static int idedisk_getgeo(struct block_device *bdev, struct hd_geometry *geo)
1102 {
1103 struct ide_disk_obj *idkp = ide_disk_g(bdev->bd_disk);
1104 ide_drive_t *drive = idkp->drive;
1105
1106 geo->heads = drive->bios_head;
1107 geo->sectors = drive->bios_sect;
1108 geo->cylinders = (u16)drive->bios_cyl; /* truncate */
1109 return 0;
1110 }
1111
1112 static int idedisk_ioctl(struct inode *inode, struct file *file,
1113 unsigned int cmd, unsigned long arg)
1114 {
1115 unsigned long flags;
1116 struct block_device *bdev = inode->i_bdev;
1117 struct ide_disk_obj *idkp = ide_disk_g(bdev->bd_disk);
1118 ide_drive_t *drive = idkp->drive;
1119 int err, (*setfunc)(ide_drive_t *, int);
1120 u8 *val;
1121
1122 switch (cmd) {
1123 case HDIO_GET_ADDRESS: val = &drive->addressing; goto read_val;
1124 case HDIO_GET_MULTCOUNT: val = &drive->mult_count; goto read_val;
1125 case HDIO_GET_NOWERR: val = &drive->nowerr; goto read_val;
1126 case HDIO_GET_WCACHE: val = &drive->wcache; goto read_val;
1127 case HDIO_GET_ACOUSTIC: val = &drive->acoustic; goto read_val;
1128 case HDIO_SET_ADDRESS: setfunc = set_lba_addressing; goto set_val;
1129 case HDIO_SET_MULTCOUNT: setfunc = set_multcount; goto set_val;
1130 case HDIO_SET_NOWERR: setfunc = set_nowerr; goto set_val;
1131 case HDIO_SET_WCACHE: setfunc = write_cache; goto set_val;
1132 case HDIO_SET_ACOUSTIC: setfunc = set_acoustic; goto set_val;
1133 }
1134
1135 return generic_ide_ioctl(drive, file, bdev, cmd, arg);
1136
1137 read_val:
1138 mutex_lock(&ide_setting_mtx);
1139 spin_lock_irqsave(&ide_lock, flags);
1140 err = *val;
1141 spin_unlock_irqrestore(&ide_lock, flags);
1142 mutex_unlock(&ide_setting_mtx);
1143 return err >= 0 ? put_user(err, (long __user *)arg) : err;
1144
1145 set_val:
1146 if (bdev != bdev->bd_contains)
1147 err = -EINVAL;
1148 else {
1149 if (!capable(CAP_SYS_ADMIN))
1150 err = -EACCES;
1151 else {
1152 mutex_lock(&ide_setting_mtx);
1153 err = setfunc(drive, arg);
1154 mutex_unlock(&ide_setting_mtx);
1155 }
1156 }
1157 return err;
1158 }
1159
1160 static int idedisk_media_changed(struct gendisk *disk)
1161 {
1162 struct ide_disk_obj *idkp = ide_disk_g(disk);
1163 ide_drive_t *drive = idkp->drive;
1164
1165 /* do not scan partitions twice if this is a removable device */
1166 if (drive->attach) {
1167 drive->attach = 0;
1168 return 0;
1169 }
1170 /* if removable, always assume it was changed */
1171 return drive->removable;
1172 }
1173
1174 static int idedisk_revalidate_disk(struct gendisk *disk)
1175 {
1176 struct ide_disk_obj *idkp = ide_disk_g(disk);
1177 set_capacity(disk, idedisk_capacity(idkp->drive));
1178 return 0;
1179 }
1180
1181 static struct block_device_operations idedisk_ops = {
1182 .owner = THIS_MODULE,
1183 .open = idedisk_open,
1184 .release = idedisk_release,
1185 .ioctl = idedisk_ioctl,
1186 .getgeo = idedisk_getgeo,
1187 .media_changed = idedisk_media_changed,
1188 .revalidate_disk= idedisk_revalidate_disk
1189 };
1190
1191 MODULE_DESCRIPTION("ATA DISK Driver");
1192
1193 static int ide_disk_probe(ide_drive_t *drive)
1194 {
1195 struct ide_disk_obj *idkp;
1196 struct gendisk *g;
1197
1198 /* strstr("foo", "") is non-NULL */
1199 if (!strstr("ide-disk", drive->driver_req))
1200 goto failed;
1201 if (!drive->present)
1202 goto failed;
1203 if (drive->media != ide_disk)
1204 goto failed;
1205
1206 idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
1207 if (!idkp)
1208 goto failed;
1209
1210 g = alloc_disk_node(1 << PARTN_BITS,
1211 hwif_to_node(drive->hwif));
1212 if (!g)
1213 goto out_free_idkp;
1214
1215 ide_init_disk(g, drive);
1216
1217 ide_proc_register_driver(drive, &idedisk_driver);
1218
1219 kref_init(&idkp->kref);
1220
1221 idkp->drive = drive;
1222 idkp->driver = &idedisk_driver;
1223 idkp->disk = g;
1224
1225 g->private_data = &idkp->driver;
1226
1227 drive->driver_data = idkp;
1228
1229 idedisk_setup(drive);
1230 if ((!drive->head || drive->head > 16) && !drive->select.b.lba) {
1231 printk(KERN_ERR "%s: INVALID GEOMETRY: %d PHYSICAL HEADS?\n",
1232 drive->name, drive->head);
1233 drive->attach = 0;
1234 } else
1235 drive->attach = 1;
1236
1237 g->minors = 1 << PARTN_BITS;
1238 g->driverfs_dev = &drive->gendev;
1239 g->flags = drive->removable ? GENHD_FL_REMOVABLE : 0;
1240 set_capacity(g, idedisk_capacity(drive));
1241 g->fops = &idedisk_ops;
1242 add_disk(g);
1243 return 0;
1244
1245 out_free_idkp:
1246 kfree(idkp);
1247 failed:
1248 return -ENODEV;
1249 }
1250
1251 static void __exit idedisk_exit (void)
1252 {
1253 driver_unregister(&idedisk_driver.gen_driver);
1254 }
1255
1256 static int __init idedisk_init(void)
1257 {
1258 return driver_register(&idedisk_driver.gen_driver);
1259 }
1260
1261 MODULE_ALIAS("ide:*m-disk*");
1262 module_init(idedisk_init);
1263 module_exit(idedisk_exit);
1264 MODULE_LICENSE("GPL");
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree