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