// SPDX-License-Identifier: GPL-2.0

  /*
   * Copyright (C) 2001 Jens Axboe <axboe@suse.de>

   */

  #include <linux/compat.h>

  #include <linux/kernel.h>
  #include <linux/errno.h>
  #include <linux/string.h>
  #include <linux/module.h>
  #include <linux/blkdev.h>

  #include <linux/capability.h>

  #include <linux/completion.h>
  #include <linux/cdrom.h>

  #include <linux/ratelimit.h>

  #include <linux/slab.h>
  #include <linux/times.h>

  #include <linux/uio.h>

  #include <linux/uaccess.h>

  
  #include <scsi/scsi.h>
  #include <scsi/scsi_ioctl.h>
  #include <scsi/scsi_cmnd.h>

  #include <scsi/sg.h>

  struct blk_cmd_filter {
  	unsigned long read_ok[BLK_SCSI_CMD_PER_LONG];
  	unsigned long write_ok[BLK_SCSI_CMD_PER_LONG];

  };
  
  static struct blk_cmd_filter blk_default_cmd_filter;

  /* Command group 3 is reserved and should never be used.  */

  const unsigned char scsi_command_size_tbl[8] =

  {
  	6, 10, 10, 12,
  	16, 12, 10, 10
  };

  EXPORT_SYMBOL(scsi_command_size_tbl);

  static int sg_get_version(int __user *p)
  {

  	static const int sg_version_num = 30527;

  	return put_user(sg_version_num, p);
  }

  static int scsi_get_idlun(struct request_queue *q, int __user *p)

  {
  	return put_user(0, p);
  }

  static int scsi_get_bus(struct request_queue *q, int __user *p)

  {
  	return put_user(0, p);
  }

  static int sg_get_timeout(struct request_queue *q)

  {

  	return jiffies_to_clock_t(q->sg_timeout);

  }

  static int sg_set_timeout(struct request_queue *q, int __user *p)

  {
  	int timeout, err = get_user(timeout, p);
  
  	if (!err)

  		q->sg_timeout = clock_t_to_jiffies(timeout);

  
  	return err;
  }

  static int max_sectors_bytes(struct request_queue *q)
  {
  	unsigned int max_sectors = queue_max_sectors(q);
  
  	max_sectors = min_t(unsigned int, max_sectors, INT_MAX >> 9);
  
  	return max_sectors << 9;
  }

  static int sg_get_reserved_size(struct request_queue *q, int __user *p)

  {

  	int val = min_t(int, q->sg_reserved_size, max_sectors_bytes(q));

  
  	return put_user(val, p);

  }

  static int sg_set_reserved_size(struct request_queue *q, int __user *p)

  {
  	int size, err = get_user(size, p);
  
  	if (err)
  		return err;
  
  	if (size < 0)
  		return -EINVAL;

  	q->sg_reserved_size = min(size, max_sectors_bytes(q));

  	return 0;
  }
  
  /*
   * will always return that we are ATAPI even for a real SCSI drive, I'm not
   * so sure this is worth doing anything about (why would you care??)
   */

  static int sg_emulated_host(struct request_queue *q, int __user *p)

  {
  	return put_user(1, p);
  }

  static void blk_set_cmd_filter_defaults(struct blk_cmd_filter *filter)

  {
  	/* Basic read-only commands */
  	__set_bit(TEST_UNIT_READY, filter->read_ok);
  	__set_bit(REQUEST_SENSE, filter->read_ok);
  	__set_bit(READ_6, filter->read_ok);
  	__set_bit(READ_10, filter->read_ok);
  	__set_bit(READ_12, filter->read_ok);
  	__set_bit(READ_16, filter->read_ok);
  	__set_bit(READ_BUFFER, filter->read_ok);
  	__set_bit(READ_DEFECT_DATA, filter->read_ok);
  	__set_bit(READ_CAPACITY, filter->read_ok);
  	__set_bit(READ_LONG, filter->read_ok);
  	__set_bit(INQUIRY, filter->read_ok);
  	__set_bit(MODE_SENSE, filter->read_ok);
  	__set_bit(MODE_SENSE_10, filter->read_ok);
  	__set_bit(LOG_SENSE, filter->read_ok);
  	__set_bit(START_STOP, filter->read_ok);
  	__set_bit(GPCMD_VERIFY_10, filter->read_ok);
  	__set_bit(VERIFY_16, filter->read_ok);
  	__set_bit(REPORT_LUNS, filter->read_ok);

  	__set_bit(SERVICE_ACTION_IN_16, filter->read_ok);

  	__set_bit(RECEIVE_DIAGNOSTIC, filter->read_ok);
  	__set_bit(MAINTENANCE_IN, filter->read_ok);
  	__set_bit(GPCMD_READ_BUFFER_CAPACITY, filter->read_ok);
  
  	/* Audio CD commands */
  	__set_bit(GPCMD_PLAY_CD, filter->read_ok);
  	__set_bit(GPCMD_PLAY_AUDIO_10, filter->read_ok);
  	__set_bit(GPCMD_PLAY_AUDIO_MSF, filter->read_ok);
  	__set_bit(GPCMD_PLAY_AUDIO_TI, filter->read_ok);
  	__set_bit(GPCMD_PAUSE_RESUME, filter->read_ok);
  
  	/* CD/DVD data reading */
  	__set_bit(GPCMD_READ_CD, filter->read_ok);
  	__set_bit(GPCMD_READ_CD_MSF, filter->read_ok);
  	__set_bit(GPCMD_READ_DISC_INFO, filter->read_ok);
  	__set_bit(GPCMD_READ_CDVD_CAPACITY, filter->read_ok);
  	__set_bit(GPCMD_READ_DVD_STRUCTURE, filter->read_ok);
  	__set_bit(GPCMD_READ_HEADER, filter->read_ok);
  	__set_bit(GPCMD_READ_TRACK_RZONE_INFO, filter->read_ok);
  	__set_bit(GPCMD_READ_SUBCHANNEL, filter->read_ok);
  	__set_bit(GPCMD_READ_TOC_PMA_ATIP, filter->read_ok);
  	__set_bit(GPCMD_REPORT_KEY, filter->read_ok);
  	__set_bit(GPCMD_SCAN, filter->read_ok);
  	__set_bit(GPCMD_GET_CONFIGURATION, filter->read_ok);
  	__set_bit(GPCMD_READ_FORMAT_CAPACITIES, filter->read_ok);
  	__set_bit(GPCMD_GET_EVENT_STATUS_NOTIFICATION, filter->read_ok);
  	__set_bit(GPCMD_GET_PERFORMANCE, filter->read_ok);
  	__set_bit(GPCMD_SEEK, filter->read_ok);
  	__set_bit(GPCMD_STOP_PLAY_SCAN, filter->read_ok);
  
  	/* Basic writing commands */
  	__set_bit(WRITE_6, filter->write_ok);
  	__set_bit(WRITE_10, filter->write_ok);
  	__set_bit(WRITE_VERIFY, filter->write_ok);
  	__set_bit(WRITE_12, filter->write_ok);
  	__set_bit(WRITE_VERIFY_12, filter->write_ok);
  	__set_bit(WRITE_16, filter->write_ok);
  	__set_bit(WRITE_LONG, filter->write_ok);
  	__set_bit(WRITE_LONG_2, filter->write_ok);

  	__set_bit(WRITE_SAME, filter->write_ok);
  	__set_bit(WRITE_SAME_16, filter->write_ok);
  	__set_bit(WRITE_SAME_32, filter->write_ok);

  	__set_bit(ERASE, filter->write_ok);
  	__set_bit(GPCMD_MODE_SELECT_10, filter->write_ok);
  	__set_bit(MODE_SELECT, filter->write_ok);
  	__set_bit(LOG_SELECT, filter->write_ok);
  	__set_bit(GPCMD_BLANK, filter->write_ok);
  	__set_bit(GPCMD_CLOSE_TRACK, filter->write_ok);
  	__set_bit(GPCMD_FLUSH_CACHE, filter->write_ok);
  	__set_bit(GPCMD_FORMAT_UNIT, filter->write_ok);
  	__set_bit(GPCMD_REPAIR_RZONE_TRACK, filter->write_ok);
  	__set_bit(GPCMD_RESERVE_RZONE_TRACK, filter->write_ok);
  	__set_bit(GPCMD_SEND_DVD_STRUCTURE, filter->write_ok);
  	__set_bit(GPCMD_SEND_EVENT, filter->write_ok);
  	__set_bit(GPCMD_SEND_KEY, filter->write_ok);
  	__set_bit(GPCMD_SEND_OPC, filter->write_ok);
  	__set_bit(GPCMD_SEND_CUE_SHEET, filter->write_ok);
  	__set_bit(GPCMD_SET_SPEED, filter->write_ok);
  	__set_bit(GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL, filter->write_ok);
  	__set_bit(GPCMD_LOAD_UNLOAD, filter->write_ok);
  	__set_bit(GPCMD_SET_STREAMING, filter->write_ok);

  	__set_bit(GPCMD_SET_READ_AHEAD, filter->write_ok);

  
  	/* ZBC Commands */
  	__set_bit(ZBC_OUT, filter->write_ok);
  	__set_bit(ZBC_IN, filter->read_ok);

  }

  int blk_verify_command(unsigned char *cmd, fmode_t mode)

  {
  	struct blk_cmd_filter *filter = &blk_default_cmd_filter;
  
  	/* root can do any command. */
  	if (capable(CAP_SYS_RAWIO))
  		return 0;

  	/* Anybody who can open the device can do a read-safe command */
  	if (test_bit(cmd[0], filter->read_ok))
  		return 0;
  
  	/* Write-safe commands require a writable open */

  	if (test_bit(cmd[0], filter->write_ok) && (mode & FMODE_WRITE))

  		return 0;
  
  	return -EPERM;
  }
  EXPORT_SYMBOL(blk_verify_command);

  static int blk_fill_sghdr_rq(struct request_queue *q, struct request *rq,

  			     struct sg_io_hdr *hdr, fmode_t mode)

  {

  	struct scsi_request *req = scsi_req(rq);
  
  	if (copy_from_user(req->cmd, hdr->cmdp, hdr->cmd_len))

  		return -EFAULT;

  	if (blk_verify_command(req->cmd, mode))

  		return -EPERM;
  
  	/*
  	 * fill in request structure
  	 */

  	req->cmd_len = hdr->cmd_len;

  	rq->timeout = msecs_to_jiffies(hdr->timeout);

  	if (!rq->timeout)
  		rq->timeout = q->sg_timeout;
  	if (!rq->timeout)
  		rq->timeout = BLK_DEFAULT_SG_TIMEOUT;

  	if (rq->timeout < BLK_MIN_SG_TIMEOUT)
  		rq->timeout = BLK_MIN_SG_TIMEOUT;

  
  	return 0;
  }

  #ifdef CONFIG_AHCI_IMX
  extern void *sg_io_buffer_hack;
  #else
  #define sg_io_buffer_hack NULL
  #endif

  static int blk_complete_sghdr_rq(struct request *rq, struct sg_io_hdr *hdr,
  				 struct bio *bio)

  {

  	struct scsi_request *req = scsi_req(rq);

  	int r, ret = 0;

  
  	/*
  	 * fill in all the output members
  	 */

  	hdr->status = req->result & 0xff;
  	hdr->masked_status = status_byte(req->result);
  	hdr->msg_status = msg_byte(req->result);
  	hdr->host_status = host_byte(req->result);
  	hdr->driver_status = driver_byte(req->result);

  	hdr->info = 0;
  	if (hdr->masked_status || hdr->host_status || hdr->driver_status)
  		hdr->info |= SG_INFO_CHECK;

  	hdr->resid = req->resid_len;

  	hdr->sb_len_wr = 0;

  	if (req->sense_len && hdr->sbp) {
  		int len = min((unsigned int) hdr->mx_sb_len, req->sense_len);

  		if (!copy_to_user(hdr->sbp, req->sense, len))

  			hdr->sb_len_wr = len;
  		else
  			ret = -EFAULT;
  	}

  	if (sg_io_buffer_hack && !hdr->iovec_count)
  		r = copy_to_user(hdr->dxferp, sg_io_buffer_hack,
  				hdr->dxfer_len);
  	else
  		r = blk_rq_unmap_user(bio);

  	if (!ret)
  		ret = r;

  	return ret;

  }

  static int sg_io(struct request_queue *q, struct gendisk *bd_disk,
  		struct sg_io_hdr *hdr, fmode_t mode)

  {

  	unsigned long start_time;

  	ssize_t ret = 0;
  	int writing = 0;

  	int at_head = 0;

  	struct request *rq;

  	struct scsi_request *req;

  	struct bio *bio;

  
  	if (hdr->interface_id != 'S')
  		return -EINVAL;

  	if (hdr->dxfer_len > (queue_max_hw_sectors(q) << 9))

  		return -EIO;

  	if (sg_io_buffer_hack && hdr->dxfer_len > 0x10000)
  		return -EIO;

  	if (hdr->dxfer_len)

  		switch (hdr->dxfer_direction) {
  		default:
  			return -EINVAL;

  		case SG_DXFER_TO_DEV:
  			writing = 1;
  			break;

  		case SG_DXFER_TO_FROM_DEV:

  		case SG_DXFER_FROM_DEV:

  			break;
  		}

  	if (hdr->flags & SG_FLAG_Q_AT_HEAD)
  		at_head = 1;

  	ret = -ENOMEM;

  	rq = blk_get_request(q, writing ? REQ_OP_SCSI_OUT : REQ_OP_SCSI_IN, 0);

  	if (IS_ERR(rq))
  		return PTR_ERR(rq);

  	req = scsi_req(rq);

  	if (hdr->cmd_len > BLK_MAX_CDB) {

  		req->cmd = kzalloc(hdr->cmd_len, GFP_KERNEL);
  		if (!req->cmd)

  			goto out_put_request;

  	}

  	ret = blk_fill_sghdr_rq(q, rq, hdr, mode);
  	if (ret < 0)

  		goto out_free_cdb;

  	ret = 0;

  	if (hdr->iovec_count) {

  		struct iov_iter i;

  		struct iovec *iov = NULL;

  		ret = import_iovec(rq_data_dir(rq), hdr->dxferp,
  				   hdr->iovec_count, 0, &iov, &i);

  		if (ret < 0)

  			goto out_free_cdb;

  		/* SG_IO howto says that the shorter of the two wins */

  		iov_iter_truncate(&i, hdr->dxfer_len);

  		ret = blk_rq_map_user_iov(q, rq, NULL, &i, GFP_KERNEL);

  		kfree(iov);

  	} else if (hdr->dxfer_len) {
  		if (sg_io_buffer_hack)
  			ret = blk_rq_map_kern(q, rq, sg_io_buffer_hack,
  					hdr->dxfer_len, GFP_KERNEL);
  		else
  			ret = blk_rq_map_user(q, rq, NULL, hdr->dxferp,
  					hdr->dxfer_len, GFP_KERNEL);
  	}

  
  	if (ret)

  		goto out_free_cdb;

  	bio = rq->bio;

  	req->retries = 0;

  	start_time = jiffies;
  
  	/* ignore return value. All information is passed back to caller
  	 * (if he doesn't check that is his problem).
  	 * N.B. a non-zero SCSI status is _not_ necessarily an error.
  	 */

  	blk_execute_rq(q, bd_disk, rq, at_head);

  	hdr->duration = jiffies_to_msecs(jiffies - start_time);

  	ret = blk_complete_sghdr_rq(rq, hdr, bio);

  
  out_free_cdb:

  	scsi_req_free_cmd(req);

  out_put_request:

  	blk_put_request(rq);
  	return ret;

  }

  /**
   * sg_scsi_ioctl  --  handle deprecated SCSI_IOCTL_SEND_COMMAND ioctl

   * @q:		request queue to send scsi commands down
   * @disk:	gendisk to operate on (option)

   * @mode:	mode used to open the file through which the ioctl has been
   *		submitted

   * @sic:	userspace structure describing the command to perform
   *
   * Send down the scsi command described by @sic to the device below
   * the request queue @q.  If @file is non-NULL it's used to perform
   * fine-grained permission checks that allow users to send down
   * non-destructive SCSI commands.  If the caller has a struct gendisk
   * available it should be passed in as @disk to allow the low level
   * driver to use the information contained in it.  A non-NULL @disk
   * is only allowed if the caller knows that the low level driver doesn't
   * need it (e.g. in the scsi subsystem).
   *
   * Notes:
   *   -  This interface is deprecated - users should use the SG_IO
   *      interface instead, as this is a more flexible approach to
   *      performing SCSI commands on a device.
   *   -  The SCSI command length is determined by examining the 1st byte
   *      of the given command. There is no way to override this.
   *   -  Data transfers are limited to PAGE_SIZE
   *   -  The length (x + y) must be at least OMAX_SB_LEN bytes long to
   *      accommodate the sense buffer when an error occurs.
   *      The sense buffer is truncated to OMAX_SB_LEN (16) bytes so that
   *      old code will not be surprised.
   *   -  If a Unix error occurs (e.g. ENOMEM) then the user will receive
   *      a negative return and the Unix error code in 'errno'.
   *      If the SCSI command succeeds then 0 is returned.
   *      Positive numbers returned are the compacted SCSI error codes (4
   *      bytes in one int) where the lowest byte is the SCSI status.
   */

  int sg_scsi_ioctl(struct request_queue *q, struct gendisk *disk, fmode_t mode,
  		struct scsi_ioctl_command __user *sic)

  {

  	enum { OMAX_SB_LEN = 16 };	/* For backward compatibility */

  	struct request *rq;

  	struct scsi_request *req;

  	int err;

  	unsigned int in_len, out_len, bytes, opcode, cmdlen;

  	char *buffer = NULL;

  	if (!sic)
  		return -EINVAL;

  	/*
  	 * get in an out lengths, verify they don't exceed a page worth of data
  	 */
  	if (get_user(in_len, &sic->inlen))
  		return -EFAULT;
  	if (get_user(out_len, &sic->outlen))
  		return -EFAULT;
  	if (in_len > PAGE_SIZE || out_len > PAGE_SIZE)
  		return -EINVAL;
  	if (get_user(opcode, sic->data))
  		return -EFAULT;
  
  	bytes = max(in_len, out_len);
  	if (bytes) {

  		buffer = kzalloc(bytes, q->bounce_gfp | GFP_USER| __GFP_NOWARN);

  		if (!buffer)
  			return -ENOMEM;

  	}

  	rq = blk_get_request(q, in_len ? REQ_OP_SCSI_OUT : REQ_OP_SCSI_IN, 0);

  	if (IS_ERR(rq)) {
  		err = PTR_ERR(rq);

  		goto error_free_buffer;

  	}

  	req = scsi_req(rq);

  
  	cmdlen = COMMAND_SIZE(opcode);
  
  	/*
  	 * get command and data to send to device, if any
  	 */
  	err = -EFAULT;

  	req->cmd_len = cmdlen;
  	if (copy_from_user(req->cmd, sic->data, cmdlen))

  		goto error;

  	if (in_len && copy_from_user(buffer, sic->data + cmdlen, in_len))

  		goto error;

  	err = blk_verify_command(req->cmd, mode);

  	if (err)
  		goto error;

  	/* default.  possible overriden later */

  	req->retries = 5;

  	switch (opcode) {

  	case SEND_DIAGNOSTIC:
  	case FORMAT_UNIT:
  		rq->timeout = FORMAT_UNIT_TIMEOUT;

  		req->retries = 1;

  		break;
  	case START_STOP:
  		rq->timeout = START_STOP_TIMEOUT;
  		break;
  	case MOVE_MEDIUM:
  		rq->timeout = MOVE_MEDIUM_TIMEOUT;
  		break;
  	case READ_ELEMENT_STATUS:
  		rq->timeout = READ_ELEMENT_STATUS_TIMEOUT;
  		break;
  	case READ_DEFECT_DATA:
  		rq->timeout = READ_DEFECT_DATA_TIMEOUT;

  		req->retries = 1;

  		break;
  	default:

  		rq->timeout = BLK_DEFAULT_SG_TIMEOUT;

  		break;
  	}

  	if (bytes && blk_rq_map_kern(q, rq, buffer, bytes, GFP_NOIO)) {

  		err = DRIVER_ERROR << 24;

  		goto error;

  	}

  	blk_execute_rq(q, disk, rq, 0);

  	err = req->result & 0xff;	/* only 8 bit SCSI status */

  	if (err) {

  		if (req->sense_len && req->sense) {
  			bytes = (OMAX_SB_LEN > req->sense_len) ?
  				req->sense_len : OMAX_SB_LEN;
  			if (copy_to_user(sic->data, req->sense, bytes))

  				err = -EFAULT;
  		}
  	} else {
  		if (copy_to_user(sic->data, buffer, out_len))
  			err = -EFAULT;
  	}
  	
  error:

  	blk_put_request(rq);
  
  error_free_buffer:

  	kfree(buffer);

  	return err;
  }

  EXPORT_SYMBOL_GPL(sg_scsi_ioctl);

  
  /* Send basic block requests */

  static int __blk_send_generic(struct request_queue *q, struct gendisk *bd_disk,
  			      int cmd, int data)

  {
  	struct request *rq;
  	int err;

  	rq = blk_get_request(q, REQ_OP_SCSI_OUT, 0);

  	if (IS_ERR(rq))
  		return PTR_ERR(rq);

  	rq->timeout = BLK_DEFAULT_SG_TIMEOUT;

  	scsi_req(rq)->cmd[0] = cmd;
  	scsi_req(rq)->cmd[4] = data;
  	scsi_req(rq)->cmd_len = 6;

  	blk_execute_rq(q, bd_disk, rq, 0);

  	err = scsi_req(rq)->result ? -EIO : 0;

  	blk_put_request(rq);
  
  	return err;
  }

  static inline int blk_send_start_stop(struct request_queue *q,
  				      struct gendisk *bd_disk, int data)

  {
  	return __blk_send_generic(q, bd_disk, GPCMD_START_STOP_UNIT, data);
  }

  int put_sg_io_hdr(const struct sg_io_hdr *hdr, void __user *argp)
  {
  #ifdef CONFIG_COMPAT
  	if (in_compat_syscall()) {
  		struct compat_sg_io_hdr hdr32 =  {
  			.interface_id	 = hdr->interface_id,
  			.dxfer_direction = hdr->dxfer_direction,
  			.cmd_len	 = hdr->cmd_len,
  			.mx_sb_len	 = hdr->mx_sb_len,
  			.iovec_count	 = hdr->iovec_count,
  			.dxfer_len	 = hdr->dxfer_len,
  			.dxferp		 = (uintptr_t)hdr->dxferp,
  			.cmdp		 = (uintptr_t)hdr->cmdp,
  			.sbp		 = (uintptr_t)hdr->sbp,
  			.timeout	 = hdr->timeout,
  			.flags		 = hdr->flags,
  			.pack_id	 = hdr->pack_id,
  			.usr_ptr	 = (uintptr_t)hdr->usr_ptr,
  			.status		 = hdr->status,
  			.masked_status	 = hdr->masked_status,
  			.msg_status	 = hdr->msg_status,
  			.sb_len_wr	 = hdr->sb_len_wr,
  			.host_status	 = hdr->host_status,
  			.driver_status	 = hdr->driver_status,
  			.resid		 = hdr->resid,
  			.duration	 = hdr->duration,
  			.info		 = hdr->info,
  		};
  
  		if (copy_to_user(argp, &hdr32, sizeof(hdr32)))
  			return -EFAULT;
  
  		return 0;
  	}
  #endif
  
  	if (copy_to_user(argp, hdr, sizeof(*hdr)))
  		return -EFAULT;
  
  	return 0;
  }
  EXPORT_SYMBOL(put_sg_io_hdr);
  
  int get_sg_io_hdr(struct sg_io_hdr *hdr, const void __user *argp)
  {
  #ifdef CONFIG_COMPAT
  	struct compat_sg_io_hdr hdr32;
  
  	if (in_compat_syscall()) {
  		if (copy_from_user(&hdr32, argp, sizeof(hdr32)))
  			return -EFAULT;
  
  		*hdr = (struct sg_io_hdr) {
  			.interface_id	 = hdr32.interface_id,
  			.dxfer_direction = hdr32.dxfer_direction,
  			.cmd_len	 = hdr32.cmd_len,
  			.mx_sb_len	 = hdr32.mx_sb_len,
  			.iovec_count	 = hdr32.iovec_count,
  			.dxfer_len	 = hdr32.dxfer_len,
  			.dxferp		 = compat_ptr(hdr32.dxferp),
  			.cmdp		 = compat_ptr(hdr32.cmdp),
  			.sbp		 = compat_ptr(hdr32.sbp),
  			.timeout	 = hdr32.timeout,
  			.flags		 = hdr32.flags,
  			.pack_id	 = hdr32.pack_id,
  			.usr_ptr	 = compat_ptr(hdr32.usr_ptr),
  			.status		 = hdr32.status,
  			.masked_status	 = hdr32.masked_status,
  			.msg_status	 = hdr32.msg_status,
  			.sb_len_wr	 = hdr32.sb_len_wr,
  			.host_status	 = hdr32.host_status,
  			.driver_status	 = hdr32.driver_status,
  			.resid		 = hdr32.resid,
  			.duration	 = hdr32.duration,
  			.info		 = hdr32.info,
  		};
  
  		return 0;
  	}
  #endif
  
  	if (copy_from_user(hdr, argp, sizeof(*hdr)))
  		return -EFAULT;
  
  	return 0;
  }
  EXPORT_SYMBOL(get_sg_io_hdr);

  #ifdef CONFIG_COMPAT
  struct compat_cdrom_generic_command {
  	unsigned char	cmd[CDROM_PACKET_SIZE];
  	compat_caddr_t	buffer;
  	compat_uint_t	buflen;
  	compat_int_t	stat;
  	compat_caddr_t	sense;
  	unsigned char	data_direction;

  	unsigned char	pad[3];

  	compat_int_t	quiet;
  	compat_int_t	timeout;

  	compat_caddr_t	unused;

  };
  #endif
  
  static int scsi_get_cdrom_generic_arg(struct cdrom_generic_command *cgc,
  				      const void __user *arg)
  {
  #ifdef CONFIG_COMPAT
  	if (in_compat_syscall()) {
  		struct compat_cdrom_generic_command cgc32;
  
  		if (copy_from_user(&cgc32, arg, sizeof(cgc32)))
  			return -EFAULT;
  
  		*cgc = (struct cdrom_generic_command) {
  			.buffer		= compat_ptr(cgc32.buffer),
  			.buflen		= cgc32.buflen,
  			.stat		= cgc32.stat,
  			.sense		= compat_ptr(cgc32.sense),
  			.data_direction	= cgc32.data_direction,
  			.quiet		= cgc32.quiet,
  			.timeout	= cgc32.timeout,

  			.unused		= compat_ptr(cgc32.unused),

  		};
  		memcpy(&cgc->cmd, &cgc32.cmd, CDROM_PACKET_SIZE);
  		return 0;
  	}
  #endif
  	if (copy_from_user(cgc, arg, sizeof(*cgc)))
  		return -EFAULT;
  
  	return 0;
  }
  
  static int scsi_put_cdrom_generic_arg(const struct cdrom_generic_command *cgc,
  				      void __user *arg)
  {
  #ifdef CONFIG_COMPAT
  	if (in_compat_syscall()) {
  		struct compat_cdrom_generic_command cgc32 = {
  			.buffer		= (uintptr_t)(cgc->buffer),
  			.buflen		= cgc->buflen,
  			.stat		= cgc->stat,
  			.sense		= (uintptr_t)(cgc->sense),
  			.data_direction	= cgc->data_direction,
  			.quiet		= cgc->quiet,
  			.timeout	= cgc->timeout,

  			.unused		= (uintptr_t)(cgc->unused),

  		};
  		memcpy(&cgc32.cmd, &cgc->cmd, CDROM_PACKET_SIZE);
  
  		if (copy_to_user(arg, &cgc32, sizeof(cgc32)))
  			return -EFAULT;
  
  		return 0;
  	}
  #endif
  	if (copy_to_user(arg, cgc, sizeof(*cgc)))
  		return -EFAULT;
  
  	return 0;
  }
  
  static int scsi_cdrom_send_packet(struct request_queue *q,
  				  struct gendisk *bd_disk,
  				  fmode_t mode, void __user *arg)
  {
  	struct cdrom_generic_command cgc;
  	struct sg_io_hdr hdr;
  	int err;
  
  	err = scsi_get_cdrom_generic_arg(&cgc, arg);
  	if (err)
  		return err;
  
  	cgc.timeout = clock_t_to_jiffies(cgc.timeout);
  	memset(&hdr, 0, sizeof(hdr));
  	hdr.interface_id = 'S';
  	hdr.cmd_len = sizeof(cgc.cmd);
  	hdr.dxfer_len = cgc.buflen;
  	switch (cgc.data_direction) {
  		case CGC_DATA_UNKNOWN:
  			hdr.dxfer_direction = SG_DXFER_UNKNOWN;
  			break;
  		case CGC_DATA_WRITE:
  			hdr.dxfer_direction = SG_DXFER_TO_DEV;
  			break;
  		case CGC_DATA_READ:
  			hdr.dxfer_direction = SG_DXFER_FROM_DEV;
  			break;
  		case CGC_DATA_NONE:
  			hdr.dxfer_direction = SG_DXFER_NONE;
  			break;
  		default:
  			return -EINVAL;
  	}
  
  	hdr.dxferp = cgc.buffer;
  	hdr.sbp = cgc.sense;
  	if (hdr.sbp)
  		hdr.mx_sb_len = sizeof(struct request_sense);
  	hdr.timeout = jiffies_to_msecs(cgc.timeout);
  	hdr.cmdp = ((struct cdrom_generic_command __user*) arg)->cmd;
  	hdr.cmd_len = sizeof(cgc.cmd);
  
  	err = sg_io(q, bd_disk, &hdr, mode);
  	if (err == -EFAULT)
  		return -EFAULT;
  
  	if (hdr.status)
  		return -EIO;
  
  	cgc.stat = err;
  	cgc.buflen = hdr.resid;
  	if (scsi_put_cdrom_generic_arg(&cgc, arg))
  		return -EFAULT;
  
  	return err;
  }

  int scsi_cmd_ioctl(struct request_queue *q, struct gendisk *bd_disk, fmode_t mode,
  		   unsigned int cmd, void __user *arg)

  {

  	int err;

  	if (!q)

  		return -ENXIO;
  
  	switch (cmd) {
  		/*
  		 * new sgv3 interface
  		 */
  		case SG_GET_VERSION_NUM:
  			err = sg_get_version(arg);
  			break;
  		case SCSI_IOCTL_GET_IDLUN:
  			err = scsi_get_idlun(q, arg);
  			break;
  		case SCSI_IOCTL_GET_BUS_NUMBER:
  			err = scsi_get_bus(q, arg);
  			break;
  		case SG_SET_TIMEOUT:
  			err = sg_set_timeout(q, arg);
  			break;
  		case SG_GET_TIMEOUT:
  			err = sg_get_timeout(q);
  			break;
  		case SG_GET_RESERVED_SIZE:
  			err = sg_get_reserved_size(q, arg);
  			break;
  		case SG_SET_RESERVED_SIZE:
  			err = sg_set_reserved_size(q, arg);
  			break;
  		case SG_EMULATED_HOST:
  			err = sg_emulated_host(q, arg);
  			break;
  		case SG_IO: {
  			struct sg_io_hdr hdr;

  			err = get_sg_io_hdr(&hdr, arg);
  			if (err)

  				break;

  			err = sg_io(q, bd_disk, &hdr, mode);

  			if (err == -EFAULT)
  				break;

  			if (put_sg_io_hdr(&hdr, arg))

  				err = -EFAULT;
  			break;
  		}

  		case CDROM_SEND_PACKET:
  			err = scsi_cdrom_send_packet(q, bd_disk, mode, arg);

  			break;

  
  		/*
  		 * old junk scsi send command ioctl
  		 */
  		case SCSI_IOCTL_SEND_COMMAND:
  			printk(KERN_WARNING "program %s is using a deprecated SCSI ioctl, please convert it to SG_IO
  ", current->comm);
  			err = -EINVAL;
  			if (!arg)
  				break;

  			err = sg_scsi_ioctl(q, bd_disk, mode, arg);

  			break;
  		case CDROMCLOSETRAY:

  			err = blk_send_start_stop(q, bd_disk, 0x03);
  			break;

  		case CDROMEJECT:

  			err = blk_send_start_stop(q, bd_disk, 0x02);

  			break;
  		default:
  			err = -ENOTTY;
  	}

  	return err;
  }

  EXPORT_SYMBOL(scsi_cmd_ioctl);

  int scsi_verify_blk_ioctl(struct block_device *bd, unsigned int cmd)
  {

  	if (bd && !bdev_is_partition(bd))

  		return 0;

  	if (capable(CAP_SYS_RAWIO))
  		return 0;

  	return -ENOIOCTLCMD;

  }
  EXPORT_SYMBOL(scsi_verify_blk_ioctl);

  int scsi_cmd_blk_ioctl(struct block_device *bd, fmode_t mode,
  		       unsigned int cmd, void __user *arg)
  {

  	int ret;
  
  	ret = scsi_verify_blk_ioctl(bd, cmd);
  	if (ret < 0)
  		return ret;

  	return scsi_cmd_ioctl(bd->bd_disk->queue, bd->bd_disk, mode, cmd, arg);
  }
  EXPORT_SYMBOL(scsi_cmd_blk_ioctl);

  /**
   * scsi_req_init - initialize certain fields of a scsi_request structure
   * @req: Pointer to a scsi_request structure.
   * Initializes .__cmd[], .cmd, .cmd_len and .sense_len but no other members
   * of struct scsi_request.
   */
  void scsi_req_init(struct scsi_request *req)

  {

  	memset(req->__cmd, 0, sizeof(req->__cmd));
  	req->cmd = req->__cmd;
  	req->cmd_len = BLK_MAX_CDB;
  	req->sense_len = 0;
  }
  EXPORT_SYMBOL(scsi_req_init);

  static int __init blk_scsi_ioctl_init(void)

  {
  	blk_set_cmd_filter_defaults(&blk_default_cmd_filter);
  	return 0;
  }

  fs_initcall(blk_scsi_ioctl_init);