xref: /freebsd/share/examples/scsi_target/scsi_target.c (revision 9875eecf53ffca0e1d76dda3a16714ae347277b0)
19875eecfSJustin T. Gibbs /*
29875eecfSJustin T. Gibbs  * Sample program to attach to the "targ" processor target, target mode
39875eecfSJustin T. Gibbs  * peripheral driver and push or receive data.
49875eecfSJustin T. Gibbs  *
59875eecfSJustin T. Gibbs  * Copyright (c) 1998 Justin T. Gibbs.
69875eecfSJustin T. Gibbs  * All rights reserved.
79875eecfSJustin T. Gibbs  *
89875eecfSJustin T. Gibbs  * Redistribution and use in source and binary forms, with or without
99875eecfSJustin T. Gibbs  * modification, are permitted provided that the following conditions
109875eecfSJustin T. Gibbs  * are met:
119875eecfSJustin T. Gibbs  * 1. Redistributions of source code must retain the above copyright
129875eecfSJustin T. Gibbs  *    notice, this list of conditions, and the following disclaimer,
139875eecfSJustin T. Gibbs  *    without modification, immediately at the beginning of the file.
149875eecfSJustin T. Gibbs  * 2. The name of the author may not be used to endorse or promote products
159875eecfSJustin T. Gibbs  *    derived from this software without specific prior written permission.
169875eecfSJustin T. Gibbs  *
179875eecfSJustin T. Gibbs  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
189875eecfSJustin T. Gibbs  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
199875eecfSJustin T. Gibbs  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
209875eecfSJustin T. Gibbs  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
219875eecfSJustin T. Gibbs  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
229875eecfSJustin T. Gibbs  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
239875eecfSJustin T. Gibbs  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
249875eecfSJustin T. Gibbs  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
259875eecfSJustin T. Gibbs  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
269875eecfSJustin T. Gibbs  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
279875eecfSJustin T. Gibbs  * SUCH DAMAGE.
289875eecfSJustin T. Gibbs  *
299875eecfSJustin T. Gibbs  *      $Id$
309875eecfSJustin T. Gibbs  */
319875eecfSJustin T. Gibbs 
329875eecfSJustin T. Gibbs #include <sys/types.h>
339875eecfSJustin T. Gibbs 
349875eecfSJustin T. Gibbs #include <fcntl.h>
359875eecfSJustin T. Gibbs #include <poll.h>
369875eecfSJustin T. Gibbs #include <stddef.h>
379875eecfSJustin T. Gibbs #include <stdio.h>
389875eecfSJustin T. Gibbs #include <stdlib.h>
399875eecfSJustin T. Gibbs #include <sysexits.h>
409875eecfSJustin T. Gibbs #include <unistd.h>
419875eecfSJustin T. Gibbs 
429875eecfSJustin T. Gibbs #include <cam/scsi/scsi_all.h>
439875eecfSJustin T. Gibbs #include <cam/scsi/scsi_message.h>
449875eecfSJustin T. Gibbs #include <cam/scsi/scsi_targetio.h>
459875eecfSJustin T. Gibbs 
469875eecfSJustin T. Gibbs char  *appname;
479875eecfSJustin T. Gibbs int    ifd;
489875eecfSJustin T. Gibbs char  *ifilename;
499875eecfSJustin T. Gibbs int    ofd;
509875eecfSJustin T. Gibbs char  *ofilename;
519875eecfSJustin T. Gibbs size_t bufsize = 64 * 1024;
529875eecfSJustin T. Gibbs void  *buf;
539875eecfSJustin T. Gibbs char  *targdevname;
549875eecfSJustin T. Gibbs int    targfd;
559875eecfSJustin T. Gibbs 
569875eecfSJustin T. Gibbs static void pump_events();
579875eecfSJustin T. Gibbs static void handle_exception();
589875eecfSJustin T. Gibbs static void usage();
599875eecfSJustin T. Gibbs 
609875eecfSJustin T. Gibbs int
619875eecfSJustin T. Gibbs main(int argc, char *argv[])
629875eecfSJustin T. Gibbs {
639875eecfSJustin T. Gibbs 	int  ch;
649875eecfSJustin T. Gibbs 
659875eecfSJustin T. Gibbs 	appname = *argv;
669875eecfSJustin T. Gibbs 	while ((ch = getopt(argc, argv, "i:o:")) != -1) {
679875eecfSJustin T. Gibbs 		switch(ch) {
689875eecfSJustin T. Gibbs 		case 'i':
699875eecfSJustin T. Gibbs 			if ((ifd = open(optarg, O_RDONLY)) == -1) {
709875eecfSJustin T. Gibbs 				perror(optarg);
719875eecfSJustin T. Gibbs 				exit(EX_NOINPUT);
729875eecfSJustin T. Gibbs 			}
739875eecfSJustin T. Gibbs 			ifilename = optarg;
749875eecfSJustin T. Gibbs 			break;
759875eecfSJustin T. Gibbs 		case 'o':
769875eecfSJustin T. Gibbs 			if ((ofd = open(optarg,
779875eecfSJustin T. Gibbs 					O_WRONLY|O_CREAT), 0600) == -1) {
789875eecfSJustin T. Gibbs 				perror(optarg);
799875eecfSJustin T. Gibbs 				exit(EX_CANTCREAT);
809875eecfSJustin T. Gibbs 			}
819875eecfSJustin T. Gibbs 			ofilename = optarg;
829875eecfSJustin T. Gibbs 			break;
839875eecfSJustin T. Gibbs 		case '?':
849875eecfSJustin T. Gibbs 		default:
859875eecfSJustin T. Gibbs 			usage();
869875eecfSJustin T. Gibbs 			/* NOTREACHED */
879875eecfSJustin T. Gibbs 		}
889875eecfSJustin T. Gibbs 	}
899875eecfSJustin T. Gibbs 	argc -= optind;
909875eecfSJustin T. Gibbs 	argv += optind;
919875eecfSJustin T. Gibbs 
929875eecfSJustin T. Gibbs 	if (argc != 1) {
939875eecfSJustin T. Gibbs 		fprintf(stderr, "%s: No target device specifiled\n", appname);
949875eecfSJustin T. Gibbs 		usage();
959875eecfSJustin T. Gibbs 		/* NOTREACHED */
969875eecfSJustin T. Gibbs 	}
979875eecfSJustin T. Gibbs 
989875eecfSJustin T. Gibbs 	targdevname = *argv;
999875eecfSJustin T. Gibbs 	if ((targfd = open(targdevname, O_RDWR)) == -1) {
1009875eecfSJustin T. Gibbs 		perror(targdevname);
1019875eecfSJustin T. Gibbs 		exit(EX_NOINPUT);
1029875eecfSJustin T. Gibbs 	}
1039875eecfSJustin T. Gibbs 
1049875eecfSJustin T. Gibbs 	buf = malloc(bufsize);
1059875eecfSJustin T. Gibbs 
1069875eecfSJustin T. Gibbs 	if (buf == NULL) {
1079875eecfSJustin T. Gibbs 		fprintf(stderr, "%s: Could not malloc I/O buffer", appname);
1089875eecfSJustin T. Gibbs 		exit(EX_OSERR);
1099875eecfSJustin T. Gibbs 	}
1109875eecfSJustin T. Gibbs 
1119875eecfSJustin T. Gibbs 	pump_events();
1129875eecfSJustin T. Gibbs 
1139875eecfSJustin T. Gibbs 	return (0);
1149875eecfSJustin T. Gibbs }
1159875eecfSJustin T. Gibbs 
1169875eecfSJustin T. Gibbs static void
1179875eecfSJustin T. Gibbs pump_events()
1189875eecfSJustin T. Gibbs {
1199875eecfSJustin T. Gibbs 	struct pollfd targpoll;
1209875eecfSJustin T. Gibbs 
1219875eecfSJustin T. Gibbs 	targpoll.fd = targfd;
1229875eecfSJustin T. Gibbs 	targpoll.events = POLLRDNORM|POLLWRNORM;
1239875eecfSJustin T. Gibbs 
1249875eecfSJustin T. Gibbs 	while (1) {
1259875eecfSJustin T. Gibbs 		int retval;
1269875eecfSJustin T. Gibbs 
1279875eecfSJustin T. Gibbs 		retval = poll(&targpoll, 1, INFTIM);
1289875eecfSJustin T. Gibbs 
1299875eecfSJustin T. Gibbs 		if (retval == -1) {
1309875eecfSJustin T. Gibbs 			perror("Poll Failed");
1319875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
1329875eecfSJustin T. Gibbs 		}
1339875eecfSJustin T. Gibbs 
1349875eecfSJustin T. Gibbs 		if (retval == 0) {
1359875eecfSJustin T. Gibbs 			perror("Poll returned 0 although timeout infinite???");
1369875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
1379875eecfSJustin T. Gibbs 		}
1389875eecfSJustin T. Gibbs 
1399875eecfSJustin T. Gibbs 		if (retval > 1) {
1409875eecfSJustin T. Gibbs 			perror("Poll returned more fds ready than allocated");
1419875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
1429875eecfSJustin T. Gibbs 		}
1439875eecfSJustin T. Gibbs 
1449875eecfSJustin T. Gibbs 		/* Process events */
1459875eecfSJustin T. Gibbs 		if ((targpoll.revents & POLLERR) != 0) {
1469875eecfSJustin T. Gibbs 			handle_exception();
1479875eecfSJustin T. Gibbs 		}
1489875eecfSJustin T. Gibbs 
1499875eecfSJustin T. Gibbs 		if ((targpoll.revents & POLLRDNORM) != 0) {
1509875eecfSJustin T. Gibbs 			printf("Read Poll event came true\n");
1519875eecfSJustin T. Gibbs 			retval = read(targfd, buf, bufsize);
1529875eecfSJustin T. Gibbs 
1539875eecfSJustin T. Gibbs 			if (retval == -1) {
1549875eecfSJustin T. Gibbs 				perror("Read from targ failed");
1559875eecfSJustin T. Gibbs 			} else {
1569875eecfSJustin T. Gibbs 				retval = write(ofd, buf, retval);
1579875eecfSJustin T. Gibbs 				if (retval == -1) {
1589875eecfSJustin T. Gibbs 					perror("Write to file failed");
1599875eecfSJustin T. Gibbs 				}
1609875eecfSJustin T. Gibbs 			}
1619875eecfSJustin T. Gibbs 		}
1629875eecfSJustin T. Gibbs 
1639875eecfSJustin T. Gibbs 		if ((targpoll.revents & POLLWRNORM) != 0) {
1649875eecfSJustin T. Gibbs 			int amount_read;
1659875eecfSJustin T. Gibbs 
1669875eecfSJustin T. Gibbs 			printf("Write Poll event came true\n");
1679875eecfSJustin T. Gibbs 			retval = read(ifd, buf, bufsize);
1689875eecfSJustin T. Gibbs 			if (retval == -1) {
1699875eecfSJustin T. Gibbs 				perror("Read from file failed");
1709875eecfSJustin T. Gibbs 				exit(EX_SOFTWARE);
1719875eecfSJustin T. Gibbs 			}
1729875eecfSJustin T. Gibbs 
1739875eecfSJustin T. Gibbs 			amount_read = retval;
1749875eecfSJustin T. Gibbs 			retval = write(targfd, buf, retval);
1759875eecfSJustin T. Gibbs 			if (retval == -1) {
1769875eecfSJustin T. Gibbs 				perror("Write to targ failed");
1779875eecfSJustin T. Gibbs 				retval = 0;
1789875eecfSJustin T. Gibbs 			}
1799875eecfSJustin T. Gibbs 
1809875eecfSJustin T. Gibbs 			/* Backup in our input stream on short writes */
1819875eecfSJustin T. Gibbs 			if (retval != amount_read)
1829875eecfSJustin T. Gibbs 				lseek(ifd, retval - amount_read, SEEK_CUR);
1839875eecfSJustin T. Gibbs 		}
1849875eecfSJustin T. Gibbs 	}
1859875eecfSJustin T. Gibbs }
1869875eecfSJustin T. Gibbs 
1879875eecfSJustin T. Gibbs static void
1889875eecfSJustin T. Gibbs handle_exception()
1899875eecfSJustin T. Gibbs {
1909875eecfSJustin T. Gibbs 	targ_exception exceptions;
1919875eecfSJustin T. Gibbs 
1929875eecfSJustin T. Gibbs 	if (ioctl(targfd, TARGIOCFETCHEXCEPTION, &exceptions) == -1) {
1939875eecfSJustin T. Gibbs 		perror("TARGIOCFETCHEXCEPTION");
1949875eecfSJustin T. Gibbs 		exit(EX_SOFTWARE);
1959875eecfSJustin T. Gibbs 	}
1969875eecfSJustin T. Gibbs 
1979875eecfSJustin T. Gibbs 	if ((exceptions & TARG_EXCEPT_DEVICE_INVALID) != 0) {
1989875eecfSJustin T. Gibbs 		/* Device went away.  Nothing more to do. */
1999875eecfSJustin T. Gibbs 		exit(0);
2009875eecfSJustin T. Gibbs 	}
2019875eecfSJustin T. Gibbs 
2029875eecfSJustin T. Gibbs 	if ((exceptions & TARG_EXCEPT_UNKNOWN_ATIO) != 0) {
2039875eecfSJustin T. Gibbs 		struct ccb_accept_tio atio;
2049875eecfSJustin T. Gibbs 		struct ioc_initiator_state ioc_istate;
2059875eecfSJustin T. Gibbs 		struct scsi_sense_data *sense;
2069875eecfSJustin T. Gibbs 		union  ccb ccb;
2079875eecfSJustin T. Gibbs 
2089875eecfSJustin T. Gibbs 		if (ioctl(targfd, TARGIOCFETCHATIO, &atio) == -1) {
2099875eecfSJustin T. Gibbs 			perror("TARGIOCFETCHATIO");
2109875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
2119875eecfSJustin T. Gibbs 		}
2129875eecfSJustin T. Gibbs 
2139875eecfSJustin T. Gibbs 		printf("Ignoring unhandled command 0x%x for Id %d\n",
2149875eecfSJustin T. Gibbs 		       atio.cdb_io.cdb_bytes[0], atio.init_id);
2159875eecfSJustin T. Gibbs 
2169875eecfSJustin T. Gibbs 		ioc_istate.initiator_id = atio.init_id;
2179875eecfSJustin T. Gibbs 		if (ioctl(targfd, TARGIOCGETISTATE, &ioc_istate) == -1) {
2189875eecfSJustin T. Gibbs 			perror("TARGIOCGETISTATE");
2199875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
2209875eecfSJustin T. Gibbs 		}
2219875eecfSJustin T. Gibbs 
2229875eecfSJustin T. Gibbs 		/* Send back Illegal Command code status */
2239875eecfSJustin T. Gibbs 		ioc_istate.istate.pending_ca |= CA_CMD_SENSE;
2249875eecfSJustin T. Gibbs 		sense = &ioc_istate.istate.sense_data;
2259875eecfSJustin T. Gibbs 		bzero(sense, sizeof(*sense));
2269875eecfSJustin T. Gibbs 		sense->error_code = SSD_CURRENT_ERROR;
2279875eecfSJustin T. Gibbs 		sense->flags = SSD_KEY_ILLEGAL_REQUEST;
2289875eecfSJustin T. Gibbs 		sense->add_sense_code = 0x20;
2299875eecfSJustin T. Gibbs 		sense->add_sense_code_qual = 0x00;
2309875eecfSJustin T. Gibbs 		sense->extra_len = offsetof(struct scsi_sense_data, fru)
2319875eecfSJustin T. Gibbs 				 - offsetof(struct scsi_sense_data, extra_len);
2329875eecfSJustin T. Gibbs 
2339875eecfSJustin T. Gibbs 		if (ioctl(targfd, TARGIOCSETISTATE, &ioc_istate) == -1) {
2349875eecfSJustin T. Gibbs 			perror("TARGIOCSETISTATE");
2359875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
2369875eecfSJustin T. Gibbs 		}
2379875eecfSJustin T. Gibbs 
2389875eecfSJustin T. Gibbs 		bzero(&ccb, sizeof(ccb));
2399875eecfSJustin T. Gibbs 		cam_fill_ctio(&ccb.csio, /*retries*/2,
2409875eecfSJustin T. Gibbs 			      /*cbfcnp*/NULL,
2419875eecfSJustin T. Gibbs 			      /*flags*/CAM_DIR_NONE
2429875eecfSJustin T. Gibbs 			     | (atio.ccb_h.flags & CAM_TAG_ACTION_VALID)
2439875eecfSJustin T. Gibbs 			     | CAM_SEND_STATUS,
2449875eecfSJustin T. Gibbs                               /*tag_action*/MSG_SIMPLE_Q_TAG,
2459875eecfSJustin T. Gibbs 			      atio.tag_id,
2469875eecfSJustin T. Gibbs 			      atio.init_id,
2479875eecfSJustin T. Gibbs 			      SCSI_STATUS_CHECK_COND,
2489875eecfSJustin T. Gibbs 			      /*data_ptr*/NULL,
2499875eecfSJustin T. Gibbs 			      /*dxfer_len*/0,
2509875eecfSJustin T. Gibbs 			      /*timeout*/5 * 1000);
2519875eecfSJustin T. Gibbs 		if (ioctl(targfd, TARGIOCCOMMAND, &ccb) == -1) {
2529875eecfSJustin T. Gibbs 			perror("TARGIOCCOMMAND");
2539875eecfSJustin T. Gibbs 			exit(EX_SOFTWARE);
2549875eecfSJustin T. Gibbs 		}
2559875eecfSJustin T. Gibbs 
2569875eecfSJustin T. Gibbs 	}
2579875eecfSJustin T. Gibbs 
2589875eecfSJustin T. Gibbs 	if (ioctl(targfd, TARGIOCCLEAREXCEPTION, &exceptions) == -1) {
2599875eecfSJustin T. Gibbs 		perror("TARGIOCCLEAREXCEPTION");
2609875eecfSJustin T. Gibbs 		exit(EX_SOFTWARE);
2619875eecfSJustin T. Gibbs 	}
2629875eecfSJustin T. Gibbs }
2639875eecfSJustin T. Gibbs 
2649875eecfSJustin T. Gibbs static void
2659875eecfSJustin T. Gibbs usage()
2669875eecfSJustin T. Gibbs {
2679875eecfSJustin T. Gibbs 
2689875eecfSJustin T. Gibbs 	(void)fprintf(stderr,
2699875eecfSJustin T. Gibbs "usage: %-16s [-o output_file] [-i input_file] /dev/targ?\n", appname);
2709875eecfSJustin T. Gibbs 
2719875eecfSJustin T. Gibbs 	exit(EX_USAGE);
2729875eecfSJustin T. Gibbs }
2739875eecfSJustin T. Gibbs 
274