230 	struct pcd_unit *cd = bdev->bd_disk->private_data;  in pcd_block_open()  local
236 	ret = cdrom_open(&cd->info, bdev, mode);  in pcd_block_open()
244 	struct pcd_unit *cd = disk->private_data;  in pcd_block_release()  local
246 	cdrom_release(&cd->info, mode);  in pcd_block_release()
253 	struct pcd_unit *cd = bdev->bd_disk->private_data;  in pcd_block_ioctl()  local
257 	ret = cdrom_ioctl(&cd->info, bdev, mode, cmd, arg);  in pcd_block_ioctl()
266 	struct pcd_unit *cd = disk->private_data;  in pcd_block_check_events()  local
267 	return cdrom_check_events(&cd->info, clearing);  in pcd_block_check_events()
297 	struct pcd_unit *cd;  in pcd_init_units()  local
301 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_init_units()
311 		cd->disk = disk;  in pcd_init_units()
312 		cd->pi = &cd->pia;  in pcd_init_units()
313 		cd->present = 0;  in pcd_init_units()
314 		cd->last_sense = 0;  in pcd_init_units()
315 		cd->changed = 1;  in pcd_init_units()
316 		cd->drive = (*drives[unit])[D_SLV];  in pcd_init_units()
320 		cd->name = &cd->info.name[0];  in pcd_init_units()
321 		snprintf(cd->name, sizeof(cd->info.name), "%s%d", name, unit);  in pcd_init_units()
322 		cd->info.ops = &pcd_dops;  in pcd_init_units()
323 		cd->info.handle = cd;  in pcd_init_units()
324 		cd->info.speed = 0;  in pcd_init_units()
325 		cd->info.capacity = 1;  in pcd_init_units()
326 		cd->info.mask = 0;  in pcd_init_units()
329 		strcpy(disk->disk_name, cd->name);	/* umm... */  in pcd_init_units()
337 	struct pcd_unit *cd = cdi->handle;  in pcd_open()  local
338 	if (!cd->present)  in pcd_open()
347 static inline int status_reg(struct pcd_unit *cd)  in status_reg()  argument
349 	return pi_read_regr(cd->pi, 1, 6);  in status_reg()
352 static inline int read_reg(struct pcd_unit *cd, int reg)  in read_reg()  argument
354 	return pi_read_regr(cd->pi, 0, reg);  in read_reg()
357 static inline void write_reg(struct pcd_unit *cd, int reg, int val)  in write_reg()  argument
359 	pi_write_regr(cd->pi, 0, reg, val);  in write_reg()
362 static int pcd_wait(struct pcd_unit *cd, int go, int stop, char *fun, char *msg)  in pcd_wait()  argument
367 	while ((((r = status_reg(cd)) & go) || (stop && (!(r & stop))))  in pcd_wait()
372 		s = read_reg(cd, 7);  in pcd_wait()
373 		e = read_reg(cd, 1);  in pcd_wait()
374 		p = read_reg(cd, 2);  in pcd_wait()
380 			       cd->name, fun, msg, r, s, e, j, p);  in pcd_wait()
386 static int pcd_command(struct pcd_unit *cd, char *cmd, int dlen, char *fun)  in pcd_command()  argument
388 	pi_connect(cd->pi);  in pcd_command()
390 	write_reg(cd, 6, 0xa0 + 0x10 * cd->drive);  in pcd_command()
392 	if (pcd_wait(cd, IDE_BUSY | IDE_DRQ, 0, fun, "before command")) {  in pcd_command()
393 		pi_disconnect(cd->pi);  in pcd_command()
397 	write_reg(cd, 4, dlen % 256);  in pcd_command()
398 	write_reg(cd, 5, dlen / 256);  in pcd_command()
399 	write_reg(cd, 7, 0xa0);	/* ATAPI packet command */  in pcd_command()
401 	if (pcd_wait(cd, IDE_BUSY, IDE_DRQ, fun, "command DRQ")) {  in pcd_command()
402 		pi_disconnect(cd->pi);  in pcd_command()
406 	if (read_reg(cd, 2) != 1) {  in pcd_command()
407 		printk("%s: %s: command phase error\n", cd->name, fun);  in pcd_command()
408 		pi_disconnect(cd->pi);  in pcd_command()
412 	pi_write_block(cd->pi, cmd, 12);  in pcd_command()
417 static int pcd_completion(struct pcd_unit *cd, char *buf, char *fun)  in pcd_completion()  argument
425 	if (!pcd_wait(cd, IDE_BUSY, IDE_DRQ | IDE_READY | IDE_ERR,  in pcd_completion()
428 		while (read_reg(cd, 7) & IDE_DRQ) {  in pcd_completion()
429 			d = read_reg(cd, 4) + 256 * read_reg(cd, 5);  in pcd_completion()
431 			p = read_reg(cd, 2) & 3;  in pcd_completion()
434 				pi_read_block(cd->pi, buf, n);  in pcd_completion()
437 					       cd->name, fun, n);  in pcd_completion()
444 					     cd->name, fun, p, d, k);  in pcd_completion()
448 					    cd->name);  in pcd_completion()
452 				printk("%s: Stuck DRQ\n", cd->name);  in pcd_completion()
456 			    (cd, IDE_BUSY, IDE_DRQ | IDE_READY | IDE_ERR, fun,  in pcd_completion()
464 	pi_disconnect(cd->pi);  in pcd_completion()
469 static void pcd_req_sense(struct pcd_unit *cd, char *fun)  in pcd_req_sense()  argument
475 	r = pcd_command(cd, rs_cmd, 16, "Request sense");  in pcd_req_sense()
478 		pcd_completion(cd, buf, "Request sense");  in pcd_req_sense()
480 	cd->last_sense = -1;  in pcd_req_sense()
485 			       cd->name, fun, buf[2] & 0xf, buf[12], buf[13]);  in pcd_req_sense()
487 		cd->last_sense =  in pcd_req_sense()
491 		cd->changed = 1;  in pcd_req_sense()
494 static int pcd_atapi(struct pcd_unit *cd, char *cmd, int dlen, char *buf, char *fun)  in pcd_atapi()  argument
498 	r = pcd_command(cd, cmd, dlen, fun);  in pcd_atapi()
501 		r = pcd_completion(cd, buf, fun);  in pcd_atapi()
503 		pcd_req_sense(cd, fun);  in pcd_atapi()
519 	struct pcd_unit *cd = cdi->handle;  in pcd_check_events()  local
520 	int res = cd->changed;  in pcd_check_events()
522 		cd->changed = 0;  in pcd_check_events()
547 static int pcd_reset(struct pcd_unit *cd)  in pcd_reset()  argument
552 	pi_connect(cd->pi);  in pcd_reset()
553 	write_reg(cd, 6, 0xa0 + 0x10 * cd->drive);  in pcd_reset()
554 	write_reg(cd, 7, 8);  in pcd_reset()
559 	while ((k++ < PCD_RESET_TMO) && (status_reg(cd) & IDE_BUSY))  in pcd_reset()
564 		flg &= (read_reg(cd, i + 1) == expect[i]);  in pcd_reset()
567 		printk("%s: Reset (%d) signature = ", cd->name, k);  in pcd_reset()
569 			printk("%3x", read_reg(cd, i + 1));  in pcd_reset()
575 	pi_disconnect(cd->pi);  in pcd_reset()
584 static int pcd_ready_wait(struct pcd_unit *cd, int tmo)  in pcd_ready_wait()  argument
591 		cd->last_sense = 0;  in pcd_ready_wait()
592 		pcd_atapi(cd, tr_cmd, 0, NULL, DBMSG("test unit ready"));  in pcd_ready_wait()
593 		p = cd->last_sense;  in pcd_ready_wait()
607 	struct pcd_unit *cd = cdi->handle;  in pcd_drive_status()  local
609 	if (pcd_ready_wait(cd, PCD_READY_TMO))  in pcd_drive_status()
611 	if (pcd_atapi(cd, rc_cmd, 8, pcd_scratch, DBMSG("check media")))  in pcd_drive_status()
616 static int pcd_identify(struct pcd_unit *cd, char *id)  in pcd_identify()  argument
623 	s = pcd_atapi(cd, id_cmd, 36, pcd_buffer, "identify");  in pcd_identify()
630 			       cd->name, cd->drive ? "Slave" : "Master");  in pcd_identify()
641 	printk("%s: %s: %s\n", cd->name, cd->drive ? "Slave" : "Master", id);  in pcd_identify()
650 static int pcd_probe(struct pcd_unit *cd, int ms, char *id)  in pcd_probe()  argument
653 		for (cd->drive = 0; cd->drive <= 1; cd->drive++)  in pcd_probe()
654 			if (!pcd_reset(cd) && !pcd_identify(cd, id))  in pcd_probe()
657 		cd->drive = ms;  in pcd_probe()
658 		if (!pcd_reset(cd) && !pcd_identify(cd, id))  in pcd_probe()
669 	struct pcd_unit *cd;  in pcd_probe_capabilities()  local
671 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_probe_capabilities()
672 		if (!cd->present)  in pcd_probe_capabilities()
674 		r = pcd_atapi(cd, cmd, 18, buffer, "mode sense capabilities");  in pcd_probe_capabilities()
679 			cd->info.mask |= CDC_CD_R;  in pcd_probe_capabilities()
681 			cd->info.mask |= CDC_CD_RW;  in pcd_probe_capabilities()
683 			cd->info.mask |= CDC_PLAY_AUDIO;  in pcd_probe_capabilities()
685 			cd->info.mask |= CDC_LOCK;  in pcd_probe_capabilities()
687 			cd->info.mask |= CDC_OPEN_TRAY;  in pcd_probe_capabilities()
689 			cd->info.mask |= CDC_CLOSE_TRAY;  in pcd_probe_capabilities()
697 	struct pcd_unit *cd;  in pcd_detect()  local
710 		cd = pcd;  in pcd_detect()
711 		if (pi_init(cd->pi, 1, -1, -1, -1, -1, -1, pcd_buffer,  in pcd_detect()
712 			    PI_PCD, verbose, cd->name)) {  in pcd_detect()
713 			if (!pcd_probe(cd, -1, id) && cd->disk) {  in pcd_detect()
714 				cd->present = 1;  in pcd_detect()
717 				pi_release(cd->pi);  in pcd_detect()
720 		for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_detect()
724 			if (!pi_init(cd->pi, 0, conf[D_PRT], conf[D_MOD],  in pcd_detect()
726 				     pcd_buffer, PI_PCD, verbose, cd->name))   in pcd_detect()
728 			if (!pcd_probe(cd, conf[D_SLV], id) && cd->disk) {  in pcd_detect()
729 				cd->present = 1;  in pcd_detect()
732 				pi_release(cd->pi);  in pcd_detect()
739 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++)  in pcd_detect()
740 		put_disk(cd->disk);  in pcd_detect()
750 	struct pcd_unit *cd;  in set_next_request()  local
755 		cd = &pcd[pcd_queue];  in set_next_request()
756 		q = cd->present ? cd->disk->queue : NULL;  in set_next_request()
778 			struct pcd_unit *cd = pcd_req->rq_disk->private_data;  in pcd_request()  local
779 			if (cd != pcd_current)  in pcd_request()
781 			pcd_current = cd;  in pcd_request()
891 	struct pcd_unit *cd = cdi->handle;  in pcd_audio_ioctl()  local
906 			r = pcd_atapi(cd, cmd, 12, buffer, "read toc header");  in pcd_audio_ioctl()
930 			r = pcd_atapi(cd, cmd, 12, buffer, "read toc entry");  in pcd_audio_ioctl()
971 	struct pcd_unit *cd;  in pcd_init()  local
986 		for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++)  in pcd_init()
987 			put_disk(cd->disk);  in pcd_init()
991 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_init()
992 		if (cd->present) {  in pcd_init()
993 			register_cdrom(&cd->info);  in pcd_init()
994 			cd->disk->private_data = cd;  in pcd_init()
995 			add_disk(cd->disk);  in pcd_init()
1004 	struct pcd_unit *cd;  in pcd_exit()  local
1007 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_exit()
1008 		if (cd->present) {  in pcd_exit()
1009 			del_gendisk(cd->disk);  in pcd_exit()
1010 			pi_release(cd->pi);  in pcd_exit()
1011 			unregister_cdrom(&cd->info);  in pcd_exit()
1013 		blk_cleanup_queue(cd->disk->queue);  in pcd_exit()
1014 		put_disk(cd->disk);  in pcd_exit()