233 	struct pcd_unit *cd = bdev->bd_disk->private_data;  in pcd_block_open()  local
239 	ret = cdrom_open(&cd->info, bdev, mode);  in pcd_block_open()
247 	struct pcd_unit *cd = disk->private_data;  in pcd_block_release()  local
249 	cdrom_release(&cd->info, mode);  in pcd_block_release()
256 	struct pcd_unit *cd = bdev->bd_disk->private_data;  in pcd_block_ioctl()  local
260 	ret = cdrom_ioctl(&cd->info, bdev, mode, cmd, arg);  in pcd_block_ioctl()
269 	struct pcd_unit *cd = disk->private_data;  in pcd_block_check_events()  local
270 	return cdrom_check_events(&cd->info, clearing);  in pcd_block_check_events()
304 	struct pcd_unit *cd;  in pcd_init_units()  local
308 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_init_units()
314 		disk->queue = blk_mq_init_sq_queue(&cd->tag_set, &pcd_mq_ops,  in pcd_init_units()
322 		INIT_LIST_HEAD(&cd->rq_list);  in pcd_init_units()
323 		disk->queue->queuedata = cd;  in pcd_init_units()
325 		cd->disk = disk;  in pcd_init_units()
326 		cd->pi = &cd->pia;  in pcd_init_units()
327 		cd->present = 0;  in pcd_init_units()
328 		cd->last_sense = 0;  in pcd_init_units()
329 		cd->changed = 1;  in pcd_init_units()
330 		cd->drive = (*drives[unit])[D_SLV];  in pcd_init_units()
334 		cd->name = &cd->info.name[0];  in pcd_init_units()
335 		snprintf(cd->name, sizeof(cd->info.name), "%s%d", name, unit);  in pcd_init_units()
336 		cd->info.ops = &pcd_dops;  in pcd_init_units()
337 		cd->info.handle = cd;  in pcd_init_units()
338 		cd->info.speed = 0;  in pcd_init_units()
339 		cd->info.capacity = 1;  in pcd_init_units()
340 		cd->info.mask = 0;  in pcd_init_units()
343 		strcpy(disk->disk_name, cd->name);	/* umm... */  in pcd_init_units()
352 	struct pcd_unit *cd = cdi->handle;  in pcd_open()  local
353 	if (!cd->present)  in pcd_open()
362 static inline int status_reg(struct pcd_unit *cd)  in status_reg()  argument
364 	return pi_read_regr(cd->pi, 1, 6);  in status_reg()
367 static inline int read_reg(struct pcd_unit *cd, int reg)  in read_reg()  argument
369 	return pi_read_regr(cd->pi, 0, reg);  in read_reg()
372 static inline void write_reg(struct pcd_unit *cd, int reg, int val)  in write_reg()  argument
374 	pi_write_regr(cd->pi, 0, reg, val);  in write_reg()
377 static int pcd_wait(struct pcd_unit *cd, int go, int stop, char *fun, char *msg)  in pcd_wait()  argument
382 	while ((((r = status_reg(cd)) & go) || (stop && (!(r & stop))))  in pcd_wait()
387 		s = read_reg(cd, 7);  in pcd_wait()
388 		e = read_reg(cd, 1);  in pcd_wait()
389 		p = read_reg(cd, 2);  in pcd_wait()
395 			       cd->name, fun, msg, r, s, e, j, p);  in pcd_wait()
401 static int pcd_command(struct pcd_unit *cd, char *cmd, int dlen, char *fun)  in pcd_command()  argument
403 	pi_connect(cd->pi);  in pcd_command()
405 	write_reg(cd, 6, 0xa0 + 0x10 * cd->drive);  in pcd_command()
407 	if (pcd_wait(cd, IDE_BUSY | IDE_DRQ, 0, fun, "before command")) {  in pcd_command()
408 		pi_disconnect(cd->pi);  in pcd_command()
412 	write_reg(cd, 4, dlen % 256);  in pcd_command()
413 	write_reg(cd, 5, dlen / 256);  in pcd_command()
414 	write_reg(cd, 7, 0xa0);	/* ATAPI packet command */  in pcd_command()
416 	if (pcd_wait(cd, IDE_BUSY, IDE_DRQ, fun, "command DRQ")) {  in pcd_command()
417 		pi_disconnect(cd->pi);  in pcd_command()
421 	if (read_reg(cd, 2) != 1) {  in pcd_command()
422 		printk("%s: %s: command phase error\n", cd->name, fun);  in pcd_command()
423 		pi_disconnect(cd->pi);  in pcd_command()
427 	pi_write_block(cd->pi, cmd, 12);  in pcd_command()
432 static int pcd_completion(struct pcd_unit *cd, char *buf, char *fun)  in pcd_completion()  argument
440 	if (!pcd_wait(cd, IDE_BUSY, IDE_DRQ | IDE_READY | IDE_ERR,  in pcd_completion()
443 		while (read_reg(cd, 7) & IDE_DRQ) {  in pcd_completion()
444 			d = read_reg(cd, 4) + 256 * read_reg(cd, 5);  in pcd_completion()
446 			p = read_reg(cd, 2) & 3;  in pcd_completion()
449 				pi_read_block(cd->pi, buf, n);  in pcd_completion()
452 					       cd->name, fun, n);  in pcd_completion()
459 					     cd->name, fun, p, d, k);  in pcd_completion()
463 					    cd->name);  in pcd_completion()
467 				printk("%s: Stuck DRQ\n", cd->name);  in pcd_completion()
471 			    (cd, IDE_BUSY, IDE_DRQ | IDE_READY | IDE_ERR, fun,  in pcd_completion()
479 	pi_disconnect(cd->pi);  in pcd_completion()
484 static void pcd_req_sense(struct pcd_unit *cd, char *fun)  in pcd_req_sense()  argument
490 	r = pcd_command(cd, rs_cmd, 16, "Request sense");  in pcd_req_sense()
493 		pcd_completion(cd, buf, "Request sense");  in pcd_req_sense()
495 	cd->last_sense = -1;  in pcd_req_sense()
500 			       cd->name, fun, buf[2] & 0xf, buf[12], buf[13]);  in pcd_req_sense()
502 		cd->last_sense =  in pcd_req_sense()
506 		cd->changed = 1;  in pcd_req_sense()
509 static int pcd_atapi(struct pcd_unit *cd, char *cmd, int dlen, char *buf, char *fun)  in pcd_atapi()  argument
513 	r = pcd_command(cd, cmd, dlen, fun);  in pcd_atapi()
516 		r = pcd_completion(cd, buf, fun);  in pcd_atapi()
518 		pcd_req_sense(cd, fun);  in pcd_atapi()
534 	struct pcd_unit *cd = cdi->handle;  in pcd_check_events()  local
535 	int res = cd->changed;  in pcd_check_events()
537 		cd->changed = 0;  in pcd_check_events()
562 static int pcd_reset(struct pcd_unit *cd)  in pcd_reset()  argument
567 	pi_connect(cd->pi);  in pcd_reset()
568 	write_reg(cd, 6, 0xa0 + 0x10 * cd->drive);  in pcd_reset()
569 	write_reg(cd, 7, 8);  in pcd_reset()
574 	while ((k++ < PCD_RESET_TMO) && (status_reg(cd) & IDE_BUSY))  in pcd_reset()
579 		flg &= (read_reg(cd, i + 1) == expect[i]);  in pcd_reset()
582 		printk("%s: Reset (%d) signature = ", cd->name, k);  in pcd_reset()
584 			printk("%3x", read_reg(cd, i + 1));  in pcd_reset()
590 	pi_disconnect(cd->pi);  in pcd_reset()
599 static int pcd_ready_wait(struct pcd_unit *cd, int tmo)  in pcd_ready_wait()  argument
606 		cd->last_sense = 0;  in pcd_ready_wait()
607 		pcd_atapi(cd, tr_cmd, 0, NULL, DBMSG("test unit ready"));  in pcd_ready_wait()
608 		p = cd->last_sense;  in pcd_ready_wait()
622 	struct pcd_unit *cd = cdi->handle;  in pcd_drive_status()  local
624 	if (pcd_ready_wait(cd, PCD_READY_TMO))  in pcd_drive_status()
626 	if (pcd_atapi(cd, rc_cmd, 8, pcd_scratch, DBMSG("check media")))  in pcd_drive_status()
631 static int pcd_identify(struct pcd_unit *cd, char *id)  in pcd_identify()  argument
638 	s = pcd_atapi(cd, id_cmd, 36, pcd_buffer, "identify");  in pcd_identify()
645 			       cd->name, cd->drive ? "Slave" : "Master");  in pcd_identify()
656 	printk("%s: %s: %s\n", cd->name, cd->drive ? "Slave" : "Master", id);  in pcd_identify()
665 static int pcd_probe(struct pcd_unit *cd, int ms, char *id)  in pcd_probe()  argument
668 		for (cd->drive = 0; cd->drive <= 1; cd->drive++)  in pcd_probe()
669 			if (!pcd_reset(cd) && !pcd_identify(cd, id))  in pcd_probe()
672 		cd->drive = ms;  in pcd_probe()
673 		if (!pcd_reset(cd) && !pcd_identify(cd, id))  in pcd_probe()
684 	struct pcd_unit *cd;  in pcd_probe_capabilities()  local
686 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_probe_capabilities()
687 		if (!cd->present)  in pcd_probe_capabilities()
689 		r = pcd_atapi(cd, cmd, 18, buffer, "mode sense capabilities");  in pcd_probe_capabilities()
694 			cd->info.mask |= CDC_CD_R;  in pcd_probe_capabilities()
696 			cd->info.mask |= CDC_CD_RW;  in pcd_probe_capabilities()
698 			cd->info.mask |= CDC_PLAY_AUDIO;  in pcd_probe_capabilities()
700 			cd->info.mask |= CDC_LOCK;  in pcd_probe_capabilities()
702 			cd->info.mask |= CDC_OPEN_TRAY;  in pcd_probe_capabilities()
704 			cd->info.mask |= CDC_CLOSE_TRAY;  in pcd_probe_capabilities()
712 	struct pcd_unit *cd;  in pcd_detect()  local
725 		cd = pcd;  in pcd_detect()
726 		if (cd->disk && pi_init(cd->pi, 1, -1, -1, -1, -1, -1,  in pcd_detect()
727 			    pcd_buffer, PI_PCD, verbose, cd->name)) {  in pcd_detect()
728 			if (!pcd_probe(cd, -1, id)) {  in pcd_detect()
729 				cd->present = 1;  in pcd_detect()
732 				pi_release(cd->pi);  in pcd_detect()
735 		for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_detect()
739 			if (!cd->disk)  in pcd_detect()
741 			if (!pi_init(cd->pi, 0, conf[D_PRT], conf[D_MOD],  in pcd_detect()
743 				     pcd_buffer, PI_PCD, verbose, cd->name))   in pcd_detect()
745 			if (!pcd_probe(cd, conf[D_SLV], id)) {  in pcd_detect()
746 				cd->present = 1;  in pcd_detect()
749 				pi_release(cd->pi);  in pcd_detect()
756 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_detect()
757 		if (!cd->disk)  in pcd_detect()
759 		blk_cleanup_queue(cd->disk->queue);  in pcd_detect()
760 		cd->disk->queue = NULL;  in pcd_detect()
761 		blk_mq_free_tag_set(&cd->tag_set);  in pcd_detect()
762 		put_disk(cd->disk);  in pcd_detect()
773 	struct pcd_unit *cd;  in set_next_request()  local
777 		cd = &pcd[pcd_queue];  in set_next_request()
780 		if (cd->present && !list_empty(&cd->rq_list)) {  in set_next_request()
781 			pcd_req = list_first_entry(&cd->rq_list, struct request,  in set_next_request()
794 	struct pcd_unit *cd;  in pcd_request()  local
802 	cd = pcd_req->rq_disk->private_data;  in pcd_request()
803 	if (cd != pcd_current)  in pcd_request()
805 	pcd_current = cd;  in pcd_request()
816 	struct pcd_unit *cd = hctx->queue->queuedata;  in pcd_queue_rq()  local
824 	list_add_tail(&bd->rq->queuelist, &cd->rq_list);  in pcd_queue_rq()
924 	struct pcd_unit *cd = cdi->handle;  in pcd_audio_ioctl()  local
939 			r = pcd_atapi(cd, cmd, 12, buffer, "read toc header");  in pcd_audio_ioctl()
963 			r = pcd_atapi(cd, cmd, 12, buffer, "read toc entry");  in pcd_audio_ioctl()
1004 	struct pcd_unit *cd;  in pcd_init()  local
1019 		for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_init()
1020 			if (!cd->disk)  in pcd_init()
1023 			blk_cleanup_queue(cd->disk->queue);  in pcd_init()
1024 			blk_mq_free_tag_set(&cd->tag_set);  in pcd_init()
1025 			put_disk(cd->disk);  in pcd_init()
1030 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_init()
1031 		if (cd->present) {  in pcd_init()
1032 			register_cdrom(&cd->info);  in pcd_init()
1033 			cd->disk->private_data = cd;  in pcd_init()
1034 			add_disk(cd->disk);  in pcd_init()
1043 	struct pcd_unit *cd;  in pcd_exit()  local
1046 	for (unit = 0, cd = pcd; unit < PCD_UNITS; unit++, cd++) {  in pcd_exit()
1047 		if (!cd->disk)  in pcd_exit()
1050 		if (cd->present) {  in pcd_exit()
1051 			del_gendisk(cd->disk);  in pcd_exit()
1052 			pi_release(cd->pi);  in pcd_exit()
1053 			unregister_cdrom(&cd->info);  in pcd_exit()
1055 		blk_cleanup_queue(cd->disk->queue);  in pcd_exit()
1056 		blk_mq_free_tag_set(&cd->tag_set);  in pcd_exit()
1057 		put_disk(cd->disk);  in pcd_exit()