开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Linux/Unix编程 > 查看源码
sg.c
资源名称：linux-2.4.20.tar.gz　[点击查看]
上传用户：jlfgdled
上传日期：2013-04-10
资源大小：33168k
文件大小：97k
源码类别：

Linux/Unix编程

开发平台：

Unix_Linux

sg.c：源码内容
  1. /*
  2.  *  History:
  3.  *  Started: Aug 9 by Lawrence Foard (entropy@world.std.com),
  4.  *           to allow user process control of SCSI devices.
  5.  *  Development Sponsored by Killy Corp. NY NY
  6.  *
  7.  * Original driver (sg.c):
  8.  *        Copyright (C) 1992 Lawrence Foard
  9.  * Version 2 and 3 extensions to driver:
  10.  *        Copyright (C) 1998 - 2002 Douglas Gilbert
  11.  *
  12.  *  Modified  19-JAN-1998  Richard Gooch <rgooch@atnf.csiro.au>  Devfs support
  13.  *
  14.  * This program is free software; you can redistribute it and/or modify
  15.  * it under the terms of the GNU General Public License as published by
  16.  * the Free Software Foundation; either version 2, or (at your option)
  17.  * any later version.
  18.  *
  19.  */
  20. #include <linux/config.h>
  21. #ifdef CONFIG_PROC_FS
  22.  static char * sg_version_str = "Version: 3.1.24 (20020505)";
  23. #endif
  24.  static int sg_version_num = 30124; /* 2 digits for each component */
  25. /*
  26.  *  D. P. Gilbert (dgilbert@interlog.com, dougg@triode.net.au), notes:
  27.  *      - scsi logging is available via SCSI_LOG_TIMEOUT macros. First
  28.  *        the kernel/module needs to be built with CONFIG_SCSI_LOGGING
  29.  *        (otherwise the macros compile to empty statements).
  30.  *        Then before running the program to be debugged enter:
  31.  *          # echo "scsi log timeout 7" > /proc/scsi/scsi
  32.  *        This will send copious output to the console and the log which
  33.  *        is usually /var/log/messages. To turn off debugging enter:
  34.  *          # echo "scsi log timeout 0" > /proc/scsi/scsi
  35.  *        The 'timeout' token was chosen because it is relatively unused.
  36.  *        The token 'hlcomplete' should be used but that triggers too
  37.  *        much output from the sd device driver. To dump the current
  38.  *        state of the SCSI mid level data structures enter:
  39.  *          # echo "scsi dump 1" > /proc/scsi/scsi
  40.  *        To dump the state of sg's data structures use:
  41.  *          # cat /proc/scsi/sg/debug
  42.  *
  43.  */
  44. #include <linux/module.h>
  46. #include <linux/fs.h>
  47. #include <linux/kernel.h>
  48. #include <linux/sched.h>
  49. #include <linux/string.h>
  50. #include <linux/mm.h>
  51. #include <linux/errno.h>
  52. #include <linux/mtio.h>
  53. #include <linux/ioctl.h>
  54. #include <linux/fcntl.h>
  55. #include <linux/init.h>
  56. #include <linux/poll.h>
  57. #include <linux/smp_lock.h>
  59. #include <asm/io.h>
  60. #include <asm/uaccess.h>
  61. #include <asm/system.h>
  63. #include <linux/blk.h>
  64. #include "scsi.h"
  65. #include "hosts.h"
  66. #include <scsi/scsi_ioctl.h>
  67. #include <scsi/sg.h>
  69. #ifdef CONFIG_PROC_FS
  70. #include <linux/proc_fs.h>
  71. static int sg_proc_init(void);
  72. static void sg_proc_cleanup(void);
  73. #endif
  75. #ifndef LINUX_VERSION_CODE
  76. #include <linux/version.h>
  77. #endif /* LINUX_VERSION_CODE */
  79. #define SG_ALLOW_DIO_DEF 0
  80. #define SG_ALLOW_DIO_CODE /* compile out be commenting this define */
  81. #ifdef SG_ALLOW_DIO_CODE
  82. #include <linux/iobuf.h>
  83. #endif
  85. #define SG_NEW_KIOVEC 0 /* use alloc_kiovec(), not alloc_kiovec_sz() */
  87. int sg_big_buff = SG_DEF_RESERVED_SIZE;
  88. /* N.B. This variable is readable and writeable via
  89.    /proc/scsi/sg/def_reserved_size . Each time sg_open() is called a buffer
  90.    of this size (or less if there is not enough memory) will be reserved
  91.    for use by this file descriptor. [Deprecated usage: this variable is also
  92.    readable via /proc/sys/kernel/sg-big-buff if the sg driver is built into
  93.    the kernel (i.e. it is not a module).] */
  94. static int def_reserved_size = -1;      /* picks up init parameter */
  95. static int sg_allow_dio = SG_ALLOW_DIO_DEF;
  97. #define SG_SECTOR_SZ 512
  98. #define SG_SECTOR_MSK (SG_SECTOR_SZ - 1)
  100. #define SG_LOW_POOL_THRESHHOLD 30
  101. #define SG_MAX_POOL_SECTORS 320  /* Max. number of pool sectors to take */
  103. static int sg_pool_secs_avail = SG_MAX_POOL_SECTORS;
  105. #define SG_HEAP_PAGE 1  /* heap from kernel via get_free_pages() */
  106. #define SG_HEAP_KMAL 2  /* heap from kernel via kmalloc() */
  107. #define SG_HEAP_POOL 3  /* heap from scsi dma pool (mid-level) */
  108. #define SG_USER_MEM 4   /* memory belongs to user space */
  110. #define SG_DEV_ARR_LUMP 6 /* amount to over allocate sg_dev_arr by */
  113. static int sg_init(void);
  114. static int sg_attach(Scsi_Device *);
  115. static void sg_finish(void);
  116. static int sg_detect(Scsi_Device *);
  117. static void sg_detach(Scsi_Device *);
  119. static Scsi_Request * dummy_cmdp; /* only used for sizeof */
  121. static rwlock_t sg_dev_arr_lock = RW_LOCK_UNLOCKED;  /* Also used to lock
  122. file descriptor list for device */
  124. static struct Scsi_Device_Template sg_template =
  125. {
  126.       tag:"sg",
  127.       scsi_type:0xff,
  128.       major:SCSI_GENERIC_MAJOR,
  129.       detect:sg_detect,
  130.       init:sg_init,
  131.       finish:sg_finish,
  132.       attach:sg_attach,
  133.       detach:sg_detach
  134. };
  137. typedef struct sg_scatter_hold  /* holding area for scsi scatter gather info */
  138. {
  139.     unsigned short k_use_sg;    /* Count of kernel scatter-gather pieces */
  140.     unsigned short sglist_len;  /* size of malloc'd scatter-gather list ++ */
  141.     unsigned bufflen;           /* Size of (aggregate) data buffer */
  142.     unsigned b_malloc_len;      /* actual len malloc'ed in buffer */
  143.     void * buffer;              /* Data buffer or scatter list + mem_src_arr */
  144.     struct kiobuf * kiobp;      /* for direct IO information */
  145.     char mapped;                /* indicates kiobp has locked pages */
  146.     char buffer_mem_src;        /* heap whereabouts of 'buffer' */
  147.     unsigned char cmd_opcode;   /* first byte of command */
  148. } Sg_scatter_hold;    /* 24 bytes long on i386 */
  150. struct sg_device;               /* forward declarations */
  151. struct sg_fd;
  153. typedef struct sg_request  /* SG_MAX_QUEUE requests outstanding per file */
  154. {
  155.     Scsi_Request * my_cmdp;     /* != 0  when request with lower levels */
  156.     struct sg_request * nextrp; /* NULL -> tail request (slist) */
  157.     struct sg_fd * parentfp;    /* NULL -> not in use */
  158.     Sg_scatter_hold data;       /* hold buffer, perhaps scatter list */
  159.     sg_io_hdr_t header;         /* scsi command+info, see <scsi/sg.h> */
  160.     unsigned char sense_b[sizeof(dummy_cmdp->sr_sense_buffer)];
  161.     char res_used;              /* 1 -> using reserve buffer, 0 -> not ... */
  162.     char orphan;                /* 1 -> drop on sight, 0 -> normal */
  163.     char sg_io_owned;           /* 1 -> packet belongs to SG_IO */
  164.     volatile char done;         /* 0->before bh, 1->before read, 2->read */
  165. } Sg_request; /* 168 bytes long on i386 */
  167. typedef struct sg_fd /* holds the state of a file descriptor */
  168. {
  169.     struct sg_fd * nextfp; /* NULL when last opened fd on this device */
  170.     struct sg_device * parentdp;     /* owning device */
  171.     wait_queue_head_t read_wait;     /* queue read until command done */
  172.     rwlock_t rq_list_lock;      /* protect access to list in req_arr */
  173.     int timeout;                     /* defaults to SG_DEFAULT_TIMEOUT */
  174.     Sg_scatter_hold reserve;  /* buffer held for this file descriptor */
  175.     unsigned save_scat_len;   /* original length of trunc. scat. element */
  176.     Sg_request * headrp;      /* head of request slist, NULL->empty */
  177.     struct fasync_struct * async_qp; /* used by asynchronous notification */
  178.     Sg_request req_arr[SG_MAX_QUEUE]; /* used as singly-linked list */
  179.     char low_dma;       /* as in parent but possibly overridden to 1 */
  180.     char force_packid;  /* 1 -> pack_id input to read(), 0 -> ignored */
  181.     volatile char closed; /* 1 -> fd closed but request(s) outstanding */
  182.     char fd_mem_src;    /* heap whereabouts of this Sg_fd object */
  183.     char cmd_q;         /* 1 -> allow command queuing, 0 -> don't */
  184.     char next_cmd_len;  /* 0 -> automatic (def), >0 -> use on next write() */
  185.     char keep_orphan;   /* 0 -> drop orphan (def), 1 -> keep for read() */
  186.     char mmap_called;   /* 0 -> mmap() never called on this fd */
  187. } Sg_fd; /* 2760 bytes long on i386 */
  189. typedef struct sg_device /* holds the state of each scsi generic device */
  190. {
  191.     Scsi_Device * device;
  192.     wait_queue_head_t o_excl_wait;   /* queue open() when O_EXCL in use */
  193.     int sg_tablesize;   /* adapter's max scatter-gather table size */
  194.     Sg_fd * headfp;     /* first open fd belonging to this device */
  195.     devfs_handle_t de;
  196.     kdev_t i_rdev;      /* holds device major+minor number */
  197.     volatile char detached;  /* 0->attached, 1->detached pending removal */
  198.     volatile char exclude;   /* opened for exclusive access */
  199.     char sgdebug;       /* 0->off, 1->sense, 9->dump dev, 10-> all devs */
  200. } Sg_device; /* 36 bytes long on i386 */
  203. static int sg_fasync(int fd, struct file * filp, int mode);
  204. static void sg_cmd_done_bh(Scsi_Cmnd * SCpnt);
  205. static int sg_start_req(Sg_request * srp);
  206. static void sg_finish_rem_req(Sg_request * srp);
  207. static int sg_build_indi(Sg_scatter_hold * schp, Sg_fd * sfp, int buff_size);
  208. static int sg_build_sgat(Sg_scatter_hold * schp, const Sg_fd * sfp,
  209.  int tablesize);
  210. static ssize_t sg_new_read(Sg_fd * sfp, char * buf, size_t count,
  211.    Sg_request * srp);
  212. static ssize_t sg_new_write(Sg_fd * sfp, const char * buf, size_t count,
  213. int blocking, int read_only, Sg_request ** o_srp);
  214. static int sg_common_write(Sg_fd * sfp, Sg_request * srp,
  215.    unsigned char * cmnd, int timeout, int blocking);
  216. static int sg_u_iovec(sg_io_hdr_t * hp, int sg_num, int ind,
  217.       int wr_xf, int * countp, unsigned char ** up);
  218. static int sg_write_xfer(Sg_request * srp);
  219. static int sg_read_xfer(Sg_request * srp);
  220. static void sg_read_oxfer(Sg_request * srp, char * outp, int num_read_xfer);
  221. static void sg_remove_scat(Sg_scatter_hold * schp);
  222. static char * sg_get_sgat_msa(Sg_scatter_hold * schp);
  223. static void sg_build_reserve(Sg_fd * sfp, int req_size);
  224. static void sg_link_reserve(Sg_fd * sfp, Sg_request * srp, int size);
  225. static void sg_unlink_reserve(Sg_fd * sfp, Sg_request * srp);
  226. static char * sg_malloc(const Sg_fd * sfp, int size, int * retSzp,
  227.                         int * mem_srcp);
  228. static void sg_free(char * buff, int size, int mem_src);
  229. static char * sg_low_malloc(int rqSz, int lowDma, int mem_src,
  230.                             int * retSzp);
  231. static void sg_low_free(char * buff, int size, int mem_src);
  232. static Sg_fd * sg_add_sfp(Sg_device * sdp, int dev);
  233. static int sg_remove_sfp(Sg_device * sdp, Sg_fd * sfp);
  234. static void __sg_remove_sfp(Sg_device * sdp, Sg_fd * sfp);
  235. static Sg_request * sg_get_rq_mark(Sg_fd * sfp, int pack_id);
  236. static Sg_request * sg_add_request(Sg_fd * sfp);
  237. static int sg_remove_request(Sg_fd * sfp, Sg_request * srp);
  238. static int sg_res_in_use(Sg_fd * sfp);
  239. static int sg_ms_to_jif(unsigned int msecs);
  240. static inline unsigned sg_jif_to_ms(int jifs);
  241. static int sg_allow_access(unsigned char opcode, char dev_type);
  242. static int sg_build_dir(Sg_request * srp, Sg_fd * sfp, int dxfer_len);
  243. static void sg_unmap_and(Sg_scatter_hold * schp, int free_also);
  244. static Sg_device * sg_get_dev(int dev);
  245. static inline int sg_alloc_kiovec(int nr, struct kiobuf **bufp, int *szp);
  246. static inline void sg_free_kiovec(int nr, struct kiobuf **bufp, int *szp);
  247. #ifdef CONFIG_PROC_FS
  248. static int sg_last_dev(void);
  249. #endif
  251. static Sg_device ** sg_dev_arr = NULL;
  253. #define SZ_SG_HEADER sizeof(struct sg_header)
  254. #define SZ_SG_IO_HDR sizeof(sg_io_hdr_t)
  255. #define SZ_SG_IOVEC sizeof(sg_iovec_t)
  256. #define SZ_SG_REQ_INFO sizeof(sg_req_info_t)
  259. static int sg_open(struct inode * inode, struct file * filp)
  260. {
  261.     int dev = MINOR(inode->i_rdev);
  262.     int flags = filp->f_flags;
  263.     Sg_device * sdp;
  264.     Sg_fd * sfp;
  265.     int res;
  266.     int retval = -EBUSY;
  268.     SCSI_LOG_TIMEOUT(3, printk("sg_open: dev=%d, flags=0x%xn", dev, flags));
  269.     sdp = sg_get_dev(dev);
  270.     if ((! sdp) || (! sdp->device))
  271.         return -ENXIO;
  272.     if (sdp->detached)
  273.      return -ENODEV;
  275.      /* This driver's module count bumped by fops_get in <linux/fs.h> */
  276.      /* Prevent the device driver from vanishing while we sleep */
  277.      if (sdp->device->host->hostt->module)
  278.         __MOD_INC_USE_COUNT(sdp->device->host->hostt->module);
  279.     sdp->device->access_count++;
  281.     if (! ((flags & O_NONBLOCK) ||
  282.    scsi_block_when_processing_errors(sdp->device))) {
  283.         retval = -ENXIO;
  284. /* we are in error recovery for this device */
  285. goto error_out;
  286.     }
  288.     if (flags & O_EXCL) {
  289.         if (O_RDONLY == (flags & O_ACCMODE))  {
  290.             retval = -EPERM;   /* Can't lock it with read only access */
  291.     goto error_out;
  292. }
  293. if (sdp->headfp && (flags & O_NONBLOCK))
  294.             goto error_out;
  295.         res = 0; 
  296. __wait_event_interruptible(sdp->o_excl_wait,
  297.        ((sdp->headfp || sdp->exclude) ? 0 : (sdp->exclude = 1)),
  298.                                    res);
  299.         if (res) {
  300.             retval = res; /* -ERESTARTSYS because signal hit process */
  301.     goto error_out;
  302.         }
  303.     }
  304.     else if (sdp->exclude) { /* some other fd has an exclusive lock on dev */
  305.         if (flags & O_NONBLOCK)
  306.             goto error_out;
  307.         res = 0; 
  308.         __wait_event_interruptible(sdp->o_excl_wait, (! sdp->exclude), res);
  309.         if (res) {
  310.             retval = res; /* -ERESTARTSYS because signal hit process */
  311.     goto error_out;
  312.         }
  313.     }
  314.     if (sdp->detached) {
  315.      retval = -ENODEV;
  316. goto error_out;
  317.     }
  318.     if (! sdp->headfp) { /* no existing opens on this device */
  319.         sdp->sgdebug = 0;
  320.         sdp->sg_tablesize = sdp->device->host->sg_tablesize;
  321.     }
  322.     if ((sfp = sg_add_sfp(sdp, dev)))
  323.         filp->private_data = sfp;
  324.     else {
  325.         if (flags & O_EXCL) sdp->exclude = 0; /* undo if error */
  326.         retval = -ENOMEM;
  327. goto error_out;
  328.     }
  329.     return 0;
  331. error_out:
  332.     sdp->device->access_count--;
  333.     if ((! sdp->detached) && sdp->device->host->hostt->module)
  334.         __MOD_DEC_USE_COUNT(sdp->device->host->hostt->module);
  335.     return retval;
  336. }
  338. /* Following function was formerly called 'sg_close' */
  339. static int sg_release(struct inode * inode, struct file * filp)
  340. {
  341.     Sg_device * sdp;
  342.     Sg_fd * sfp;
  344.     lock_kernel();
  345.     if ((! (sfp = (Sg_fd *)filp->private_data)) || (! (sdp = sfp->parentdp))) {
  346. unlock_kernel();
  347.         return -ENXIO;
  348.     }
  349.     SCSI_LOG_TIMEOUT(3, printk("sg_release: dev=%dn", MINOR(sdp->i_rdev)));
  350.     sg_fasync(-1, filp, 0);   /* remove filp from async notification list */
  351.     if (0 == sg_remove_sfp(sdp, sfp)) { /* Returns 1 when sdp gone */
  352.         if (! sdp->detached) {
  353.             sdp->device->access_count--;
  354.             if (sdp->device->host->hostt->module)
  355.                 __MOD_DEC_USE_COUNT(sdp->device->host->hostt->module);
  356.         }
  357. sdp->exclude = 0;
  358. wake_up_interruptible(&sdp->o_excl_wait);
  359.     }
  360.     unlock_kernel();
  361.     return 0;
  362. }
  364. static ssize_t sg_read(struct file * filp, char * buf,
  365.                        size_t count, loff_t *ppos)
  366. {
  367.     int k, res;
  368.     Sg_device * sdp;
  369.     Sg_fd * sfp;
  370.     Sg_request * srp;
  371.     int req_pack_id = -1;
  372.     struct sg_header old_hdr;
  373.     sg_io_hdr_t new_hdr;
  374.     sg_io_hdr_t * hp;
  376.     if ((! (sfp = (Sg_fd *)filp->private_data)) || (! (sdp = sfp->parentdp)))
  377.         return -ENXIO;
  378.     SCSI_LOG_TIMEOUT(3, printk("sg_read: dev=%d, count=%dn",
  379.                                MINOR(sdp->i_rdev), (int)count));
  380.     if (ppos != &filp->f_pos)
  381.         ; /* FIXME: Hmm.  Seek to the right place, or fail?  */
  382.     if ((k = verify_area(VERIFY_WRITE, buf, count)))
  383.         return k;
  384.     if (sfp->force_packid && (count >= SZ_SG_HEADER)) {
  385. __copy_from_user(&old_hdr, buf, SZ_SG_HEADER);
  386. if (old_hdr.reply_len < 0) {
  387.     if (count >= SZ_SG_IO_HDR) {
  388. __copy_from_user(&new_hdr, buf, SZ_SG_IO_HDR);
  389. req_pack_id = new_hdr.pack_id;
  390.     }
  391. }
  392. else
  393.     req_pack_id = old_hdr.pack_id;
  394.     }
  395.     srp = sg_get_rq_mark(sfp, req_pack_id);
  396.     if (! srp) { /* now wait on packet to arrive */
  397. if (sdp->detached)
  398.     return -ENODEV;
  399.         if (filp->f_flags & O_NONBLOCK)
  400.             return -EAGAIN;
  401. while (1) {
  402.     res = 0;  /* following is a macro that beats race condition */
  403.     __wait_event_interruptible(sfp->read_wait, (sdp->detached || 
  404.     (srp = sg_get_rq_mark(sfp, req_pack_id))), res);
  405.     if (sdp->detached)
  406. return -ENODEV;
  407.     if (0 == res)
  408. break;
  409.     return res; /* -ERESTARTSYS because signal hit process */
  410. }
  411.     }
  412.     if (srp->header.interface_id != '')
  413. return sg_new_read(sfp, buf, count, srp);
  415.     hp = &srp->header;
  416.     memset(&old_hdr, 0, SZ_SG_HEADER);
  417.     old_hdr.reply_len = (int)hp->timeout;
  418.     old_hdr.pack_len = old_hdr.reply_len;   /* very old, strange behaviour */
  419.     old_hdr.pack_id = hp->pack_id;
  420.     old_hdr.twelve_byte =
  421.     ((srp->data.cmd_opcode >= 0xc0) && (12 == hp->cmd_len)) ? 1 : 0;
  422.     old_hdr.target_status = hp->masked_status;
  423.     old_hdr.host_status = hp->host_status;
  424.     old_hdr.driver_status = hp->driver_status;
  425.     if ((CHECK_CONDITION & hp->masked_status) ||
  426. (DRIVER_SENSE & hp->driver_status))
  427. memcpy(old_hdr.sense_buffer, srp->sense_b,
  428.        sizeof(old_hdr.sense_buffer));
  429.     switch (hp->host_status)
  430.     { /* This setup of 'result' is for backward compatibility and is best
  431.  ignored by the user who should use target, host + driver status */
  432. case DID_OK:
  433. case DID_PASSTHROUGH:
  434. case DID_SOFT_ERROR:
  435.     old_hdr.result = 0;
  436.     break;
  437. case DID_NO_CONNECT:
  438. case DID_BUS_BUSY:
  439. case DID_TIME_OUT:
  440.     old_hdr.result = EBUSY;
  441.     break;
  442. case DID_BAD_TARGET:
  443. case DID_ABORT:
  444. case DID_PARITY:
  445. case DID_RESET:
  446. case DID_BAD_INTR:
  447.     old_hdr.result = EIO;
  448.     break;
  449. case DID_ERROR:
  450.     old_hdr.result =
  451.       (srp->sense_b[0] == 0 && hp->masked_status == GOOD) ? 0 : EIO;
  452.     break;
  453. default:
  454.     old_hdr.result = EIO;
  455.     break;
  456.     }
  458.     /* Now copy the result back to the user buffer.  */
  459.     if (count >= SZ_SG_HEADER) {
  460. __copy_to_user(buf, &old_hdr, SZ_SG_HEADER);
  461.         buf += SZ_SG_HEADER;
  462. if (count > old_hdr.reply_len)
  463.     count = old_hdr.reply_len;
  464. if (count > SZ_SG_HEADER)
  465.     sg_read_oxfer(srp, buf, count - SZ_SG_HEADER);
  466.     }
  467.     else
  468. count = (old_hdr.result == 0) ? 0 : -EIO;
  469.     sg_finish_rem_req(srp);
  470.     return count;
  471. }
  473. static ssize_t sg_new_read(Sg_fd * sfp, char * buf, size_t count,
  474.    Sg_request * srp)
  475. {
  476.     sg_io_hdr_t * hp = &srp->header;
  477.     int err = 0;
  478.     int len;
  480.     if (count < SZ_SG_IO_HDR) {
  481. err = -EINVAL;
  482.      goto err_out;
  483.     }
  484.     hp->sb_len_wr = 0;
  485.     if ((hp->mx_sb_len > 0) && hp->sbp) {
  486. if ((CHECK_CONDITION & hp->masked_status) ||
  487.     (DRIVER_SENSE & hp->driver_status)) {
  488.     int sb_len = sizeof(dummy_cmdp->sr_sense_buffer);
  489.     sb_len = (hp->mx_sb_len > sb_len) ? sb_len : hp->mx_sb_len;
  490.     len = 8 + (int)srp->sense_b[7]; /* Additional sense length field */
  491.     len = (len > sb_len) ? sb_len : len;
  492.     if ((err = verify_area(VERIFY_WRITE, hp->sbp, len)))
  493. goto err_out;
  494.     __copy_to_user(hp->sbp, srp->sense_b, len);
  495.     hp->sb_len_wr = len;
  496. }
  497.     }
  498.     if (hp->masked_status || hp->host_status || hp->driver_status)
  499. hp->info |= SG_INFO_CHECK;
  500.     copy_to_user(buf, hp, SZ_SG_IO_HDR);
  501.     err = sg_read_xfer(srp);
  502. err_out:
  503.     sg_finish_rem_req(srp);
  504.     return (0 == err) ? count : err;
  505. }
  508. static ssize_t sg_write(struct file * filp, const char * buf,
  509.                         size_t count, loff_t *ppos)
  510. {
  511.     int                   mxsize, cmd_size, k;
  512.     int                   input_size, blocking;
  513.     unsigned char         opcode;
  514.     Sg_device           * sdp;
  515.     Sg_fd               * sfp;
  516.     Sg_request          * srp;
  517.     struct sg_header      old_hdr;
  518.     sg_io_hdr_t         * hp;
  519.     unsigned char         cmnd[sizeof(dummy_cmdp->sr_cmnd)];
  521.     if ((! (sfp = (Sg_fd *)filp->private_data)) || (! (sdp = sfp->parentdp)))
  522.         return -ENXIO;
  523.     SCSI_LOG_TIMEOUT(3, printk("sg_write: dev=%d, count=%dn",
  524.                                MINOR(sdp->i_rdev), (int)count));
  525.     if (sdp->detached)
  526.      return -ENODEV;
  527.     if (! ((filp->f_flags & O_NONBLOCK) ||
  528.            scsi_block_when_processing_errors(sdp->device)))
  529.         return -ENXIO;
  530.     if (ppos != &filp->f_pos)
  531.         ; /* FIXME: Hmm.  Seek to the right place, or fail?  */
  533.     if ((k = verify_area(VERIFY_READ, buf, count)))
  534.         return k;  /* protects following copy_from_user()s + get_user()s */
  535.     if (count < SZ_SG_HEADER)
  536. return -EIO;
  537.     __copy_from_user(&old_hdr, buf, SZ_SG_HEADER);
  538.     blocking = !(filp->f_flags & O_NONBLOCK);
  539.     if (old_hdr.reply_len < 0)
  540. return sg_new_write(sfp, buf, count, blocking, 0, NULL);
  541.     if (count < (SZ_SG_HEADER + 6))
  542. return -EIO;   /* The minimum scsi command length is 6 bytes. */
  544.     if (! (srp = sg_add_request(sfp))) {
  545. SCSI_LOG_TIMEOUT(1, printk("sg_write: queue fulln"));
  546. return -EDOM;
  547.     }
  548.     buf += SZ_SG_HEADER;
  549.     __get_user(opcode, buf);
  550.     if (sfp->next_cmd_len > 0) {
  551.         if (sfp->next_cmd_len > MAX_COMMAND_SIZE) {
  552.             SCSI_LOG_TIMEOUT(1, printk("sg_write: command length too longn"));
  553.             sfp->next_cmd_len = 0;
  554.     sg_remove_request(sfp, srp);
  555.             return -EIO;
  556.         }
  557.         cmd_size = sfp->next_cmd_len;
  558.         sfp->next_cmd_len = 0; /* reset so only this write() effected */
  559.     }
  560.     else {
  561.         cmd_size = COMMAND_SIZE(opcode); /* based on SCSI command group */
  562. if ((opcode >= 0xc0) && old_hdr.twelve_byte)
  563.             cmd_size = 12;
  564.     }
  565.     SCSI_LOG_TIMEOUT(4, printk("sg_write:   scsi opcode=0x%02x, cmd_size=%dn",
  566.                                (int)opcode, cmd_size));
  567. /* Determine buffer size.  */
  568.     input_size = count - cmd_size;
  569.     mxsize = (input_size > old_hdr.reply_len) ? input_size :
  570. old_hdr.reply_len;
  571.     mxsize -= SZ_SG_HEADER;
  572.     input_size -= SZ_SG_HEADER;
  573.     if (input_size < 0) {
  574.         sg_remove_request(sfp, srp);
  575.         return -EIO; /* User did not pass enough bytes for this command. */
  576.     }
  577.     hp = &srp->header;
  578.     hp->interface_id = ''; /* indicator of old interface tunnelled */
  579.     hp->cmd_len = (unsigned char)cmd_size;
  580.     hp->iovec_count = 0;
  581.     hp->mx_sb_len = 0;
  582.     if (input_size > 0)
  583. hp->dxfer_direction = (old_hdr.reply_len > SZ_SG_HEADER) ?
  584.       SG_DXFER_TO_FROM_DEV : SG_DXFER_TO_DEV;
  585.     else
  586. hp->dxfer_direction = (mxsize > 0) ? SG_DXFER_FROM_DEV :
  587.      SG_DXFER_NONE;
  588.     hp->dxfer_len = mxsize;
  589.     hp->dxferp = (unsigned char *)buf + cmd_size;
  590.     hp->sbp = NULL;
  591.     hp->timeout = old_hdr.reply_len;    /* structure abuse ... */
  592.     hp->flags = input_size;             /* structure abuse ... */
  593.     hp->pack_id = old_hdr.pack_id;
  594.     hp->usr_ptr = NULL;
  595.     __copy_from_user(cmnd, buf, cmd_size);
  596.     k = sg_common_write(sfp, srp, cmnd, sfp->timeout, blocking);
  597.     return (k < 0) ? k : count;
  598. }
  600. static ssize_t sg_new_write(Sg_fd * sfp, const char * buf, size_t count,
  601.     int blocking, int read_only, Sg_request ** o_srp)
  602. {
  603.     int                   k;
  604.     Sg_request          * srp;
  605.     sg_io_hdr_t         * hp;
  606.     unsigned char         cmnd[sizeof(dummy_cmdp->sr_cmnd)];
  607.     int                   timeout;
  609.     if (count < SZ_SG_IO_HDR)
  610. return -EINVAL;
  611.     if ((k = verify_area(VERIFY_READ, buf, count)))
  612. return k;  /* protects following copy_from_user()s + get_user()s */
  614.     sfp->cmd_q = 1;  /* when sg_io_hdr seen, set command queuing on */
  615.     if (! (srp = sg_add_request(sfp))) {
  616. SCSI_LOG_TIMEOUT(1, printk("sg_new_write: queue fulln"));
  617. return -EDOM;
  618.     }
  619.     hp = &srp->header;
  620.     __copy_from_user(hp, buf, SZ_SG_IO_HDR);
  621.     if (hp->interface_id != 'S') {
  622. sg_remove_request(sfp, srp);
  623. return -ENOSYS;
  624.     }
  625.     if (hp->flags & SG_FLAG_MMAP_IO) {
  626.      if (hp->dxfer_len > sfp->reserve.bufflen) {
  627.     sg_remove_request(sfp, srp);
  628.     return -ENOMEM; /* MMAP_IO size must fit in reserve buffer */
  629. }
  630. if (hp->flags & SG_FLAG_DIRECT_IO) {
  631.     sg_remove_request(sfp, srp);
  632.     return -EINVAL; /* either MMAP_IO or DIRECT_IO (not both) */
  633. }
  634. if (sg_res_in_use(sfp)) {
  635.     sg_remove_request(sfp, srp);
  636.     return -EBUSY; /* reserve buffer already being used */
  637. }
  638.     }
  639.     timeout = sg_ms_to_jif(srp->header.timeout);
  640.     if ((! hp->cmdp) || (hp->cmd_len < 6) || (hp->cmd_len > sizeof(cmnd))) {
  641. sg_remove_request(sfp, srp);
  642. return -EMSGSIZE;
  643.     }
  644.     if ((k = verify_area(VERIFY_READ, hp->cmdp, hp->cmd_len))) {
  645. sg_remove_request(sfp, srp);
  646. return k;  /* protects following copy_from_user()s + get_user()s */
  647.     }
  648.     __copy_from_user(cmnd, hp->cmdp, hp->cmd_len);
  649.     if (read_only &&
  650. (! sg_allow_access(cmnd[0], sfp->parentdp->device->type))) {
  651. sg_remove_request(sfp, srp);
  652. return -EPERM;
  653.     }
  654.     k = sg_common_write(sfp, srp, cmnd, timeout, blocking);
  655.     if (k < 0) return k;
  656.     if (o_srp) *o_srp = srp;
  657.     return count;
  658. }
  660. static int sg_common_write(Sg_fd * sfp, Sg_request * srp,
  661.    unsigned char * cmnd, int timeout, int blocking)
  662. {
  663.     int                   k;
  664.     Scsi_Request        * SRpnt;
  665.     Sg_device           * sdp = sfp->parentdp;
  666.     sg_io_hdr_t         * hp = &srp->header;
  667.     request_queue_t * q;
  669.     srp->data.cmd_opcode = cmnd[0];  /* hold opcode of command */
  670.     hp->status = 0;
  671.     hp->masked_status = 0;
  672.     hp->msg_status = 0;
  673.     hp->info = 0;
  674.     hp->host_status = 0;
  675.     hp->driver_status = 0;
  676.     hp->resid = 0;
  677.     SCSI_LOG_TIMEOUT(4,
  678. printk("sg_common_write:  scsi opcode=0x%02x, cmd_size=%dn",
  679.        (int)cmnd[0], (int)hp->cmd_len));
  681.     if ((k = sg_start_req(srp))) {
  682. SCSI_LOG_TIMEOUT(1, printk("sg_write: start_req err=%dn", k));
  683. sg_finish_rem_req(srp);
  684.         return k;    /* probably out of space --> ENOMEM */
  685.     }
  686.     if ((k = sg_write_xfer(srp))) {
  687. SCSI_LOG_TIMEOUT(1, printk("sg_write: write_xfer, bad addressn"));
  688. sg_finish_rem_req(srp);
  689. return k;
  690.     }
  691.     if (sdp->detached) {
  692.      sg_finish_rem_req(srp);
  693.      return -ENODEV;
  694.     }
  695.     SRpnt = scsi_allocate_request(sdp->device);
  696.     if(SRpnt == NULL) {
  697.      SCSI_LOG_TIMEOUT(1, printk("sg_write: no memn"));
  698.      sg_finish_rem_req(srp);
  699.      return -ENOMEM;
  700.     }
  702.     srp->my_cmdp = SRpnt;
  703.     q = &SRpnt->sr_device->request_queue;
  704.     SRpnt->sr_request.rq_dev = sdp->i_rdev;
  705.     SRpnt->sr_request.rq_status = RQ_ACTIVE;
  706.     SRpnt->sr_sense_buffer[0] = 0;
  707.     SRpnt->sr_cmd_len = hp->cmd_len;
  708.     if (! (hp->flags & SG_FLAG_LUN_INHIBIT)) {
  709. if (sdp->device->scsi_level <= SCSI_2)
  710.     cmnd[1] = (cmnd[1] & 0x1f) | (sdp->device->lun << 5);
  711.     }
  712.     SRpnt->sr_use_sg = srp->data.k_use_sg;
  713.     SRpnt->sr_sglist_len = srp->data.sglist_len;
  714.     SRpnt->sr_bufflen = srp->data.bufflen;
  715.     SRpnt->sr_underflow = 0;
  716.     SRpnt->sr_buffer = srp->data.buffer;
  717.     switch (hp->dxfer_direction) {
  718.     case SG_DXFER_TO_FROM_DEV:
  719.     case SG_DXFER_FROM_DEV:
  720. SRpnt->sr_data_direction = SCSI_DATA_READ; break;
  721.     case SG_DXFER_TO_DEV:
  722. SRpnt->sr_data_direction = SCSI_DATA_WRITE; break;
  723.     case SG_DXFER_UNKNOWN:
  724. SRpnt->sr_data_direction = SCSI_DATA_UNKNOWN; break;
  725.     default:
  726. SRpnt->sr_data_direction = SCSI_DATA_NONE; break;
  727.     }
  728.     srp->data.k_use_sg = 0;
  729.     srp->data.sglist_len = 0;
  730.     srp->data.bufflen = 0;
  731.     srp->data.buffer = NULL;
  732.     hp->duration = jiffies; /* unit jiffies now, millisecs after done */
  733. /* Now send everything of to mid-level. The next time we hear about this
  734.    packet is when sg_cmd_done_bh() is called (i.e. a callback). */
  735.     scsi_do_req(SRpnt, (void *)cmnd,
  736. (void *)SRpnt->sr_buffer, hp->dxfer_len,
  737. sg_cmd_done_bh, timeout, SG_DEFAULT_RETRIES);
  738.     /* dxfer_len overwrites SRpnt->sr_bufflen, hence need for b_malloc_len */
  739. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,1)
  740.     generic_unplug_device(q);
  741. #endif
  742.     return 0;
  743. }
  745. static int sg_ioctl(struct inode * inode, struct file * filp,
  746.                     unsigned int cmd_in, unsigned long arg)
  747. {
  748.     int result, val, read_only;
  749.     Sg_device * sdp;
  750.     Sg_fd * sfp;
  751.     Sg_request * srp;
  752.     unsigned long iflags;
  754.     if ((! (sfp = (Sg_fd *)filp->private_data)) || (! (sdp = sfp->parentdp)))
  755.         return -ENXIO;
  756.     SCSI_LOG_TIMEOUT(3, printk("sg_ioctl: dev=%d, cmd=0x%xn",
  757.                                MINOR(sdp->i_rdev), (int)cmd_in));
  758.     read_only = (O_RDWR != (filp->f_flags & O_ACCMODE));
  760.     switch(cmd_in)
  761.     {
  762.     case SG_IO:
  763. {
  764.     int blocking = 1;   /* ignore O_NONBLOCK flag */
  766.     if (sdp->detached)
  767. return -ENODEV;
  768.     if(! scsi_block_when_processing_errors(sdp->device) )
  769. return -ENXIO;
  770.     result = verify_area(VERIFY_WRITE, (void *)arg, SZ_SG_IO_HDR);
  771.     if (result) return result;
  772.     result = sg_new_write(sfp, (const char *)arg, SZ_SG_IO_HDR,
  773.   blocking, read_only, &srp);
  774.     if (result < 0) return result;
  775.     srp->sg_io_owned = 1;
  776.     while (1) {
  777. result = 0;  /* following macro to beat race condition */
  778. __wait_event_interruptible(sfp->read_wait,
  779.        (sdp->detached || sfp->closed || srp->done), result);
  780. if (sdp->detached)
  781.     return -ENODEV;
  782. if (sfp->closed)
  783.     return 0;       /* request packet dropped already */
  784. if (0 == result)
  785.     break;
  786. srp->orphan = 1;
  787. return result; /* -ERESTARTSYS because signal hit process */
  788.     }
  789.     srp->done = 2;
  790.     result = sg_new_read(sfp, (char *)arg, SZ_SG_IO_HDR, srp);
  791.     return (result < 0) ? result : 0;
  792. }
  793.     case SG_SET_TIMEOUT:
  794.         result =  get_user(val, (int *)arg);
  795.         if (result) return result;
  796.         if (val < 0)
  797.             return -EIO;
  798.         sfp->timeout = val;
  799.         return 0;
  800.     case SG_GET_TIMEOUT:  /* N.B. User receives timeout as return value */
  801.         return sfp->timeout; /* strange ..., for backward compatibility */
  802.     case SG_SET_FORCE_LOW_DMA:
  803.         result = get_user(val, (int *)arg);
  804.         if (result) return result;
  805.         if (val) {
  806.             sfp->low_dma = 1;
  807.             if ((0 == sfp->low_dma) && (0 == sg_res_in_use(sfp))) {
  808.                 val = (int)sfp->reserve.bufflen;
  809.                 sg_remove_scat(&sfp->reserve);
  810.                 sg_build_reserve(sfp, val);
  811.             }
  812.         }
  813.         else {
  814.     if (sdp->detached)
  815. return -ENODEV;
  816.             sfp->low_dma = sdp->device->host->unchecked_isa_dma;
  817. }
  818.         return 0;
  819.     case SG_GET_LOW_DMA:
  820.         return put_user((int)sfp->low_dma, (int *)arg);
  821.     case SG_GET_SCSI_ID:
  822. result = verify_area(VERIFY_WRITE, (void *)arg, sizeof(sg_scsi_id_t));
  823.         if (result) return result;
  824.         else {
  825.     sg_scsi_id_t * sg_idp = (sg_scsi_id_t *)arg;
  827.     if (sdp->detached)
  828. return -ENODEV;
  829.             __put_user((int)sdp->device->host->host_no, &sg_idp->host_no);
  830.             __put_user((int)sdp->device->channel, &sg_idp->channel);
  831.             __put_user((int)sdp->device->id, &sg_idp->scsi_id);
  832.             __put_user((int)sdp->device->lun, &sg_idp->lun);
  833.             __put_user((int)sdp->device->type, &sg_idp->scsi_type);
  834.     __put_user((short)sdp->device->host->cmd_per_lun,
  835.                        &sg_idp->h_cmd_per_lun);
  836.     __put_user((short)sdp->device->queue_depth,
  837.                        &sg_idp->d_queue_depth);
  838.     __put_user(0, &sg_idp->unused[0]);
  839.     __put_user(0, &sg_idp->unused[1]);
  840.             return 0;
  841.         }
  842.     case SG_SET_FORCE_PACK_ID:
  843.         result = get_user(val, (int *)arg);
  844.         if (result) return result;
  845.         sfp->force_packid = val ? 1 : 0;
  846.         return 0;
  847.     case SG_GET_PACK_ID:
  848.         result = verify_area(VERIFY_WRITE, (void *) arg, sizeof(int));
  849.         if (result) return result;
  850. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  851. for (srp = sfp->headrp; srp; srp = srp->nextrp) {
  852.     if ((1 == srp->done) && (! srp->sg_io_owned)) {
  853. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  854.                 __put_user(srp->header.pack_id, (int *)arg);
  855.                 return 0;
  856.             }
  857.         }
  858. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  859.         __put_user(-1, (int *)arg);
  860.         return 0;
  861.     case SG_GET_NUM_WAITING:
  862. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  863.         for (val = 0, srp = sfp->headrp; srp; srp = srp->nextrp) {
  864.     if ((1 == srp->done) && (! srp->sg_io_owned))
  865.                 ++val;
  866.         }
  867. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  868.         return put_user(val, (int *)arg);
  869.     case SG_GET_SG_TABLESIZE:
  870.         return put_user(sdp->sg_tablesize, (int *)arg);
  871.     case SG_SET_RESERVED_SIZE:
  872.         result = get_user(val, (int *)arg);
  873.         if (result) return result;
  874.         if (val != sfp->reserve.bufflen) {
  875.             if (sg_res_in_use(sfp) || sfp->mmap_called)
  876.                 return -EBUSY;
  877.             sg_remove_scat(&sfp->reserve);
  878.             sg_build_reserve(sfp, val);
  879.         }
  880.         return 0;
  881.     case SG_GET_RESERVED_SIZE:
  882.         val = (int)sfp->reserve.bufflen;
  883.         return put_user(val, (int *)arg);
  884.     case SG_SET_COMMAND_Q:
  885.         result = get_user(val, (int *)arg);
  886.         if (result) return result;
  887.         sfp->cmd_q = val ? 1 : 0;
  888.         return 0;
  889.     case SG_GET_COMMAND_Q:
  890.         return put_user((int)sfp->cmd_q, (int *)arg);
  891.     case SG_SET_KEEP_ORPHAN:
  892.         result = get_user(val, (int *)arg);
  893.         if (result) return result;
  894. sfp->keep_orphan = val;
  895.         return 0;
  896.     case SG_GET_KEEP_ORPHAN:
  897. return put_user((int)sfp->keep_orphan, (int *)arg);
  898.     case SG_NEXT_CMD_LEN:
  899.         result = get_user(val, (int *)arg);
  900.         if (result) return result;
  901.         sfp->next_cmd_len = (val > 0) ? val : 0;
  902.         return 0;
  903.     case SG_GET_VERSION_NUM:
  904.         return put_user(sg_version_num, (int *)arg);
  905.     case SG_GET_ACCESS_COUNT:
  906.      val = (sdp->device ? sdp->device->access_count : 0);
  907. return put_user(val, (int *)arg);
  908.     case SG_GET_REQUEST_TABLE:
  909. result = verify_area(VERIFY_WRITE, (void *) arg,
  910.      SZ_SG_REQ_INFO * SG_MAX_QUEUE);
  911. if (result) return result;
  912. else {
  913.     sg_req_info_t rinfo[SG_MAX_QUEUE];
  914.     Sg_request * srp;
  915.     read_lock_irqsave(&sfp->rq_list_lock, iflags);
  916.     for (srp = sfp->headrp, val = 0; val < SG_MAX_QUEUE;
  917.  ++val, srp = srp ? srp->nextrp : srp) {
  918. memset(&rinfo[val], 0, SZ_SG_REQ_INFO);
  919. if (srp) {
  920.     rinfo[val].req_state = srp->done + 1;
  921.     rinfo[val].problem = srp->header.masked_status &
  922. srp->header.host_status & srp->header.driver_status;
  923.     rinfo[val].duration = srp->done ?
  924.     srp->header.duration :
  925.     sg_jif_to_ms(jiffies - srp->header.duration);
  926.     rinfo[val].orphan = srp->orphan;
  927.     rinfo[val].sg_io_owned = srp->sg_io_owned;
  928.     rinfo[val].pack_id = srp->header.pack_id;
  929.     rinfo[val].usr_ptr = srp->header.usr_ptr;
  930. }
  931.     }
  932.     read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  933.     __copy_to_user((void *)arg, rinfo, SZ_SG_REQ_INFO * SG_MAX_QUEUE);
  934.     return 0;
  935. }
  936.     case SG_EMULATED_HOST:
  937. if (sdp->detached)
  938.     return -ENODEV;
  939.         return put_user(sdp->device->host->hostt->emulated, (int *)arg);
  940.     case SG_SCSI_RESET:
  941. if (sdp->detached)
  942.     return -ENODEV;
  943.         if (filp->f_flags & O_NONBLOCK) {
  944.     if (sdp->device->host->in_recovery)
  945. return -EBUSY;
  946. }
  947. else if (! scsi_block_when_processing_errors(sdp->device))
  948.             return -EBUSY;
  949.         result = get_user(val, (int *)arg);
  950.         if (result) return result;
  951. if (SG_SCSI_RESET_NOTHING == val)
  952.     return 0;
  953. #ifdef SCSI_TRY_RESET_DEVICE
  954. switch (val)
  955. {
  956. case SG_SCSI_RESET_DEVICE:
  957.     val = SCSI_TRY_RESET_DEVICE;
  958.     break;
  959. case SG_SCSI_RESET_BUS:
  960.     val = SCSI_TRY_RESET_BUS;
  961.     break;
  962. case SG_SCSI_RESET_HOST:
  963.     val = SCSI_TRY_RESET_HOST;
  964.     break;
  965. default:
  966.     return -EINVAL;
  967. }
  968. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  969.     return -EACCES;
  970. return (scsi_reset_provider(sdp->device, val) == SUCCESS) ? 0 : -EIO;
  971. #else
  972. SCSI_LOG_TIMEOUT(1, printk("sg_ioctl: SG_RESET_SCSI not supportedn"));
  973. result = -EINVAL;
  974. #endif
  975.     case SCSI_IOCTL_SEND_COMMAND:
  976. if (sdp->detached)
  977.     return -ENODEV;
  978. if (read_only) {
  979.     unsigned char opcode = WRITE_6;
  980.     Scsi_Ioctl_Command * siocp = (void *)arg;
  982.     copy_from_user(&opcode, siocp->data, 1);
  983.     if (! sg_allow_access(opcode, sdp->device->type))
  984. return -EPERM;
  985. }
  986.         return scsi_ioctl_send_command(sdp->device, (void *)arg);
  987.     case SG_SET_DEBUG:
  988.         result = get_user(val, (int *)arg);
  989.         if (result) return result;
  990.         sdp->sgdebug = (char)val;
  991.         return 0;
  992.     case SCSI_IOCTL_GET_IDLUN:
  993.     case SCSI_IOCTL_GET_BUS_NUMBER:
  994.     case SCSI_IOCTL_PROBE_HOST:
  995.     case SG_GET_TRANSFORM:
  996. if (sdp->detached)
  997.     return -ENODEV;
  998.         return scsi_ioctl(sdp->device, cmd_in, (void *)arg);
  999.     default:
  1000. if (read_only)
  1001.             return -EPERM; /* don't know so take safe approach */
  1002.         return scsi_ioctl(sdp->device, cmd_in, (void *)arg);
  1003.     }
  1004. }
  1006. static unsigned int sg_poll(struct file * filp, poll_table * wait)
  1007. {
  1008.     unsigned int res = 0;
  1009.     Sg_device * sdp;
  1010.     Sg_fd * sfp;
  1011.     Sg_request * srp;
  1012.     int count = 0;
  1013.     unsigned long iflags;
  1015.     if ((! (sfp = (Sg_fd *)filp->private_data)) || (! (sdp = sfp->parentdp))
  1016.      || sfp->closed)
  1017.         return POLLERR;
  1018.     poll_wait(filp, &sfp->read_wait, wait);
  1019.     read_lock_irqsave(&sfp->rq_list_lock, iflags);
  1020.     for (srp = sfp->headrp; srp; srp = srp->nextrp) {   
  1021.      /* if any read waiting, flag it */
  1022. if ((0 == res) && (1 == srp->done) && (! srp->sg_io_owned))
  1023.             res = POLLIN | POLLRDNORM;
  1024.         ++count;
  1025.     }
  1026.     read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1028.     if (sdp->detached)
  1029. res |= POLLHUP;
  1030.     else if (! sfp->cmd_q) {
  1031.         if (0 == count)
  1032.             res |= POLLOUT | POLLWRNORM;
  1033.     }
  1034.     else if (count < SG_MAX_QUEUE)
  1035.         res |= POLLOUT | POLLWRNORM;
  1036.     SCSI_LOG_TIMEOUT(3, printk("sg_poll: dev=%d, res=0x%xn",
  1037.                         MINOR(sdp->i_rdev), (int)res));
  1038.     return res;
  1039. }
  1041. static int sg_fasync(int fd, struct file * filp, int mode)
  1042. {
  1043.     int retval;
  1044.     Sg_device * sdp;
  1045.     Sg_fd * sfp;
  1047.     if ((! (sfp = (Sg_fd *)filp->private_data)) || (! (sdp = sfp->parentdp)))
  1048.         return -ENXIO;
  1049.     SCSI_LOG_TIMEOUT(3, printk("sg_fasync: dev=%d, mode=%dn",
  1050.                                MINOR(sdp->i_rdev), mode));
  1052.     retval = fasync_helper(fd, filp, mode, &sfp->async_qp);
  1053.     return (retval < 0) ? retval : 0;
  1054. }
  1056. static void sg_rb_correct4mmap(Sg_scatter_hold * rsv_schp, int startFinish)
  1057. {
  1058.     void * page_ptr;
  1059.     struct page * page;
  1060.     int k, m;
  1062.     SCSI_LOG_TIMEOUT(3, printk("sg_rb_correct4mmap: startFinish=%d, "
  1063.    "scatg=%dn", startFinish, rsv_schp->k_use_sg)); 
  1064.     /* N.B. correction _not_ applied to base page of aech allocation */
  1065.     if (rsv_schp->k_use_sg) { /* reserve buffer is a scatter gather list */
  1066.         struct scatterlist * sclp = rsv_schp->buffer;
  1068.         for (k = 0; k < rsv_schp->k_use_sg; ++k, ++sclp) {
  1069.     for (m = PAGE_SIZE; m < sclp->length; m += PAGE_SIZE) {
  1070. page_ptr = (unsigned char *)sclp->address + m;
  1071. page = virt_to_page(page_ptr);
  1072. if (startFinish)
  1073.     get_page(page); /* increment page count */
  1074. else {
  1075.     if (page_count(page) > 0)
  1076. put_page_testzero(page); /* decrement page count */
  1077. }
  1078.     }
  1079.         }
  1080.     }
  1081.     else { /* reserve buffer is just a single allocation */
  1082. for (m = PAGE_SIZE; m < rsv_schp->bufflen; m += PAGE_SIZE) {
  1083.     page_ptr = (unsigned char *)rsv_schp->buffer + m;
  1084.     page = virt_to_page(page_ptr);
  1085.     if (startFinish)
  1086. get_page(page); /* increment page count */
  1087.     else {
  1088. if (page_count(page) > 0)
  1089.     put_page_testzero(page); /* decrement page count */
  1090.     }
  1091. }
  1092.     }
  1093. }
  1095. static struct page * sg_vma_nopage(struct vm_area_struct *vma, 
  1096.    unsigned long addr, int unused)
  1097. {
  1098.     Sg_fd * sfp;
  1099.     struct page * page = NOPAGE_SIGBUS;
  1100.     void * page_ptr = NULL;
  1101.     unsigned long offset;
  1102.     Sg_scatter_hold * rsv_schp;
  1104.     if ((NULL == vma) || (! (sfp = (Sg_fd *)vma->vm_private_data)))
  1105. return page;
  1106.     rsv_schp = &sfp->reserve;
  1107.     offset = addr - vma->vm_start;
  1108.     if (offset >= rsv_schp->bufflen)
  1109. return page;
  1110.     SCSI_LOG_TIMEOUT(3, printk("sg_vma_nopage: offset=%lu, scatg=%dn", 
  1111.        offset, rsv_schp->k_use_sg));
  1112.     if (rsv_schp->k_use_sg) { /* reserve buffer is a scatter gather list */
  1113.         int k;
  1114.         unsigned long sa = vma->vm_start;
  1115.         unsigned long len;
  1116.         struct scatterlist * sclp = rsv_schp->buffer;
  1118.         for (k = 0; (k < rsv_schp->k_use_sg) && (sa < vma->vm_end);
  1119.              ++k, ++sclp) {
  1120.             len = vma->vm_end - sa;
  1121.             len = (len < sclp->length) ? len : sclp->length;
  1122.     if (offset < len) {
  1123. page_ptr = (unsigned char *)sclp->address + offset;
  1124. page = virt_to_page(page_ptr);
  1125. get_page(page); /* increment page count */
  1126. break;
  1127.     }
  1128.             sa += len;
  1129.     offset -= len;
  1130.         }
  1131.     }
  1132.     else { /* reserve buffer is just a single allocation */
  1133.         page_ptr = (unsigned char *)rsv_schp->buffer + offset;
  1134. page = virt_to_page(page_ptr);
  1135. get_page(page); /* increment page count */
  1136.     }
  1137.     return page;
  1138. }
  1140. static struct vm_operations_struct sg_mmap_vm_ops = {
  1141.     nopage : sg_vma_nopage,
  1142. };
  1144. static int sg_mmap(struct file * filp, struct vm_area_struct *vma)
  1145. {
  1146.     Sg_fd * sfp;
  1147.     unsigned long req_sz = vma->vm_end - vma->vm_start;
  1148.     Sg_scatter_hold * rsv_schp;
  1150.     if ((! filp) || (! vma) || (! (sfp = (Sg_fd *)filp->private_data)))
  1151.         return -ENXIO;
  1152.     SCSI_LOG_TIMEOUT(3, printk("sg_mmap starting, vm_start=%p, len=%dn", 
  1153.        (void *)vma->vm_start, (int)req_sz));
  1154.     if (vma->vm_pgoff)
  1155.      return -EINVAL; /* want no offset */
  1156.     rsv_schp = &sfp->reserve;
  1157.     if (req_sz > rsv_schp->bufflen)
  1158.      return -ENOMEM; /* cannot map more than reserved buffer */
  1160.     if (rsv_schp->k_use_sg) { /* reserve buffer is a scatter gather list */
  1161.      int k;
  1162. unsigned long sa = vma->vm_start;
  1163. unsigned long len;
  1164. struct scatterlist * sclp = rsv_schp->buffer;
  1166. for (k = 0; (k < rsv_schp->k_use_sg) && (sa < vma->vm_end); 
  1167.      ++k, ++sclp) {
  1168.     if ((unsigned long)sclp->address & (PAGE_SIZE - 1))
  1169.      return -EFAULT;     /* non page aligned memory ?? */
  1170.     len = vma->vm_end - sa;
  1171.     len = (len < sclp->length) ? len : sclp->length;
  1172.     sa += len;
  1173. }
  1174.     }
  1175.     else { /* reserve buffer is just a single allocation */
  1176.      if ((unsigned long)rsv_schp->buffer & (PAGE_SIZE - 1))
  1177.     return -EFAULT; /* non page aligned memory ?? */
  1178.     }
  1179.     if (0 == sfp->mmap_called) {
  1180.      sg_rb_correct4mmap(rsv_schp, 1);  /* do only once per fd lifetime */
  1181. sfp->mmap_called = 1;
  1182.     }
  1183.     vma->vm_flags |= (VM_RESERVED | VM_IO);
  1184.     vma->vm_private_data = sfp;
  1185.     vma->vm_ops = &sg_mmap_vm_ops;
  1186.     return 0;
  1187. }
  1189. /* This function is a "bottom half" handler that is called by the
  1190.  * mid level when a command is completed (or has failed). */
  1191. static void sg_cmd_done_bh(Scsi_Cmnd * SCpnt)
  1192. {
  1193.     Scsi_Request * SRpnt = SCpnt->sc_request;
  1194.     int dev = MINOR(SRpnt->sr_request.rq_dev);
  1195.     Sg_device * sdp = NULL;
  1196.     Sg_fd * sfp;
  1197.     Sg_request * srp = NULL;
  1199.     read_lock(&sg_dev_arr_lock);
  1200.     if (sg_dev_arr && (dev >= 0)) {
  1201. if (dev < sg_template.dev_max)
  1202.     sdp = sg_dev_arr[dev];
  1203.     }
  1204.     if ((NULL == sdp) || sdp->detached) {
  1205. read_unlock(&sg_dev_arr_lock);
  1206. SCSI_LOG_TIMEOUT(1, printk("sg...bh: dev=%d gonen", dev));
  1207.         scsi_release_request(SRpnt);
  1208.         SRpnt = NULL;
  1209.         return;
  1210.     }
  1211.     sfp = sdp->headfp;
  1212.     while (sfp) {
  1213. read_lock(&sfp->rq_list_lock);
  1214. for (srp = sfp->headrp; srp; srp = srp->nextrp) {
  1215.             if (SRpnt == srp->my_cmdp)
  1216.                 break;
  1217.         }
  1218. read_unlock(&sfp->rq_list_lock);
  1219.         if (srp)
  1220.             break;
  1221.         sfp = sfp->nextfp;
  1222.     }
  1223.     if (! srp) {
  1224. read_unlock(&sg_dev_arr_lock);
  1225. SCSI_LOG_TIMEOUT(1, printk("sg...bh: req missing, dev=%dn", dev));
  1226.         scsi_release_request(SRpnt);
  1227.         SRpnt = NULL;
  1228.         return;
  1229.     }
  1230.     /* First transfer ownership of data buffers to sg_device object. */
  1231.     srp->data.k_use_sg = SRpnt->sr_use_sg;
  1232.     srp->data.sglist_len = SRpnt->sr_sglist_len;
  1233.     srp->data.bufflen = SRpnt->sr_bufflen;
  1234.     srp->data.buffer = SRpnt->sr_buffer;
  1235.     /* now clear out request structure */
  1236.     SRpnt->sr_use_sg = 0;
  1237.     SRpnt->sr_sglist_len = 0;
  1238.     SRpnt->sr_bufflen = 0;
  1239.     SRpnt->sr_buffer = NULL;
  1240.     SRpnt->sr_underflow = 0;
  1241.     SRpnt->sr_request.rq_dev = MKDEV(0, 0);  /* "sg" _disowns_ request blk */
  1243.     srp->my_cmdp = NULL;
  1244.     srp->done = 1;
  1245.     read_unlock(&sg_dev_arr_lock);
  1247.     SCSI_LOG_TIMEOUT(4, printk("sg...bh: dev=%d, pack_id=%d, res=0x%xn",
  1248.      dev, srp->header.pack_id, (int)SRpnt->sr_result));
  1249.     srp->header.resid = SCpnt->resid;
  1250.     /* sg_unmap_and(&srp->data, 0); */     /* unmap locked pages a.s.a.p. */
  1251.     /* N.B. unit of duration changes here from jiffies to millisecs */
  1252.     srp->header.duration = sg_jif_to_ms(jiffies - (int)srp->header.duration);
  1253.     if (0 != SRpnt->sr_result) {
  1254. memcpy(srp->sense_b, SRpnt->sr_sense_buffer, sizeof(srp->sense_b));
  1255. srp->header.status = 0xff & SRpnt->sr_result;
  1256. srp->header.masked_status  = status_byte(SRpnt->sr_result);
  1257. srp->header.msg_status  = msg_byte(SRpnt->sr_result);
  1258. srp->header.host_status = host_byte(SRpnt->sr_result);
  1259. srp->header.driver_status = driver_byte(SRpnt->sr_result);
  1260. if ((sdp->sgdebug > 0) &&
  1261.     ((CHECK_CONDITION == srp->header.masked_status) ||
  1262.      (COMMAND_TERMINATED == srp->header.masked_status)))
  1263.     print_req_sense("sg_cmd_done_bh", SRpnt);
  1265. /* Following if statement is a patch supplied by Eric Youngdale */
  1266. if (driver_byte(SRpnt->sr_result) != 0
  1267.     && (SRpnt->sr_sense_buffer[0] & 0x7f) == 0x70
  1268.     && (SRpnt->sr_sense_buffer[2] & 0xf) == UNIT_ATTENTION
  1269.     && sdp->device->removable) {
  1270.     /* Detected disc change. Set the bit - this may be used if */
  1271.     /* there are filesystems using this device. */
  1272.     sdp->device->changed = 1;
  1273. }
  1274.     }
  1275.     /* Rely on write phase to clean out srp status values, so no "else" */
  1277.     scsi_release_request(SRpnt);
  1278.     SRpnt = NULL;
  1279.     if (sfp->closed) { /* whoops this fd already released, cleanup */
  1280.         SCSI_LOG_TIMEOUT(1,
  1281.        printk("sg...bh: already closed, freeing ...n"));
  1282. sg_finish_rem_req(srp);
  1283. srp = NULL;
  1284. if (NULL == sfp->headrp) {
  1285.             SCSI_LOG_TIMEOUT(1,
  1286. printk("sg...bh: already closed, final cleanupn"));
  1287.             if (0 == sg_remove_sfp(sdp, sfp)) { /* device still present */
  1288. sdp->device->access_count--;
  1289. if (sdp->device->host->hostt->module)
  1290.     __MOD_DEC_USE_COUNT(sdp->device->host->hostt->module);
  1291.     }
  1292.     if (sg_template.module)
  1293.     __MOD_DEC_USE_COUNT(sg_template.module);
  1294.     sfp = NULL;
  1295.         }
  1296.     }
  1297.     else if (srp && srp->orphan) {
  1298. if (sfp->keep_orphan)
  1299.     srp->sg_io_owned = 0;
  1300. else {
  1301.     sg_finish_rem_req(srp);
  1302.     srp = NULL;
  1303.         }
  1304.     }
  1305.     if (sfp && srp) {
  1306. /* Now wake up any sg_read() that is waiting for this packet. */
  1307. wake_up_interruptible(&sfp->read_wait);
  1308. kill_fasync(&sfp->async_qp, SIGPOLL, POLL_IN);
  1309.     }
  1310. }
  1312. static struct file_operations sg_fops = {
  1313. owner: THIS_MODULE,
  1314. read: sg_read,
  1315. write: sg_write,
  1316. poll: sg_poll,
  1317. ioctl: sg_ioctl,
  1318. open: sg_open,
  1319. mmap: sg_mmap,
  1320. release: sg_release,
  1321. fasync: sg_fasync,
  1322. };
  1325. static int sg_detect(Scsi_Device * scsidp)
  1326. {
  1327.     sg_template.dev_noticed++;
  1328.     return 1;
  1329. }
  1331. /* Driver initialization */
  1332. static int sg_init()
  1333. {
  1334.     static int sg_registered = 0;
  1335.     unsigned long iflags;
  1337.     if ((sg_template.dev_noticed == 0) || sg_dev_arr)
  1338.      return 0;
  1340.     write_lock_irqsave(&sg_dev_arr_lock, iflags);
  1341.     if(!sg_registered) {
  1342. if (devfs_register_chrdev(SCSI_GENERIC_MAJOR,"sg",&sg_fops))
  1343.         {
  1344.             printk(KERN_ERR "Unable to get major %d for generic SCSI devicen",
  1345.                    SCSI_GENERIC_MAJOR);
  1346.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1347.             sg_template.dev_noticed = 0;
  1348.             return 1;
  1349.         }
  1350.         sg_registered++;
  1351.     }
  1353.     SCSI_LOG_TIMEOUT(3, printk("sg_initn"));
  1354.     sg_template.dev_max = sg_template.dev_noticed + SG_DEV_ARR_LUMP;
  1355.     sg_dev_arr = (Sg_device **)kmalloc(sg_template.dev_max * 
  1356.      sizeof(Sg_device *), GFP_ATOMIC);
  1357.     if (NULL == sg_dev_arr) {
  1358.         printk(KERN_ERR "sg_init: no space for sg_dev_arrn");
  1359. write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1360.         sg_template.dev_noticed = 0;
  1361.         return 1;
  1362.     }
  1363.     memset(sg_dev_arr, 0, sg_template.dev_max * sizeof(Sg_device *));
  1364.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1365. #ifdef CONFIG_PROC_FS
  1366.     sg_proc_init();
  1367. #endif  /* CONFIG_PROC_FS */
  1368.     return 0;
  1369. }
  1371. #ifndef MODULE
  1372. static int __init sg_def_reserved_size_setup(char *str)
  1373. {
  1374.     int tmp;
  1376.     if (get_option(&str, &tmp) == 1) {
  1377. def_reserved_size = tmp;
  1378. if (tmp >= 0)
  1379.     sg_big_buff = tmp;
  1380. return 1;
  1381.     } else {
  1382. printk(KERN_WARNING "sg_def_reserved_size : usage "
  1383.     "sg_def_reserved_size=n (n could be 65536, 131072 or 262144)n");
  1384. return 0;
  1385.     }
  1386. }
  1388. __setup("sg_def_reserved_size=", sg_def_reserved_size_setup);
  1389. #endif
  1392. static int sg_attach(Scsi_Device * scsidp)
  1393. {
  1394.     Sg_device * sdp;
  1395.     unsigned long iflags;
  1396.     int k;
  1398.     write_lock_irqsave(&sg_dev_arr_lock, iflags);
  1399.     if (sg_template.nr_dev >= sg_template.dev_max) { /* try to resize */
  1400.      Sg_device ** tmp_da;
  1401. int tmp_dev_max = sg_template.nr_dev + SG_DEV_ARR_LUMP;
  1403. tmp_da = (Sg_device **)kmalloc(tmp_dev_max * 
  1404.      sizeof(Sg_device *), GFP_ATOMIC);
  1405. if (NULL == tmp_da) {
  1406.     scsidp->attached--;
  1407.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1408.     printk(KERN_ERR "sg_attach: device array cannot be resizedn");
  1409.     return 1;
  1410. }
  1411. memset(tmp_da, 0, tmp_dev_max * sizeof(Sg_device *));
  1412. memcpy(tmp_da, sg_dev_arr, sg_template.dev_max * sizeof(Sg_device *));
  1413. kfree((char *)sg_dev_arr);
  1414. sg_dev_arr = tmp_da;
  1415. sg_template.dev_max = tmp_dev_max;
  1416.     }
  1418.     for(k = 0; k < sg_template.dev_max; k++)
  1419.         if(! sg_dev_arr[k]) break;
  1420.     if (k > MINORMASK) {
  1421. scsidp->attached--;
  1422. write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1423. printk(KERN_WARNING "Unable to attach sg device <%d, %d, %d, %d>"
  1424.        " type=%d, minor number exceed %dn", scsidp->host->host_no, 
  1425.        scsidp->channel, scsidp->id, scsidp->lun, scsidp->type,
  1426.        MINORMASK);
  1427. return 1;
  1428.     }
  1429.     if(k < sg_template.dev_max)
  1430.      sdp = (Sg_device *)kmalloc(sizeof(Sg_device), GFP_ATOMIC);
  1431.     else
  1432.      sdp = NULL;
  1433.     if (NULL == sdp) {
  1434. scsidp->attached--;
  1435. write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1436. printk(KERN_ERR "sg_attach: Sg_device cannot be allocatedn");
  1437. return 1;
  1438.     }
  1440.     SCSI_LOG_TIMEOUT(3, printk("sg_attach: dev=%d n", k));
  1441.     sdp->device = scsidp;
  1442.     init_waitqueue_head(&sdp->o_excl_wait);
  1443.     sdp->headfp= NULL;
  1444.     sdp->exclude = 0;
  1445.     sdp->sgdebug = 0;
  1446.     sdp->detached = 0;
  1447.     sdp->sg_tablesize = scsidp->host ? scsidp->host->sg_tablesize : 0;
  1448.     sdp->i_rdev = MKDEV(SCSI_GENERIC_MAJOR, k);
  1449.     sdp->de = devfs_register (scsidp->de, "generic", DEVFS_FL_DEFAULT,
  1450.                              SCSI_GENERIC_MAJOR, k,
  1451.                              S_IFCHR | S_IRUSR | S_IWUSR | S_IRGRP,
  1452.                              &sg_fops, sdp);
  1453.     sg_template.nr_dev++;
  1454.     sg_dev_arr[k] = sdp;
  1455.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1456.     switch (scsidp->type) {
  1457. case TYPE_DISK:
  1458. case TYPE_MOD:
  1459. case TYPE_ROM:
  1460. case TYPE_WORM:
  1461. case TYPE_TAPE: break;
  1462. default:
  1463.     printk(KERN_NOTICE "Attached scsi generic sg%d at scsi%d, channel"
  1464.         " %d, id %d, lun %d,  type %dn", k, scsidp->host->host_no, 
  1465.    scsidp->channel, scsidp->id, scsidp->lun, scsidp->type);
  1466.     }
  1467.     return 0;
  1468. }
  1470. /* Called at 'finish' of init process, after all attaches */
  1471. static void sg_finish(void)
  1472. { }
  1474. static void sg_detach(Scsi_Device * scsidp)
  1475. {
  1476.     Sg_device * sdp;
  1477.     unsigned long iflags;
  1478.     Sg_fd * sfp;
  1479.     Sg_fd * tsfp;
  1480.     Sg_request * srp;
  1481.     Sg_request * tsrp;
  1482.     int k, delay;
  1484.     if (NULL == sg_dev_arr)
  1485.      return;
  1486.     delay = 0;
  1487.     write_lock_irqsave(&sg_dev_arr_lock, iflags);
  1488.     for (k = 0; k < sg_template.dev_max; k++) {
  1489.      sdp = sg_dev_arr[k];
  1490.         if ((NULL == sdp) || (sdp->device != scsidp))
  1491.             continue;   /* dirty but lowers nesting */
  1492.         if (sdp->headfp) {
  1493.     sdp->detached = 1;
  1494.     for (sfp = sdp->headfp; sfp; sfp = tsfp) {
  1495.      tsfp = sfp->nextfp;
  1496. for (srp = sfp->headrp; srp; srp = tsrp) {
  1497.     tsrp = srp->nextrp;
  1498.     if (sfp->closed || (0 == srp->done))
  1499. sg_finish_rem_req(srp);
  1500. }
  1501. if (sfp->closed) {
  1502.     sdp->device->access_count--;
  1503.     if (sg_template.module)
  1504. __MOD_DEC_USE_COUNT(sg_template.module);
  1505.     if (sdp->device->host->hostt->module)
  1506. __MOD_DEC_USE_COUNT(sdp->device->host->hostt->module);
  1507.     __sg_remove_sfp(sdp, sfp);
  1508. }
  1509. else {
  1510.     delay = 1;
  1511.     wake_up_interruptible(&sfp->read_wait);
  1512.     kill_fasync(&sfp->async_qp, SIGPOLL, POLL_HUP);
  1513. }
  1514.             }
  1515.     SCSI_LOG_TIMEOUT(3, printk("sg_detach: dev=%d, dirtyn", k));
  1516.     devfs_unregister (sdp->de);
  1517.     sdp->de = NULL;
  1518.     if (NULL == sdp->headfp) {
  1519. kfree((char *)sdp);
  1520. sg_dev_arr[k] = NULL;
  1521.     }
  1522.         }
  1523.         else { /* nothing active, simple case */
  1524.             SCSI_LOG_TIMEOUT(3, printk("sg_detach: dev=%dn", k));
  1525.     devfs_unregister (sdp->de);
  1526.     kfree((char *)sdp);
  1527.     sg_dev_arr[k] = NULL;
  1528.         }
  1529.         scsidp->attached--;
  1530.         sg_template.nr_dev--;
  1531.         sg_template.dev_noticed--; /* from <dan@lectra.fr> */
  1532.         break;
  1533.     }
  1534.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  1535.     if (delay)
  1536. scsi_sleep(2); /* dirty detach so delay device destruction */
  1537. }
  1539. MODULE_AUTHOR("Douglas Gilbert");
  1540. MODULE_DESCRIPTION("SCSI generic (sg) driver");
  1542. #ifdef MODULE_LICENSE
  1543. MODULE_LICENSE("GPL");
  1544. #endif
  1546. MODULE_PARM(def_reserved_size, "i");
  1547. MODULE_PARM_DESC(def_reserved_size, "size of buffer reserved for each fd");
  1549. static int __init init_sg(void) {
  1550.     if (def_reserved_size >= 0)
  1551. sg_big_buff = def_reserved_size;
  1552.     sg_template.module = THIS_MODULE;
  1553.     return scsi_register_module(MODULE_SCSI_DEV, &sg_template);
  1554. }
  1556. static void __exit exit_sg( void)
  1557. {
  1558. #ifdef CONFIG_PROC_FS
  1559.     sg_proc_cleanup();
  1560. #endif  /* CONFIG_PROC_FS */
  1561.     scsi_unregister_module(MODULE_SCSI_DEV, &sg_template);
  1562.     devfs_unregister_chrdev(SCSI_GENERIC_MAJOR, "sg");
  1563.     if(sg_dev_arr != NULL) {
  1564. kfree((char *)sg_dev_arr);
  1565.         sg_dev_arr = NULL;
  1566.     }
  1567.     sg_template.dev_max = 0;
  1568. }
  1571. static int sg_start_req(Sg_request * srp)
  1572. {
  1573.     int res;
  1574.     Sg_fd * sfp = srp->parentfp;
  1575.     sg_io_hdr_t * hp = &srp->header;
  1576.     int dxfer_len = (int)hp->dxfer_len;
  1577.     int dxfer_dir = hp->dxfer_direction;
  1578.     Sg_scatter_hold * req_schp = &srp->data;
  1579.     Sg_scatter_hold * rsv_schp = &sfp->reserve;
  1581.     SCSI_LOG_TIMEOUT(4, printk("sg_start_req: dxfer_len=%dn", dxfer_len));
  1582.     if ((dxfer_len <= 0) || (dxfer_dir == SG_DXFER_NONE))
  1583.      return 0;
  1584.     if (sg_allow_dio && (hp->flags & SG_FLAG_DIRECT_IO) && 
  1585. (dxfer_dir != SG_DXFER_UNKNOWN) && (0 == hp->iovec_count) &&
  1586. (! sfp->parentdp->device->host->unchecked_isa_dma)) {
  1587. res = sg_build_dir(srp, sfp, dxfer_len);
  1588. if (res <= 0)   /* -ve -> error, 0 -> done, 1 -> try indirect */
  1589.     return res;
  1590.     }
  1591.     if ((! sg_res_in_use(sfp)) && (dxfer_len <= rsv_schp->bufflen))
  1592. sg_link_reserve(sfp, srp, dxfer_len);
  1593.     else {
  1594. res = sg_build_indi(req_schp, sfp, dxfer_len);
  1595.         if (res) {
  1596.             sg_remove_scat(req_schp);
  1597.             return res;
  1598.         }
  1599.     }
  1600.     return 0;
  1601. }
  1603. static void sg_finish_rem_req(Sg_request * srp)
  1604. {
  1605.     Sg_fd * sfp = srp->parentfp;
  1606.     Sg_scatter_hold * req_schp = &srp->data;
  1608.     SCSI_LOG_TIMEOUT(4, printk("sg_finish_rem_req: res_used=%dn",
  1609.        (int)srp->res_used));
  1610.     sg_unmap_and(&srp->data, 1);
  1611.     if (srp->res_used)
  1612.         sg_unlink_reserve(sfp, srp);
  1613.     else
  1614.         sg_remove_scat(req_schp);
  1615.     sg_remove_request(sfp, srp);
  1616. }
  1618. static int sg_build_sgat(Sg_scatter_hold * schp, const Sg_fd * sfp,
  1619.  int tablesize)
  1620. {
  1621.     int mem_src, ret_sz;
  1622.     int elem_sz = sizeof(struct scatterlist) + sizeof(char);
  1623.     /* scatter gather array, followed by mem_src_arr (array of chars) */
  1624.     int sg_bufflen = tablesize * elem_sz;
  1625.     int mx_sc_elems = tablesize;
  1627.     mem_src = SG_HEAP_KMAL;
  1628.     schp->buffer = sg_malloc(sfp, sg_bufflen, &ret_sz, &mem_src);
  1629.     if (! schp->buffer)
  1630. return -ENOMEM;
  1631.     else if (ret_sz != sg_bufflen) {
  1632. sg_bufflen = ret_sz;
  1633. mx_sc_elems = sg_bufflen / elem_sz;
  1634.     }
  1635.     schp->buffer_mem_src = (char)mem_src;
  1636.     schp->sglist_len = sg_bufflen;
  1637.     memset(schp->buffer, 0, sg_bufflen);
  1638.     return mx_sc_elems; /* number of scat_gath elements allocated */
  1639. }
  1641. static void sg_unmap_and(Sg_scatter_hold * schp, int free_also)
  1642. {
  1643. #ifdef SG_ALLOW_DIO_CODE
  1644.     int nbhs = 0;
  1646.     if (schp && schp->kiobp) {
  1647. if (schp->mapped) {
  1648.     unmap_kiobuf(schp->kiobp);
  1649.     schp->mapped = 0;
  1650. }
  1651. if (free_also) {
  1652.     sg_free_kiovec(1, &schp->kiobp, &nbhs);
  1653.     schp->kiobp = NULL;
  1654. }
  1655.     }
  1656. #endif
  1657. }
  1659. static int sg_build_dir(Sg_request * srp, Sg_fd * sfp, int dxfer_len)
  1660. {
  1661. #ifdef SG_ALLOW_DIO_CODE
  1662.     int res, k, split, offset, num, mx_sc_elems, rem_sz;
  1663.     struct kiobuf * kp;
  1664.     char * mem_src_arr;
  1665.     struct scatterlist * sclp;
  1666.     unsigned long addr, prev_addr;
  1667.     sg_io_hdr_t * hp = &srp->header;
  1668.     Sg_scatter_hold * schp = &srp->data;
  1669.     int sg_tablesize = sfp->parentdp->sg_tablesize;
  1670.     int nbhs = 0;
  1672.     res = sg_alloc_kiovec(1, &schp->kiobp, &nbhs);
  1673.     if (0 != res) {
  1674. SCSI_LOG_TIMEOUT(5, printk("sg_build_dir: sg_alloc_kiovec res=%dn", 
  1675.  res));
  1676. return 1;
  1677.     }
  1678.     res = map_user_kiobuf((SG_DXFER_TO_DEV == hp->dxfer_direction) ? 1 : 0,
  1679.   schp->kiobp, (unsigned long)hp->dxferp, dxfer_len);
  1680.     if (0 != res) {
  1681. SCSI_LOG_TIMEOUT(5,
  1682. printk("sg_build_dir: map_user_kiobuf res=%dn", res));
  1683. sg_unmap_and(schp, 1);
  1684. return 1;
  1685.     }
  1686.     schp->mapped = 1;
  1687.     kp = schp->kiobp;
  1688.     prev_addr = (unsigned long) page_address(kp->maplist[0]);
  1689.     for (k = 1, split = 0; k < kp->nr_pages; ++k, prev_addr = addr) {
  1690. addr = (unsigned long) page_address(kp->maplist[k]);
  1691. if ((prev_addr + PAGE_SIZE) != addr) {
  1692.     split = k;
  1693.     break;
  1694. }
  1695.     }
  1696.     if (! split) {
  1697. schp->k_use_sg = 0;
  1698. schp->buffer = page_address(kp->maplist[0]) + kp->offset;
  1699. schp->bufflen = dxfer_len;
  1700. schp->buffer_mem_src = SG_USER_MEM;
  1701. schp->b_malloc_len = dxfer_len;
  1702. hp->info |= SG_INFO_DIRECT_IO;
  1703. return 0;
  1704.     }
  1705.     mx_sc_elems = sg_build_sgat(schp, sfp, sg_tablesize);
  1706.     if (mx_sc_elems <= 1) {
  1707. sg_unmap_and(schp, 1);
  1708. sg_remove_scat(schp);
  1709. return 1;
  1710.     }
  1711.     mem_src_arr = schp->buffer + (mx_sc_elems * sizeof(struct scatterlist));
  1712.     for (k = 0, sclp = schp->buffer, rem_sz = dxfer_len;
  1713.  (rem_sz > 0) && (k < mx_sc_elems);
  1714.  ++k, ++sclp) {
  1715. offset = (0 == k) ? kp->offset : 0;
  1716. num = (rem_sz > (PAGE_SIZE - offset)) ? (PAGE_SIZE - offset) :
  1717. rem_sz;
  1718. sclp->address = page_address(kp->maplist[k]) + offset;
  1719. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,13)
  1720. sclp->page = NULL;
  1721. #endif
  1722. sclp->length = num;
  1723. mem_src_arr[k] = SG_USER_MEM;
  1724. rem_sz -= num;
  1725. SCSI_LOG_TIMEOUT(5,
  1726.     printk("sg_build_dir: k=%d, a=0x%p, len=%d, ms=%dn",
  1727.     k, sclp->address, num, mem_src_arr[k]));
  1728.     }
  1729.     schp->k_use_sg = k;
  1730.     SCSI_LOG_TIMEOUT(5,
  1731. printk("sg_build_dir: k_use_sg=%d, rem_sz=%dn", k, rem_sz));
  1732.     schp->bufflen = dxfer_len;
  1733.     if (rem_sz > 0) {   /* must have failed */
  1734. sg_unmap_and(schp, 1);
  1735. sg_remove_scat(schp);
  1736. return 1;   /* out of scatter gather elements, try indirect */
  1737.     }
  1738.     hp->info |= SG_INFO_DIRECT_IO;
  1739.     return 0;
  1740. #else
  1741.     return 1;
  1742. #endif /* SG_ALLOW_DIO_CODE */
  1743. }
  1745. static int sg_build_indi(Sg_scatter_hold * schp, Sg_fd * sfp, int buff_size)
  1746. {
  1747.     int ret_sz, mem_src;
  1748.     int blk_size = buff_size;
  1749.     char * p = NULL;
  1751.     if ((blk_size < 0) || (! sfp))
  1752.         return -EFAULT;
  1753.     if (0 == blk_size)
  1754.         ++blk_size;             /* don't know why */
  1755. /* round request up to next highest SG_SECTOR_SZ byte boundary */
  1756.     blk_size = (blk_size + SG_SECTOR_MSK) & (~SG_SECTOR_MSK);
  1757.     SCSI_LOG_TIMEOUT(4, printk("sg_build_indi: buff_size=%d, blk_size=%dn",
  1758.                                buff_size, blk_size));
  1759.     if (blk_size <= SG_SCATTER_SZ) {
  1760.         mem_src = SG_HEAP_PAGE;
  1761.         p = sg_malloc(sfp, blk_size, &ret_sz, &mem_src);
  1762.         if (! p)
  1763.             return -ENOMEM;
  1764.         if (blk_size == ret_sz) { /* got it on the first attempt */
  1765.     schp->k_use_sg = 0;
  1766.             schp->buffer = p;
  1767.             schp->bufflen = blk_size;
  1768.     schp->buffer_mem_src = (char)mem_src;
  1769.             schp->b_malloc_len = blk_size;
  1770.             return 0;
  1771.         }
  1772.     }
  1773.     else {
  1774.         mem_src = SG_HEAP_PAGE;
  1775.         p = sg_malloc(sfp, SG_SCATTER_SZ, &ret_sz, &mem_src);
  1776.         if (! p)
  1777.             return -ENOMEM;
  1778.     }
  1779. /* Want some local declarations, so start new block ... */
  1780.     {   /* lets try and build a scatter gather list */
  1781.         struct scatterlist * sclp;
  1782. int k, rem_sz, num;
  1783. int mx_sc_elems;
  1784.         int sg_tablesize = sfp->parentdp->sg_tablesize;
  1785.         int first = 1;
  1786. char * mem_src_arr;
  1788.         /* N.B. ret_sz and mem_src carried into this block ... */
  1789. mx_sc_elems = sg_build_sgat(schp, sfp, sg_tablesize);
  1790. if (mx_sc_elems < 0)
  1791.     return mx_sc_elems; /* most likely -ENOMEM */
  1792. mem_src_arr = schp->buffer +
  1793.       (mx_sc_elems * sizeof(struct scatterlist));
  1795. for (k = 0, sclp = schp->buffer, rem_sz = blk_size;
  1796.      (rem_sz > 0) && (k < mx_sc_elems);
  1797.              ++k, rem_sz -= ret_sz, ++sclp) {
  1798.     if (first)
  1799.                 first = 0;
  1800.             else {
  1801.                 num = (rem_sz > SG_SCATTER_SZ) ? SG_SCATTER_SZ : rem_sz;
  1802.                 mem_src = SG_HEAP_PAGE;
  1803.                 p = sg_malloc(sfp, num, &ret_sz, &mem_src);
  1804.                 if (! p)
  1805.                     break;
  1806.             }
  1807.             sclp->address = p;
  1808. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,13)
  1809.     sclp->page = NULL;
  1810. #endif
  1811.             sclp->length = ret_sz;
  1812.     mem_src_arr[k] = mem_src;
  1814.     SCSI_LOG_TIMEOUT(5,
  1815. printk("sg_build_build: k=%d, a=0x%p, len=%d, ms=%dn",
  1816.                 k, sclp->address, ret_sz, mem_src));
  1817.         } /* end of for loop */
  1818. schp->k_use_sg = k;
  1819. SCSI_LOG_TIMEOUT(5,
  1820.     printk("sg_build_indi: k_use_sg=%d, rem_sz=%dn", k, rem_sz));
  1821.         schp->bufflen = blk_size;
  1822.         if (rem_sz > 0)   /* must have failed */
  1823.             return -ENOMEM;
  1824.     }
  1825.     return 0;
  1826. }
  1828. static int sg_write_xfer(Sg_request * srp)
  1829. {
  1830.     sg_io_hdr_t * hp = &srp->header;
  1831.     Sg_scatter_hold * schp = &srp->data;
  1832.     int num_xfer = 0;
  1833.     int j, k, onum, usglen, ksglen, res, ok;
  1834.     int iovec_count = (int)hp->iovec_count;
  1835.     int dxfer_dir = hp->dxfer_direction;
  1836.     unsigned char * p;
  1837.     unsigned char * up;
  1838.     int new_interface = ('' == hp->interface_id) ? 0 : 1;
  1840.     if ((SG_DXFER_UNKNOWN == dxfer_dir) || (SG_DXFER_TO_DEV == dxfer_dir) ||
  1841. (SG_DXFER_TO_FROM_DEV == dxfer_dir)) {
  1842. num_xfer = (int)(new_interface ?  hp->dxfer_len : hp->flags);
  1843. if (schp->bufflen < num_xfer)
  1844.     num_xfer = schp->bufflen;
  1845.     }
  1846.     if ((num_xfer <= 0) || 
  1847.      (new_interface && ((SG_FLAG_NO_DXFER | SG_FLAG_MMAP_IO) & hp->flags)))
  1848. return 0;
  1850.     SCSI_LOG_TIMEOUT(4,
  1851.  printk("sg_write_xfer: num_xfer=%d, iovec_count=%d, k_use_sg=%dn",
  1852. num_xfer, iovec_count, schp->k_use_sg));
  1853.     if (iovec_count) {
  1854. onum = iovec_count;
  1855. if ((k = verify_area(VERIFY_READ, hp->dxferp,
  1856.      SZ_SG_IOVEC * onum)))
  1857.     return k;
  1858.     }
  1859.     else
  1860. onum = 1;
  1862.     if (0 == schp->k_use_sg) {  /* kernel has single buffer */
  1863. if (SG_USER_MEM != schp->buffer_mem_src) { /* else nothing to do */
  1865.     for (j = 0, p = schp->buffer; j < onum; ++j) {
  1866. res = sg_u_iovec(hp, iovec_count, j, 1, &usglen, &up);
  1867. if (res) return res;
  1868. usglen = (num_xfer > usglen) ? usglen : num_xfer;
  1869. __copy_from_user(p, up, usglen);
  1870. p += usglen;
  1871. num_xfer -= usglen;
  1872. if (num_xfer <= 0)
  1873.     return 0;
  1874.             }
  1875. }
  1876.     }
  1877.     else {      /* kernel using scatter gather list */
  1878. struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  1879. char * mem_src_arr = sg_get_sgat_msa(schp);
  1880. ksglen = (int)sclp->length;
  1881. p = sclp->address;
  1883. for (j = 0, k = 0; j < onum; ++j) {
  1884.     res = sg_u_iovec(hp, iovec_count, j, 1, &usglen, &up);
  1885.     if (res) return res;
  1887.     for (; k < schp->k_use_sg; ++k, ++sclp) {
  1888. ksglen = (int)sclp->length;
  1889. p = sclp->address;
  1890. if (NULL == p)
  1891.     break;
  1892. ok = (SG_USER_MEM != mem_src_arr[k]);
  1893. if (usglen <= 0)
  1894.     break;
  1895. if (ksglen > usglen) {
  1896.     if (usglen >= num_xfer) {
  1897. if (ok) __copy_from_user(p, up, num_xfer);
  1898. return 0;
  1899.     }
  1900.     if (ok) __copy_from_user(p, up, usglen);
  1901.     p += usglen;
  1902.     ksglen -= usglen;
  1903.                     break;
  1904. }
  1905. else {
  1906.     if (ksglen >= num_xfer) {
  1907. if (ok) __copy_from_user(p, up, num_xfer);
  1908. return 0;
  1909.     }
  1910.     if (ok) __copy_from_user(p, up, ksglen);
  1911.     up += ksglen;
  1912.     usglen -= ksglen;
  1913. }
  1914.             }
  1915.         }
  1916.     }
  1917.     return 0;
  1918. }
  1920. static int sg_u_iovec(sg_io_hdr_t * hp, int sg_num, int ind,
  1921.       int wr_xf, int * countp, unsigned char ** up)
  1922. {
  1923.     int num_xfer = (int)hp->dxfer_len;
  1924.     unsigned char * p;
  1925.     int count, k;
  1926.     sg_iovec_t u_iovec;
  1928.     if (0 == sg_num) {
  1929. p = (unsigned char *)hp->dxferp;
  1930. if (wr_xf && ('' == hp->interface_id))
  1931.     count = (int)hp->flags; /* holds "old" input_size */
  1932. else
  1933.     count = num_xfer;
  1934.     }
  1935.     else {
  1936. __copy_from_user(&u_iovec,
  1937.  (unsigned char *)hp->dxferp + (ind * SZ_SG_IOVEC),
  1938.  SZ_SG_IOVEC);
  1939. p = (unsigned char *)u_iovec.iov_base;
  1940. count = (int)u_iovec.iov_len;
  1941.     }
  1942.     if ((k = verify_area(wr_xf ? VERIFY_READ : VERIFY_WRITE, p, count)))
  1943. return k;
  1944.     if (up) *up = p;
  1945.     if (countp) *countp = count;
  1946.     return 0;
  1947. }
  1949. static char * sg_get_sgat_msa(Sg_scatter_hold * schp)
  1950. {
  1951.     int elem_sz = sizeof(struct scatterlist) + sizeof(char);
  1952.     int mx_sc_elems = schp->sglist_len / elem_sz;
  1953.     return schp->buffer + (sizeof(struct scatterlist) * mx_sc_elems);
  1954. }
  1956. static void sg_remove_scat(Sg_scatter_hold * schp)
  1957. {
  1958.     SCSI_LOG_TIMEOUT(4, printk("sg_remove_scat: k_use_sg=%dn",
  1959.        schp->k_use_sg));
  1960.     if (schp->buffer && schp->sglist_len) {
  1961.         int k, mem_src;
  1962.         struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  1963. char * mem_src_arr = sg_get_sgat_msa(schp);
  1965. for (k = 0; (k < schp->k_use_sg) && sclp->address; ++k, ++sclp) {
  1966.     mem_src = mem_src_arr[k];
  1967.     SCSI_LOG_TIMEOUT(5,
  1968. printk("sg_remove_scat: k=%d, a=0x%p, len=%d, ms=%dn",
  1969.                        k, sclp->address, sclp->length, mem_src));
  1970.             sg_free(sclp->address, sclp->length, mem_src);
  1971.             sclp->address = NULL;
  1972. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,13)
  1973.     sclp->page = NULL;
  1974. #endif
  1975.             sclp->length = 0;
  1976.         }
  1977. sg_free(schp->buffer, schp->sglist_len, schp->buffer_mem_src);
  1978.     }
  1979.     else if (schp->buffer)
  1980. sg_free(schp->buffer, schp->b_malloc_len, schp->buffer_mem_src);
  1981.     memset(schp, 0, sizeof(*schp));
  1982. }
  1984. static int sg_read_xfer(Sg_request * srp)
  1985. {
  1986.     sg_io_hdr_t * hp = &srp->header;
  1987.     Sg_scatter_hold * schp = &srp->data;
  1988.     int num_xfer = 0;
  1989.     int j, k, onum, usglen, ksglen, res, ok;
  1990.     int iovec_count = (int)hp->iovec_count;
  1991.     int dxfer_dir = hp->dxfer_direction;
  1992.     unsigned char * p;
  1993.     unsigned char * up;
  1994.     int new_interface = ('' == hp->interface_id) ? 0 : 1;
  1996.     if ((SG_DXFER_UNKNOWN == dxfer_dir) || (SG_DXFER_FROM_DEV == dxfer_dir) ||
  1997. (SG_DXFER_TO_FROM_DEV == dxfer_dir)) {
  1998. num_xfer =  hp->dxfer_len;
  1999. if (schp->bufflen < num_xfer)
  2000.     num_xfer = schp->bufflen;
  2001.     }
  2002.     if ((num_xfer <= 0) || 
  2003.      (new_interface && ((SG_FLAG_NO_DXFER | SG_FLAG_MMAP_IO) & hp->flags)))
  2004. return 0;
  2006.     SCSI_LOG_TIMEOUT(4,
  2007.  printk("sg_read_xfer: num_xfer=%d, iovec_count=%d, k_use_sg=%dn",
  2008. num_xfer, iovec_count, schp->k_use_sg));
  2009.     if (iovec_count) {
  2010. onum = iovec_count;
  2011. if ((k = verify_area(VERIFY_READ, hp->dxferp,
  2012.      SZ_SG_IOVEC * onum)))
  2013.     return k;
  2014.     }
  2015.     else
  2016. onum = 1;
  2018.     if (0 == schp->k_use_sg) {  /* kernel has single buffer */
  2019. if (SG_USER_MEM != schp->buffer_mem_src) { /* else nothing to do */
  2021.     for (j = 0, p = schp->buffer; j < onum; ++j) {
  2022. res = sg_u_iovec(hp, iovec_count, j, 0, &usglen, &up);
  2023. if (res) return res;
  2024. usglen = (num_xfer > usglen) ? usglen : num_xfer;
  2025. __copy_to_user(up, p, usglen);
  2026. p += usglen;
  2027. num_xfer -= usglen;
  2028. if (num_xfer <= 0)
  2029.     return 0;
  2030.     }
  2031. }
  2032.     }
  2033.     else {      /* kernel using scatter gather list */
  2034. struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  2035. char * mem_src_arr = sg_get_sgat_msa(schp);
  2036. ksglen = (int)sclp->length;
  2037. p = sclp->address;
  2039. for (j = 0, k = 0; j < onum; ++j) {
  2040.     res = sg_u_iovec(hp, iovec_count, j, 0, &usglen, &up);
  2041.     if (res) return res;
  2043.     for (; k < schp->k_use_sg; ++k, ++sclp) {
  2044. ksglen = (int)sclp->length;
  2045. p = sclp->address;
  2046. if (NULL == p)
  2047.     break;
  2048. ok = (SG_USER_MEM != mem_src_arr[k]);
  2049. if (usglen <= 0)
  2050.     break;
  2051. if (ksglen > usglen) {
  2052.     if (usglen >= num_xfer) {
  2053. if (ok) __copy_to_user(up, p, num_xfer);
  2054. return 0;
  2055.     }
  2056.     if (ok) __copy_to_user(up, p, usglen);
  2057.     p += usglen;
  2058.     ksglen -= usglen;
  2059.     break;
  2060. }
  2061. else {
  2062.     if (ksglen >= num_xfer) {
  2063. if (ok) __copy_to_user(up, p, num_xfer);
  2064. return 0;
  2065.     }
  2066.     if (ok) __copy_to_user(up, p, ksglen);
  2067.     up += ksglen;
  2068.     usglen -= ksglen;
  2069. }
  2070.     }
  2071. }
  2072.     }
  2073.     return 0;
  2074. }
  2076. static void sg_read_oxfer(Sg_request * srp, char * outp, int num_read_xfer)
  2077. {
  2078.     Sg_scatter_hold * schp = &srp->data;
  2080.     SCSI_LOG_TIMEOUT(4, printk("sg_read_oxfer: num_read_xfer=%dn",
  2081.        num_read_xfer));
  2082.     if ((! outp) || (num_read_xfer <= 0))
  2083.         return;
  2084.     if(schp->k_use_sg > 0) {
  2085.         int k, num;
  2086.         struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  2088. for (k = 0; (k < schp->k_use_sg) && sclp->address; ++k, ++sclp) {
  2089.             num = (int)sclp->length;
  2090.             if (num > num_read_xfer) {
  2091.                 __copy_to_user(outp, sclp->address, num_read_xfer);
  2092.                 break;
  2093.             }
  2094.             else {
  2095.                 __copy_to_user(outp, sclp->address, num);
  2096.                 num_read_xfer -= num;
  2097.                 if (num_read_xfer <= 0)
  2098.                     break;
  2099.                 outp += num;
  2100.             }
  2101.         }
  2102.     }
  2103.     else
  2104.         __copy_to_user(outp, schp->buffer, num_read_xfer);
  2105. }
  2107. static void sg_build_reserve(Sg_fd * sfp, int req_size)
  2108. {
  2109.     Sg_scatter_hold * schp = &sfp->reserve;
  2111.     SCSI_LOG_TIMEOUT(4, printk("sg_build_reserve: req_size=%dn", req_size));
  2112.     do {
  2113.         if (req_size < PAGE_SIZE)
  2114.             req_size = PAGE_SIZE;
  2115. if (0 == sg_build_indi(schp, sfp, req_size))
  2116.             return;
  2117.         else
  2118.             sg_remove_scat(schp);
  2119.         req_size >>= 1; /* divide by 2 */
  2120.     } while (req_size >  (PAGE_SIZE / 2));
  2121. }
  2123. static void sg_link_reserve(Sg_fd * sfp, Sg_request * srp, int size)
  2124. {
  2125.     Sg_scatter_hold * req_schp = &srp->data;
  2126.     Sg_scatter_hold * rsv_schp = &sfp->reserve;
  2128.     srp->res_used = 1;
  2129.     SCSI_LOG_TIMEOUT(4, printk("sg_link_reserve: size=%dn", size));
  2130.     size = (size + 1) & (~1);    /* round to even for aha1542 */
  2131.     if (rsv_schp->k_use_sg > 0) {
  2132.         int k, num;
  2133.         int rem = size;
  2134.         struct scatterlist * sclp = (struct scatterlist *)rsv_schp->buffer;
  2136. for (k = 0; k < rsv_schp->k_use_sg; ++k, ++sclp) {
  2137.             num = (int)sclp->length;
  2138.             if (rem <= num) {
  2139. if (0 == k) {
  2140.     req_schp->k_use_sg = 0;
  2141.     req_schp->buffer = sclp->address;
  2142. }
  2143. else {
  2144.          sfp->save_scat_len = num;
  2145.          sclp->length = (unsigned)rem;
  2146.          req_schp->k_use_sg = k + 1;
  2147.          req_schp->sglist_len = rsv_schp->sglist_len;
  2148.          req_schp->buffer = rsv_schp->buffer;
  2149. }
  2150. req_schp->bufflen = size;
  2151. req_schp->buffer_mem_src = rsv_schp->buffer_mem_src;
  2152. req_schp->b_malloc_len = rsv_schp->b_malloc_len;
  2153. break;
  2154.             }
  2155.             else
  2156.                 rem -= num;
  2157.         }
  2158. if (k >= rsv_schp->k_use_sg)
  2159.     SCSI_LOG_TIMEOUT(1, printk("sg_link_reserve: BAD sizen"));
  2160.     }
  2161.     else {
  2162. req_schp->k_use_sg = 0;
  2163.         req_schp->bufflen = size;
  2164.         req_schp->buffer = rsv_schp->buffer;
  2165. req_schp->buffer_mem_src = rsv_schp->buffer_mem_src;
  2166.         req_schp->b_malloc_len = rsv_schp->b_malloc_len;
  2167.     }
  2168. }
  2170. static void sg_unlink_reserve(Sg_fd * sfp, Sg_request * srp)
  2171. {
  2172.     Sg_scatter_hold * req_schp = &srp->data;
  2173.     Sg_scatter_hold * rsv_schp = &sfp->reserve;
  2175.     SCSI_LOG_TIMEOUT(4, printk("sg_unlink_reserve: req->k_use_sg=%dn",
  2176.        (int)req_schp->k_use_sg));
  2177.     if ((rsv_schp->k_use_sg > 0) && (req_schp->k_use_sg > 0)) {
  2178.         struct scatterlist * sclp = (struct scatterlist *)rsv_schp->buffer;
  2180. if (sfp->save_scat_len > 0)
  2181.     (sclp + (req_schp->k_use_sg - 1))->length =
  2182.                                         (unsigned)sfp->save_scat_len;
  2183.         else
  2184.             SCSI_LOG_TIMEOUT(1, printk(
  2185. "sg_unlink_reserve: BAD save_scat_lenn"));
  2186.     }
  2187.     req_schp->k_use_sg = 0;
  2188.     req_schp->bufflen = 0;
  2189.     req_schp->buffer = NULL;
  2190.     req_schp->sglist_len = 0;
  2191.     sfp->save_scat_len = 0;
  2192.     srp->res_used = 0;
  2193. }
  2195. static Sg_request * sg_get_rq_mark(Sg_fd * sfp, int pack_id)
  2196. {
  2197.     Sg_request * resp;
  2198.     unsigned long iflags;
  2200.     write_lock_irqsave(&sfp->rq_list_lock, iflags);
  2201.     for (resp = sfp->headrp; resp; resp = resp->nextrp) { 
  2202. /* look for requests that are ready + not SG_IO owned */
  2203. if ((1 == resp->done) && (! resp->sg_io_owned) &&
  2204.             ((-1 == pack_id) || (resp->header.pack_id == pack_id))) {
  2205.     resp->done = 2;   /* guard against other readers */
  2206.             break;
  2207. }
  2208.     }
  2209.     write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2210.     return resp;
  2211. }
  2213. #ifdef CONFIG_PROC_FS
  2214. static Sg_request * sg_get_nth_request(Sg_fd * sfp, int nth)
  2215. {
  2216.     Sg_request * resp;
  2217.     unsigned long iflags;
  2218.     int k;
  2220.     read_lock_irqsave(&sfp->rq_list_lock, iflags);
  2221.     for (k = 0, resp = sfp->headrp; resp && (k < nth); 
  2222.  ++k, resp = resp->nextrp)
  2223. ;
  2224.     read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2225.     return resp;
  2226. }
  2227. #endif
  2229. /* always adds to end of list */
  2230. static Sg_request * sg_add_request(Sg_fd * sfp)
  2231. {
  2232.     int k;
  2233.     unsigned long iflags;
  2234.     Sg_request * resp;
  2235.     Sg_request * rp =  sfp->req_arr;
  2237.     write_lock_irqsave(&sfp->rq_list_lock, iflags);
  2238.     resp = sfp->headrp;
  2239.     if (! resp) {
  2240. memset(rp, 0, sizeof(Sg_request));
  2241. rp->parentfp = sfp;
  2242. resp = rp;
  2243. sfp->headrp = resp;
  2244.     }
  2245.     else {
  2246.         if (0 == sfp->cmd_q)
  2247.             resp = NULL;   /* command queuing disallowed */
  2248.         else {
  2249.             for (k = 0; k < SG_MAX_QUEUE; ++k, ++rp) {
  2250.                 if (! rp->parentfp)
  2251.                     break;
  2252.             }
  2253.             if (k < SG_MAX_QUEUE) {
  2254. memset(rp, 0, sizeof(Sg_request));
  2255. rp->parentfp = sfp;
  2256. while (resp->nextrp) 
  2257.     resp = resp->nextrp;
  2258. resp->nextrp = rp;
  2259. resp = rp;
  2260.             }
  2261.             else
  2262.                 resp = NULL;
  2263.         }
  2264.     }
  2265.     if (resp) {
  2266.         resp->nextrp = NULL;
  2267. resp->header.duration = jiffies;
  2268.         resp->my_cmdp = NULL;
  2269. resp->data.kiobp = NULL;
  2270.     }
  2271.     write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2272.     return resp;
  2273. }
  2275. /* Return of 1 for found; 0 for not found */
  2276. static int sg_remove_request(Sg_fd * sfp, Sg_request * srp)
  2277. {
  2278.     Sg_request * prev_rp;
  2279.     Sg_request * rp;
  2280.     unsigned long iflags;
  2281.     int res = 0;
  2283.     if ((! sfp) || (! srp) || (! sfp->headrp))
  2284.         return res;
  2285.     write_lock_irqsave(&sfp->rq_list_lock, iflags);
  2286.     prev_rp = sfp->headrp;
  2287.     if (srp == prev_rp) {
  2288.         sfp->headrp = prev_rp->nextrp;
  2289.         prev_rp->parentfp = NULL;
  2290.         res = 1;
  2291.     }
  2292.     else {
  2293. while ((rp = prev_rp->nextrp)) {
  2294.     if (srp == rp) {
  2295. prev_rp->nextrp = rp->nextrp;
  2296. rp->parentfp = NULL;
  2297. res = 1;
  2298. break;
  2299.     }
  2300.     prev_rp = rp;
  2301. }
  2302.     }
  2303.     write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2304.     return res;
  2305. }
  2307. #ifdef CONFIG_PROC_FS
  2308. static Sg_fd * sg_get_nth_sfp(Sg_device * sdp, int nth)
  2309. {
  2310.     Sg_fd * resp;
  2311.     unsigned long iflags;
  2312.     int k;
  2314.     read_lock_irqsave(&sg_dev_arr_lock, iflags);
  2315.     for (k = 0, resp = sdp->headfp; resp && (k < nth); 
  2316.  ++k, resp = resp->nextfp)
  2317. ;
  2318.     read_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2319.     return resp;
  2320. }
  2321. #endif
  2323. static Sg_fd * sg_add_sfp(Sg_device * sdp, int dev)
  2324. {
  2325.     Sg_fd * sfp;
  2326.     unsigned long iflags;
  2328.     sfp = (Sg_fd *)sg_low_malloc(sizeof(Sg_fd), 0, SG_HEAP_KMAL, 0);
  2329.     if (! sfp)
  2330.         return NULL;
  2331.     memset(sfp, 0, sizeof(Sg_fd));
  2332.     sfp->fd_mem_src = SG_HEAP_KMAL;
  2333.     init_waitqueue_head(&sfp->read_wait);
  2334.     sfp->rq_list_lock = RW_LOCK_UNLOCKED;
  2336.     sfp->timeout = SG_DEFAULT_TIMEOUT;
  2337.     sfp->force_packid = SG_DEF_FORCE_PACK_ID;
  2338.     sfp->low_dma = (SG_DEF_FORCE_LOW_DMA == 0) ?
  2339.                    sdp->device->host->unchecked_isa_dma : 1;
  2340.     sfp->cmd_q = SG_DEF_COMMAND_Q;
  2341.     sfp->keep_orphan = SG_DEF_KEEP_ORPHAN;
  2342.     sfp->parentdp = sdp;
  2343.     write_lock_irqsave(&sg_dev_arr_lock, iflags);
  2344.     if (! sdp->headfp)
  2345.         sdp->headfp = sfp;
  2346.     else {    /* add to tail of existing list */
  2347. Sg_fd * pfp = sdp->headfp;
  2348. while (pfp->nextfp)
  2349.     pfp = pfp->nextfp;
  2350. pfp->nextfp = sfp;
  2351.     }
  2352.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2353.     SCSI_LOG_TIMEOUT(3, printk("sg_add_sfp: sfp=0x%p, m_s=%dn",
  2354.        sfp, (int)sfp->fd_mem_src));
  2355.     sg_build_reserve(sfp, sg_big_buff);
  2356.     SCSI_LOG_TIMEOUT(3, printk("sg_add_sfp:   bufflen=%d, k_use_sg=%dn",
  2357.    sfp->reserve.bufflen, sfp->reserve.k_use_sg));
  2358.     return sfp;
  2359. }
  2361. static void __sg_remove_sfp(Sg_device * sdp, Sg_fd * sfp)
  2362. {
  2363.     Sg_fd * fp;
  2364.     Sg_fd * prev_fp;
  2366.     prev_fp =  sdp->headfp;
  2367.     if (sfp == prev_fp)
  2368. sdp->headfp = prev_fp->nextfp;
  2369.     else {
  2370. while ((fp = prev_fp->nextfp)) {
  2371.     if (sfp == fp) {
  2372. prev_fp->nextfp = fp->nextfp;
  2373. break;
  2374.     }
  2375.     prev_fp = fp;
  2376. }
  2377.     }
  2378.     if (sfp->reserve.bufflen > 0) {
  2379.     SCSI_LOG_TIMEOUT(6, printk("__sg_remove_sfp:    bufflen=%d, k_use_sg=%dn",
  2380.      (int)sfp->reserve.bufflen, (int)sfp->reserve.k_use_sg));
  2381. if (sfp->mmap_called)
  2382.     sg_rb_correct4mmap(&sfp->reserve, 0); /* undo correction */
  2383. sg_remove_scat(&sfp->reserve);
  2384.     }
  2385.     sfp->parentdp = NULL;
  2386.     SCSI_LOG_TIMEOUT(6, printk("__sg_remove_sfp:    sfp=0x%pn", sfp));
  2387.     sg_low_free((char *)sfp, sizeof(Sg_fd), sfp->fd_mem_src);
  2388. }
  2390. /* Returns 0 in normal case, 1 when detached and sdp object removed */
  2391. static int sg_remove_sfp(Sg_device * sdp, Sg_fd * sfp)
  2392. {
  2393.     Sg_request * srp;
  2394.     Sg_request * tsrp;
  2395.     int dirty = 0;
  2396.     int res = 0;
  2398.     for (srp = sfp->headrp; srp; srp = tsrp) {
  2399. tsrp = srp->nextrp;
  2400. if (srp->done)
  2401.     sg_finish_rem_req(srp);
  2402. else
  2403.     ++dirty;
  2404.     }
  2405.     if (0 == dirty) {
  2406. unsigned long iflags;
  2408. write_lock_irqsave(&sg_dev_arr_lock, iflags);
  2409. __sg_remove_sfp(sdp, sfp);
  2410. if (sdp->detached && (NULL == sdp->headfp)) {
  2411.     int k, maxd;
  2413.     maxd = sg_template.dev_max;
  2414.     for (k = 0; k < maxd; ++k) {
  2415.      if (sdp == sg_dev_arr[k])
  2416.     break;
  2417.     }
  2418.     if (k < maxd)
  2419. sg_dev_arr[k] = NULL;
  2420.     kfree((char *)sdp);
  2421.     res = 1;
  2422. }
  2423. write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2424.     }
  2425.     else {
  2426.         sfp->closed = 1; /* flag dirty state on this fd */
  2427. sdp->device->access_count++;
  2428. /* MOD_INC's to inhibit unloading sg and associated adapter driver */
  2429. if (sg_template.module)
  2430.     __MOD_INC_USE_COUNT(sg_template.module);
  2431. if (sdp->device->host->hostt->module)
  2432.     __MOD_INC_USE_COUNT(sdp->device->host->hostt->module);
  2433.         SCSI_LOG_TIMEOUT(1, printk(
  2434.           "sg_remove_sfp: worrisome, %d writes pendingn", dirty));
  2435.     }
  2436.     return res;
  2437. }
  2439. static int sg_res_in_use(Sg_fd * sfp)
  2440. {
  2441.     const Sg_request * srp;
  2442.     unsigned long iflags;
  2444.     read_lock_irqsave(&sfp->rq_list_lock, iflags);
  2445.     for (srp = sfp->headrp; srp; srp = srp->nextrp)
  2446.         if (srp->res_used) break;
  2447.     read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2448.     return srp ? 1 : 0;
  2449. }
  2451. /* If retSzp==NULL want exact size or fail */
  2452. static char * sg_low_malloc(int rqSz, int lowDma, int mem_src, int * retSzp)
  2453. {
  2454.     char * resp = NULL;
  2455.     int page_mask = lowDma ? (GFP_ATOMIC | GFP_DMA) : GFP_ATOMIC;
  2457.     if (rqSz <= 0)
  2458.         return resp;
  2459.     if (SG_HEAP_KMAL == mem_src) {
  2460.         resp = kmalloc(rqSz, page_mask);
  2461. if (resp) {
  2462.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2463.      memset(resp, 0, rqSz);
  2464.     if (retSzp) *retSzp = rqSz;
  2465. }
  2466.         return resp;
  2467.     }
  2468.     if (SG_HEAP_POOL == mem_src) {
  2469.         int num_sect = rqSz / SG_SECTOR_SZ;
  2471.         if (0 != (rqSz & SG_SECTOR_MSK)) {
  2472.             if (! retSzp)
  2473.                 return resp;
  2474.             ++num_sect;
  2475.             rqSz = num_sect * SG_SECTOR_SZ;
  2476.         }
  2477.         while (num_sect > 0) {
  2478.             if ((num_sect <= sg_pool_secs_avail) &&
  2479.                 (scsi_dma_free_sectors > (SG_LOW_POOL_THRESHHOLD + num_sect))) {
  2480.                 resp = scsi_malloc(rqSz);
  2481.                 if (resp) {
  2482.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2483. memset(resp, 0, rqSz);
  2484.                     if (retSzp) *retSzp = rqSz;
  2485.                     sg_pool_secs_avail -= num_sect;
  2486.                     return resp;
  2487.                 }
  2488.             }
  2489.             if (! retSzp)
  2490.                 return resp;
  2491.             num_sect /= 2;      /* try half as many */
  2492.             rqSz = num_sect * SG_SECTOR_SZ;
  2493.         }
  2494.     }
  2495.     else if (SG_HEAP_PAGE == mem_src) {
  2496.         int order, a_size;
  2497.         int resSz = rqSz;
  2499.         for (order = 0, a_size = PAGE_SIZE;
  2500.              a_size < rqSz; order++, a_size <<= 1)
  2501.             ;
  2502.         resp = (char *)__get_free_pages(page_mask, order);
  2503.         while ((! resp) && order && retSzp) {
  2504.             --order;
  2505.             a_size >>= 1;   /* divide by 2, until PAGE_SIZE */
  2506.             resp = (char *)__get_free_pages(page_mask, order); /* try half */
  2507.             resSz = a_size;
  2508.         }
  2509. if (resp) {
  2510.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2511.                 memset(resp, 0, resSz);
  2512.     if (retSzp) *retSzp = resSz;
  2513. }
  2514.     }
  2515.     else
  2516.         printk(KERN_ERR "sg_low_malloc: bad mem_src=%d, rqSz=%dfn", 
  2517.        mem_src, rqSz);
  2518.     return resp;
  2519. }
  2521. static char * sg_malloc(const Sg_fd * sfp, int size, int * retSzp,
  2522.                         int * mem_srcp)
  2523. {
  2524.     char * resp = NULL;
  2526.     if (retSzp) *retSzp = size;
  2527.     if (size <= 0)
  2528.         ;
  2529.     else {
  2530.         int low_dma = sfp->low_dma;
  2531.         int l_ms = -1;  /* invalid value */
  2533. switch (*mem_srcp)
  2534.         {
  2535.         case SG_HEAP_PAGE:
  2536.             l_ms = (size < PAGE_SIZE) ? SG_HEAP_POOL : SG_HEAP_PAGE;
  2537.             resp = sg_low_malloc(size, low_dma, l_ms, 0);
  2538.             if (resp)
  2539.                 break;
  2540.             resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2541.             if (! resp) {
  2542.                 l_ms = (SG_HEAP_POOL == l_ms) ? SG_HEAP_PAGE : SG_HEAP_POOL;
  2543.                 resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2544.                 if (! resp) {
  2545.                     l_ms = SG_HEAP_KMAL;
  2546.                     resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2547.                 }
  2548.             }
  2549.             if (resp && retSzp) *retSzp = size;
  2550.             break;
  2551.         case SG_HEAP_KMAL:
  2552.             l_ms = SG_HEAP_KMAL; /* was SG_HEAP_PAGE */
  2553.             resp = sg_low_malloc(size, low_dma, l_ms, 0);
  2554.             if (resp)
  2555.                 break;
  2556.             l_ms = SG_HEAP_POOL;
  2557.             resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2558.             if (resp && retSzp) *retSzp = size;
  2559.             break;
  2560.         default:
  2561.             SCSI_LOG_TIMEOUT(1, printk("sg_malloc: bad ms=%dn", *mem_srcp));
  2562.             break;
  2563.         }
  2564.         if (resp) *mem_srcp = l_ms;
  2565.     }
  2566.     SCSI_LOG_TIMEOUT(6, printk("sg_malloc: size=%d, ms=%d, ret=0x%pn",
  2567.                                size, *mem_srcp, resp));
  2568.     return resp;
  2569. }
  2571. static inline int sg_alloc_kiovec(int nr, struct kiobuf **bufp, int *szp)
  2572. {
  2573. #if SG_NEW_KIOVEC
  2574.     return alloc_kiovec_sz(nr, bufp, szp);
  2575. #else
  2576.     return alloc_kiovec(nr, bufp);
  2577. #endif
  2578. }
  2580. static void sg_low_free(char * buff, int size, int mem_src)
  2581. {
  2582.     if (! buff) return;
  2583.     switch (mem_src) {
  2584.     case SG_HEAP_POOL:
  2585. {
  2586.     int num_sect = size / SG_SECTOR_SZ;
  2588.     scsi_free(buff, size);
  2589.     sg_pool_secs_avail += num_sect;
  2590. }
  2591. break;
  2592.     case SG_HEAP_KMAL:
  2593. kfree(buff);    /* size not used */
  2594. break;
  2595.     case SG_HEAP_PAGE:
  2596. {
  2597.     int order, a_size;
  2598.     for (order = 0, a_size = PAGE_SIZE;
  2599.  a_size < size; order++, a_size <<= 1)
  2600. ;
  2601.     free_pages((unsigned long)buff, order);
  2602. }
  2603. break;
  2604.     case SG_USER_MEM:
  2605. break; /* nothing to do */
  2606.     default:
  2607. printk(KERN_ERR "sg_low_free: bad mem_src=%d, buff=0x%p, rqSz=%dn",
  2608.                mem_src, buff, size);
  2609. break;
  2610.     }
  2611. }
  2613. static void sg_free(char * buff, int size, int mem_src)
  2614. {
  2615.     SCSI_LOG_TIMEOUT(6,
  2616.         printk("sg_free: buff=0x%p, size=%dn", buff, size));
  2617.     if ((! buff) || (size <= 0))
  2618.         ;
  2619.     else
  2620.         sg_low_free(buff, size, mem_src);
  2621. }
  2623. static inline void sg_free_kiovec(int nr, struct kiobuf **bufp, int *szp)
  2624. {
  2625. #if SG_NEW_KIOVEC
  2626.     free_kiovec_sz(nr, bufp, szp);
  2627. #else
  2628.     free_kiovec(nr, bufp);
  2629. #endif
  2630. }
  2632. static int sg_ms_to_jif(unsigned int msecs)
  2633. {
  2634.     if ((UINT_MAX / 2U) < msecs)
  2635. return INT_MAX;      /* special case, set largest possible */
  2636.     else
  2637. return ((int)msecs < (INT_MAX / 1000)) ? (((int)msecs * HZ) / 1000)
  2638.        : (((int)msecs / 1000) * HZ);
  2639. }
  2641. static inline unsigned sg_jif_to_ms(int jifs)
  2642. {
  2643.     if (jifs <= 0)
  2644. return 0U;
  2645.     else {
  2646. unsigned int j = (unsigned int)jifs;
  2647. return (j < (UINT_MAX / 1000)) ? ((j * 1000) / HZ) : ((j / HZ) * 1000);
  2648.     }
  2649. }
  2651. static unsigned char allow_ops[] = {TEST_UNIT_READY, REQUEST_SENSE,
  2652. INQUIRY, READ_CAPACITY, READ_BUFFER, READ_6, READ_10, READ_12,
  2653. MODE_SENSE, MODE_SENSE_10, LOG_SENSE};
  2655. static int sg_allow_access(unsigned char opcode, char dev_type)
  2656. {
  2657.     int k;
  2659.     if (TYPE_SCANNER == dev_type) /* TYPE_ROM maybe burner */
  2660. return 1;
  2661.     for (k = 0; k < sizeof(allow_ops); ++k) {
  2662. if (opcode == allow_ops[k])
  2663.     return 1;
  2664.     }
  2665.     return 0;
  2666. }
  2669. #ifdef CONFIG_PROC_FS
  2670. static int sg_last_dev()
  2671. {
  2672.     int k;
  2673.     unsigned long iflags;
  2675.     read_lock_irqsave(&sg_dev_arr_lock, iflags);
  2676.     for (k = sg_template.dev_max - 1; k >= 0; --k)
  2677. if (sg_dev_arr[k] && sg_dev_arr[k]->device) break;
  2678.     read_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2679.     return k + 1;   /* origin 1 */
  2680. }
  2681. #endif
  2683. static Sg_device * sg_get_dev(int dev)
  2684. {
  2685.     Sg_device * sdp = NULL;
  2686.     unsigned long iflags;
  2688.     if (sg_dev_arr && (dev >= 0))
  2689.     {
  2690. read_lock_irqsave(&sg_dev_arr_lock, iflags);
  2691. if (dev < sg_template.dev_max)
  2692.     sdp = sg_dev_arr[dev];
  2693. read_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2694.     }
  2695.     return sdp;
  2696. }
  2698. #ifdef CONFIG_PROC_FS
  2700. static struct proc_dir_entry * sg_proc_sgp = NULL;
  2702. static char sg_proc_sg_dirname[] = "sg";
  2703. static const char * sg_proc_leaf_names[] = {"allow_dio", "def_reserved_size",
  2704. "debug", "devices", "device_hdr", "device_strs",
  2705. "hosts", "host_hdr", "host_strs", "version"};
  2707. static int sg_proc_adio_read(char * buffer, char ** start, off_t offset,
  2708.      int size, int * eof, void * data);
  2709. static int sg_proc_adio_info(char * buffer, int * len, off_t * begin,
  2710.      off_t offset, int size);
  2711. static int sg_proc_adio_write(struct file * filp, const char * buffer,
  2712.       unsigned long count, void * data);
  2713. static int sg_proc_dressz_read(char * buffer, char ** start, off_t offset,
  2714.        int size, int * eof, void * data);
  2715. static int sg_proc_dressz_info(char * buffer, int * len, off_t * begin,
  2716.        off_t offset, int size);
  2717. static int sg_proc_dressz_write(struct file * filp, const char * buffer,
  2718. unsigned long count, void * data);
  2719. static int sg_proc_debug_read(char * buffer, char ** start, off_t offset,
  2720.       int size, int * eof, void * data);
  2721. static int sg_proc_debug_info(char * buffer, int * len, off_t * begin,
  2722.       off_t offset, int size);
  2723. static int sg_proc_dev_read(char * buffer, char ** start, off_t offset,
  2724.     int size, int * eof, void * data);
  2725. static int sg_proc_dev_info(char * buffer, int * len, off_t * begin,
  2726.     off_t offset, int size);
  2727. static int sg_proc_devhdr_read(char * buffer, char ** start, off_t offset,
  2728.        int size, int * eof, void * data);
  2729. static int sg_proc_devhdr_info(char * buffer, int * len, off_t * begin,
  2730.        off_t offset, int size);
  2731. static int sg_proc_devstrs_read(char * buffer, char ** start, off_t offset,
  2732. int size, int * eof, void * data);
  2733. static int sg_proc_devstrs_info(char * buffer, int * len, off_t * begin,
  2734. off_t offset, int size);
  2735. static int sg_proc_host_read(char * buffer, char ** start, off_t offset,
  2736.      int size, int * eof, void * data);
  2737. static int sg_proc_host_info(char * buffer, int * len, off_t * begin,
  2738.      off_t offset, int size);
  2739. static int sg_proc_hosthdr_read(char * buffer, char ** start, off_t offset,
  2740. int size, int * eof, void * data);
  2741. static int sg_proc_hosthdr_info(char * buffer, int * len, off_t * begin,
  2742. off_t offset, int size);
  2743. static int sg_proc_hoststrs_read(char * buffer, char ** start, off_t offset,
  2744.  int size, int * eof, void * data);
  2745. static int sg_proc_hoststrs_info(char * buffer, int * len, off_t * begin,
  2746.  off_t offset, int size);
  2747. static int sg_proc_version_read(char * buffer, char ** start, off_t offset,
  2748. int size, int * eof, void * data);
  2749. static int sg_proc_version_info(char * buffer, int * len, off_t * begin,
  2750. off_t offset, int size);
  2751. static read_proc_t * sg_proc_leaf_reads[] = {
  2752.      sg_proc_adio_read, sg_proc_dressz_read, sg_proc_debug_read,
  2753.      sg_proc_dev_read, sg_proc_devhdr_read, sg_proc_devstrs_read,
  2754.      sg_proc_host_read, sg_proc_hosthdr_read, sg_proc_hoststrs_read,
  2755.      sg_proc_version_read};
  2756. static write_proc_t * sg_proc_leaf_writes[] = {
  2757.      sg_proc_adio_write, sg_proc_dressz_write, 0, 0, 0, 0, 0, 0, 0, 0};
  2759. #define PRINT_PROC(fmt,args...)                                 
  2760.     do {                                                        
  2761. *len += sprintf(buffer + *len, fmt, ##args);            
  2762. if (*begin + *len > offset + size)                      
  2763.     return 0;                                           
  2764. if (*begin + *len < offset) {                           
  2765.     *begin += *len;                                     
  2766.     *len = 0;                                           
  2767. }                                                       
  2768.     } while(0)
  2770. #define SG_PROC_READ_FN(infofp)                                 
  2771.     do {                                                        
  2772. int len = 0;                                            
  2773. off_t begin = 0;                                        
  2774. *eof = infofp(buffer, &len, &begin, offset, size);      
  2775. if (offset >= (begin + len))                            
  2776.     return 0;                                           
  2777. *start = buffer + offset - begin;
  2778. return (size < (begin + len - offset)) ?                
  2779. size : begin + len - offset;    
  2780.     } while(0)
  2783. static int sg_proc_init()
  2784. {
  2785.     int k, mask;
  2786.     int leaves = sizeof(sg_proc_leaf_names) / sizeof(sg_proc_leaf_names[0]);
  2787.     struct proc_dir_entry * pdep;
  2789.     if (! proc_scsi)
  2790. return 1;
  2791.     sg_proc_sgp = create_proc_entry(sg_proc_sg_dirname,
  2792.     S_IFDIR | S_IRUGO | S_IXUGO, proc_scsi);
  2793.     if (! sg_proc_sgp)
  2794. return 1;
  2795.     for (k = 0; k < leaves; ++k) {
  2796. mask = sg_proc_leaf_writes[k] ? S_IRUGO | S_IWUSR : S_IRUGO;
  2797. pdep = create_proc_entry(sg_proc_leaf_names[k], mask, sg_proc_sgp);
  2798. if (pdep) {
  2799.     pdep->read_proc = sg_proc_leaf_reads[k];
  2800.     if (sg_proc_leaf_writes[k])
  2801. pdep->write_proc = sg_proc_leaf_writes[k];
  2802. }
  2803.     }
  2804.     return 0;
  2805. }
  2807. static void sg_proc_cleanup()
  2808. {
  2809.     int k;
  2810.     int leaves = sizeof(sg_proc_leaf_names) / sizeof(sg_proc_leaf_names[0]);
  2812.     if ((! proc_scsi) || (! sg_proc_sgp))
  2813. return;
  2814.     for (k = 0; k < leaves; ++k)
  2815. remove_proc_entry(sg_proc_leaf_names[k], sg_proc_sgp);
  2816.     remove_proc_entry(sg_proc_sg_dirname, proc_scsi);
  2817. }
  2819. static int sg_proc_adio_read(char * buffer, char ** start, off_t offset,
  2820.        int size, int * eof, void * data)
  2821. { SG_PROC_READ_FN(sg_proc_adio_info); }
  2823. static int sg_proc_adio_info(char * buffer, int * len, off_t * begin,
  2824.      off_t offset, int size)
  2825. {
  2826.     PRINT_PROC("%dn", sg_allow_dio);
  2827.     return 1;
  2828. }
  2830. static int sg_proc_adio_write(struct file * filp, const char * buffer,
  2831.       unsigned long count, void * data)
  2832. {
  2833.     int num;
  2834.     char buff[11];
  2836.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2837. return -EACCES;
  2838.     num = (count < 10) ? count : 10;
  2839.     copy_from_user(buff, buffer, num);
  2840.     buff[num] = '';
  2841.     sg_allow_dio = simple_strtoul(buff, 0, 10) ? 1 : 0;
  2842.     return count;
  2843. }
  2845. static int sg_proc_dressz_read(char * buffer, char ** start, off_t offset,
  2846.        int size, int * eof, void * data)
  2847. { SG_PROC_READ_FN(sg_proc_dressz_info); }
  2849. static int sg_proc_dressz_info(char * buffer, int * len, off_t * begin,
  2850.        off_t offset, int size)
  2851. {
  2852.     PRINT_PROC("%dn", sg_big_buff);
  2853.     return 1;
  2854. }
  2856. static int sg_proc_dressz_write(struct file * filp, const char * buffer,
  2857. unsigned long count, void * data)
  2858. {
  2859.     int num;
  2860.     unsigned long k = ULONG_MAX;
  2861.     char buff[11];
  2863.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2864. return -EACCES;
  2865.     num = (count < 10) ? count : 10;
  2866.     copy_from_user(buff, buffer, num);
  2867.     buff[num] = '';
  2868.     k = simple_strtoul(buff, 0, 10);
  2869.     if (k <= 1048576) {
  2870. sg_big_buff = k;
  2871. return count;
  2872.     }
  2873.     return -ERANGE;
  2874. }
  2876. static int sg_proc_debug_read(char * buffer, char ** start, off_t offset,
  2877.       int size, int * eof, void * data)
  2878. { SG_PROC_READ_FN(sg_proc_debug_info); }
  2880. static int sg_proc_debug_info(char * buffer, int * len, off_t * begin,
  2881.       off_t offset, int size)
  2882. {
  2883.     Sg_device * sdp;
  2884.     const sg_io_hdr_t * hp;
  2885.     int j, max_dev, new_interface;
  2887.     if (NULL == sg_dev_arr) {
  2888. PRINT_PROC("sg_dev_arr NULL, driver not initializedn");
  2889. return 1;
  2890.     }
  2891.     max_dev = sg_last_dev();
  2892.     PRINT_PROC("dev_max(currently)=%d max_active_device=%d (origin 1)n",
  2893.        sg_template.dev_max, max_dev);
  2894.     PRINT_PROC(" scsi_dma_free_sectors=%u sg_pool_secs_aval=%d "
  2895.        "def_reserved_size=%dn",
  2896.        scsi_dma_free_sectors, sg_pool_secs_avail, sg_big_buff);
  2897.     for (j = 0; j < max_dev; ++j) {
  2898. if ((sdp = sg_get_dev(j))) {
  2899.     Sg_fd * fp;
  2900.     Sg_request * srp;
  2901.     struct scsi_device * scsidp;
  2902.     int dev, k, m, blen, usg;
  2903.  
  2904.     scsidp = sdp->device;
  2905.     if (NULL == scsidp) {
  2906. PRINT_PROC("device %d detached ??n", j);
  2907. continue;
  2908.     }
  2909.     dev = MINOR(sdp->i_rdev);
  2911.     if (sg_get_nth_sfp(sdp, 0)) {
  2912. PRINT_PROC(" >>> device=sg%d ", dev);
  2913. if (sdp->detached)
  2914.     PRINT_PROC("detached pending close ");
  2915. else
  2916.     PRINT_PROC("scsi%d chan=%d id=%d lun=%d   em=%d",
  2917.        scsidp->host->host_no, scsidp->channel,
  2918.        scsidp->id, scsidp->lun, scsidp->host->hostt->emulated);
  2919. PRINT_PROC(" sg_tablesize=%d excl=%dn", sdp->sg_tablesize, 
  2920.    sdp->exclude);
  2921.     }
  2922.     for (k = 0; (fp = sg_get_nth_sfp(sdp, k)); ++k) {
  2923. PRINT_PROC("   FD(%d): timeout=%dms bufflen=%d "
  2924.    "(res)sgat=%d low_dma=%dn", k + 1,
  2925.    sg_jif_to_ms(fp->timeout), fp->reserve.bufflen,
  2926.    (int)fp->reserve.k_use_sg, (int)fp->low_dma);
  2927. PRINT_PROC("   cmd_q=%d f_packid=%d k_orphan=%d closed=%dn",
  2928.    (int)fp->cmd_q, (int)fp->force_packid,
  2929.    (int)fp->keep_orphan, (int)fp->closed);
  2930. for (m = 0; (srp = sg_get_nth_request(fp, m)); ++m) {
  2931.     hp = &srp->header;
  2932.     new_interface = (hp->interface_id == '') ? 0 : 1;
  2933. /* stop indenting so far ... */
  2934. PRINT_PROC(srp->res_used ? ((new_interface && 
  2935.     (SG_FLAG_MMAP_IO & hp->flags)) ? "     mmap>> " : "     rb>> ") :
  2936.     ((SG_INFO_DIRECT_IO_MASK & hp->info) ? "     dio>> " : "     "));
  2937. blen = srp->my_cmdp ? srp->my_cmdp->sr_bufflen : srp->data.bufflen;
  2938. usg = srp->my_cmdp ? srp->my_cmdp->sr_use_sg : srp->data.k_use_sg;
  2939. PRINT_PROC(srp->done ? ((1 == srp->done) ? "rcv:" : "fin:") 
  2940.      : (srp->my_cmdp ? "act:" : "prior:"));
  2941. PRINT_PROC(" id=%d blen=%d", srp->header.pack_id, blen);
  2942. if (srp->done)
  2943.     PRINT_PROC(" dur=%d", hp->duration);
  2944. else
  2945.     PRINT_PROC(" t_o/elap=%d/%d", new_interface ? hp->timeout :
  2946. sg_jif_to_ms(fp->timeout),
  2947.   sg_jif_to_ms(hp->duration ? (jiffies - hp->duration) : 0));
  2948. PRINT_PROC("ms sgat=%d op=0x%02xn", usg, (int)srp->data.cmd_opcode);
  2949. /* reset indenting */
  2950. }
  2951. if (0 == m)
  2952.     PRINT_PROC("     No requests activen");
  2953.     }
  2954. }
  2955.     }
  2956.     return 1;
  2957. }
  2959. static int sg_proc_dev_read(char * buffer, char ** start, off_t offset,
  2960.     int size, int * eof, void * data)
  2961. { SG_PROC_READ_FN(sg_proc_dev_info); }
  2963. static int sg_proc_dev_info(char * buffer, int * len, off_t * begin,
  2964.     off_t offset, int size)
  2965. {
  2966.     Sg_device * sdp;
  2967.     int j, max_dev;
  2968.     struct scsi_device * scsidp;
  2970.     max_dev = sg_last_dev();
  2971.     for (j = 0; j < max_dev; ++j) {
  2972. sdp = sg_get_dev(j);
  2973. if (sdp && (scsidp = sdp->device) && (! sdp->detached))
  2974.     PRINT_PROC("%dt%dt%dt%dt%dt%dt%dt%dt%dn",
  2975.        scsidp->host->host_no, scsidp->channel, scsidp->id,
  2976.        scsidp->lun, (int)scsidp->type, (int)scsidp->access_count,
  2977.        (int)scsidp->queue_depth, (int)scsidp->device_busy,
  2978.        (int)scsidp->online);
  2979. else
  2980.     PRINT_PROC("-1t-1t-1t-1t-1t-1t-1t-1t-1n");
  2981.     }
  2982.     return 1;
  2983. }
  2985. static int sg_proc_devhdr_read(char * buffer, char ** start, off_t offset,
  2986.        int size, int * eof, void * data)
  2987. { SG_PROC_READ_FN(sg_proc_devhdr_info); }
  2989. static int sg_proc_devhdr_info(char * buffer, int * len, off_t * begin,
  2990.        off_t offset, int size)
  2991. {
  2992.     PRINT_PROC("hosttchantidtlunttypetopenstqdepthtbusytonlinen");
  2993.     return 1;
  2994. }
  2996. static int sg_proc_devstrs_read(char * buffer, char ** start, off_t offset,
  2997. int size, int * eof, void * data)
  2998. { SG_PROC_READ_FN(sg_proc_devstrs_info); }
  3000. static int sg_proc_devstrs_info(char * buffer, int * len, off_t * begin,
  3001. off_t offset, int size)
  3002. {
  3003.     Sg_device * sdp;
  3004.     int j, max_dev;
  3005.     struct scsi_device * scsidp;
  3007.     max_dev = sg_last_dev();
  3008.     for (j = 0; j < max_dev; ++j) {
  3009. sdp = sg_get_dev(j);
  3010. if (sdp && (scsidp = sdp->device) && (! sdp->detached))
  3011.     PRINT_PROC("%8.8st%16.16st%4.4sn",
  3012.        scsidp->vendor, scsidp->model, scsidp->rev);
  3013. else
  3014.     PRINT_PROC("<no active device>n");
  3015.     }
  3016.     return 1;
  3017. }
  3019. static int sg_proc_host_read(char * buffer, char ** start, off_t offset,
  3020.      int size, int * eof, void * data)
  3021. { SG_PROC_READ_FN(sg_proc_host_info); }
  3023. static int sg_proc_host_info(char * buffer, int * len, off_t * begin,
  3024.      off_t offset, int size)
  3025. {
  3026.     struct Scsi_Host * shp;
  3027.     int k;
  3029.     for (k = 0, shp = scsi_hostlist; shp; shp = shp->next, ++k) {
  3030.      for ( ; k < shp->host_no; ++k)
  3031.     PRINT_PROC("-1t-1t-1t-1t-1t-1n");
  3032. PRINT_PROC("%ut%hut%hdt%hut%dt%dn",
  3033.    shp->unique_id, shp->host_busy, shp->cmd_per_lun,
  3034.    shp->sg_tablesize, (int)shp->unchecked_isa_dma,
  3035.    (int)shp->hostt->emulated);
  3036.     }
  3037.     return 1;
  3038. }
  3040. static int sg_proc_hosthdr_read(char * buffer, char ** start, off_t offset,
  3041. int size, int * eof, void * data)
  3042. { SG_PROC_READ_FN(sg_proc_hosthdr_info); }
  3044. static int sg_proc_hosthdr_info(char * buffer, int * len, off_t * begin,
  3045. off_t offset, int size)
  3046. {
  3047.     PRINT_PROC("uidtbusytcpltscatgtisatemuln");
  3048.     return 1;
  3049. }
  3051. static int sg_proc_hoststrs_read(char * buffer, char ** start, off_t offset,
  3052.  int size, int * eof, void * data)
  3053. { SG_PROC_READ_FN(sg_proc_hoststrs_info); }
  3055. #define SG_MAX_HOST_STR_LEN 256
  3057. static int sg_proc_hoststrs_info(char * buffer, int * len, off_t * begin,
  3058.  off_t offset, int size)
  3059. {
  3060.     struct Scsi_Host * shp;
  3061.     int k;
  3062.     char buff[SG_MAX_HOST_STR_LEN];
  3063.     char * cp;
  3065.     for (k = 0, shp = scsi_hostlist; shp; shp = shp->next, ++k) {
  3066.      for ( ; k < shp->host_no; ++k)
  3067.     PRINT_PROC("<no active host>n");
  3068. strncpy(buff, shp->hostt->info ? shp->hostt->info(shp) :
  3069.     (shp->hostt->name ? shp->hostt->name : "<no name>"),
  3070. SG_MAX_HOST_STR_LEN);
  3071. buff[SG_MAX_HOST_STR_LEN - 1] = '';
  3072. for (cp = buff; *cp; ++cp) {
  3073.     if ('n' == *cp)
  3074. *cp = ' '; /* suppress imbedded newlines */
  3075. }
  3076. PRINT_PROC("%sn", buff);
  3077.     }
  3078.     return 1;
  3079. }
  3081. static int sg_proc_version_read(char * buffer, char ** start, off_t offset,
  3082. int size, int * eof, void * data)
  3083. { SG_PROC_READ_FN(sg_proc_version_info); }
  3085. static int sg_proc_version_info(char * buffer, int * len, off_t * begin,
  3086. off_t offset, int size)
  3087. {
  3088.     PRINT_PROC("%dt%sn", sg_version_num, sg_version_str);
  3089.     return 1;
  3090. }
  3091. #endif  /* CONFIG_PROC_FS */
  3094. module_init(init_sg);
  3095. module_exit(exit_sg);