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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
sg.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：96k
源码类别：

嵌入式Linux

开发平台：

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 - 2001 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.22 (20011208)";
  23. #endif
  24.  static int sg_version_num = 30122; /* 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 = -EACCES;   /* 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) > 0) ?
  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 -EACCES;
  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 -EACCES;
  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 -EACCES; /* 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) && p;
  1888.  ++k, ++sclp, ksglen = (int)sclp->length, p = sclp->address) {
  1889. ok = (SG_USER_MEM != mem_src_arr[k]);
  1890. if (usglen <= 0)
  1891.     break;
  1892. if (ksglen > usglen) {
  1893.     if (usglen >= num_xfer) {
  1894. if (ok) __copy_from_user(p, up, num_xfer);
  1895. return 0;
  1896.     }
  1897.     if (ok) __copy_from_user(p, up, usglen);
  1898.     p += usglen;
  1899.     ksglen -= usglen;
  1900.                     break;
  1901. }
  1902. else {
  1903.     if (ksglen >= num_xfer) {
  1904. if (ok) __copy_from_user(p, up, num_xfer);
  1905. return 0;
  1906.     }
  1907.     if (ok) __copy_from_user(p, up, ksglen);
  1908.     up += ksglen;
  1909.     usglen -= ksglen;
  1910. }
  1911.             }
  1912.         }
  1913.     }
  1914.     return 0;
  1915. }
  1917. static int sg_u_iovec(sg_io_hdr_t * hp, int sg_num, int ind,
  1918.       int wr_xf, int * countp, unsigned char ** up)
  1919. {
  1920.     int num_xfer = (int)hp->dxfer_len;
  1921.     unsigned char * p;
  1922.     int count, k;
  1923.     sg_iovec_t u_iovec;
  1925.     if (0 == sg_num) {
  1926. p = (unsigned char *)hp->dxferp;
  1927. if (wr_xf && ('' == hp->interface_id))
  1928.     count = (int)hp->flags; /* holds "old" input_size */
  1929. else
  1930.     count = num_xfer;
  1931.     }
  1932.     else {
  1933. __copy_from_user(&u_iovec,
  1934.  (unsigned char *)hp->dxferp + (ind * SZ_SG_IOVEC),
  1935.  SZ_SG_IOVEC);
  1936. p = (unsigned char *)u_iovec.iov_base;
  1937. count = (int)u_iovec.iov_len;
  1938.     }
  1939.     if ((k = verify_area(wr_xf ? VERIFY_READ : VERIFY_WRITE, p, count)))
  1940. return k;
  1941.     if (up) *up = p;
  1942.     if (countp) *countp = count;
  1943.     return 0;
  1944. }
  1946. static char * sg_get_sgat_msa(Sg_scatter_hold * schp)
  1947. {
  1948.     int elem_sz = sizeof(struct scatterlist) + sizeof(char);
  1949.     int mx_sc_elems = schp->sglist_len / elem_sz;
  1950.     return schp->buffer + (sizeof(struct scatterlist) * mx_sc_elems);
  1951. }
  1953. static void sg_remove_scat(Sg_scatter_hold * schp)
  1954. {
  1955.     SCSI_LOG_TIMEOUT(4, printk("sg_remove_scat: k_use_sg=%dn",
  1956.        schp->k_use_sg));
  1957.     if (schp->buffer && schp->sglist_len) {
  1958.         int k, mem_src;
  1959.         struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  1960. char * mem_src_arr = sg_get_sgat_msa(schp);
  1962. for (k = 0; (k < schp->k_use_sg) && sclp->address; ++k, ++sclp) {
  1963.     mem_src = mem_src_arr[k];
  1964.     SCSI_LOG_TIMEOUT(5,
  1965. printk("sg_remove_scat: k=%d, a=0x%p, len=%d, ms=%dn",
  1966.                        k, sclp->address, sclp->length, mem_src));
  1967.             sg_free(sclp->address, sclp->length, mem_src);
  1968.             sclp->address = NULL;
  1969. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,13)
  1970.     sclp->page = NULL;
  1971. #endif
  1972.             sclp->length = 0;
  1973.         }
  1974. sg_free(schp->buffer, schp->sglist_len, schp->buffer_mem_src);
  1975.     }
  1976.     else if (schp->buffer)
  1977. sg_free(schp->buffer, schp->b_malloc_len, schp->buffer_mem_src);
  1978.     memset(schp, 0, sizeof(*schp));
  1979. }
  1981. static int sg_read_xfer(Sg_request * srp)
  1982. {
  1983.     sg_io_hdr_t * hp = &srp->header;
  1984.     Sg_scatter_hold * schp = &srp->data;
  1985.     int num_xfer = 0;
  1986.     int j, k, onum, usglen, ksglen, res, ok;
  1987.     int iovec_count = (int)hp->iovec_count;
  1988.     int dxfer_dir = hp->dxfer_direction;
  1989.     unsigned char * p;
  1990.     unsigned char * up;
  1991.     int new_interface = ('' == hp->interface_id) ? 0 : 1;
  1993.     if ((SG_DXFER_UNKNOWN == dxfer_dir) || (SG_DXFER_FROM_DEV == dxfer_dir) ||
  1994. (SG_DXFER_TO_FROM_DEV == dxfer_dir)) {
  1995. num_xfer =  hp->dxfer_len;
  1996. if (schp->bufflen < num_xfer)
  1997.     num_xfer = schp->bufflen;
  1998.     }
  1999.     if ((num_xfer <= 0) || 
  2000.      (new_interface && ((SG_FLAG_NO_DXFER | SG_FLAG_MMAP_IO) & hp->flags)))
  2001. return 0;
  2003.     SCSI_LOG_TIMEOUT(4,
  2004.  printk("sg_read_xfer: num_xfer=%d, iovec_count=%d, k_use_sg=%dn",
  2005. num_xfer, iovec_count, schp->k_use_sg));
  2006.     if (iovec_count) {
  2007. onum = iovec_count;
  2008. if ((k = verify_area(VERIFY_READ, hp->dxferp,
  2009.      SZ_SG_IOVEC * onum)))
  2010.     return k;
  2011.     }
  2012.     else
  2013. onum = 1;
  2015.     if (0 == schp->k_use_sg) {  /* kernel has single buffer */
  2016. if (SG_USER_MEM != schp->buffer_mem_src) { /* else nothing to do */
  2018.     for (j = 0, p = schp->buffer; j < onum; ++j) {
  2019. res = sg_u_iovec(hp, iovec_count, j, 0, &usglen, &up);
  2020. if (res) return res;
  2021. usglen = (num_xfer > usglen) ? usglen : num_xfer;
  2022. __copy_to_user(up, p, usglen);
  2023. p += usglen;
  2024. num_xfer -= usglen;
  2025. if (num_xfer <= 0)
  2026.     return 0;
  2027.     }
  2028. }
  2029.     }
  2030.     else {      /* kernel using scatter gather list */
  2031. struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  2032. char * mem_src_arr = sg_get_sgat_msa(schp);
  2033. ksglen = (int)sclp->length;
  2034. p = sclp->address;
  2036. for (j = 0, k = 0; j < onum; ++j) {
  2037.     res = sg_u_iovec(hp, iovec_count, j, 0, &usglen, &up);
  2038.     if (res) return res;
  2040.     for (; (k < schp->k_use_sg) && p;
  2041.  ++k, ++sclp, ksglen = (int)sclp->length, p = sclp->address) {
  2042. ok = (SG_USER_MEM != mem_src_arr[k]);
  2043. if (usglen <= 0)
  2044.     break;
  2045. if (ksglen > usglen) {
  2046.     if (usglen >= num_xfer) {
  2047. if (ok) __copy_to_user(up, p, num_xfer);
  2048. return 0;
  2049.     }
  2050.     if (ok) __copy_to_user(up, p, usglen);
  2051.     p += usglen;
  2052.     ksglen -= usglen;
  2053.     break;
  2054. }
  2055. else {
  2056.     if (ksglen >= num_xfer) {
  2057. if (ok) __copy_to_user(up, p, num_xfer);
  2058. return 0;
  2059.     }
  2060.     if (ok) __copy_to_user(up, p, ksglen);
  2061.     up += ksglen;
  2062.     usglen -= ksglen;
  2063. }
  2064.     }
  2065. }
  2066.     }
  2067.     return 0;
  2068. }
  2070. static void sg_read_oxfer(Sg_request * srp, char * outp, int num_read_xfer)
  2071. {
  2072.     Sg_scatter_hold * schp = &srp->data;
  2074.     SCSI_LOG_TIMEOUT(4, printk("sg_read_oxfer: num_read_xfer=%dn",
  2075.        num_read_xfer));
  2076.     if ((! outp) || (num_read_xfer <= 0))
  2077.         return;
  2078.     if(schp->k_use_sg > 0) {
  2079.         int k, num;
  2080.         struct scatterlist * sclp = (struct scatterlist *)schp->buffer;
  2082. for (k = 0; (k < schp->k_use_sg) && sclp->address; ++k, ++sclp) {
  2083.             num = (int)sclp->length;
  2084.             if (num > num_read_xfer) {
  2085.                 __copy_to_user(outp, sclp->address, num_read_xfer);
  2086.                 break;
  2087.             }
  2088.             else {
  2089.                 __copy_to_user(outp, sclp->address, num);
  2090.                 num_read_xfer -= num;
  2091.                 if (num_read_xfer <= 0)
  2092.                     break;
  2093.                 outp += num;
  2094.             }
  2095.         }
  2096.     }
  2097.     else
  2098.         __copy_to_user(outp, schp->buffer, num_read_xfer);
  2099. }
  2101. static void sg_build_reserve(Sg_fd * sfp, int req_size)
  2102. {
  2103.     Sg_scatter_hold * schp = &sfp->reserve;
  2105.     SCSI_LOG_TIMEOUT(4, printk("sg_build_reserve: req_size=%dn", req_size));
  2106.     do {
  2107.         if (req_size < PAGE_SIZE)
  2108.             req_size = PAGE_SIZE;
  2109. if (0 == sg_build_indi(schp, sfp, req_size))
  2110.             return;
  2111.         else
  2112.             sg_remove_scat(schp);
  2113.         req_size >>= 1; /* divide by 2 */
  2114.     } while (req_size >  (PAGE_SIZE / 2));
  2115. }
  2117. static void sg_link_reserve(Sg_fd * sfp, Sg_request * srp, int size)
  2118. {
  2119.     Sg_scatter_hold * req_schp = &srp->data;
  2120.     Sg_scatter_hold * rsv_schp = &sfp->reserve;
  2122.     srp->res_used = 1;
  2123.     SCSI_LOG_TIMEOUT(4, printk("sg_link_reserve: size=%dn", size));
  2124.     size = (size + 1) & (~1);    /* round to even for aha1542 */
  2125.     if (rsv_schp->k_use_sg > 0) {
  2126.         int k, num;
  2127.         int rem = size;
  2128.         struct scatterlist * sclp = (struct scatterlist *)rsv_schp->buffer;
  2130. for (k = 0; k < rsv_schp->k_use_sg; ++k, ++sclp) {
  2131.             num = (int)sclp->length;
  2132.             if (rem <= num) {
  2133. if (0 == k) {
  2134.     req_schp->k_use_sg = 0;
  2135.     req_schp->buffer = sclp->address;
  2136. }
  2137. else {
  2138.          sfp->save_scat_len = num;
  2139.          sclp->length = (unsigned)rem;
  2140.          req_schp->k_use_sg = k + 1;
  2141.          req_schp->sglist_len = rsv_schp->sglist_len;
  2142.          req_schp->buffer = rsv_schp->buffer;
  2143. }
  2144. req_schp->bufflen = size;
  2145. req_schp->buffer_mem_src = rsv_schp->buffer_mem_src;
  2146. req_schp->b_malloc_len = rsv_schp->b_malloc_len;
  2147. break;
  2148.             }
  2149.             else
  2150.                 rem -= num;
  2151.         }
  2152. if (k >= rsv_schp->k_use_sg)
  2153.     SCSI_LOG_TIMEOUT(1, printk("sg_link_reserve: BAD sizen"));
  2154.     }
  2155.     else {
  2156. req_schp->k_use_sg = 0;
  2157.         req_schp->bufflen = size;
  2158.         req_schp->buffer = rsv_schp->buffer;
  2159. req_schp->buffer_mem_src = rsv_schp->buffer_mem_src;
  2160.         req_schp->b_malloc_len = rsv_schp->b_malloc_len;
  2161.     }
  2162. }
  2164. static void sg_unlink_reserve(Sg_fd * sfp, Sg_request * srp)
  2165. {
  2166.     Sg_scatter_hold * req_schp = &srp->data;
  2167.     Sg_scatter_hold * rsv_schp = &sfp->reserve;
  2169.     SCSI_LOG_TIMEOUT(4, printk("sg_unlink_reserve: req->k_use_sg=%dn",
  2170.        (int)req_schp->k_use_sg));
  2171.     if ((rsv_schp->k_use_sg > 0) && (req_schp->k_use_sg > 0)) {
  2172.         struct scatterlist * sclp = (struct scatterlist *)rsv_schp->buffer;
  2174. if (sfp->save_scat_len > 0)
  2175.     (sclp + (req_schp->k_use_sg - 1))->length =
  2176.                                         (unsigned)sfp->save_scat_len;
  2177.         else
  2178.             SCSI_LOG_TIMEOUT(1, printk(
  2179. "sg_unlink_reserve: BAD save_scat_lenn"));
  2180.     }
  2181.     req_schp->k_use_sg = 0;
  2182.     req_schp->bufflen = 0;
  2183.     req_schp->buffer = NULL;
  2184.     req_schp->sglist_len = 0;
  2185.     sfp->save_scat_len = 0;
  2186.     srp->res_used = 0;
  2187. }
  2189. static Sg_request * sg_get_rq_mark(Sg_fd * sfp, int pack_id)
  2190. {
  2191.     Sg_request * resp;
  2192.     unsigned long iflags;
  2194.     write_lock_irqsave(&sfp->rq_list_lock, iflags);
  2195.     for (resp = sfp->headrp; resp; resp = resp->nextrp) { 
  2196. /* look for requests that are ready + not SG_IO owned */
  2197. if ((1 == resp->done) && (! resp->sg_io_owned) &&
  2198.             ((-1 == pack_id) || (resp->header.pack_id == pack_id))) {
  2199.     resp->done = 2;   /* guard against other readers */
  2200.             break;
  2201. }
  2202.     }
  2203.     write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2204.     return resp;
  2205. }
  2207. #ifdef CONFIG_PROC_FS
  2208. static Sg_request * sg_get_nth_request(Sg_fd * sfp, int nth)
  2209. {
  2210.     Sg_request * resp;
  2211.     unsigned long iflags;
  2212.     int k;
  2214.     read_lock_irqsave(&sfp->rq_list_lock, iflags);
  2215.     for (k = 0, resp = sfp->headrp; resp && (k < nth); 
  2216.  ++k, resp = resp->nextrp)
  2217. ;
  2218.     read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2219.     return resp;
  2220. }
  2221. #endif
  2223. /* always adds to end of list */
  2224. static Sg_request * sg_add_request(Sg_fd * sfp)
  2225. {
  2226.     int k;
  2227.     unsigned long iflags;
  2228.     Sg_request * resp;
  2229.     Sg_request * rp =  sfp->req_arr;
  2231.     write_lock_irqsave(&sfp->rq_list_lock, iflags);
  2232.     resp = sfp->headrp;
  2233.     if (! resp) {
  2234. memset(rp, 0, sizeof(Sg_request));
  2235. rp->parentfp = sfp;
  2236. resp = rp;
  2237. sfp->headrp = resp;
  2238.     }
  2239.     else {
  2240.         if (0 == sfp->cmd_q)
  2241.             resp = NULL;   /* command queuing disallowed */
  2242.         else {
  2243.             for (k = 0; k < SG_MAX_QUEUE; ++k, ++rp) {
  2244.                 if (! rp->parentfp)
  2245.                     break;
  2246.             }
  2247.             if (k < SG_MAX_QUEUE) {
  2248. memset(rp, 0, sizeof(Sg_request));
  2249. rp->parentfp = sfp;
  2250. while (resp->nextrp) 
  2251.     resp = resp->nextrp;
  2252. resp->nextrp = rp;
  2253. resp = rp;
  2254.             }
  2255.             else
  2256.                 resp = NULL;
  2257.         }
  2258.     }
  2259.     if (resp) {
  2260.         resp->nextrp = NULL;
  2261. resp->header.duration = jiffies;
  2262.         resp->my_cmdp = NULL;
  2263. resp->data.kiobp = NULL;
  2264.     }
  2265.     write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2266.     return resp;
  2267. }
  2269. /* Return of 1 for found; 0 for not found */
  2270. static int sg_remove_request(Sg_fd * sfp, Sg_request * srp)
  2271. {
  2272.     Sg_request * prev_rp;
  2273.     Sg_request * rp;
  2274.     unsigned long iflags;
  2275.     int res = 0;
  2277.     if ((! sfp) || (! srp) || (! sfp->headrp))
  2278.         return res;
  2279.     write_lock_irqsave(&sfp->rq_list_lock, iflags);
  2280.     prev_rp = sfp->headrp;
  2281.     if (srp == prev_rp) {
  2282.         sfp->headrp = prev_rp->nextrp;
  2283.         prev_rp->parentfp = NULL;
  2284.         res = 1;
  2285.     }
  2286.     else {
  2287. while ((rp = prev_rp->nextrp)) {
  2288.     if (srp == rp) {
  2289. prev_rp->nextrp = rp->nextrp;
  2290. rp->parentfp = NULL;
  2291. res = 1;
  2292. break;
  2293.     }
  2294.     prev_rp = rp;
  2295. }
  2296.     }
  2297.     write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2298.     return res;
  2299. }
  2301. #ifdef CONFIG_PROC_FS
  2302. static Sg_fd * sg_get_nth_sfp(Sg_device * sdp, int nth)
  2303. {
  2304.     Sg_fd * resp;
  2305.     unsigned long iflags;
  2306.     int k;
  2308.     read_lock_irqsave(&sg_dev_arr_lock, iflags);
  2309.     for (k = 0, resp = sdp->headfp; resp && (k < nth); 
  2310.  ++k, resp = resp->nextfp)
  2311. ;
  2312.     read_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2313.     return resp;
  2314. }
  2315. #endif
  2317. static Sg_fd * sg_add_sfp(Sg_device * sdp, int dev)
  2318. {
  2319.     Sg_fd * sfp;
  2320.     unsigned long iflags;
  2322.     sfp = (Sg_fd *)sg_low_malloc(sizeof(Sg_fd), 0, SG_HEAP_KMAL, 0);
  2323.     if (! sfp)
  2324.         return NULL;
  2325.     memset(sfp, 0, sizeof(Sg_fd));
  2326.     sfp->fd_mem_src = SG_HEAP_KMAL;
  2327.     init_waitqueue_head(&sfp->read_wait);
  2328.     sfp->rq_list_lock = RW_LOCK_UNLOCKED;
  2330.     sfp->timeout = SG_DEFAULT_TIMEOUT;
  2331.     sfp->force_packid = SG_DEF_FORCE_PACK_ID;
  2332.     sfp->low_dma = (SG_DEF_FORCE_LOW_DMA == 0) ?
  2333.                    sdp->device->host->unchecked_isa_dma : 1;
  2334.     sfp->cmd_q = SG_DEF_COMMAND_Q;
  2335.     sfp->keep_orphan = SG_DEF_KEEP_ORPHAN;
  2336.     sfp->parentdp = sdp;
  2337.     write_lock_irqsave(&sg_dev_arr_lock, iflags);
  2338.     if (! sdp->headfp)
  2339.         sdp->headfp = sfp;
  2340.     else {    /* add to tail of existing list */
  2341. Sg_fd * pfp = sdp->headfp;
  2342. while (pfp->nextfp)
  2343.     pfp = pfp->nextfp;
  2344. pfp->nextfp = sfp;
  2345.     }
  2346.     write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2347.     SCSI_LOG_TIMEOUT(3, printk("sg_add_sfp: sfp=0x%p, m_s=%dn",
  2348.        sfp, (int)sfp->fd_mem_src));
  2349.     sg_build_reserve(sfp, sg_big_buff);
  2350.     SCSI_LOG_TIMEOUT(3, printk("sg_add_sfp:   bufflen=%d, k_use_sg=%dn",
  2351.    sfp->reserve.bufflen, sfp->reserve.k_use_sg));
  2352.     return sfp;
  2353. }
  2355. static void __sg_remove_sfp(Sg_device * sdp, Sg_fd * sfp)
  2356. {
  2357.     Sg_fd * fp;
  2358.     Sg_fd * prev_fp;
  2360.     prev_fp =  sdp->headfp;
  2361.     if (sfp == prev_fp)
  2362. sdp->headfp = prev_fp->nextfp;
  2363.     else {
  2364. while ((fp = prev_fp->nextfp)) {
  2365.     if (sfp == fp) {
  2366. prev_fp->nextfp = fp->nextfp;
  2367. break;
  2368.     }
  2369.     prev_fp = fp;
  2370. }
  2371.     }
  2372.     if (sfp->reserve.bufflen > 0) {
  2373.     SCSI_LOG_TIMEOUT(6, printk("__sg_remove_sfp:    bufflen=%d, k_use_sg=%dn",
  2374.      (int)sfp->reserve.bufflen, (int)sfp->reserve.k_use_sg));
  2375. if (sfp->mmap_called)
  2376.     sg_rb_correct4mmap(&sfp->reserve, 0); /* undo correction */
  2377. sg_remove_scat(&sfp->reserve);
  2378.     }
  2379.     sfp->parentdp = NULL;
  2380.     SCSI_LOG_TIMEOUT(6, printk("__sg_remove_sfp:    sfp=0x%pn", sfp));
  2381.     sg_low_free((char *)sfp, sizeof(Sg_fd), sfp->fd_mem_src);
  2382. }
  2384. /* Returns 0 in normal case, 1 when detached and sdp object removed */
  2385. static int sg_remove_sfp(Sg_device * sdp, Sg_fd * sfp)
  2386. {
  2387.     Sg_request * srp;
  2388.     Sg_request * tsrp;
  2389.     int dirty = 0;
  2390.     int res = 0;
  2392.     for (srp = sfp->headrp; srp; srp = tsrp) {
  2393. tsrp = srp->nextrp;
  2394. if (srp->done)
  2395.     sg_finish_rem_req(srp);
  2396. else
  2397.     ++dirty;
  2398.     }
  2399.     if (0 == dirty) {
  2400. unsigned long iflags;
  2402. write_lock_irqsave(&sg_dev_arr_lock, iflags);
  2403. __sg_remove_sfp(sdp, sfp);
  2404. if (sdp->detached && (NULL == sdp->headfp)) {
  2405.     int k, maxd;
  2407.     maxd = sg_template.dev_max;
  2408.     for (k = 0; k < maxd; ++k) {
  2409.      if (sdp == sg_dev_arr[k])
  2410.     break;
  2411.     }
  2412.     if (k < maxd)
  2413. sg_dev_arr[k] = NULL;
  2414.     kfree((char *)sdp);
  2415.     res = 1;
  2416. }
  2417. write_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2418.     }
  2419.     else {
  2420.         sfp->closed = 1; /* flag dirty state on this fd */
  2421. sdp->device->access_count++;
  2422. /* MOD_INC's to inhibit unloading sg and associated adapter driver */
  2423. if (sg_template.module)
  2424.     __MOD_INC_USE_COUNT(sg_template.module);
  2425. if (sdp->device->host->hostt->module)
  2426.     __MOD_INC_USE_COUNT(sdp->device->host->hostt->module);
  2427.         SCSI_LOG_TIMEOUT(1, printk(
  2428.           "sg_remove_sfp: worrisome, %d writes pendingn", dirty));
  2429.     }
  2430.     return res;
  2431. }
  2433. static int sg_res_in_use(Sg_fd * sfp)
  2434. {
  2435.     const Sg_request * srp;
  2436.     unsigned long iflags;
  2438.     read_lock_irqsave(&sfp->rq_list_lock, iflags);
  2439.     for (srp = sfp->headrp; srp; srp = srp->nextrp)
  2440.         if (srp->res_used) break;
  2441.     read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  2442.     return srp ? 1 : 0;
  2443. }
  2445. /* If retSzp==NULL want exact size or fail */
  2446. static char * sg_low_malloc(int rqSz, int lowDma, int mem_src, int * retSzp)
  2447. {
  2448.     char * resp = NULL;
  2449.     int page_mask = lowDma ? (GFP_ATOMIC | GFP_DMA) : GFP_ATOMIC;
  2451.     if (rqSz <= 0)
  2452.         return resp;
  2453.     if (SG_HEAP_KMAL == mem_src) {
  2454.         resp = kmalloc(rqSz, page_mask);
  2455.         if (resp && retSzp) *retSzp = rqSz;
  2456.         return resp;
  2457.     }
  2458.     if (SG_HEAP_POOL == mem_src) {
  2459.         int num_sect = rqSz / SG_SECTOR_SZ;
  2461.         if (0 != (rqSz & SG_SECTOR_MSK)) {
  2462.             if (! retSzp)
  2463.                 return resp;
  2464.             ++num_sect;
  2465.             rqSz = num_sect * SG_SECTOR_SZ;
  2466.         }
  2467.         while (num_sect > 0) {
  2468.             if ((num_sect <= sg_pool_secs_avail) &&
  2469.                 (scsi_dma_free_sectors > (SG_LOW_POOL_THRESHHOLD + num_sect))) {
  2470.                 resp = scsi_malloc(rqSz);
  2471.                 if (resp) {
  2472.                     if (retSzp) *retSzp = rqSz;
  2473.                     sg_pool_secs_avail -= num_sect;
  2474.                     return resp;
  2475.                 }
  2476.             }
  2477.             if (! retSzp)
  2478.                 return resp;
  2479.             num_sect /= 2;      /* try half as many */
  2480.             rqSz = num_sect * SG_SECTOR_SZ;
  2481.         }
  2482.     }
  2483.     else if (SG_HEAP_PAGE == mem_src) {
  2484.         int order, a_size;
  2485.         int resSz = rqSz;
  2487.         for (order = 0, a_size = PAGE_SIZE;
  2488.              a_size < rqSz; order++, a_size <<= 1)
  2489.             ;
  2490.         resp = (char *)__get_free_pages(page_mask, order);
  2491.         while ((! resp) && order && retSzp) {
  2492.             --order;
  2493.             a_size >>= 1;   /* divide by 2, until PAGE_SIZE */
  2494.             resp = (char *)__get_free_pages(page_mask, order); /* try half */
  2495.             resSz = a_size;
  2496.         }
  2497.         if (retSzp) *retSzp = resSz;
  2498.     }
  2499.     else
  2500.         printk(KERN_ERR "sg_low_malloc: bad mem_src=%d, rqSz=%dfn", 
  2501.        mem_src, rqSz);
  2502.     return resp;
  2503. }
  2505. static char * sg_malloc(const Sg_fd * sfp, int size, int * retSzp,
  2506.                         int * mem_srcp)
  2507. {
  2508.     char * resp = NULL;
  2510.     if (retSzp) *retSzp = size;
  2511.     if (size <= 0)
  2512.         ;
  2513.     else {
  2514.         int low_dma = sfp->low_dma;
  2515.         int l_ms = -1;  /* invalid value */
  2517. switch (*mem_srcp)
  2518.         {
  2519.         case SG_HEAP_PAGE:
  2520.             l_ms = (size < PAGE_SIZE) ? SG_HEAP_POOL : SG_HEAP_PAGE;
  2521.             resp = sg_low_malloc(size, low_dma, l_ms, 0);
  2522.             if (resp)
  2523.                 break;
  2524.             resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2525.             if (! resp) {
  2526.                 l_ms = (SG_HEAP_POOL == l_ms) ? SG_HEAP_PAGE : SG_HEAP_POOL;
  2527.                 resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2528.                 if (! resp) {
  2529.                     l_ms = SG_HEAP_KMAL;
  2530.                     resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2531.                 }
  2532.             }
  2533.             if (resp && retSzp) *retSzp = size;
  2534.             break;
  2535.         case SG_HEAP_KMAL:
  2536.             l_ms = SG_HEAP_KMAL; /* was SG_HEAP_PAGE */
  2537.             resp = sg_low_malloc(size, low_dma, l_ms, 0);
  2538.             if (resp)
  2539.                 break;
  2540.             l_ms = SG_HEAP_POOL;
  2541.             resp = sg_low_malloc(size, low_dma, l_ms, &size);
  2542.             if (resp && retSzp) *retSzp = size;
  2543.             break;
  2544.         default:
  2545.             SCSI_LOG_TIMEOUT(1, printk("sg_malloc: bad ms=%dn", *mem_srcp));
  2546.             break;
  2547.         }
  2548.         if (resp) *mem_srcp = l_ms;
  2549.     }
  2550.     SCSI_LOG_TIMEOUT(6, printk("sg_malloc: size=%d, ms=%d, ret=0x%pn",
  2551.                                size, *mem_srcp, resp));
  2552.     return resp;
  2553. }
  2555. static inline int sg_alloc_kiovec(int nr, struct kiobuf **bufp, int *szp)
  2556. {
  2557. #if SG_NEW_KIOVEC
  2558.     return alloc_kiovec_sz(nr, bufp, szp);
  2559. #else
  2560.     return alloc_kiovec(nr, bufp);
  2561. #endif
  2562. }
  2564. static void sg_low_free(char * buff, int size, int mem_src)
  2565. {
  2566.     if (! buff) return;
  2567.     switch (mem_src) {
  2568.     case SG_HEAP_POOL:
  2569. {
  2570.     int num_sect = size / SG_SECTOR_SZ;
  2572.     scsi_free(buff, size);
  2573.     sg_pool_secs_avail += num_sect;
  2574. }
  2575. break;
  2576.     case SG_HEAP_KMAL:
  2577. kfree(buff);    /* size not used */
  2578. break;
  2579.     case SG_HEAP_PAGE:
  2580. {
  2581.     int order, a_size;
  2582.     for (order = 0, a_size = PAGE_SIZE;
  2583.  a_size < size; order++, a_size <<= 1)
  2584. ;
  2585.     free_pages((unsigned long)buff, order);
  2586. }
  2587. break;
  2588.     case SG_USER_MEM:
  2589. break; /* nothing to do */
  2590.     default:
  2591. printk(KERN_ERR "sg_low_free: bad mem_src=%d, buff=0x%p, rqSz=%dn",
  2592.                mem_src, buff, size);
  2593. break;
  2594.     }
  2595. }
  2597. static void sg_free(char * buff, int size, int mem_src)
  2598. {
  2599.     SCSI_LOG_TIMEOUT(6,
  2600.         printk("sg_free: buff=0x%p, size=%dn", buff, size));
  2601.     if ((! buff) || (size <= 0))
  2602.         ;
  2603.     else
  2604.         sg_low_free(buff, size, mem_src);
  2605. }
  2607. static inline void sg_free_kiovec(int nr, struct kiobuf **bufp, int *szp)
  2608. {
  2609. #if SG_NEW_KIOVEC
  2610.     free_kiovec_sz(nr, bufp, szp);
  2611. #else
  2612.     free_kiovec(nr, bufp);
  2613. #endif
  2614. }
  2616. static int sg_ms_to_jif(unsigned int msecs)
  2617. {
  2618.     if ((UINT_MAX / 2U) < msecs)
  2619. return INT_MAX;      /* special case, set largest possible */
  2620.     else
  2621. return ((int)msecs < (INT_MAX / 1000)) ? (((int)msecs * HZ) / 1000)
  2622.        : (((int)msecs / 1000) * HZ);
  2623. }
  2625. static inline unsigned sg_jif_to_ms(int jifs)
  2626. {
  2627.     if (jifs <= 0)
  2628. return 0U;
  2629.     else {
  2630. unsigned int j = (unsigned int)jifs;
  2631. return (j < (UINT_MAX / 1000)) ? ((j * 1000) / HZ) : ((j / HZ) * 1000);
  2632.     }
  2633. }
  2635. static unsigned char allow_ops[] = {TEST_UNIT_READY, INQUIRY,
  2636. READ_CAPACITY, READ_BUFFER, READ_6, READ_10, READ_12,
  2637. MODE_SENSE, MODE_SENSE_10};
  2639. static int sg_allow_access(unsigned char opcode, char dev_type)
  2640. {
  2641.     int k;
  2643.     if (TYPE_SCANNER == dev_type) /* TYPE_ROM maybe burner */
  2644. return 1;
  2645.     for (k = 0; k < sizeof(allow_ops); ++k) {
  2646. if (opcode == allow_ops[k])
  2647.     return 1;
  2648.     }
  2649.     return 0;
  2650. }
  2653. #ifdef CONFIG_PROC_FS
  2654. static int sg_last_dev()
  2655. {
  2656.     int k;
  2657.     unsigned long iflags;
  2659.     read_lock_irqsave(&sg_dev_arr_lock, iflags);
  2660.     for (k = sg_template.dev_max - 1; k >= 0; --k)
  2661. if (sg_dev_arr[k] && sg_dev_arr[k]->device) break;
  2662.     read_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2663.     return k + 1;   /* origin 1 */
  2664. }
  2665. #endif
  2667. static Sg_device * sg_get_dev(int dev)
  2668. {
  2669.     Sg_device * sdp = NULL;
  2670.     unsigned long iflags;
  2672.     if (sg_dev_arr && (dev >= 0))
  2673.     {
  2674. read_lock_irqsave(&sg_dev_arr_lock, iflags);
  2675. if (dev < sg_template.dev_max)
  2676.     sdp = sg_dev_arr[dev];
  2677. read_unlock_irqrestore(&sg_dev_arr_lock, iflags);
  2678.     }
  2679.     return sdp;
  2680. }
  2682. #ifdef CONFIG_PROC_FS
  2684. static struct proc_dir_entry * sg_proc_sgp = NULL;
  2686. static char sg_proc_sg_dirname[] = "sg";
  2687. static const char * sg_proc_leaf_names[] = {"allow_dio", "def_reserved_size",
  2688. "debug", "devices", "device_hdr", "device_strs",
  2689. "hosts", "host_hdr", "host_strs", "version"};
  2691. static int sg_proc_adio_read(char * buffer, char ** start, off_t offset,
  2692.      int size, int * eof, void * data);
  2693. static int sg_proc_adio_info(char * buffer, int * len, off_t * begin,
  2694.      off_t offset, int size);
  2695. static int sg_proc_adio_write(struct file * filp, const char * buffer,
  2696.       unsigned long count, void * data);
  2697. static int sg_proc_dressz_read(char * buffer, char ** start, off_t offset,
  2698.        int size, int * eof, void * data);
  2699. static int sg_proc_dressz_info(char * buffer, int * len, off_t * begin,
  2700.        off_t offset, int size);
  2701. static int sg_proc_dressz_write(struct file * filp, const char * buffer,
  2702. unsigned long count, void * data);
  2703. static int sg_proc_debug_read(char * buffer, char ** start, off_t offset,
  2704.       int size, int * eof, void * data);
  2705. static int sg_proc_debug_info(char * buffer, int * len, off_t * begin,
  2706.       off_t offset, int size);
  2707. static int sg_proc_dev_read(char * buffer, char ** start, off_t offset,
  2708.     int size, int * eof, void * data);
  2709. static int sg_proc_dev_info(char * buffer, int * len, off_t * begin,
  2710.     off_t offset, int size);
  2711. static int sg_proc_devhdr_read(char * buffer, char ** start, off_t offset,
  2712.        int size, int * eof, void * data);
  2713. static int sg_proc_devhdr_info(char * buffer, int * len, off_t * begin,
  2714.        off_t offset, int size);
  2715. static int sg_proc_devstrs_read(char * buffer, char ** start, off_t offset,
  2716. int size, int * eof, void * data);
  2717. static int sg_proc_devstrs_info(char * buffer, int * len, off_t * begin,
  2718. off_t offset, int size);
  2719. static int sg_proc_host_read(char * buffer, char ** start, off_t offset,
  2720.      int size, int * eof, void * data);
  2721. static int sg_proc_host_info(char * buffer, int * len, off_t * begin,
  2722.      off_t offset, int size);
  2723. static int sg_proc_hosthdr_read(char * buffer, char ** start, off_t offset,
  2724. int size, int * eof, void * data);
  2725. static int sg_proc_hosthdr_info(char * buffer, int * len, off_t * begin,
  2726. off_t offset, int size);
  2727. static int sg_proc_hoststrs_read(char * buffer, char ** start, off_t offset,
  2728.  int size, int * eof, void * data);
  2729. static int sg_proc_hoststrs_info(char * buffer, int * len, off_t * begin,
  2730.  off_t offset, int size);
  2731. static int sg_proc_version_read(char * buffer, char ** start, off_t offset,
  2732. int size, int * eof, void * data);
  2733. static int sg_proc_version_info(char * buffer, int * len, off_t * begin,
  2734. off_t offset, int size);
  2735. static read_proc_t * sg_proc_leaf_reads[] = {
  2736.      sg_proc_adio_read, sg_proc_dressz_read, sg_proc_debug_read,
  2737.      sg_proc_dev_read, sg_proc_devhdr_read, sg_proc_devstrs_read,
  2738.      sg_proc_host_read, sg_proc_hosthdr_read, sg_proc_hoststrs_read,
  2739.      sg_proc_version_read};
  2740. static write_proc_t * sg_proc_leaf_writes[] = {
  2741.      sg_proc_adio_write, sg_proc_dressz_write, 0, 0, 0, 0, 0, 0, 0, 0};
  2743. #define PRINT_PROC(fmt,args...)                                 
  2744.     do {                                                        
  2745. *len += sprintf(buffer + *len, fmt, ##args);            
  2746. if (*begin + *len > offset + size)                      
  2747.     return 0;                                           
  2748. if (*begin + *len < offset) {                           
  2749.     *begin += *len;                                     
  2750.     *len = 0;                                           
  2751. }                                                       
  2752.     } while(0)
  2754. #define SG_PROC_READ_FN(infofp)                                 
  2755.     do {                                                        
  2756. int len = 0;                                            
  2757. off_t begin = 0;                                        
  2758. *eof = infofp(buffer, &len, &begin, offset, size);      
  2759. if (offset >= (begin + len))                            
  2760.     return 0;                                           
  2761. *start = buffer + offset - begin;
  2762. return (size < (begin + len - offset)) ?                
  2763. size : begin + len - offset;    
  2764.     } while(0)
  2767. static int sg_proc_init()
  2768. {
  2769.     int k, mask;
  2770.     int leaves = sizeof(sg_proc_leaf_names) / sizeof(sg_proc_leaf_names[0]);
  2771.     struct proc_dir_entry * pdep;
  2773.     if (! proc_scsi)
  2774. return 1;
  2775.     sg_proc_sgp = create_proc_entry(sg_proc_sg_dirname,
  2776.     S_IFDIR | S_IRUGO | S_IXUGO, proc_scsi);
  2777.     if (! sg_proc_sgp)
  2778. return 1;
  2779.     for (k = 0; k < leaves; ++k) {
  2780. mask = sg_proc_leaf_writes[k] ? S_IRUGO | S_IWUSR : S_IRUGO;
  2781. pdep = create_proc_entry(sg_proc_leaf_names[k], mask, sg_proc_sgp);
  2782. if (pdep) {
  2783.     pdep->read_proc = sg_proc_leaf_reads[k];
  2784.     if (sg_proc_leaf_writes[k])
  2785. pdep->write_proc = sg_proc_leaf_writes[k];
  2786. }
  2787.     }
  2788.     return 0;
  2789. }
  2791. static void sg_proc_cleanup()
  2792. {
  2793.     int k;
  2794.     int leaves = sizeof(sg_proc_leaf_names) / sizeof(sg_proc_leaf_names[0]);
  2796.     if ((! proc_scsi) || (! sg_proc_sgp))
  2797. return;
  2798.     for (k = 0; k < leaves; ++k)
  2799. remove_proc_entry(sg_proc_leaf_names[k], sg_proc_sgp);
  2800.     remove_proc_entry(sg_proc_sg_dirname, proc_scsi);
  2801. }
  2803. static int sg_proc_adio_read(char * buffer, char ** start, off_t offset,
  2804.        int size, int * eof, void * data)
  2805. { SG_PROC_READ_FN(sg_proc_adio_info); }
  2807. static int sg_proc_adio_info(char * buffer, int * len, off_t * begin,
  2808.      off_t offset, int size)
  2809. {
  2810.     PRINT_PROC("%dn", sg_allow_dio);
  2811.     return 1;
  2812. }
  2814. static int sg_proc_adio_write(struct file * filp, const char * buffer,
  2815.       unsigned long count, void * data)
  2816. {
  2817.     int num;
  2818.     char buff[11];
  2820.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2821. return -EACCES;
  2822.     num = (count < 10) ? count : 10;
  2823.     copy_from_user(buff, buffer, num);
  2824.     buff[num] = '';
  2825.     sg_allow_dio = simple_strtoul(buff, 0, 10) ? 1 : 0;
  2826.     return count;
  2827. }
  2829. static int sg_proc_dressz_read(char * buffer, char ** start, off_t offset,
  2830.        int size, int * eof, void * data)
  2831. { SG_PROC_READ_FN(sg_proc_dressz_info); }
  2833. static int sg_proc_dressz_info(char * buffer, int * len, off_t * begin,
  2834.        off_t offset, int size)
  2835. {
  2836.     PRINT_PROC("%dn", sg_big_buff);
  2837.     return 1;
  2838. }
  2840. static int sg_proc_dressz_write(struct file * filp, const char * buffer,
  2841. unsigned long count, void * data)
  2842. {
  2843.     int num;
  2844.     unsigned long k = ULONG_MAX;
  2845.     char buff[11];
  2847.     if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2848. return -EACCES;
  2849.     num = (count < 10) ? count : 10;
  2850.     copy_from_user(buff, buffer, num);
  2851.     buff[num] = '';
  2852.     k = simple_strtoul(buff, 0, 10);
  2853.     if (k <= 1048576) {
  2854. sg_big_buff = k;
  2855. return count;
  2856.     }
  2857.     return -ERANGE;
  2858. }
  2860. static int sg_proc_debug_read(char * buffer, char ** start, off_t offset,
  2861.       int size, int * eof, void * data)
  2862. { SG_PROC_READ_FN(sg_proc_debug_info); }
  2864. static int sg_proc_debug_info(char * buffer, int * len, off_t * begin,
  2865.       off_t offset, int size)
  2866. {
  2867.     Sg_device * sdp;
  2868.     const sg_io_hdr_t * hp;
  2869.     int j, max_dev, new_interface;
  2871.     if (NULL == sg_dev_arr) {
  2872. PRINT_PROC("sg_dev_arr NULL, driver not initializedn");
  2873. return 1;
  2874.     }
  2875.     max_dev = sg_last_dev();
  2876.     PRINT_PROC("dev_max(currently)=%d max_active_device=%d (origin 1)n",
  2877.        sg_template.dev_max, max_dev);
  2878.     PRINT_PROC(" scsi_dma_free_sectors=%u sg_pool_secs_aval=%d "
  2879.        "def_reserved_size=%dn",
  2880.        scsi_dma_free_sectors, sg_pool_secs_avail, sg_big_buff);
  2881.     for (j = 0; j < max_dev; ++j) {
  2882. if ((sdp = sg_get_dev(j))) {
  2883.     Sg_fd * fp;
  2884.     Sg_request * srp;
  2885.     struct scsi_device * scsidp;
  2886.     int dev, k, m, blen, usg;
  2887.  
  2888.     scsidp = sdp->device;
  2889.     if (NULL == scsidp) {
  2890. PRINT_PROC("device %d detached ??n", j);
  2891. continue;
  2892.     }
  2893.     dev = MINOR(sdp->i_rdev);
  2895.     if (sg_get_nth_sfp(sdp, 0)) {
  2896. PRINT_PROC(" >>> device=sg%d ", dev);
  2897. if (sdp->detached)
  2898.     PRINT_PROC("detached pending close ");
  2899. else
  2900.     PRINT_PROC("scsi%d chan=%d id=%d lun=%d   em=%d",
  2901.        scsidp->host->host_no, scsidp->channel,
  2902.        scsidp->id, scsidp->lun, scsidp->host->hostt->emulated);
  2903. PRINT_PROC(" sg_tablesize=%d excl=%dn", sdp->sg_tablesize, 
  2904.    sdp->exclude);
  2905.     }
  2906.     for (k = 0; (fp = sg_get_nth_sfp(sdp, k)); ++k) {
  2907. PRINT_PROC("   FD(%d): timeout=%dms bufflen=%d "
  2908.    "(res)sgat=%d low_dma=%dn", k + 1,
  2909.    sg_jif_to_ms(fp->timeout), fp->reserve.bufflen,
  2910.    (int)fp->reserve.k_use_sg, (int)fp->low_dma);
  2911. PRINT_PROC("   cmd_q=%d f_packid=%d k_orphan=%d closed=%dn",
  2912.    (int)fp->cmd_q, (int)fp->force_packid,
  2913.    (int)fp->keep_orphan, (int)fp->closed);
  2914. for (m = 0; (srp = sg_get_nth_request(fp, m)); ++m) {
  2915.     hp = &srp->header;
  2916.     new_interface = (hp->interface_id == '') ? 0 : 1;
  2917. /* stop indenting so far ... */
  2918. PRINT_PROC(srp->res_used ? ((new_interface && 
  2919.     (SG_FLAG_MMAP_IO & hp->flags)) ? "     mmap>> " : "     rb>> ") :
  2920.     ((SG_INFO_DIRECT_IO_MASK & hp->info) ? "     dio>> " : "     "));
  2921. blen = srp->my_cmdp ? srp->my_cmdp->sr_bufflen : srp->data.bufflen;
  2922. usg = srp->my_cmdp ? srp->my_cmdp->sr_use_sg : srp->data.k_use_sg;
  2923. PRINT_PROC(srp->done ? ((1 == srp->done) ? "rcv:" : "fin:") 
  2924.      : (srp->my_cmdp ? "act:" : "prior:"));
  2925. PRINT_PROC(" id=%d blen=%d", srp->header.pack_id, blen);
  2926. if (srp->done)
  2927.     PRINT_PROC(" dur=%d", hp->duration);
  2928. else
  2929.     PRINT_PROC(" t_o/elap=%d/%d", new_interface ? hp->timeout :
  2930. sg_jif_to_ms(fp->timeout),
  2931.   sg_jif_to_ms(hp->duration ? (jiffies - hp->duration) : 0));
  2932. PRINT_PROC("ms sgat=%d op=0x%02xn", usg, (int)srp->data.cmd_opcode);
  2933. /* reset indenting */
  2934. }
  2935. if (0 == m)
  2936.     PRINT_PROC("     No requests activen");
  2937.     }
  2938. }
  2939.     }
  2940.     return 1;
  2941. }
  2943. static int sg_proc_dev_read(char * buffer, char ** start, off_t offset,
  2944.     int size, int * eof, void * data)
  2945. { SG_PROC_READ_FN(sg_proc_dev_info); }
  2947. static int sg_proc_dev_info(char * buffer, int * len, off_t * begin,
  2948.     off_t offset, int size)
  2949. {
  2950.     Sg_device * sdp;
  2951.     int j, max_dev;
  2952.     struct scsi_device * scsidp;
  2954.     max_dev = sg_last_dev();
  2955.     for (j = 0; j < max_dev; ++j) {
  2956. sdp = sg_get_dev(j);
  2957. if (sdp && (scsidp = sdp->device) && (! sdp->detached))
  2958.     PRINT_PROC("%dt%dt%dt%dt%dt%dt%dt%dt%dn",
  2959.        scsidp->host->host_no, scsidp->channel, scsidp->id,
  2960.        scsidp->lun, (int)scsidp->type, (int)scsidp->access_count,
  2961.        (int)scsidp->queue_depth, (int)scsidp->device_busy,
  2962.        (int)scsidp->online);
  2963. else
  2964.     PRINT_PROC("-1t-1t-1t-1t-1t-1t-1t-1t-1n");
  2965.     }
  2966.     return 1;
  2967. }
  2969. static int sg_proc_devhdr_read(char * buffer, char ** start, off_t offset,
  2970.        int size, int * eof, void * data)
  2971. { SG_PROC_READ_FN(sg_proc_devhdr_info); }
  2973. static int sg_proc_devhdr_info(char * buffer, int * len, off_t * begin,
  2974.        off_t offset, int size)
  2975. {
  2976.     PRINT_PROC("hosttchantidtlunttypetopenstqdepthtbusytonlinen");
  2977.     return 1;
  2978. }
  2980. static int sg_proc_devstrs_read(char * buffer, char ** start, off_t offset,
  2981. int size, int * eof, void * data)
  2982. { SG_PROC_READ_FN(sg_proc_devstrs_info); }
  2984. static int sg_proc_devstrs_info(char * buffer, int * len, off_t * begin,
  2985. off_t offset, int size)
  2986. {
  2987.     Sg_device * sdp;
  2988.     int j, max_dev;
  2989.     struct scsi_device * scsidp;
  2991.     max_dev = sg_last_dev();
  2992.     for (j = 0; j < max_dev; ++j) {
  2993. sdp = sg_get_dev(j);
  2994. if (sdp && (scsidp = sdp->device) && (! sdp->detached))
  2995.     PRINT_PROC("%8.8st%16.16st%4.4sn",
  2996.        scsidp->vendor, scsidp->model, scsidp->rev);
  2997. else
  2998.     PRINT_PROC("<no active device>n");
  2999.     }
  3000.     return 1;
  3001. }
  3003. static int sg_proc_host_read(char * buffer, char ** start, off_t offset,
  3004.      int size, int * eof, void * data)
  3005. { SG_PROC_READ_FN(sg_proc_host_info); }
  3007. static int sg_proc_host_info(char * buffer, int * len, off_t * begin,
  3008.      off_t offset, int size)
  3009. {
  3010.     struct Scsi_Host * shp;
  3011.     int k;
  3013.     for (k = 0, shp = scsi_hostlist; shp; shp = shp->next, ++k) {
  3014.      for ( ; k < shp->host_no; ++k)
  3015.     PRINT_PROC("-1t-1t-1t-1t-1t-1n");
  3016. PRINT_PROC("%ut%hut%hdt%hut%dt%dn",
  3017.    shp->unique_id, shp->host_busy, shp->cmd_per_lun,
  3018.    shp->sg_tablesize, (int)shp->unchecked_isa_dma,
  3019.    (int)shp->hostt->emulated);
  3020.     }
  3021.     return 1;
  3022. }
  3024. static int sg_proc_hosthdr_read(char * buffer, char ** start, off_t offset,
  3025. int size, int * eof, void * data)
  3026. { SG_PROC_READ_FN(sg_proc_hosthdr_info); }
  3028. static int sg_proc_hosthdr_info(char * buffer, int * len, off_t * begin,
  3029. off_t offset, int size)
  3030. {
  3031.     PRINT_PROC("uidtbusytcpltscatgtisatemuln");
  3032.     return 1;
  3033. }
  3035. static int sg_proc_hoststrs_read(char * buffer, char ** start, off_t offset,
  3036.  int size, int * eof, void * data)
  3037. { SG_PROC_READ_FN(sg_proc_hoststrs_info); }
  3039. static int sg_proc_hoststrs_info(char * buffer, int * len, off_t * begin,
  3040.  off_t offset, int size)
  3041. {
  3042.     struct Scsi_Host * shp;
  3043.     int k;
  3045.     for (k = 0, shp = scsi_hostlist; shp; shp = shp->next, ++k) {
  3046.      for ( ; k < shp->host_no; ++k)
  3047.     PRINT_PROC("<no active host>n");
  3048. PRINT_PROC("%sn", shp->hostt->info ? shp->hostt->info(shp) :
  3049.     (shp->hostt->name ? shp->hostt->name : "<no name>"));
  3050.     }
  3051.     return 1;
  3052. }
  3054. static int sg_proc_version_read(char * buffer, char ** start, off_t offset,
  3055. int size, int * eof, void * data)
  3056. { SG_PROC_READ_FN(sg_proc_version_info); }
  3058. static int sg_proc_version_info(char * buffer, int * len, off_t * begin,
  3059. off_t offset, int size)
  3060. {
  3061.     PRINT_PROC("%dt%sn", sg_version_num, sg_version_str);
  3062.     return 1;
  3063. }
  3064. #endif  /* CONFIG_PROC_FS */
  3067. module_init(init_sg);
  3068. module_exit(exit_sg);