freebsd-dev/share/examples/scsi_target/scsi_target.c

335 lines
7.7 KiB
C
Raw Normal View History

/*
* Sample program to attach to the "targ" processor target, target mode
* peripheral driver and push or receive data.
*
* Copyright (c) 1998 Justin T. Gibbs.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions, and the following disclaimer,
* without modification, immediately at the beginning of the file.
* 2. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $Id: scsi_target.c,v 1.2 1998/12/10 04:00:03 gibbs Exp $
*/
#include <sys/types.h>
#include <errno.h>
#include <fcntl.h>
#include <poll.h>
#include <signal.h>
#include <stddef.h>
#include <stdio.h>
#include <stdlib.h>
#include <sysexits.h>
#include <unistd.h>
#include <cam/scsi/scsi_all.h>
#include <cam/scsi/scsi_message.h>
#include <cam/scsi/scsi_targetio.h>
char *appname;
int ifd;
char *ifilename;
int ofd;
char *ofilename;
size_t bufsize = 64 * 1024;
void *buf;
char targdevname[80];
int targctlfd;
int targfd;
int quit;
struct ioc_alloc_unit alloc_unit = {
CAM_BUS_WILDCARD,
CAM_TARGET_WILDCARD,
CAM_LUN_WILDCARD
};
static void pump_events();
static void handle_exception();
static void quit_handler();
static void usage();
int
main(int argc, char *argv[])
{
int ch;
appname = *argv;
while ((ch = getopt(argc, argv, "i:o:p:t:l:")) != -1) {
switch(ch) {
case 'i':
if ((ifd = open(optarg, O_RDONLY)) == -1) {
perror(optarg);
exit(EX_NOINPUT);
}
ifilename = optarg;
break;
case 'o':
if ((ofd = open(optarg,
O_WRONLY|O_CREAT), 0600) == -1) {
perror(optarg);
exit(EX_CANTCREAT);
}
ofilename = optarg;
break;
case 'p':
alloc_unit.path_id = atoi(optarg);
break;
case 't':
alloc_unit.target_id = atoi(optarg);
break;
case 'l':
alloc_unit.lun_id = atoi(optarg);
break;
case '?':
default:
usage();
/* NOTREACHED */
}
}
argc -= optind;
argv += optind;
if (alloc_unit.path_id == CAM_BUS_WILDCARD
|| alloc_unit.target_id == CAM_TARGET_WILDCARD
|| alloc_unit.lun_id == CAM_LUN_WILDCARD) {
fprintf(stderr, "%s: Incomplete device path specifiled\n",
appname);
usage();
/* NOTREACHED */
}
if (argc != 0) {
fprintf(stderr, "%s: Too many arguments\n", appname);
usage();
/* NOTREACHED */
}
/* Allocate a new instance */
if ((targctlfd = open("/dev/targ.ctl", O_RDWR)) == -1) {
perror("/dev/targ.ctl");
exit(EX_UNAVAILABLE);
}
if (ioctl(targctlfd, TARGCTLIOALLOCUNIT, &alloc_unit) == -1) {
perror("TARGCTLIOALLOCUNIT");
exit(EX_SOFTWARE);
}
snprintf(targdevname, sizeof(targdevname), "/dev/targ%d",
alloc_unit.unit);
if ((targfd = open(targdevname, O_RDWR)) == -1) {
perror(targdevname);
ioctl(targctlfd, TARGCTLIOFREEUNIT, &alloc_unit);
exit(EX_NOINPUT);
}
buf = malloc(bufsize);
if (buf == NULL) {
fprintf(stderr, "%s: Could not malloc I/O buffer", appname);
exit(EX_OSERR);
}
signal(SIGHUP, quit_handler);
signal(SIGINT, quit_handler);
signal(SIGTERM, quit_handler);
pump_events();
close(targfd);
if (ioctl(targctlfd, TARGCTLIOFREEUNIT, &alloc_unit) == -1) {
perror("TARGCTLIOFREEUNIT");
exit(EX_SOFTWARE);
}
close(targctlfd);
return (0);
}
static void
pump_events()
{
struct pollfd targpoll;
targpoll.fd = targfd;
targpoll.events = POLLRDNORM|POLLWRNORM;
while (quit == 0) {
int retval;
retval = poll(&targpoll, 1, INFTIM);
if (retval == -1) {
if (errno == EINTR)
continue;
perror("Poll Failed");
exit(EX_SOFTWARE);
}
if (retval == 0) {
perror("Poll returned 0 although timeout infinite???");
exit(EX_SOFTWARE);
}
if (retval > 1) {
perror("Poll returned more fds ready than allocated");
exit(EX_SOFTWARE);
}
/* Process events */
if ((targpoll.revents & POLLERR) != 0) {
handle_exception();
}
if ((targpoll.revents & POLLRDNORM) != 0) {
retval = read(targfd, buf, bufsize);
if (retval == -1) {
perror("Read from targ failed");
} else {
retval = write(ofd, buf, retval);
if (retval == -1) {
perror("Write to file failed");
}
}
}
if ((targpoll.revents & POLLWRNORM) != 0) {
int amount_read;
retval = read(ifd, buf, bufsize);
if (retval == -1) {
perror("Read from file failed");
exit(EX_SOFTWARE);
}
amount_read = retval;
retval = write(targfd, buf, retval);
if (retval == -1) {
perror("Write to targ failed");
retval = 0;
}
/* Backup in our input stream on short writes */
if (retval != amount_read)
lseek(ifd, retval - amount_read, SEEK_CUR);
}
}
}
static void
handle_exception()
{
targ_exception exceptions;
if (ioctl(targfd, TARGIOCFETCHEXCEPTION, &exceptions) == -1) {
perror("TARGIOCFETCHEXCEPTION");
exit(EX_SOFTWARE);
}
if ((exceptions & TARG_EXCEPT_DEVICE_INVALID) != 0) {
/* Device went away. Nothing more to do. */
exit(0);
}
if ((exceptions & TARG_EXCEPT_UNKNOWN_ATIO) != 0) {
struct ccb_accept_tio atio;
struct ioc_initiator_state ioc_istate;
struct scsi_sense_data *sense;
union ccb ccb;
if (ioctl(targfd, TARGIOCFETCHATIO, &atio) == -1) {
perror("TARGIOCFETCHATIO");
exit(EX_SOFTWARE);
}
printf("Ignoring unhandled command 0x%x for Id %d\n",
atio.cdb_io.cdb_bytes[0], atio.init_id);
ioc_istate.initiator_id = atio.init_id;
if (ioctl(targfd, TARGIOCGETISTATE, &ioc_istate) == -1) {
perror("TARGIOCGETISTATE");
exit(EX_SOFTWARE);
}
/* Send back Illegal Command code status */
ioc_istate.istate.pending_ca |= CA_CMD_SENSE;
sense = &ioc_istate.istate.sense_data;
bzero(sense, sizeof(*sense));
sense->error_code = SSD_CURRENT_ERROR;
sense->flags = SSD_KEY_ILLEGAL_REQUEST;
sense->add_sense_code = 0x20;
sense->add_sense_code_qual = 0x00;
sense->extra_len = offsetof(struct scsi_sense_data, fru)
- offsetof(struct scsi_sense_data, extra_len);
if (ioctl(targfd, TARGIOCSETISTATE, &ioc_istate) == -1) {
perror("TARGIOCSETISTATE");
exit(EX_SOFTWARE);
}
bzero(&ccb, sizeof(ccb));
cam_fill_ctio(&ccb.csio, /*retries*/2,
/*cbfcnp*/NULL,
/*flags*/CAM_DIR_NONE
| (atio.ccb_h.flags & CAM_TAG_ACTION_VALID)
| CAM_SEND_STATUS,
/*tag_action*/MSG_SIMPLE_Q_TAG,
atio.tag_id,
atio.init_id,
SCSI_STATUS_CHECK_COND,
/*data_ptr*/NULL,
/*dxfer_len*/0,
/*timeout*/5 * 1000);
if (ioctl(targfd, TARGIOCCOMMAND, &ccb) == -1) {
perror("TARGIOCCOMMAND");
exit(EX_SOFTWARE);
}
}
if (ioctl(targfd, TARGIOCCLEAREXCEPTION, &exceptions) == -1) {
perror("TARGIOCCLEAREXCEPTION");
exit(EX_SOFTWARE);
}
}
static void
quit_handler(int signum)
{
quit = 1;
}
static void
usage()
{
(void)fprintf(stderr,
"usage: %-16s [-o output_file] [-i input_file] -p path -t target -l lun\n",
appname);
exit(EX_USAGE);
}