move scsi/scsi_io.c to utils/scsi/scsi_io.c

(This used to be ctdb commit 157e5a0e96af133d28a36847c82efd23fb2354e3)

1 files changed, 1155 insertions, 0 deletions

diff --git a/ctdb/utils/scsi_io/scsi_io.c b/ctdb/utils/scsi_io/scsi_io.c
new file mode 100644
index 00000000000..a177d726dc7
--- /dev/null
+++ b/ctdb/utils/scsi_io/scsi_io.c
@@ -0,0 +1,1155 @@
+/* a tool to open a scsi device and issue some useful commands
+   such as INQUIRY and helpers to call various PERSISTENT RESERVATION
+   functions
+
+   Copyright   ronnie sahlberg 2007
+
+   This program is free software; you can redistribute it and/or modify
+   it under the terms of the GNU General Public License as published by
+   the Free Software Foundation; either version 3 of the License, or
+   (at your option) any later version.
+   
+   This program is distributed in the hope that it will be useful,
+   but WITHOUT ANY WARRANTY; without even the implied warranty of
+   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+   GNU General Public License for more details.
+   
+   You should have received a copy of the GNU General Public License
+   along with this program; if not, see <http://www.gnu.org/licenses/>.
+*/
+
+/* very incomplete and needs to be enhanced with noice command line options
+   to drive it.
+   we need access to an array that supports the PERSISTENT RESERVATION cdb's
+   before we can proceed
+*/
+/* scsi bugs:
+   INQUIRY takes a 2 byte allocation_length parameter but it appears that 
+   it only looks at the low byte. If you specify 0x00ff all is well
+   but if you specify 0x0100   it gets confused and returnes garbage data
+   for (e.g) SupportedVPDPages. Same goes for UnitSerialNumber and probably all
+   other inq pages as well.
+
+*/
+
+#include <unistd.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <string.h>
+#include <errno.h>
+#include <sys/ioctl.h>
+#include <scsi/sg.h>
+#include "popt.h"
+
+
+#define SCSI_TIMEOUT 5000 /* ms */
+
+static char *command = NULL;
+static char *device  = NULL;
+static char *key     = NULL;
+static char *rmkey     = NULL;
+static int scope = -1;
+static int type  = -1;
+
+const char *sensetable[16]={
+	"no sense",
+	"recovered error",
+	"not ready",
+	"medium error",
+	"hardware error",
+	"illegal request",
+	"unit attention",
+	"data protect",
+	"blank check",
+	"vendor specific",
+	"copy aborted",
+	"aboreted command",
+	"unknown",
+	"unknown",
+	"unknown",
+	"unknown"
+};
+
+int scsi_io(int fd, unsigned char *cdb, unsigned char cdb_size, int xfer_dir, unsigned char *data, unsigned int *data_size, unsigned char *sense, unsigned int *sense_len)
+{
+	sg_io_hdr_t io_hdr;
+
+	memset(&io_hdr, 0, sizeof(sg_io_hdr_t));
+	io_hdr.interface_id = 'S';
+
+	/* CDB */
+	io_hdr.cmdp = cdb;
+	io_hdr.cmd_len = cdb_size;
+
+	/* Where to store the sense_data, if there was an error */
+	io_hdr.sbp = sense;
+	io_hdr.mx_sb_len = *sense_len;
+	*sense_len=0;
+
+	/* Transfer direction, either in or out. Linux does not yet
+	   support bidirectional SCSI transfers ?
+	 */
+	io_hdr.dxfer_direction = xfer_dir;
+
+	/* Where to store the DATA IN/OUT from the device and how big the
+	   buffer is
+	 */
+	io_hdr.dxferp = data;
+	io_hdr.dxfer_len = *data_size;
+
+	/* SCSI timeout in ms */
+	io_hdr.timeout = SCSI_TIMEOUT;
+
+
+	if(ioctl(fd, SG_IO, &io_hdr) < 0){
+		perror("SG_IO ioctl failed");
+		return -1;
+	}
+
+	/* now for the error processing */
+	if((io_hdr.info & SG_INFO_OK_MASK) != SG_INFO_OK){
+		if(io_hdr.sb_len_wr > 0){
+			*sense_len=io_hdr.sb_len_wr;
+			return 0;
+		}
+	}
+	if(io_hdr.masked_status){
+		printf("status=0x%x\n", io_hdr.status);
+		printf("masked_status=0x%x\n", io_hdr.masked_status);
+		return -2;
+	}
+	if(io_hdr.host_status){
+		printf("host_status=0x%x\n", io_hdr.host_status);
+		return -3;
+	}
+	if(io_hdr.driver_status){
+		printf("driver_status=0x%x\n", io_hdr.driver_status);
+		return -4;
+	}
+
+#if 0
+{int i;
+printf("CDB:\n");
+for(i=0;i<cdb_size;i++){printf("0x%02x ",cdb[i]);if((i%8)==7)printf("\n");}
+printf("\n");
+}
+{int i;
+printf("DATA:\n");
+for(i=0;i<96;i++){printf("0x%02x ",data[i]);if((i%8)==7)printf("\n");}
+printf("\n");
+}
+#endif
+
+	return 0;
+}
+
+typedef struct _value_string_t {
+	int	value;
+	const char	*string;
+} value_string_t;
+
+
+
+value_string_t peripheral_device_types[] = {
+	{0, "SBC : Direct Access Block device"},
+	{1, "SSC : Sequential Access Device"},
+	{5, "MMC : Multimedia Device"},
+	{17,"OSD : Object Based Storage"},
+	{0,NULL}
+};
+
+value_string_t scsi_versions[] = {
+	{0, "No conformance to any standard claimed"},
+	{3, "SPC"},
+	{4, "SPC-2"},
+	{5, "SPC-3"},
+	{0,NULL}
+};
+
+value_string_t vpd_pages[] = {
+	{0x00, "Supported VPD Pages"},
+	{0x80, "Unit Serial number"},
+	{0x83, "Device Identification"},
+	{0,NULL}
+};
+
+const char *val_to_str(value_string_t *vs, int v)
+{
+	while(vs && vs->string){
+		if(vs->value==v){
+			return vs->string;
+		}
+		vs++;
+	}
+	return "";
+}
+
+void print_sense_data(unsigned char *sense, int sense_len)
+{
+	int i;
+	unsigned char asc, ascq;
+
+	printf("Device returned sense information\n");
+	if(sense[0]==0x70){
+		printf("filemark:%d eom:%d ili:%d  sense-key:0x%02x (%s)\n",
+			!!(sense[2]&0x80),
+			!!(sense[2]&0x40),
+			!!(sense[2]&0x20),
+			sense[2]&0x0f,
+			sensetable[sense[2]&0x0f]);
+		printf("command specific info: 0x%02x 0x%02x 0x%02x 0x%02x\n",
+			sense[8],sense[9],sense[10],sense[11]);
+
+		asc=sense[12];
+		printf("additional sense code:0x%02x\n", asc);
+
+		ascq=sense[13];
+		printf("additional sense code qualifier:0x%02x\n", ascq);
+
+		printf("field replacable unit code:0x%02x\n", sense[14]);
+
+		if((asc==0x20)&&(ascq==0x00))
+			printf("INVALID COMMAND OPERATION CODE\n");
+	}
+
+	printf("Sense data:\n");
+	for(i=0;i<sense_len;i++){
+		printf("0x%02x ", sense[i]);
+		if((i%8)==7)printf("\n");
+	}
+	printf("\n");
+}
+
+int scsi_inquiry(int fd)
+{
+	unsigned char cdb[]={0x12,0,0,0,0,0};
+
+	unsigned int data_size=96;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+
+	int res, alen, i;
+
+	cdb[3]=(data_size>>8)&0xff;
+	cdb[4]=data_size&0xff;
+
+
+	printf("Standard INQUIRY Data:\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* Peripheral Qualifier */
+	printf("Peripheral Qualifier:%c%c%cb\n",
+		'0'+!!(data[0]&0x80),
+		'0'+!!(data[0]&0x40),
+		'0'+!!(data[0]&0x20));
+
+	/* Peripheral Device Type */
+	printf("Peripheral Device Type: 0x%02x (%s)\n",
+		data[0]&0x1f,
+		val_to_str(peripheral_device_types, data[0]&0x1f));
+
+	/* RMB */
+	printf("RMB: %s device\n", data[1]&0x80?"REMOVABLE":"NON-REMOVABLE");
+
+	/* SCSI Version */
+	printf("SCSI Version: 0x%02x (%s)\n",
+		data[2],
+		val_to_str(scsi_versions, data[2]));
+
+	/* NormACA, HiSUP, Response Data Format */
+	printf("NormACA:%d HiSup:%d ResponseDataFormat:%d\n",
+		!!(data[3]&0x20),
+		!!(data[3]&0x10),
+		data[3]&0x0f);
+
+	/* Additional Length */
+	alen=data[4];
+ 
+	switch(data[3]&0x0f){
+	/*SPC-2/SPC-3/SPC-4*/
+	case 2:
+	/*SPC (not strictly correct but we print it like 2 anyway)*/
+	case 1:
+		/* SCCS ... */
+		printf("SCCS:%d ACC:%d TPGS:%c%cb 3PC:%d PROTECT:%d\n",
+			!!(data[5]&0x80),
+			!!(data[5]&0x40),
+			'0'+!!(data[5]&0x20),
+			'0'+!!(data[5]&0x10),
+			!!(data[5]&0x08),
+			!!(data[5]&0x01));
+
+		/* Encserv ... */
+		printf("Encserv:%d VS:%d MultiP:%d ADDR16:%d\n",
+			!!(data[6]&0x40),
+			!!(data[6]&0x20),
+			!!(data[6]&0x10),
+			!!(data[6]&0x01));
+
+		/* WBUS16 ... */
+		printf("WBUS16:%d SYNC:%d CmdQue:%d VS:%d\n",
+			!!(data[7]&0x20),
+			!!(data[7]&0x10),
+			!!(data[7]&0x02),
+			!!(data[7]&0x01));
+			
+
+		/* T10 vendor Identification */
+		printf("Vendor:");
+		for(i=0;i<8;i++)printf("%c",data[8+i]);printf("\n");
+ 
+		/* Product Identification */
+		printf("Product:");
+		for(i=0;i<16;i++)printf("%c",data[16+i]);printf("\n");
+
+		/* Product Revision Level */
+		printf("Product Revision:");
+		for(i=0;i<4;i++)printf("%c",data[32+i]);printf("\n");
+
+		break;
+	}
+	
+	return 0;
+}
+
+int scsi_inquiry_supported_vpd_pages(int fd)
+{
+	unsigned char cdb[]={0x12,0x01,0,0,0,0};
+
+	unsigned int data_size=0xff;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+
+	int res, pl, i;
+
+	cdb[3]=(data_size>>8)&0xff;
+	cdb[4]=data_size&0xff;
+
+
+	printf("INQUIRY Supported VPD Pages:\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* Page Length */
+	pl=data[3];
+
+	/* Pages */
+	for(i=4;i<(pl+4);i++){
+		printf("Page:%02xh (%s)\n",
+			data[i],
+			val_to_str(vpd_pages, data[i]));
+	}
+
+	return 0;
+}
+
+int scsi_inquiry_unit_serial_number(int fd)
+{
+	unsigned char cdb[]={0x12,0x01,0x80,0,0,0};
+
+	unsigned int data_size=0x00ff;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+
+	int res, pl, i;
+
+	cdb[3]=(data_size>>8)&0xff;
+	cdb[4]=data_size&0xff;
+
+
+	printf("INQUIRY Unit Serial Number:\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* Page Length */
+	pl=data[3];
+
+	/* Unit Serial Number */
+	printf("Unit Serial Number:");
+	for(i=4;i<(pl+4);i++)printf("%c",data[i]&0xff);printf("\n");
+
+	return 0;
+}
+
+int scsi_persistent_reserve_in_read_keys(int fd)
+{
+	unsigned char cdb[]={0x5e,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=0x00ff;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=0;
+	int res, i;
+	unsigned long prgeneration, additional_length;
+
+	cdb[1]=service_action;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+
+	printf("PRESISTENT RESERVE IN: READ KEYS\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* PRGeneration */
+	prgeneration=data[0];
+	prgeneration<<=8;prgeneration|=data[1];
+	prgeneration<<=8;prgeneration|=data[2];
+	prgeneration<<=8;prgeneration|=data[3];
+	printf("PRGeneration:%lu\n", prgeneration);
+
+	/* Additional Length */
+	additional_length=data[4];
+	additional_length<<=8;additional_length|=data[5];
+	additional_length<<=8;additional_length|=data[6];
+	additional_length<<=8;additional_length|=data[7];
+	printf("Additional Length:%lu\n", additional_length);
+
+	/* print the registered keys */
+	for(i=0;i<additional_length;i+=8){
+		printf("Key:%02x%02x%02x%02x%02x%02x%02x%02x\n",
+			data[i+8],
+			data[i+9],
+			data[i+10],
+			data[i+11],
+			data[i+12],
+			data[i+13],
+			data[i+14],
+			data[i+15]);
+	}
+
+	return 0;
+}
+
+int scsi_persistent_reserve_in_read_reservation(int fd)
+{
+	unsigned char cdb[]={0x5e,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=0x00ff;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=1;
+	int res;
+	unsigned long prgeneration, additional_length;
+
+	cdb[1]=service_action;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+
+	printf("PRESISTENT RESERVE IN: READ RESERVATION\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* PRGeneration */
+	prgeneration=data[0];
+	prgeneration<<=8;prgeneration|=data[1];
+	prgeneration<<=8;prgeneration|=data[2];
+	prgeneration<<=8;prgeneration|=data[3];
+	printf("PRGeneration:%lu\n", prgeneration);
+
+	/* Additional Length */
+	additional_length=data[4];
+	additional_length<<=8;additional_length|=data[5];
+	additional_length<<=8;additional_length|=data[6];
+	additional_length<<=8;additional_length|=data[7];
+	printf("Additional Length:%lu\n", additional_length);
+
+	if(additional_length==16){
+		printf("Key:%02x%02x%02x%02x%02x%02x%02x%02x\n",
+			data[8],
+			data[9],
+			data[10],
+			data[11],
+			data[12],
+			data[13],
+			data[14],
+			data[15]);
+		printf("Scope:%xh Type:%xh\n",data[21]>>4,data[21]&0x0f);
+	}
+
+	return 0;
+}
+
+int scsi_persistent_reserve_in_report_capabilities(int fd)
+{
+	unsigned char cdb[]={0x5e,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=0x00ff;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=2;
+	int res;
+	unsigned short length, type_mask;
+
+	cdb[1]=service_action;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+
+	printf("PRESISTENT RESERVE IN: REPORT CAPABILITIES\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* Length */
+	length=data[0];
+	length<<=8;length|=data[1];
+	printf("Length:%d\n", length);
+
+	/* CRH ... */
+	printf("CRH:%d SIP_C:%d ATP_C:%d PTPL_C:%d\n",
+		!!(data[2]&0x10),
+		!!(data[2]&0x08),
+		!!(data[2]&0x04),
+		!!(data[2]&0x01));
+
+	/* TMV ... */
+	printf("TMV:%d ALLOW_COMMANDS:%c%c%cb PTPL_A:%d\n",
+		!!(data[3]&0x80),
+		'0'+(!!(data[3]&0x40)),
+		'0'+(!!(data[3]&0x20)),
+		'0'+(!!(data[3]&0x10)),
+		!!(data[3]&0x01));
+
+	/* Persistent Reservation Type Mask */
+	type_mask=data[4];
+	type_mask<<=8;type_mask|=data[5];
+	printf("Presistent Reservation Type Mask:0x%04x\n", type_mask);
+	printf("WR_EX_AR:%d EX_AC_RO:%d WR_EX_RO:%d EX_AC:%d WR_EX:%d EX_AC_AR:%d\n",
+		!!(data[4]&0x80),
+		!!(data[4]&0x40),
+		!!(data[4]&0x20),
+		!!(data[4]&0x08),
+		!!(data[4]&0x02),
+		!!(data[4]&0x01));
+
+	return 0;
+}
+
+int scsi_persistent_reserve_in_read_full_status(int fd)
+{
+	unsigned char cdb[]={0x5e,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=0x00ff;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=3;
+	int res;
+	unsigned long prgeneration, additional_length;
+
+	cdb[1]=service_action;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+
+	printf("PRESISTENT RESERVE IN: READ FULL STATUS\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_FROM_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	/* PRGeneration */
+	prgeneration=data[0];
+	prgeneration<<=8;prgeneration|=data[1];
+	prgeneration<<=8;prgeneration|=data[2];
+	prgeneration<<=8;prgeneration|=data[3];
+	printf("PRGeneration:%lu\n", prgeneration);
+
+	/* Additional Length */
+	additional_length=data[4];
+	additional_length<<=8;additional_length|=data[5];
+	additional_length<<=8;additional_length|=data[6];
+	additional_length<<=8;additional_length|=data[7];
+	printf("Additional Length:%lu\n", additional_length);
+
+/*XXX*/
+
+	return 0;
+}
+
+int scsi_persistent_reserve_out_clear(int fd)
+{
+	unsigned char cdb[]={0x5f,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=24;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=3;
+	int res;
+
+	long long k;
+
+	if (scope==-1) {
+		printf("Must specify scope\n");
+		printf("scsi_io --device=<DEVICE> --command=clear --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (type==-1) {
+		printf("Must specify type\n");
+		printf("scsi_io --device=<DEVICE> --command=clear --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (!key) {
+		printf("Must specify key\n");
+		printf("scsi_io --device=<DEVICE> --command=clear --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+
+	sscanf(key, "%llx", &k);
+	cdb[1]=service_action;
+	cdb[2]=(scope<<4)|type;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+	memset(data, 0, data_size);
+
+	/* Reservation Key */
+	data[0]=(k>>56)&0xff;
+	data[1]=(k>>48)&0xff;
+	data[2]=(k>>40)&0xff;
+	data[3]=(k>>32)&0xff;
+	data[4]=(k>>24)&0xff;
+	data[5]=(k>>16)&0xff;
+	data[6]=(k>> 8)&0xff;
+	data[7]=(k    )&0xff;
+
+	/* Service Action Key */
+	data[8]=0;
+	data[9]=0;
+	data[10]=0;
+	data[11]=0;
+	data[12]=0;
+	data[13]=0;
+	data[14]=0;
+	data[15]=0;
+
+	/* Spec_ip_ti=0 all_tg_pt=1 aptpl=0 */
+	data[20]=0x04;
+
+	printf("PRESISTENT RESERVE IN: CLEAR\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_TO_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	return 0;
+}
+
+int scsi_persistent_reserve_out_reserve(int fd)
+{
+	unsigned char cdb[]={0x5f,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=24;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=1;
+	int res;
+	long long k;
+
+	if (scope==-1) {
+		printf("Must specify scope\n");
+		printf("scsi_io --device=<DEVICE> --command=reserve --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (type==-1) {
+		printf("Must specify type\n");
+		printf("scsi_io --device=<DEVICE> --command=reserve --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (!key) {
+		printf("Must specify key\n");
+		printf("scsi_io --device=<DEVICE> --command=reserve --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+
+	sscanf(key, "%llx", &k);
+
+
+	cdb[1]=service_action;
+	cdb[2]=(scope<<4)|type;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+	memset(data, 0, data_size);
+
+	/* Reservation Key */
+	data[0]=(k>>56)&0xff;
+	data[1]=(k>>48)&0xff;
+	data[2]=(k>>40)&0xff;
+	data[3]=(k>>32)&0xff;
+	data[4]=(k>>24)&0xff;
+	data[5]=(k>>16)&0xff;
+	data[6]=(k>> 8)&0xff;
+	data[7]=(k    )&0xff;
+
+	/* Service Action Key */
+	data[8]=0;
+	data[9]=0;
+	data[10]=0;
+	data[11]=0;
+	data[12]=0;
+	data[13]=0;
+	data[14]=0;
+	data[15]=0;
+
+	/* Spec_ip_ti=0 all_tg_pt=1 aptpl=0 */
+	data[20]=0x04;
+
+	printf("PRESISTENT RESERVE IN: RESERVE\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_TO_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	return 0;
+}
+
+int scsi_persistent_reserve_out_preempt(int fd)
+{
+	unsigned char cdb[]={0x5f,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=24;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=4;
+	int res;
+	long long k;
+
+	if (scope==-1) {
+		printf("Must specify scope\n");
+		printf("scsi_io --device=<DEVICE> --command=preempt --scope=<SCOPE> --type=<TYPE> --key=<KEY> --rmkey=<KEY>\n");
+		_exit(10);
+	}
+	if (type==-1) {
+		printf("Must specify type\n");
+		printf("scsi_io --device=<DEVICE> --command=preempt --scope=<SCOPE> --type=<TYPE> --key=<KEY> --rmkey=<KEY>\n");
+		_exit(10);
+	}
+	if (!key) {
+		printf("Must specify key\n");
+		printf("scsi_io --device=<DEVICE> --command=preempt --scope=<SCOPE> --type=<TYPE> --key=<KEY> --rmkey=<KEY>\n");
+		_exit(10);
+	}
+	if (!rmkey) {
+		printf("Must specify rmkey\n");
+		printf("scsi_io --device=<DEVICE> --command=preempt --scope=<SCOPE> --type=<TYPE> --key=<KEY> --rmkey=<KEY>\n");
+		_exit(10);
+	}
+
+
+
+	cdb[1]=service_action;
+	cdb[2]=(scope<<4)|type;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+	memset(data, 0, data_size);
+
+	/* Reservation Key */
+	sscanf(key, "%llx", &k);
+	data[0]=(k>>56)&0xff;
+	data[1]=(k>>48)&0xff;
+	data[2]=(k>>40)&0xff;
+	data[3]=(k>>32)&0xff;
+	data[4]=(k>>24)&0xff;
+	data[5]=(k>>16)&0xff;
+	data[6]=(k>> 8)&0xff;
+	data[7]=(k    )&0xff;
+
+	/* Service Action Key */
+	sscanf(rmkey, "%llx", &k);
+	data[8] =(k>>56)&0xff;
+	data[9] =(k>>48)&0xff;
+	data[10]=(k>>40)&0xff;
+	data[11]=(k>>32)&0xff;
+	data[12]=(k>>24)&0xff;
+	data[13]=(k>>16)&0xff;
+	data[14]=(k>> 8)&0xff;
+	data[15]=(k    )&0xff;
+
+	/* Spec_ip_ti=0 all_tg_pt=1 aptpl=0 */
+	data[20]=0x04;
+
+	printf("PRESISTENT RESERVE IN: RESERVE\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_TO_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	return 0;
+}
+
+int scsi_persistent_reserve_out_register_and_ignore_existing_key(int fd)
+{
+	unsigned char cdb[]={0x5f,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=24;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=6;
+	int res;
+	long long k;
+
+	if (scope==-1) {
+		printf("Must specify scope\n");
+		printf("scsi_io --device=<DEVICE> --command=registerkey --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (type==-1) {
+		printf("Must specify type\n");
+		printf("scsi_io --device=<DEVICE> --command=registerkey --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (!key) {
+		printf("Must specify key\n");
+		printf("scsi_io --device=<DEVICE> --command=registerkey --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+
+	sscanf(key, "%llx", &k);
+
+	cdb[1]=service_action;
+	cdb[2]=(scope<<4)|type;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+	memset(data, 0, data_size);
+
+	/* Reservation Key */
+	data[0]=0;
+	data[1]=0;
+	data[2]=0;
+	data[3]=0;
+	data[4]=0;
+	data[5]=0;
+	data[6]=0;
+	data[7]=0;
+
+	/* Service Action Key */
+	data[8] =(k>>56)&0xff;
+	data[9] =(k>>48)&0xff;
+	data[10]=(k>>40)&0xff;
+	data[11]=(k>>32)&0xff;
+	data[12]=(k>>24)&0xff;
+	data[13]=(k>>16)&0xff;
+	data[14]=(k>> 8)&0xff;
+	data[15]=(k    )&0xff;
+
+	/* Spec_ip_ti=0 all_tg_pt=1 aptpl=0 */
+	data[20]=0x04;
+
+	printf("PRESISTENT RESERVE IN: REGISTER AND IGNORE EXISTING KEY\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_TO_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	return 0;
+}
+
+int scsi_persistent_reserve_out_unregister_key(int fd)
+{
+	unsigned char cdb[]={0x5f,0,0,0,0,0,0,0,0,0};
+
+	unsigned int data_size=24;
+	unsigned char data[data_size];
+
+	unsigned int sense_len=32;
+	unsigned char sense[sense_len];
+	unsigned char service_action=6;
+	int res;
+	long long k;
+
+	if (scope==-1) {
+		printf("Must specify scope\n");
+		printf("scsi_io --device=<DEVICE> --command=unregisterkey --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (type==-1) {
+		printf("Must specify type\n");
+		printf("scsi_io --device=<DEVICE> --command=unregisterkey --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+	if (!key) {
+		printf("Must specify key\n");
+		printf("scsi_io --device=<DEVICE> --command=unregisterkey --scope=<SCOPE> --type=<TYPE> --key=<KEY>\n");
+		_exit(10);
+	}
+
+	sscanf(key, "%llx", &k);
+
+	cdb[1]=service_action;
+	cdb[2]=(scope<<4)|type;
+	cdb[7]=(data_size>>8)&0xff;
+	cdb[8]=data_size&0xff;
+
+	memset(data, 0, data_size);
+
+	/* Reservation Key */
+	data[0]=(k>>56)&0xff;
+	data[1]=(k>>48)&0xff;
+	data[2]=(k>>40)&0xff;
+	data[3]=(k>>32)&0xff;
+	data[4]=(k>>24)&0xff;
+	data[5]=(k>>16)&0xff;
+	data[6]=(k>> 8)&0xff;
+	data[7]=(k    )&0xff;
+
+	/* Service Action Key */
+	data[8]=0;
+	data[9]=0;
+	data[10]=0;
+	data[11]=0;
+	data[12]=0;
+	data[13]=0;
+	data[14]=0;
+	data[15]=0;
+
+	/* Spec_ip_ti=0 all_tg_pt=1 aptpl=0 */
+	data[20]=0x04;
+
+	printf("PRESISTENT RESERVE IN: UNREGISTER KEY\n");
+
+	res=scsi_io(fd, cdb, sizeof(cdb), SG_DXFER_TO_DEV, data, &data_size, sense, &sense_len);
+	if(res){
+		printf("SCSI_IO failed\n");
+		return -1;
+	}
+	if(sense_len){
+		print_sense_data(sense, sense_len);
+		return -1;
+	}
+
+	return 0;
+}
+
+
+
+
+int open_scsi_device(const char *dev)
+{
+	int fd, vers;
+
+	if((fd=open(dev, O_RDWR))<0){
+		printf("ERROR could not open device %s\n", dev);
+		return -1;
+	}
+	if ((ioctl(fd, SG_GET_VERSION_NUM, &vers) < 0) || (vers < 30000)) {
+		printf("/dev is not an sg device, or old sg driver\n");
+		close(fd);
+		return -1;
+	}
+
+	return fd;
+}
+
+typedef int (*scsi_func_t)(int fd);
+typedef struct _cmds_t {
+	const char *cmd;
+	scsi_func_t func;
+	const char *comment;
+} cmds_t;
+cmds_t cmds[] = {
+	{"inq",		scsi_inquiry,	"Standard INQUIRY output"},
+	{"vpd",		scsi_inquiry_supported_vpd_pages,	"Supported VPD Pages"},
+	{"usn",		scsi_inquiry_unit_serial_number,	"Unit serial number"},
+	{"readkeys",	scsi_persistent_reserve_in_read_keys,	"Read SCSI Reservation Keys"},
+	{"readrsvr",	scsi_persistent_reserve_in_read_reservation, "Read SCSI Reservation Data"},
+	{"reportcap",	scsi_persistent_reserve_in_report_capabilities, "Report reservation Capabilities"},
+	{"registerkey",	scsi_persistent_reserve_out_register_and_ignore_existing_key,	"Register and ignore existing key"},
+	{"unregisterkey", scsi_persistent_reserve_out_unregister_key, "Unregister a key"},
+	{"clear",	scsi_persistent_reserve_out_clear, "Clear all reservations and registrations"},
+	{"reserve",	scsi_persistent_reserve_out_reserve, "Reserve"},
+	{"preempt",	scsi_persistent_reserve_out_preempt, "Preempt (remove someone elses registration)"},
+};
+
+void usage(void)
+{
+	int i;
+	printf("Usage:  scsi_io --command <command> --device <device>\n");
+	printf("Commands:\n");
+	for (i=0;i<sizeof(cmds)/sizeof(cmds[0]);i++){
+		printf("	%s	%s\n", cmds[i].cmd, cmds[i].comment);
+	}	
+}
+
+
+int main(int argc, const char *argv[])
+{
+	int i, fd;
+	int opt;
+	scsi_func_t func=NULL;
+	struct poptOption popt_options[] = {
+		POPT_AUTOHELP
+		{ "scope", 's', POPT_ARG_INT, &scope, 0, "scope", "integer" },
+		{ "type", 't', POPT_ARG_INT, &type, 0, "type", "integer" },
+		{ "key",      'k', POPT_ARG_STRING, &key, 0, "key", "key" },
+		{ "rmkey",      'r', POPT_ARG_STRING, &rmkey, 0, "rmkey", "rmkey" },
+		{ "command",      'c', POPT_ARG_STRING, &command, 0, "command", "command" },
+		{ "device",      'd', POPT_ARG_STRING, &device, 0, "device", "device" },
+//		{ "machinereadable", 'Y', POPT_ARG_NONE, &options.machinereadable, 0, "enable machinereadable output", NULL },
+		POPT_TABLEEND
+	};
+	poptContext pc;
+
+	pc = poptGetContext(argv[0], argc, argv, popt_options, POPT_CONTEXT_KEEP_FIRST);
+
+	while ((opt = poptGetNextOpt(pc)) != -1) {
+		switch (opt) {
+		default:
+			fprintf(stderr, "Invalid option %s: %s\n", 
+				poptBadOption(pc, 0), poptStrerror(opt));
+			_exit(1);
+		}
+	}
+
+	if (!command) {
+		printf("Must specify the command\n");
+		usage();
+		_exit(10);
+	}
+
+	if (!device) {
+		printf("Must specify the device\n");
+		usage();
+		_exit(10);
+	}
+
+	fd=open_scsi_device(device);
+	if(fd<0){
+		printf("Could not open SCSI device %s\n",device);
+		usage();
+		_exit(10);
+	}
+
+	for (i=0;i<sizeof(cmds)/sizeof(cmds[0]);i++){
+		if(!strcmp(cmds[i].cmd, command)) {
+			func = cmds[i].func;
+			break;
+		}		
+	}
+	if (!func) {
+		printf("Unrecognized command : %s\n", command);
+		usage();
+		_exit(10);
+	}
+
+	func(fd);
+
+#if 0
+	scsi_persistent_reserve_in_read_full_status(fd);
+	scsi_persistent_reserve_out_register_and_ignore_existing_key(fd);
+	scsi_persistent_reserve_in_read_keys(fd);
+
+	scsi_persistent_reserve_out_reserve(fd);
+	scsi_persistent_reserve_in_read_reservation(fd);
+
+	scsi_persistent_reserve_out_clear(fd);
+	scsi_persistent_reserve_in_read_reservation(fd);
+
+	scsi_persistent_reserve_out_unregister_key(fd);
+	scsi_persistent_reserve_in_read_keys(fd);
+#endif
+	return 0;
+}