1 /*
2  *  Copyright (C) 1994-1998   Linus Torvalds & authors (see below)
3  *  Copyright (C) 2005, 2007  Bartlomiej Zolnierkiewicz
4  */
5 
6 /*
7  *  Mostly written by Mark Lord <mlord@pobox.com>
8  *                and Gadi Oxman <gadio@netvision.net.il>
9  *                and Andre Hedrick <andre@linux-ide.org>
10  *
11  *  See linux/MAINTAINERS for address of current maintainer.
12  *
13  * This is the IDE probe module, as evolved from hd.c and ide.c.
14  *
15  * -- increase WAIT_PIDENTIFY to avoid CD-ROM locking at boot
16  *	 by Andrea Arcangeli
17  */
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>
24 #include <linux/mm.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/ide.h>
32 #include <linux/spinlock.h>
33 #include <linux/kmod.h>
34 #include <linux/pci.h>
35 #include <linux/scatterlist.h>
36 
37 #include <asm/byteorder.h>
38 #include <asm/irq.h>
39 #include <asm/uaccess.h>
40 #include <asm/io.h>
41 
42 /**
43  *	generic_id		-	add a generic drive id
44  *	@drive:	drive to make an ID block for
45  *
46  *	Add a fake id field to the drive we are passed. This allows
47  *	use to skip a ton of NULL checks (which people always miss)
48  *	and make drive properties unconditional outside of this file
49  */
50 
generic_id(ide_drive_t * drive)51 static void generic_id(ide_drive_t *drive)
52 {
53 	u16 *id = drive->id;
54 
55 	id[ATA_ID_CUR_CYLS]	= id[ATA_ID_CYLS]	= drive->cyl;
56 	id[ATA_ID_CUR_HEADS]	= id[ATA_ID_HEADS]	= drive->head;
57 	id[ATA_ID_CUR_SECTORS]	= id[ATA_ID_SECTORS]	= drive->sect;
58 }
59 
ide_disk_init_chs(ide_drive_t * drive)60 static void ide_disk_init_chs(ide_drive_t *drive)
61 {
62 	u16 *id = drive->id;
63 
64 	/* Extract geometry if we did not already have one for the drive */
65 	if (!drive->cyl || !drive->head || !drive->sect) {
66 		drive->cyl  = drive->bios_cyl  = id[ATA_ID_CYLS];
67 		drive->head = drive->bios_head = id[ATA_ID_HEADS];
68 		drive->sect = drive->bios_sect = id[ATA_ID_SECTORS];
69 	}
70 
71 	/* Handle logical geometry translation by the drive */
72 	if (ata_id_current_chs_valid(id)) {
73 		drive->cyl  = id[ATA_ID_CUR_CYLS];
74 		drive->head = id[ATA_ID_CUR_HEADS];
75 		drive->sect = id[ATA_ID_CUR_SECTORS];
76 	}
77 
78 	/* Use physical geometry if what we have still makes no sense */
79 	if (drive->head > 16 && id[ATA_ID_HEADS] && id[ATA_ID_HEADS] <= 16) {
80 		drive->cyl  = id[ATA_ID_CYLS];
81 		drive->head = id[ATA_ID_HEADS];
82 		drive->sect = id[ATA_ID_SECTORS];
83 	}
84 }
85 
ide_disk_init_mult_count(ide_drive_t * drive)86 static void ide_disk_init_mult_count(ide_drive_t *drive)
87 {
88 	u16 *id = drive->id;
89 	u8 max_multsect = id[ATA_ID_MAX_MULTSECT] & 0xff;
90 
91 	if (max_multsect) {
92 		if ((max_multsect / 2) > 1)
93 			id[ATA_ID_MULTSECT] = max_multsect | 0x100;
94 		else
95 			id[ATA_ID_MULTSECT] &= ~0x1ff;
96 
97 		drive->mult_req = id[ATA_ID_MULTSECT] & 0xff;
98 
99 		if (drive->mult_req)
100 			drive->special_flags |= IDE_SFLAG_SET_MULTMODE;
101 	}
102 }
103 
ide_classify_ata_dev(ide_drive_t * drive)104 static void ide_classify_ata_dev(ide_drive_t *drive)
105 {
106 	u16 *id = drive->id;
107 	char *m = (char *)&id[ATA_ID_PROD];
108 	int is_cfa = ata_id_is_cfa(id);
109 
110 	/* CF devices are *not* removable in Linux definition of the term */
111 	if (is_cfa == 0 && (id[ATA_ID_CONFIG] & (1 << 7)))
112 		drive->dev_flags |= IDE_DFLAG_REMOVABLE;
113 
114 	drive->media = ide_disk;
115 
116 	if (!ata_id_has_unload(drive->id))
117 		drive->dev_flags |= IDE_DFLAG_NO_UNLOAD;
118 
119 	printk(KERN_INFO "%s: %s, %s DISK drive\n", drive->name, m,
120 		is_cfa ? "CFA" : "ATA");
121 }
122 
ide_classify_atapi_dev(ide_drive_t * drive)123 static void ide_classify_atapi_dev(ide_drive_t *drive)
124 {
125 	u16 *id = drive->id;
126 	char *m = (char *)&id[ATA_ID_PROD];
127 	u8 type = (id[ATA_ID_CONFIG] >> 8) & 0x1f;
128 
129 	printk(KERN_INFO "%s: %s, ATAPI ", drive->name, m);
130 	switch (type) {
131 	case ide_floppy:
132 		if (!strstr(m, "CD-ROM")) {
133 			if (!strstr(m, "oppy") &&
134 			    !strstr(m, "poyp") &&
135 			    !strstr(m, "ZIP"))
136 				printk(KERN_CONT "cdrom or floppy?, assuming ");
137 			if (drive->media != ide_cdrom) {
138 				printk(KERN_CONT "FLOPPY");
139 				drive->dev_flags |= IDE_DFLAG_REMOVABLE;
140 				break;
141 			}
142 		}
143 		/* Early cdrom models used zero */
144 		type = ide_cdrom;
145 	case ide_cdrom:
146 		drive->dev_flags |= IDE_DFLAG_REMOVABLE;
147 #ifdef CONFIG_PPC
148 		/* kludge for Apple PowerBook internal zip */
149 		if (!strstr(m, "CD-ROM") && strstr(m, "ZIP")) {
150 			printk(KERN_CONT "FLOPPY");
151 			type = ide_floppy;
152 			break;
153 		}
154 #endif
155 		printk(KERN_CONT "CD/DVD-ROM");
156 		break;
157 	case ide_tape:
158 		printk(KERN_CONT "TAPE");
159 		break;
160 	case ide_optical:
161 		printk(KERN_CONT "OPTICAL");
162 		drive->dev_flags |= IDE_DFLAG_REMOVABLE;
163 		break;
164 	default:
165 		printk(KERN_CONT "UNKNOWN (type %d)", type);
166 		break;
167 	}
168 
169 	printk(KERN_CONT " drive\n");
170 	drive->media = type;
171 	/* an ATAPI device ignores DRDY */
172 	drive->ready_stat = 0;
173 	if (ata_id_cdb_intr(id))
174 		drive->atapi_flags |= IDE_AFLAG_DRQ_INTERRUPT;
175 	drive->dev_flags |= IDE_DFLAG_DOORLOCKING;
176 	/* we don't do head unloading on ATAPI devices */
177 	drive->dev_flags |= IDE_DFLAG_NO_UNLOAD;
178 }
179 
180 /**
181  *	do_identify	-	identify a drive
182  *	@drive: drive to identify
183  *	@cmd: command used
184  *	@id: buffer for IDENTIFY data
185  *
186  *	Called when we have issued a drive identify command to
187  *	read and parse the results. This function is run with
188  *	interrupts disabled.
189  */
190 
do_identify(ide_drive_t * drive,u8 cmd,u16 * id)191 static void do_identify(ide_drive_t *drive, u8 cmd, u16 *id)
192 {
193 	ide_hwif_t *hwif = drive->hwif;
194 	char *m = (char *)&id[ATA_ID_PROD];
195 	unsigned long flags;
196 	int bswap = 1;
197 
198 	/* local CPU only; some systems need this */
199 	local_irq_save(flags);
200 	/* read 512 bytes of id info */
201 	hwif->tp_ops->input_data(drive, NULL, id, SECTOR_SIZE);
202 	local_irq_restore(flags);
203 
204 	drive->dev_flags |= IDE_DFLAG_ID_READ;
205 #ifdef DEBUG
206 	printk(KERN_INFO "%s: dumping identify data\n", drive->name);
207 	ide_dump_identify((u8 *)id);
208 #endif
209 	ide_fix_driveid(id);
210 
211 	/*
212 	 *  ATA_CMD_ID_ATA returns little-endian info,
213 	 *  ATA_CMD_ID_ATAPI *usually* returns little-endian info.
214 	 */
215 	if (cmd == ATA_CMD_ID_ATAPI) {
216 		if ((m[0] == 'N' && m[1] == 'E') ||  /* NEC */
217 		    (m[0] == 'F' && m[1] == 'X') ||  /* Mitsumi */
218 		    (m[0] == 'P' && m[1] == 'i'))    /* Pioneer */
219 			/* Vertos drives may still be weird */
220 			bswap ^= 1;
221 	}
222 
223 	ide_fixstring(m, ATA_ID_PROD_LEN, bswap);
224 	ide_fixstring((char *)&id[ATA_ID_FW_REV], ATA_ID_FW_REV_LEN, bswap);
225 	ide_fixstring((char *)&id[ATA_ID_SERNO], ATA_ID_SERNO_LEN, bswap);
226 
227 	/* we depend on this a lot! */
228 	m[ATA_ID_PROD_LEN - 1] = '\0';
229 
230 	if (strstr(m, "E X A B Y T E N E S T"))
231 		drive->dev_flags &= ~IDE_DFLAG_PRESENT;
232 	else
233 		drive->dev_flags |= IDE_DFLAG_PRESENT;
234 }
235 
236 /**
237  *	ide_dev_read_id	-	send ATA/ATAPI IDENTIFY command
238  *	@drive: drive to identify
239  *	@cmd: command to use
240  *	@id: buffer for IDENTIFY data
241  *	@irq_ctx: flag set when called from the IRQ context
242  *
243  *	Sends an ATA(PI) IDENTIFY request to a drive and waits for a response.
244  *
245  *	Returns:	0  device was identified
246  *			1  device timed-out (no response to identify request)
247  *			2  device aborted the command (refused to identify itself)
248  */
249 
ide_dev_read_id(ide_drive_t * drive,u8 cmd,u16 * id,int irq_ctx)250 int ide_dev_read_id(ide_drive_t *drive, u8 cmd, u16 *id, int irq_ctx)
251 {
252 	ide_hwif_t *hwif = drive->hwif;
253 	struct ide_io_ports *io_ports = &hwif->io_ports;
254 	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
255 	int use_altstatus = 0, rc;
256 	unsigned long timeout;
257 	u8 s = 0, a = 0;
258 
259 	/*
260 	 * Disable device IRQ.  Otherwise we'll get spurious interrupts
261 	 * during the identify phase that the IRQ handler isn't expecting.
262 	 */
263 	if (io_ports->ctl_addr)
264 		tp_ops->write_devctl(hwif, ATA_NIEN | ATA_DEVCTL_OBS);
265 
266 	/* take a deep breath */
267 	if (irq_ctx)
268 		mdelay(50);
269 	else
270 		msleep(50);
271 
272 	if (io_ports->ctl_addr &&
273 	    (hwif->host_flags & IDE_HFLAG_BROKEN_ALTSTATUS) == 0) {
274 		a = tp_ops->read_altstatus(hwif);
275 		s = tp_ops->read_status(hwif);
276 		if ((a ^ s) & ~ATA_IDX)
277 			/* ancient Seagate drives, broken interfaces */
278 			printk(KERN_INFO "%s: probing with STATUS(0x%02x) "
279 					 "instead of ALTSTATUS(0x%02x)\n",
280 					 drive->name, s, a);
281 		else
282 			/* use non-intrusive polling */
283 			use_altstatus = 1;
284 	}
285 
286 	/* set features register for atapi
287 	 * identify command to be sure of reply
288 	 */
289 	if (cmd == ATA_CMD_ID_ATAPI) {
290 		struct ide_taskfile tf;
291 
292 		memset(&tf, 0, sizeof(tf));
293 		/* disable DMA & overlap */
294 		tp_ops->tf_load(drive, &tf, IDE_VALID_FEATURE);
295 	}
296 
297 	/* ask drive for ID */
298 	tp_ops->exec_command(hwif, cmd);
299 
300 	timeout = ((cmd == ATA_CMD_ID_ATA) ? WAIT_WORSTCASE : WAIT_PIDENTIFY) / 2;
301 
302 	/* wait for IRQ and ATA_DRQ */
303 	if (irq_ctx) {
304 		rc = __ide_wait_stat(drive, ATA_DRQ, BAD_R_STAT, timeout, &s);
305 		if (rc)
306 			return 1;
307 	} else {
308 		rc = ide_busy_sleep(drive, timeout, use_altstatus);
309 		if (rc)
310 			return 1;
311 
312 		msleep(50);
313 		s = tp_ops->read_status(hwif);
314 	}
315 
316 	if (OK_STAT(s, ATA_DRQ, BAD_R_STAT)) {
317 		/* drive returned ID */
318 		do_identify(drive, cmd, id);
319 		/* drive responded with ID */
320 		rc = 0;
321 		/* clear drive IRQ */
322 		(void)tp_ops->read_status(hwif);
323 	} else {
324 		/* drive refused ID */
325 		rc = 2;
326 	}
327 	return rc;
328 }
329 
ide_busy_sleep(ide_drive_t * drive,unsigned long timeout,int altstatus)330 int ide_busy_sleep(ide_drive_t *drive, unsigned long timeout, int altstatus)
331 {
332 	ide_hwif_t *hwif = drive->hwif;
333 	u8 stat;
334 
335 	timeout += jiffies;
336 
337 	do {
338 		msleep(50);	/* give drive a breather */
339 		stat = altstatus ? hwif->tp_ops->read_altstatus(hwif)
340 				 : hwif->tp_ops->read_status(hwif);
341 		if ((stat & ATA_BUSY) == 0)
342 			return 0;
343 	} while (time_before(jiffies, timeout));
344 
345 	printk(KERN_ERR "%s: timeout in %s\n", drive->name, __func__);
346 
347 	return 1;	/* drive timed-out */
348 }
349 
ide_read_device(ide_drive_t * drive)350 static u8 ide_read_device(ide_drive_t *drive)
351 {
352 	struct ide_taskfile tf;
353 
354 	drive->hwif->tp_ops->tf_read(drive, &tf, IDE_VALID_DEVICE);
355 
356 	return tf.device;
357 }
358 
359 /**
360  *	do_probe		-	probe an IDE device
361  *	@drive: drive to probe
362  *	@cmd: command to use
363  *
364  *	do_probe() has the difficult job of finding a drive if it exists,
365  *	without getting hung up if it doesn't exist, without trampling on
366  *	ethernet cards, and without leaving any IRQs dangling to haunt us later.
367  *
368  *	If a drive is "known" to exist (from CMOS or kernel parameters),
369  *	but does not respond right away, the probe will "hang in there"
370  *	for the maximum wait time (about 30 seconds), otherwise it will
371  *	exit much more quickly.
372  *
373  * Returns:	0  device was identified
374  *		1  device timed-out (no response to identify request)
375  *		2  device aborted the command (refused to identify itself)
376  *		3  bad status from device (possible for ATAPI drives)
377  *		4  probe was not attempted because failure was obvious
378  */
379 
do_probe(ide_drive_t * drive,u8 cmd)380 static int do_probe (ide_drive_t *drive, u8 cmd)
381 {
382 	ide_hwif_t *hwif = drive->hwif;
383 	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
384 	u16 *id = drive->id;
385 	int rc;
386 	u8 present = !!(drive->dev_flags & IDE_DFLAG_PRESENT), stat;
387 
388 	/* avoid waiting for inappropriate probes */
389 	if (present && drive->media != ide_disk && cmd == ATA_CMD_ID_ATA)
390 		return 4;
391 
392 #ifdef DEBUG
393 	printk(KERN_INFO "probing for %s: present=%d, media=%d, probetype=%s\n",
394 		drive->name, present, drive->media,
395 		(cmd == ATA_CMD_ID_ATA) ? "ATA" : "ATAPI");
396 #endif
397 
398 	/* needed for some systems
399 	 * (e.g. crw9624 as drive0 with disk as slave)
400 	 */
401 	msleep(50);
402 	tp_ops->dev_select(drive);
403 	msleep(50);
404 
405 	if (ide_read_device(drive) != drive->select && present == 0) {
406 		if (drive->dn & 1) {
407 			/* exit with drive0 selected */
408 			tp_ops->dev_select(hwif->devices[0]);
409 			/* allow ATA_BUSY to assert & clear */
410 			msleep(50);
411 		}
412 		/* no i/f present: mmm.. this should be a 4 -ml */
413 		return 3;
414 	}
415 
416 	stat = tp_ops->read_status(hwif);
417 
418 	if (OK_STAT(stat, ATA_DRDY, ATA_BUSY) ||
419 	    present || cmd == ATA_CMD_ID_ATAPI) {
420 		rc = ide_dev_read_id(drive, cmd, id, 0);
421 		if (rc)
422 			/* failed: try again */
423 			rc = ide_dev_read_id(drive, cmd, id, 0);
424 
425 		stat = tp_ops->read_status(hwif);
426 
427 		if (stat == (ATA_BUSY | ATA_DRDY))
428 			return 4;
429 
430 		if (rc == 1 && cmd == ATA_CMD_ID_ATAPI) {
431 			printk(KERN_ERR "%s: no response (status = 0x%02x), "
432 					"resetting drive\n", drive->name, stat);
433 			msleep(50);
434 			tp_ops->dev_select(drive);
435 			msleep(50);
436 			tp_ops->exec_command(hwif, ATA_CMD_DEV_RESET);
437 			(void)ide_busy_sleep(drive, WAIT_WORSTCASE, 0);
438 			rc = ide_dev_read_id(drive, cmd, id, 0);
439 		}
440 
441 		/* ensure drive IRQ is clear */
442 		stat = tp_ops->read_status(hwif);
443 
444 		if (rc == 1)
445 			printk(KERN_ERR "%s: no response (status = 0x%02x)\n",
446 					drive->name, stat);
447 	} else {
448 		/* not present or maybe ATAPI */
449 		rc = 3;
450 	}
451 	if (drive->dn & 1) {
452 		/* exit with drive0 selected */
453 		tp_ops->dev_select(hwif->devices[0]);
454 		msleep(50);
455 		/* ensure drive irq is clear */
456 		(void)tp_ops->read_status(hwif);
457 	}
458 	return rc;
459 }
460 
461 /**
462  *	probe_for_drives	-	upper level drive probe
463  *	@drive: drive to probe for
464  *
465  *	probe_for_drive() tests for existence of a given drive using do_probe()
466  *	and presents things to the user as needed.
467  *
468  *	Returns:	0  no device was found
469  *			1  device was found
470  *			   (note: IDE_DFLAG_PRESENT might still be not set)
471  */
472 
probe_for_drive(ide_drive_t * drive)473 static u8 probe_for_drive(ide_drive_t *drive)
474 {
475 	char *m;
476 	int rc;
477 	u8 cmd;
478 
479 	drive->dev_flags &= ~IDE_DFLAG_ID_READ;
480 
481 	m = (char *)&drive->id[ATA_ID_PROD];
482 	strcpy(m, "UNKNOWN");
483 
484 	/* skip probing? */
485 	if ((drive->dev_flags & IDE_DFLAG_NOPROBE) == 0) {
486 		/* if !(success||timed-out) */
487 		cmd = ATA_CMD_ID_ATA;
488 		rc = do_probe(drive, cmd);
489 		if (rc >= 2) {
490 			/* look for ATAPI device */
491 			cmd = ATA_CMD_ID_ATAPI;
492 			rc = do_probe(drive, cmd);
493 		}
494 
495 		if ((drive->dev_flags & IDE_DFLAG_PRESENT) == 0)
496 			return 0;
497 
498 		/* identification failed? */
499 		if ((drive->dev_flags & IDE_DFLAG_ID_READ) == 0) {
500 			if (drive->media == ide_disk) {
501 				printk(KERN_INFO "%s: non-IDE drive, CHS=%d/%d/%d\n",
502 					drive->name, drive->cyl,
503 					drive->head, drive->sect);
504 			} else if (drive->media == ide_cdrom) {
505 				printk(KERN_INFO "%s: ATAPI cdrom (?)\n", drive->name);
506 			} else {
507 				/* nuke it */
508 				printk(KERN_WARNING "%s: Unknown device on bus refused identification. Ignoring.\n", drive->name);
509 				drive->dev_flags &= ~IDE_DFLAG_PRESENT;
510 			}
511 		} else {
512 			if (cmd == ATA_CMD_ID_ATAPI)
513 				ide_classify_atapi_dev(drive);
514 			else
515 				ide_classify_ata_dev(drive);
516 		}
517 	}
518 
519 	if ((drive->dev_flags & IDE_DFLAG_PRESENT) == 0)
520 		return 0;
521 
522 	/* The drive wasn't being helpful. Add generic info only */
523 	if ((drive->dev_flags & IDE_DFLAG_ID_READ) == 0) {
524 		generic_id(drive);
525 		return 1;
526 	}
527 
528 	if (drive->media == ide_disk) {
529 		ide_disk_init_chs(drive);
530 		ide_disk_init_mult_count(drive);
531 	}
532 
533 	return 1;
534 }
535 
hwif_release_dev(struct device * dev)536 static void hwif_release_dev(struct device *dev)
537 {
538 	ide_hwif_t *hwif = container_of(dev, ide_hwif_t, gendev);
539 
540 	complete(&hwif->gendev_rel_comp);
541 }
542 
ide_register_port(ide_hwif_t * hwif)543 static int ide_register_port(ide_hwif_t *hwif)
544 {
545 	int ret;
546 
547 	/* register with global device tree */
548 	dev_set_name(&hwif->gendev, hwif->name);
549 	dev_set_drvdata(&hwif->gendev, hwif);
550 	if (hwif->gendev.parent == NULL)
551 		hwif->gendev.parent = hwif->dev;
552 	hwif->gendev.release = hwif_release_dev;
553 
554 	ret = device_register(&hwif->gendev);
555 	if (ret < 0) {
556 		printk(KERN_WARNING "IDE: %s: device_register error: %d\n",
557 			__func__, ret);
558 		goto out;
559 	}
560 
561 	hwif->portdev = device_create(ide_port_class, &hwif->gendev,
562 				      MKDEV(0, 0), hwif, hwif->name);
563 	if (IS_ERR(hwif->portdev)) {
564 		ret = PTR_ERR(hwif->portdev);
565 		device_unregister(&hwif->gendev);
566 	}
567 out:
568 	return ret;
569 }
570 
571 /**
572  *	ide_port_wait_ready	-	wait for port to become ready
573  *	@hwif: IDE port
574  *
575  *	This is needed on some PPCs and a bunch of BIOS-less embedded
576  *	platforms.  Typical cases are:
577  *
578  *	- The firmware hard reset the disk before booting the kernel,
579  *	  the drive is still doing it's poweron-reset sequence, that
580  *	  can take up to 30 seconds.
581  *
582  *	- The firmware does nothing (or no firmware), the device is
583  *	  still in POST state (same as above actually).
584  *
585  *	- Some CD/DVD/Writer combo drives tend to drive the bus during
586  *	  their reset sequence even when they are non-selected slave
587  *	  devices, thus preventing discovery of the main HD.
588  *
589  *	Doing this wait-for-non-busy should not harm any existing
590  *	configuration and fix some issues like the above.
591  *
592  *	BenH.
593  *
594  *	Returns 0 on success, error code (< 0) otherwise.
595  */
596 
ide_port_wait_ready(ide_hwif_t * hwif)597 static int ide_port_wait_ready(ide_hwif_t *hwif)
598 {
599 	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
600 	ide_drive_t *drive;
601 	int i, rc;
602 
603 	printk(KERN_DEBUG "Probing IDE interface %s...\n", hwif->name);
604 
605 	/* Let HW settle down a bit from whatever init state we
606 	 * come from */
607 	mdelay(2);
608 
609 	/* Wait for BSY bit to go away, spec timeout is 30 seconds,
610 	 * I know of at least one disk who takes 31 seconds, I use 35
611 	 * here to be safe
612 	 */
613 	rc = ide_wait_not_busy(hwif, 35000);
614 	if (rc)
615 		return rc;
616 
617 	/* Now make sure both master & slave are ready */
618 	ide_port_for_each_dev(i, drive, hwif) {
619 		/* Ignore disks that we will not probe for later. */
620 		if ((drive->dev_flags & IDE_DFLAG_NOPROBE) == 0 ||
621 		    (drive->dev_flags & IDE_DFLAG_PRESENT)) {
622 			tp_ops->dev_select(drive);
623 			tp_ops->write_devctl(hwif, ATA_DEVCTL_OBS);
624 			mdelay(2);
625 			rc = ide_wait_not_busy(hwif, 35000);
626 			if (rc)
627 				goto out;
628 		} else
629 			printk(KERN_DEBUG "%s: ide_wait_not_busy() skipped\n",
630 					  drive->name);
631 	}
632 out:
633 	/* Exit function with master reselected (let's be sane) */
634 	if (i)
635 		tp_ops->dev_select(hwif->devices[0]);
636 
637 	return rc;
638 }
639 
640 /**
641  *	ide_undecoded_slave	-	look for bad CF adapters
642  *	@dev1: slave device
643  *
644  *	Analyse the drives on the interface and attempt to decide if we
645  *	have the same drive viewed twice. This occurs with crap CF adapters
646  *	and PCMCIA sometimes.
647  */
648 
ide_undecoded_slave(ide_drive_t * dev1)649 void ide_undecoded_slave(ide_drive_t *dev1)
650 {
651 	ide_drive_t *dev0 = dev1->hwif->devices[0];
652 
653 	if ((dev1->dn & 1) == 0 || (dev0->dev_flags & IDE_DFLAG_PRESENT) == 0)
654 		return;
655 
656 	/* If the models don't match they are not the same product */
657 	if (strcmp((char *)&dev0->id[ATA_ID_PROD],
658 		   (char *)&dev1->id[ATA_ID_PROD]))
659 		return;
660 
661 	/* Serial numbers do not match */
662 	if (strncmp((char *)&dev0->id[ATA_ID_SERNO],
663 		    (char *)&dev1->id[ATA_ID_SERNO], ATA_ID_SERNO_LEN))
664 		return;
665 
666 	/* No serial number, thankfully very rare for CF */
667 	if (*(char *)&dev0->id[ATA_ID_SERNO] == 0)
668 		return;
669 
670 	/* Appears to be an IDE flash adapter with decode bugs */
671 	printk(KERN_WARNING "ide-probe: ignoring undecoded slave\n");
672 
673 	dev1->dev_flags &= ~IDE_DFLAG_PRESENT;
674 }
675 
676 EXPORT_SYMBOL_GPL(ide_undecoded_slave);
677 
ide_probe_port(ide_hwif_t * hwif)678 static int ide_probe_port(ide_hwif_t *hwif)
679 {
680 	ide_drive_t *drive;
681 	unsigned int irqd;
682 	int i, rc = -ENODEV;
683 
684 	BUG_ON(hwif->present);
685 
686 	if ((hwif->devices[0]->dev_flags & IDE_DFLAG_NOPROBE) &&
687 	    (hwif->devices[1]->dev_flags & IDE_DFLAG_NOPROBE))
688 		return -EACCES;
689 
690 	/*
691 	 * We must always disable IRQ, as probe_for_drive will assert IRQ, but
692 	 * we'll install our IRQ driver much later...
693 	 */
694 	irqd = hwif->irq;
695 	if (irqd)
696 		disable_irq(hwif->irq);
697 
698 	if (ide_port_wait_ready(hwif) == -EBUSY)
699 		printk(KERN_DEBUG "%s: Wait for ready failed before probe !\n", hwif->name);
700 
701 	/*
702 	 * Second drive should only exist if first drive was found,
703 	 * but a lot of cdrom drives are configured as single slaves.
704 	 */
705 	ide_port_for_each_dev(i, drive, hwif) {
706 		(void) probe_for_drive(drive);
707 		if (drive->dev_flags & IDE_DFLAG_PRESENT)
708 			rc = 0;
709 	}
710 
711 	/*
712 	 * Use cached IRQ number. It might be (and is...) changed by probe
713 	 * code above
714 	 */
715 	if (irqd)
716 		enable_irq(irqd);
717 
718 	return rc;
719 }
720 
ide_port_tune_devices(ide_hwif_t * hwif)721 static void ide_port_tune_devices(ide_hwif_t *hwif)
722 {
723 	const struct ide_port_ops *port_ops = hwif->port_ops;
724 	ide_drive_t *drive;
725 	int i;
726 
727 	ide_port_for_each_present_dev(i, drive, hwif) {
728 		ide_check_nien_quirk_list(drive);
729 
730 		if (port_ops && port_ops->quirkproc)
731 			port_ops->quirkproc(drive);
732 	}
733 
734 	ide_port_for_each_present_dev(i, drive, hwif) {
735 		ide_set_max_pio(drive);
736 
737 		drive->dev_flags |= IDE_DFLAG_NICE1;
738 
739 		if (hwif->dma_ops)
740 			ide_set_dma(drive);
741 	}
742 }
743 
744 /*
745  * init request queue
746  */
ide_init_queue(ide_drive_t * drive)747 static int ide_init_queue(ide_drive_t *drive)
748 {
749 	struct request_queue *q;
750 	ide_hwif_t *hwif = drive->hwif;
751 	int max_sectors = 256;
752 	int max_sg_entries = PRD_ENTRIES;
753 
754 	/*
755 	 *	Our default set up assumes the normal IDE case,
756 	 *	that is 64K segmenting, standard PRD setup
757 	 *	and LBA28. Some drivers then impose their own
758 	 *	limits and LBA48 we could raise it but as yet
759 	 *	do not.
760 	 */
761 
762 	q = blk_init_queue_node(do_ide_request, NULL, hwif_to_node(hwif));
763 	if (!q)
764 		return 1;
765 
766 	q->queuedata = drive;
767 	blk_queue_segment_boundary(q, 0xffff);
768 
769 	if (hwif->rqsize < max_sectors)
770 		max_sectors = hwif->rqsize;
771 	blk_queue_max_hw_sectors(q, max_sectors);
772 
773 #ifdef CONFIG_PCI
774 	/* When we have an IOMMU, we may have a problem where pci_map_sg()
775 	 * creates segments that don't completely match our boundary
776 	 * requirements and thus need to be broken up again. Because it
777 	 * doesn't align properly either, we may actually have to break up
778 	 * to more segments than what was we got in the first place, a max
779 	 * worst case is twice as many.
780 	 * This will be fixed once we teach pci_map_sg() about our boundary
781 	 * requirements, hopefully soon. *FIXME*
782 	 */
783 	if (!PCI_DMA_BUS_IS_PHYS)
784 		max_sg_entries >>= 1;
785 #endif /* CONFIG_PCI */
786 
787 	blk_queue_max_segments(q, max_sg_entries);
788 
789 	/* assign drive queue */
790 	drive->queue = q;
791 
792 	/* needs drive->queue to be set */
793 	ide_toggle_bounce(drive, 1);
794 
795 	return 0;
796 }
797 
798 static DEFINE_MUTEX(ide_cfg_mtx);
799 
800 /*
801  * For any present drive:
802  * - allocate the block device queue
803  */
ide_port_setup_devices(ide_hwif_t * hwif)804 static int ide_port_setup_devices(ide_hwif_t *hwif)
805 {
806 	ide_drive_t *drive;
807 	int i, j = 0;
808 
809 	mutex_lock(&ide_cfg_mtx);
810 	ide_port_for_each_present_dev(i, drive, hwif) {
811 		if (ide_init_queue(drive)) {
812 			printk(KERN_ERR "ide: failed to init %s\n",
813 					drive->name);
814 			drive->dev_flags &= ~IDE_DFLAG_PRESENT;
815 			continue;
816 		}
817 
818 		j++;
819 	}
820 	mutex_unlock(&ide_cfg_mtx);
821 
822 	return j;
823 }
824 
ide_host_enable_irqs(struct ide_host * host)825 static void ide_host_enable_irqs(struct ide_host *host)
826 {
827 	ide_hwif_t *hwif;
828 	int i;
829 
830 	ide_host_for_each_port(i, hwif, host) {
831 		if (hwif == NULL)
832 			continue;
833 
834 		/* clear any pending IRQs */
835 		hwif->tp_ops->read_status(hwif);
836 
837 		/* unmask IRQs */
838 		if (hwif->io_ports.ctl_addr)
839 			hwif->tp_ops->write_devctl(hwif, ATA_DEVCTL_OBS);
840 	}
841 }
842 
843 /*
844  * This routine sets up the IRQ for an IDE interface.
845  */
init_irq(ide_hwif_t * hwif)846 static int init_irq (ide_hwif_t *hwif)
847 {
848 	struct ide_io_ports *io_ports = &hwif->io_ports;
849 	struct ide_host *host = hwif->host;
850 	irq_handler_t irq_handler = host->irq_handler;
851 	int sa = host->irq_flags;
852 
853 	if (irq_handler == NULL)
854 		irq_handler = ide_intr;
855 
856 	if (request_irq(hwif->irq, irq_handler, sa, hwif->name, hwif))
857 		goto out_up;
858 
859 #if !defined(__mc68000__)
860 	printk(KERN_INFO "%s at 0x%03lx-0x%03lx,0x%03lx on irq %d", hwif->name,
861 		io_ports->data_addr, io_ports->status_addr,
862 		io_ports->ctl_addr, hwif->irq);
863 #else
864 	printk(KERN_INFO "%s at 0x%08lx on irq %d", hwif->name,
865 		io_ports->data_addr, hwif->irq);
866 #endif /* __mc68000__ */
867 	if (hwif->host->host_flags & IDE_HFLAG_SERIALIZE)
868 		printk(KERN_CONT " (serialized)");
869 	printk(KERN_CONT "\n");
870 
871 	return 0;
872 out_up:
873 	return 1;
874 }
875 
ata_lock(dev_t dev,void * data)876 static int ata_lock(dev_t dev, void *data)
877 {
878 	/* FIXME: we want to pin hwif down */
879 	return 0;
880 }
881 
ata_probe(dev_t dev,int * part,void * data)882 static struct kobject *ata_probe(dev_t dev, int *part, void *data)
883 {
884 	ide_hwif_t *hwif = data;
885 	int unit = *part >> PARTN_BITS;
886 	ide_drive_t *drive = hwif->devices[unit];
887 
888 	if ((drive->dev_flags & IDE_DFLAG_PRESENT) == 0)
889 		return NULL;
890 
891 	if (drive->media == ide_disk)
892 		request_module("ide-disk");
893 	if (drive->media == ide_cdrom || drive->media == ide_optical)
894 		request_module("ide-cd");
895 	if (drive->media == ide_tape)
896 		request_module("ide-tape");
897 	if (drive->media == ide_floppy)
898 		request_module("ide-floppy");
899 
900 	return NULL;
901 }
902 
exact_match(dev_t dev,int * part,void * data)903 static struct kobject *exact_match(dev_t dev, int *part, void *data)
904 {
905 	struct gendisk *p = data;
906 	*part &= (1 << PARTN_BITS) - 1;
907 	return &disk_to_dev(p)->kobj;
908 }
909 
exact_lock(dev_t dev,void * data)910 static int exact_lock(dev_t dev, void *data)
911 {
912 	struct gendisk *p = data;
913 
914 	if (!get_disk(p))
915 		return -1;
916 	return 0;
917 }
918 
ide_register_region(struct gendisk * disk)919 void ide_register_region(struct gendisk *disk)
920 {
921 	blk_register_region(MKDEV(disk->major, disk->first_minor),
922 			    disk->minors, NULL, exact_match, exact_lock, disk);
923 }
924 
925 EXPORT_SYMBOL_GPL(ide_register_region);
926 
ide_unregister_region(struct gendisk * disk)927 void ide_unregister_region(struct gendisk *disk)
928 {
929 	blk_unregister_region(MKDEV(disk->major, disk->first_minor),
930 			      disk->minors);
931 }
932 
933 EXPORT_SYMBOL_GPL(ide_unregister_region);
934 
ide_init_disk(struct gendisk * disk,ide_drive_t * drive)935 void ide_init_disk(struct gendisk *disk, ide_drive_t *drive)
936 {
937 	ide_hwif_t *hwif = drive->hwif;
938 	unsigned int unit = drive->dn & 1;
939 
940 	disk->major = hwif->major;
941 	disk->first_minor = unit << PARTN_BITS;
942 	sprintf(disk->disk_name, "hd%c", 'a' + hwif->index * MAX_DRIVES + unit);
943 	disk->queue = drive->queue;
944 }
945 
946 EXPORT_SYMBOL_GPL(ide_init_disk);
947 
drive_release_dev(struct device * dev)948 static void drive_release_dev (struct device *dev)
949 {
950 	ide_drive_t *drive = container_of(dev, ide_drive_t, gendev);
951 
952 	ide_proc_unregister_device(drive);
953 
954 	blk_cleanup_queue(drive->queue);
955 	drive->queue = NULL;
956 
957 	drive->dev_flags &= ~IDE_DFLAG_PRESENT;
958 
959 	complete(&drive->gendev_rel_comp);
960 }
961 
hwif_init(ide_hwif_t * hwif)962 static int hwif_init(ide_hwif_t *hwif)
963 {
964 	if (!hwif->irq) {
965 		printk(KERN_ERR "%s: disabled, no IRQ\n", hwif->name);
966 		return 0;
967 	}
968 
969 	if (register_blkdev(hwif->major, hwif->name))
970 		return 0;
971 
972 	if (!hwif->sg_max_nents)
973 		hwif->sg_max_nents = PRD_ENTRIES;
974 
975 	hwif->sg_table = kmalloc(sizeof(struct scatterlist)*hwif->sg_max_nents,
976 				 GFP_KERNEL);
977 	if (!hwif->sg_table) {
978 		printk(KERN_ERR "%s: unable to allocate SG table.\n", hwif->name);
979 		goto out;
980 	}
981 
982 	sg_init_table(hwif->sg_table, hwif->sg_max_nents);
983 
984 	if (init_irq(hwif)) {
985 		printk(KERN_ERR "%s: disabled, unable to get IRQ %d\n",
986 			hwif->name, hwif->irq);
987 		goto out;
988 	}
989 
990 	blk_register_region(MKDEV(hwif->major, 0), MAX_DRIVES << PARTN_BITS,
991 			    THIS_MODULE, ata_probe, ata_lock, hwif);
992 	return 1;
993 
994 out:
995 	unregister_blkdev(hwif->major, hwif->name);
996 	return 0;
997 }
998 
hwif_register_devices(ide_hwif_t * hwif)999 static void hwif_register_devices(ide_hwif_t *hwif)
1000 {
1001 	ide_drive_t *drive;
1002 	unsigned int i;
1003 
1004 	ide_port_for_each_present_dev(i, drive, hwif) {
1005 		struct device *dev = &drive->gendev;
1006 		int ret;
1007 
1008 		dev_set_name(dev, "%u.%u", hwif->index, i);
1009 		dev_set_drvdata(dev, drive);
1010 		dev->parent = &hwif->gendev;
1011 		dev->bus = &ide_bus_type;
1012 		dev->release = drive_release_dev;
1013 
1014 		ret = device_register(dev);
1015 		if (ret < 0)
1016 			printk(KERN_WARNING "IDE: %s: device_register error: "
1017 					    "%d\n", __func__, ret);
1018 	}
1019 }
1020 
ide_port_init_devices(ide_hwif_t * hwif)1021 static void ide_port_init_devices(ide_hwif_t *hwif)
1022 {
1023 	const struct ide_port_ops *port_ops = hwif->port_ops;
1024 	ide_drive_t *drive;
1025 	int i;
1026 
1027 	ide_port_for_each_dev(i, drive, hwif) {
1028 		drive->dn = i + hwif->channel * 2;
1029 
1030 		if (hwif->host_flags & IDE_HFLAG_IO_32BIT)
1031 			drive->io_32bit = 1;
1032 		if (hwif->host_flags & IDE_HFLAG_NO_IO_32BIT)
1033 			drive->dev_flags |= IDE_DFLAG_NO_IO_32BIT;
1034 		if (hwif->host_flags & IDE_HFLAG_UNMASK_IRQS)
1035 			drive->dev_flags |= IDE_DFLAG_UNMASK;
1036 		if (hwif->host_flags & IDE_HFLAG_NO_UNMASK_IRQS)
1037 			drive->dev_flags |= IDE_DFLAG_NO_UNMASK;
1038 
1039 		drive->pio_mode = XFER_PIO_0;
1040 
1041 		if (port_ops && port_ops->init_dev)
1042 			port_ops->init_dev(drive);
1043 	}
1044 }
1045 
ide_init_port(ide_hwif_t * hwif,unsigned int port,const struct ide_port_info * d)1046 static void ide_init_port(ide_hwif_t *hwif, unsigned int port,
1047 			  const struct ide_port_info *d)
1048 {
1049 	hwif->channel = port;
1050 
1051 	hwif->chipset = d->chipset ? d->chipset : ide_pci;
1052 
1053 	if (d->init_iops)
1054 		d->init_iops(hwif);
1055 
1056 	/* ->host_flags may be set by ->init_iops (or even earlier...) */
1057 	hwif->host_flags |= d->host_flags;
1058 	hwif->pio_mask = d->pio_mask;
1059 
1060 	if (d->tp_ops)
1061 		hwif->tp_ops = d->tp_ops;
1062 
1063 	/* ->set_pio_mode for DTC2278 is currently limited to port 0 */
1064 	if ((hwif->host_flags & IDE_HFLAG_DTC2278) == 0 || hwif->channel == 0)
1065 		hwif->port_ops = d->port_ops;
1066 
1067 	hwif->swdma_mask = d->swdma_mask;
1068 	hwif->mwdma_mask = d->mwdma_mask;
1069 	hwif->ultra_mask = d->udma_mask;
1070 
1071 	if ((d->host_flags & IDE_HFLAG_NO_DMA) == 0) {
1072 		int rc;
1073 
1074 		hwif->dma_ops = d->dma_ops;
1075 
1076 		if (d->init_dma)
1077 			rc = d->init_dma(hwif, d);
1078 		else
1079 			rc = ide_hwif_setup_dma(hwif, d);
1080 
1081 		if (rc < 0) {
1082 			printk(KERN_INFO "%s: DMA disabled\n", hwif->name);
1083 
1084 			hwif->dma_ops = NULL;
1085 			hwif->dma_base = 0;
1086 			hwif->swdma_mask = 0;
1087 			hwif->mwdma_mask = 0;
1088 			hwif->ultra_mask = 0;
1089 		}
1090 	}
1091 
1092 	if ((d->host_flags & IDE_HFLAG_SERIALIZE) ||
1093 	    ((d->host_flags & IDE_HFLAG_SERIALIZE_DMA) && hwif->dma_base))
1094 		hwif->host->host_flags |= IDE_HFLAG_SERIALIZE;
1095 
1096 	if (d->max_sectors)
1097 		hwif->rqsize = d->max_sectors;
1098 	else {
1099 		if ((hwif->host_flags & IDE_HFLAG_NO_LBA48) ||
1100 		    (hwif->host_flags & IDE_HFLAG_NO_LBA48_DMA))
1101 			hwif->rqsize = 256;
1102 		else
1103 			hwif->rqsize = 65536;
1104 	}
1105 
1106 	/* call chipset specific routine for each enabled port */
1107 	if (d->init_hwif)
1108 		d->init_hwif(hwif);
1109 }
1110 
ide_port_cable_detect(ide_hwif_t * hwif)1111 static void ide_port_cable_detect(ide_hwif_t *hwif)
1112 {
1113 	const struct ide_port_ops *port_ops = hwif->port_ops;
1114 
1115 	if (port_ops && port_ops->cable_detect && (hwif->ultra_mask & 0x78)) {
1116 		if (hwif->cbl != ATA_CBL_PATA40_SHORT)
1117 			hwif->cbl = port_ops->cable_detect(hwif);
1118 	}
1119 }
1120 
1121 static const u8 ide_hwif_to_major[] =
1122 	{ IDE0_MAJOR, IDE1_MAJOR, IDE2_MAJOR, IDE3_MAJOR, IDE4_MAJOR,
1123 	  IDE5_MAJOR, IDE6_MAJOR, IDE7_MAJOR, IDE8_MAJOR, IDE9_MAJOR };
1124 
ide_port_init_devices_data(ide_hwif_t * hwif)1125 static void ide_port_init_devices_data(ide_hwif_t *hwif)
1126 {
1127 	ide_drive_t *drive;
1128 	int i;
1129 
1130 	ide_port_for_each_dev(i, drive, hwif) {
1131 		u8 j = (hwif->index * MAX_DRIVES) + i;
1132 		u16 *saved_id = drive->id;
1133 
1134 		memset(drive, 0, sizeof(*drive));
1135 		memset(saved_id, 0, SECTOR_SIZE);
1136 		drive->id = saved_id;
1137 
1138 		drive->media			= ide_disk;
1139 		drive->select			= (i << 4) | ATA_DEVICE_OBS;
1140 		drive->hwif			= hwif;
1141 		drive->ready_stat		= ATA_DRDY;
1142 		drive->bad_wstat		= BAD_W_STAT;
1143 		drive->special_flags		= IDE_SFLAG_RECALIBRATE |
1144 						  IDE_SFLAG_SET_GEOMETRY;
1145 		drive->name[0]			= 'h';
1146 		drive->name[1]			= 'd';
1147 		drive->name[2]			= 'a' + j;
1148 		drive->max_failures		= IDE_DEFAULT_MAX_FAILURES;
1149 
1150 		INIT_LIST_HEAD(&drive->list);
1151 		init_completion(&drive->gendev_rel_comp);
1152 	}
1153 }
1154 
ide_init_port_data(ide_hwif_t * hwif,unsigned int index)1155 static void ide_init_port_data(ide_hwif_t *hwif, unsigned int index)
1156 {
1157 	/* fill in any non-zero initial values */
1158 	hwif->index	= index;
1159 	hwif->major	= ide_hwif_to_major[index];
1160 
1161 	hwif->name[0]	= 'i';
1162 	hwif->name[1]	= 'd';
1163 	hwif->name[2]	= 'e';
1164 	hwif->name[3]	= '0' + index;
1165 
1166 	spin_lock_init(&hwif->lock);
1167 
1168 	init_timer(&hwif->timer);
1169 	hwif->timer.function = &ide_timer_expiry;
1170 	hwif->timer.data = (unsigned long)hwif;
1171 
1172 	init_completion(&hwif->gendev_rel_comp);
1173 
1174 	hwif->tp_ops = &default_tp_ops;
1175 
1176 	ide_port_init_devices_data(hwif);
1177 }
1178 
ide_init_port_hw(ide_hwif_t * hwif,struct ide_hw * hw)1179 static void ide_init_port_hw(ide_hwif_t *hwif, struct ide_hw *hw)
1180 {
1181 	memcpy(&hwif->io_ports, &hw->io_ports, sizeof(hwif->io_ports));
1182 	hwif->irq = hw->irq;
1183 	hwif->dev = hw->dev;
1184 	hwif->gendev.parent = hw->parent ? hw->parent : hw->dev;
1185 	hwif->config_data = hw->config;
1186 }
1187 
1188 static unsigned int ide_indexes;
1189 
1190 /**
1191  *	ide_find_port_slot	-	find free port slot
1192  *	@d: IDE port info
1193  *
1194  *	Return the new port slot index or -ENOENT if we are out of free slots.
1195  */
1196 
ide_find_port_slot(const struct ide_port_info * d)1197 static int ide_find_port_slot(const struct ide_port_info *d)
1198 {
1199 	int idx = -ENOENT;
1200 	u8 bootable = (d && (d->host_flags & IDE_HFLAG_NON_BOOTABLE)) ? 0 : 1;
1201 	u8 i = (d && (d->host_flags & IDE_HFLAG_QD_2ND_PORT)) ? 1 : 0;
1202 
1203 	/*
1204 	 * Claim an unassigned slot.
1205 	 *
1206 	 * Give preference to claiming other slots before claiming ide0/ide1,
1207 	 * just in case there's another interface yet-to-be-scanned
1208 	 * which uses ports 0x1f0/0x170 (the ide0/ide1 defaults).
1209 	 *
1210 	 * Unless there is a bootable card that does not use the standard
1211 	 * ports 0x1f0/0x170 (the ide0/ide1 defaults).
1212 	 */
1213 	mutex_lock(&ide_cfg_mtx);
1214 	if (bootable) {
1215 		if ((ide_indexes | i) != (1 << MAX_HWIFS) - 1)
1216 			idx = ffz(ide_indexes | i);
1217 	} else {
1218 		if ((ide_indexes | 3) != (1 << MAX_HWIFS) - 1)
1219 			idx = ffz(ide_indexes | 3);
1220 		else if ((ide_indexes & 3) != 3)
1221 			idx = ffz(ide_indexes);
1222 	}
1223 	if (idx >= 0)
1224 		ide_indexes |= (1 << idx);
1225 	mutex_unlock(&ide_cfg_mtx);
1226 
1227 	return idx;
1228 }
1229 
ide_free_port_slot(int idx)1230 static void ide_free_port_slot(int idx)
1231 {
1232 	mutex_lock(&ide_cfg_mtx);
1233 	ide_indexes &= ~(1 << idx);
1234 	mutex_unlock(&ide_cfg_mtx);
1235 }
1236 
ide_port_free_devices(ide_hwif_t * hwif)1237 static void ide_port_free_devices(ide_hwif_t *hwif)
1238 {
1239 	ide_drive_t *drive;
1240 	int i;
1241 
1242 	ide_port_for_each_dev(i, drive, hwif) {
1243 		kfree(drive->id);
1244 		kfree(drive);
1245 	}
1246 }
1247 
ide_port_alloc_devices(ide_hwif_t * hwif,int node)1248 static int ide_port_alloc_devices(ide_hwif_t *hwif, int node)
1249 {
1250 	int i;
1251 
1252 	for (i = 0; i < MAX_DRIVES; i++) {
1253 		ide_drive_t *drive;
1254 
1255 		drive = kzalloc_node(sizeof(*drive), GFP_KERNEL, node);
1256 		if (drive == NULL)
1257 			goto out_nomem;
1258 
1259 		/*
1260 		 * In order to keep things simple we have an id
1261 		 * block for all drives at all times. If the device
1262 		 * is pre ATA or refuses ATA/ATAPI identify we
1263 		 * will add faked data to this.
1264 		 *
1265 		 * Also note that 0 everywhere means "can't do X"
1266 		 */
1267 		drive->id = kzalloc_node(SECTOR_SIZE, GFP_KERNEL, node);
1268 		if (drive->id == NULL)
1269 			goto out_nomem;
1270 
1271 		hwif->devices[i] = drive;
1272 	}
1273 	return 0;
1274 
1275 out_nomem:
1276 	ide_port_free_devices(hwif);
1277 	return -ENOMEM;
1278 }
1279 
ide_host_alloc(const struct ide_port_info * d,struct ide_hw ** hws,unsigned int n_ports)1280 struct ide_host *ide_host_alloc(const struct ide_port_info *d,
1281 				struct ide_hw **hws, unsigned int n_ports)
1282 {
1283 	struct ide_host *host;
1284 	struct device *dev = hws[0] ? hws[0]->dev : NULL;
1285 	int node = dev ? dev_to_node(dev) : -1;
1286 	int i;
1287 
1288 	host = kzalloc_node(sizeof(*host), GFP_KERNEL, node);
1289 	if (host == NULL)
1290 		return NULL;
1291 
1292 	for (i = 0; i < n_ports; i++) {
1293 		ide_hwif_t *hwif;
1294 		int idx;
1295 
1296 		if (hws[i] == NULL)
1297 			continue;
1298 
1299 		hwif = kzalloc_node(sizeof(*hwif), GFP_KERNEL, node);
1300 		if (hwif == NULL)
1301 			continue;
1302 
1303 		if (ide_port_alloc_devices(hwif, node) < 0) {
1304 			kfree(hwif);
1305 			continue;
1306 		}
1307 
1308 		idx = ide_find_port_slot(d);
1309 		if (idx < 0) {
1310 			printk(KERN_ERR "%s: no free slot for interface\n",
1311 					d ? d->name : "ide");
1312 			ide_port_free_devices(hwif);
1313 			kfree(hwif);
1314 			continue;
1315 		}
1316 
1317 		ide_init_port_data(hwif, idx);
1318 
1319 		hwif->host = host;
1320 
1321 		host->ports[i] = hwif;
1322 		host->n_ports++;
1323 	}
1324 
1325 	if (host->n_ports == 0) {
1326 		kfree(host);
1327 		return NULL;
1328 	}
1329 
1330 	host->dev[0] = dev;
1331 
1332 	if (d) {
1333 		host->init_chipset = d->init_chipset;
1334 		host->get_lock     = d->get_lock;
1335 		host->release_lock = d->release_lock;
1336 		host->host_flags = d->host_flags;
1337 		host->irq_flags = d->irq_flags;
1338 	}
1339 
1340 	return host;
1341 }
1342 EXPORT_SYMBOL_GPL(ide_host_alloc);
1343 
ide_port_free(ide_hwif_t * hwif)1344 static void ide_port_free(ide_hwif_t *hwif)
1345 {
1346 	ide_port_free_devices(hwif);
1347 	ide_free_port_slot(hwif->index);
1348 	kfree(hwif);
1349 }
1350 
ide_disable_port(ide_hwif_t * hwif)1351 static void ide_disable_port(ide_hwif_t *hwif)
1352 {
1353 	struct ide_host *host = hwif->host;
1354 	int i;
1355 
1356 	printk(KERN_INFO "%s: disabling port\n", hwif->name);
1357 
1358 	for (i = 0; i < MAX_HOST_PORTS; i++) {
1359 		if (host->ports[i] == hwif) {
1360 			host->ports[i] = NULL;
1361 			host->n_ports--;
1362 		}
1363 	}
1364 
1365 	ide_port_free(hwif);
1366 }
1367 
ide_host_register(struct ide_host * host,const struct ide_port_info * d,struct ide_hw ** hws)1368 int ide_host_register(struct ide_host *host, const struct ide_port_info *d,
1369 		      struct ide_hw **hws)
1370 {
1371 	ide_hwif_t *hwif, *mate = NULL;
1372 	int i, j = 0;
1373 
1374 	ide_host_for_each_port(i, hwif, host) {
1375 		if (hwif == NULL) {
1376 			mate = NULL;
1377 			continue;
1378 		}
1379 
1380 		ide_init_port_hw(hwif, hws[i]);
1381 		ide_port_apply_params(hwif);
1382 
1383 		if ((i & 1) && mate) {
1384 			hwif->mate = mate;
1385 			mate->mate = hwif;
1386 		}
1387 
1388 		mate = (i & 1) ? NULL : hwif;
1389 
1390 		ide_init_port(hwif, i & 1, d);
1391 		ide_port_cable_detect(hwif);
1392 
1393 		hwif->port_flags |= IDE_PFLAG_PROBING;
1394 
1395 		ide_port_init_devices(hwif);
1396 	}
1397 
1398 	ide_host_for_each_port(i, hwif, host) {
1399 		if (hwif == NULL)
1400 			continue;
1401 
1402 		if (ide_probe_port(hwif) == 0)
1403 			hwif->present = 1;
1404 
1405 		hwif->port_flags &= ~IDE_PFLAG_PROBING;
1406 
1407 		if ((hwif->host_flags & IDE_HFLAG_4DRIVES) == 0 ||
1408 		    hwif->mate == NULL || hwif->mate->present == 0) {
1409 			if (ide_register_port(hwif)) {
1410 				ide_disable_port(hwif);
1411 				continue;
1412 			}
1413 		}
1414 
1415 		if (hwif->present)
1416 			ide_port_tune_devices(hwif);
1417 	}
1418 
1419 	ide_host_enable_irqs(host);
1420 
1421 	ide_host_for_each_port(i, hwif, host) {
1422 		if (hwif == NULL)
1423 			continue;
1424 
1425 		if (hwif_init(hwif) == 0) {
1426 			printk(KERN_INFO "%s: failed to initialize IDE "
1427 					 "interface\n", hwif->name);
1428 			device_unregister(&hwif->gendev);
1429 			ide_disable_port(hwif);
1430 			continue;
1431 		}
1432 
1433 		if (hwif->present)
1434 			if (ide_port_setup_devices(hwif) == 0) {
1435 				hwif->present = 0;
1436 				continue;
1437 			}
1438 
1439 		j++;
1440 
1441 		ide_acpi_init_port(hwif);
1442 
1443 		if (hwif->present)
1444 			ide_acpi_port_init_devices(hwif);
1445 	}
1446 
1447 	ide_host_for_each_port(i, hwif, host) {
1448 		if (hwif == NULL)
1449 			continue;
1450 
1451 		ide_sysfs_register_port(hwif);
1452 		ide_proc_register_port(hwif);
1453 
1454 		if (hwif->present) {
1455 			ide_proc_port_register_devices(hwif);
1456 			hwif_register_devices(hwif);
1457 		}
1458 	}
1459 
1460 	return j ? 0 : -1;
1461 }
1462 EXPORT_SYMBOL_GPL(ide_host_register);
1463 
ide_host_add(const struct ide_port_info * d,struct ide_hw ** hws,unsigned int n_ports,struct ide_host ** hostp)1464 int ide_host_add(const struct ide_port_info *d, struct ide_hw **hws,
1465 		 unsigned int n_ports, struct ide_host **hostp)
1466 {
1467 	struct ide_host *host;
1468 	int rc;
1469 
1470 	host = ide_host_alloc(d, hws, n_ports);
1471 	if (host == NULL)
1472 		return -ENOMEM;
1473 
1474 	rc = ide_host_register(host, d, hws);
1475 	if (rc) {
1476 		ide_host_free(host);
1477 		return rc;
1478 	}
1479 
1480 	if (hostp)
1481 		*hostp = host;
1482 
1483 	return 0;
1484 }
1485 EXPORT_SYMBOL_GPL(ide_host_add);
1486 
__ide_port_unregister_devices(ide_hwif_t * hwif)1487 static void __ide_port_unregister_devices(ide_hwif_t *hwif)
1488 {
1489 	ide_drive_t *drive;
1490 	int i;
1491 
1492 	ide_port_for_each_present_dev(i, drive, hwif) {
1493 		device_unregister(&drive->gendev);
1494 		wait_for_completion(&drive->gendev_rel_comp);
1495 	}
1496 }
1497 
ide_port_unregister_devices(ide_hwif_t * hwif)1498 void ide_port_unregister_devices(ide_hwif_t *hwif)
1499 {
1500 	mutex_lock(&ide_cfg_mtx);
1501 	__ide_port_unregister_devices(hwif);
1502 	hwif->present = 0;
1503 	ide_port_init_devices_data(hwif);
1504 	mutex_unlock(&ide_cfg_mtx);
1505 }
1506 EXPORT_SYMBOL_GPL(ide_port_unregister_devices);
1507 
1508 /**
1509  *	ide_unregister		-	free an IDE interface
1510  *	@hwif: IDE interface
1511  *
1512  *	Perform the final unregister of an IDE interface.
1513  *
1514  *	Locking:
1515  *	The caller must not hold the IDE locks.
1516  *
1517  *	It is up to the caller to be sure there is no pending I/O here,
1518  *	and that the interface will not be reopened (present/vanishing
1519  *	locking isn't yet done BTW).
1520  */
1521 
ide_unregister(ide_hwif_t * hwif)1522 static void ide_unregister(ide_hwif_t *hwif)
1523 {
1524 	BUG_ON(in_interrupt());
1525 	BUG_ON(irqs_disabled());
1526 
1527 	mutex_lock(&ide_cfg_mtx);
1528 
1529 	if (hwif->present) {
1530 		__ide_port_unregister_devices(hwif);
1531 		hwif->present = 0;
1532 	}
1533 
1534 	ide_proc_unregister_port(hwif);
1535 
1536 	free_irq(hwif->irq, hwif);
1537 
1538 	device_unregister(hwif->portdev);
1539 	device_unregister(&hwif->gendev);
1540 	wait_for_completion(&hwif->gendev_rel_comp);
1541 
1542 	/*
1543 	 * Remove us from the kernel's knowledge
1544 	 */
1545 	blk_unregister_region(MKDEV(hwif->major, 0), MAX_DRIVES<<PARTN_BITS);
1546 	kfree(hwif->sg_table);
1547 	unregister_blkdev(hwif->major, hwif->name);
1548 
1549 	ide_release_dma_engine(hwif);
1550 
1551 	mutex_unlock(&ide_cfg_mtx);
1552 }
1553 
ide_host_free(struct ide_host * host)1554 void ide_host_free(struct ide_host *host)
1555 {
1556 	ide_hwif_t *hwif;
1557 	int i;
1558 
1559 	ide_host_for_each_port(i, hwif, host) {
1560 		if (hwif)
1561 			ide_port_free(hwif);
1562 	}
1563 
1564 	kfree(host);
1565 }
1566 EXPORT_SYMBOL_GPL(ide_host_free);
1567 
ide_host_remove(struct ide_host * host)1568 void ide_host_remove(struct ide_host *host)
1569 {
1570 	ide_hwif_t *hwif;
1571 	int i;
1572 
1573 	ide_host_for_each_port(i, hwif, host) {
1574 		if (hwif)
1575 			ide_unregister(hwif);
1576 	}
1577 
1578 	ide_host_free(host);
1579 }
1580 EXPORT_SYMBOL_GPL(ide_host_remove);
1581 
ide_port_scan(ide_hwif_t * hwif)1582 void ide_port_scan(ide_hwif_t *hwif)
1583 {
1584 	int rc;
1585 
1586 	ide_port_apply_params(hwif);
1587 	ide_port_cable_detect(hwif);
1588 
1589 	hwif->port_flags |= IDE_PFLAG_PROBING;
1590 
1591 	ide_port_init_devices(hwif);
1592 
1593 	rc = ide_probe_port(hwif);
1594 
1595 	hwif->port_flags &= ~IDE_PFLAG_PROBING;
1596 
1597 	if (rc < 0)
1598 		return;
1599 
1600 	hwif->present = 1;
1601 
1602 	ide_port_tune_devices(hwif);
1603 	ide_port_setup_devices(hwif);
1604 	ide_acpi_port_init_devices(hwif);
1605 	hwif_register_devices(hwif);
1606 	ide_proc_port_register_devices(hwif);
1607 }
1608 EXPORT_SYMBOL_GPL(ide_port_scan);
1609