sg.c 69 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586
  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 - 2005 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. static int sg_version_num = 30534; /* 2 digits for each component */
  21. #define SG_VERSION_STR "3.5.34"
  22. /*
  23. * D. P. Gilbert (dgilbert@interlog.com, dougg@triode.net.au), notes:
  24. * - scsi logging is available via SCSI_LOG_TIMEOUT macros. First
  25. * the kernel/module needs to be built with CONFIG_SCSI_LOGGING
  26. * (otherwise the macros compile to empty statements).
  27. *
  28. */
  29. #include <linux/module.h>
  30. #include <linux/fs.h>
  31. #include <linux/kernel.h>
  32. #include <linux/sched.h>
  33. #include <linux/string.h>
  34. #include <linux/mm.h>
  35. #include <linux/errno.h>
  36. #include <linux/mtio.h>
  37. #include <linux/ioctl.h>
  38. #include <linux/fcntl.h>
  39. #include <linux/init.h>
  40. #include <linux/poll.h>
  41. #include <linux/moduleparam.h>
  42. #include <linux/cdev.h>
  43. #include <linux/idr.h>
  44. #include <linux/seq_file.h>
  45. #include <linux/blkdev.h>
  46. #include <linux/delay.h>
  47. #include <linux/blktrace_api.h>
  48. #include <linux/smp_lock.h>
  49. #include "scsi.h"
  50. #include <scsi/scsi_dbg.h>
  51. #include <scsi/scsi_host.h>
  52. #include <scsi/scsi_driver.h>
  53. #include <scsi/scsi_ioctl.h>
  54. #include <scsi/sg.h>
  55. #include "scsi_logging.h"
  56. #ifdef CONFIG_SCSI_PROC_FS
  57. #include <linux/proc_fs.h>
  58. static char *sg_version_date = "20061027";
  59. static int sg_proc_init(void);
  60. static void sg_proc_cleanup(void);
  61. #endif
  62. #define SG_ALLOW_DIO_DEF 0
  63. #define SG_MAX_DEVS 32768
  64. /*
  65. * Suppose you want to calculate the formula muldiv(x,m,d)=int(x * m / d)
  66. * Then when using 32 bit integers x * m may overflow during the calculation.
  67. * Replacing muldiv(x) by muldiv(x)=((x % d) * m) / d + int(x / d) * m
  68. * calculates the same, but prevents the overflow when both m and d
  69. * are "small" numbers (like HZ and USER_HZ).
  70. * Of course an overflow is inavoidable if the result of muldiv doesn't fit
  71. * in 32 bits.
  72. */
  73. #define MULDIV(X,MUL,DIV) ((((X % DIV) * MUL) / DIV) + ((X / DIV) * MUL))
  74. #define SG_DEFAULT_TIMEOUT MULDIV(SG_DEFAULT_TIMEOUT_USER, HZ, USER_HZ)
  75. int sg_big_buff = SG_DEF_RESERVED_SIZE;
  76. /* N.B. This variable is readable and writeable via
  77. /proc/scsi/sg/def_reserved_size . Each time sg_open() is called a buffer
  78. of this size (or less if there is not enough memory) will be reserved
  79. for use by this file descriptor. [Deprecated usage: this variable is also
  80. readable via /proc/sys/kernel/sg-big-buff if the sg driver is built into
  81. the kernel (i.e. it is not a module).] */
  82. static int def_reserved_size = -1; /* picks up init parameter */
  83. static int sg_allow_dio = SG_ALLOW_DIO_DEF;
  84. static int scatter_elem_sz = SG_SCATTER_SZ;
  85. static int scatter_elem_sz_prev = SG_SCATTER_SZ;
  86. #define SG_SECTOR_SZ 512
  87. static int sg_add(struct device *, struct class_interface *);
  88. static void sg_remove(struct device *, struct class_interface *);
  89. static DEFINE_IDR(sg_index_idr);
  90. static DEFINE_RWLOCK(sg_index_lock); /* Also used to lock
  91. file descriptor list for device */
  92. static struct class_interface sg_interface = {
  93. .add_dev = sg_add,
  94. .remove_dev = sg_remove,
  95. };
  96. typedef struct sg_scatter_hold { /* holding area for scsi scatter gather info */
  97. unsigned short k_use_sg; /* Count of kernel scatter-gather pieces */
  98. unsigned sglist_len; /* size of malloc'd scatter-gather list ++ */
  99. unsigned bufflen; /* Size of (aggregate) data buffer */
  100. struct page **pages;
  101. int page_order;
  102. char dio_in_use; /* 0->indirect IO (or mmap), 1->dio */
  103. unsigned char cmd_opcode; /* first byte of command */
  104. } Sg_scatter_hold;
  105. struct sg_device; /* forward declarations */
  106. struct sg_fd;
  107. typedef struct sg_request { /* SG_MAX_QUEUE requests outstanding per file */
  108. struct sg_request *nextrp; /* NULL -> tail request (slist) */
  109. struct sg_fd *parentfp; /* NULL -> not in use */
  110. Sg_scatter_hold data; /* hold buffer, perhaps scatter list */
  111. sg_io_hdr_t header; /* scsi command+info, see <scsi/sg.h> */
  112. unsigned char sense_b[SCSI_SENSE_BUFFERSIZE];
  113. char res_used; /* 1 -> using reserve buffer, 0 -> not ... */
  114. char orphan; /* 1 -> drop on sight, 0 -> normal */
  115. char sg_io_owned; /* 1 -> packet belongs to SG_IO */
  116. volatile char done; /* 0->before bh, 1->before read, 2->read */
  117. struct request *rq;
  118. struct bio *bio;
  119. struct execute_work ew;
  120. } Sg_request;
  121. typedef struct sg_fd { /* holds the state of a file descriptor */
  122. struct sg_fd *nextfp; /* NULL when last opened fd on this device */
  123. struct sg_device *parentdp; /* owning device */
  124. wait_queue_head_t read_wait; /* queue read until command done */
  125. rwlock_t rq_list_lock; /* protect access to list in req_arr */
  126. int timeout; /* defaults to SG_DEFAULT_TIMEOUT */
  127. int timeout_user; /* defaults to SG_DEFAULT_TIMEOUT_USER */
  128. Sg_scatter_hold reserve; /* buffer held for this file descriptor */
  129. unsigned save_scat_len; /* original length of trunc. scat. element */
  130. Sg_request *headrp; /* head of request slist, NULL->empty */
  131. struct fasync_struct *async_qp; /* used by asynchronous notification */
  132. Sg_request req_arr[SG_MAX_QUEUE]; /* used as singly-linked list */
  133. char low_dma; /* as in parent but possibly overridden to 1 */
  134. char force_packid; /* 1 -> pack_id input to read(), 0 -> ignored */
  135. volatile char closed; /* 1 -> fd closed but request(s) outstanding */
  136. char cmd_q; /* 1 -> allow command queuing, 0 -> don't */
  137. char next_cmd_len; /* 0 -> automatic (def), >0 -> use on next write() */
  138. char keep_orphan; /* 0 -> drop orphan (def), 1 -> keep for read() */
  139. char mmap_called; /* 0 -> mmap() never called on this fd */
  140. struct kref f_ref;
  141. struct execute_work ew;
  142. } Sg_fd;
  143. typedef struct sg_device { /* holds the state of each scsi generic device */
  144. struct scsi_device *device;
  145. wait_queue_head_t o_excl_wait; /* queue open() when O_EXCL in use */
  146. int sg_tablesize; /* adapter's max scatter-gather table size */
  147. u32 index; /* device index number */
  148. Sg_fd *headfp; /* first open fd belonging to this device */
  149. volatile char detached; /* 0->attached, 1->detached pending removal */
  150. volatile char exclude; /* opened for exclusive access */
  151. char sgdebug; /* 0->off, 1->sense, 9->dump dev, 10-> all devs */
  152. struct gendisk *disk;
  153. struct cdev * cdev; /* char_dev [sysfs: /sys/cdev/major/sg<n>] */
  154. struct kref d_ref;
  155. } Sg_device;
  156. /* tasklet or soft irq callback */
  157. static void sg_rq_end_io(struct request *rq, int uptodate);
  158. static int sg_start_req(Sg_request *srp, unsigned char *cmd);
  159. static void sg_finish_rem_req(Sg_request * srp);
  160. static int sg_build_indirect(Sg_scatter_hold * schp, Sg_fd * sfp, int buff_size);
  161. static ssize_t sg_new_read(Sg_fd * sfp, char __user *buf, size_t count,
  162. Sg_request * srp);
  163. static ssize_t sg_new_write(Sg_fd *sfp, struct file *file,
  164. const char __user *buf, size_t count, int blocking,
  165. int read_only, int sg_io_owned, Sg_request **o_srp);
  166. static int sg_common_write(Sg_fd * sfp, Sg_request * srp,
  167. unsigned char *cmnd, int timeout, int blocking);
  168. static int sg_read_oxfer(Sg_request * srp, char __user *outp, int num_read_xfer);
  169. static void sg_remove_scat(Sg_scatter_hold * schp);
  170. static void sg_build_reserve(Sg_fd * sfp, int req_size);
  171. static void sg_link_reserve(Sg_fd * sfp, Sg_request * srp, int size);
  172. static void sg_unlink_reserve(Sg_fd * sfp, Sg_request * srp);
  173. static Sg_fd *sg_add_sfp(Sg_device * sdp, int dev);
  174. static void sg_remove_sfp(struct kref *);
  175. static Sg_request *sg_get_rq_mark(Sg_fd * sfp, int pack_id);
  176. static Sg_request *sg_add_request(Sg_fd * sfp);
  177. static int sg_remove_request(Sg_fd * sfp, Sg_request * srp);
  178. static int sg_res_in_use(Sg_fd * sfp);
  179. static Sg_device *sg_get_dev(int dev);
  180. static void sg_put_dev(Sg_device *sdp);
  181. #define SZ_SG_HEADER sizeof(struct sg_header)
  182. #define SZ_SG_IO_HDR sizeof(sg_io_hdr_t)
  183. #define SZ_SG_IOVEC sizeof(sg_iovec_t)
  184. #define SZ_SG_REQ_INFO sizeof(sg_req_info_t)
  185. static int sg_allow_access(struct file *filp, unsigned char *cmd)
  186. {
  187. struct sg_fd *sfp = (struct sg_fd *)filp->private_data;
  188. struct request_queue *q = sfp->parentdp->device->request_queue;
  189. if (sfp->parentdp->device->type == TYPE_SCANNER)
  190. return 0;
  191. return blk_verify_command(&q->cmd_filter,
  192. cmd, filp->f_mode & FMODE_WRITE);
  193. }
  194. static int
  195. sg_open(struct inode *inode, struct file *filp)
  196. {
  197. int dev = iminor(inode);
  198. int flags = filp->f_flags;
  199. struct request_queue *q;
  200. Sg_device *sdp;
  201. Sg_fd *sfp;
  202. int res;
  203. int retval;
  204. lock_kernel();
  205. nonseekable_open(inode, filp);
  206. SCSI_LOG_TIMEOUT(3, printk("sg_open: dev=%d, flags=0x%x\n", dev, flags));
  207. sdp = sg_get_dev(dev);
  208. if (IS_ERR(sdp)) {
  209. retval = PTR_ERR(sdp);
  210. sdp = NULL;
  211. goto sg_put;
  212. }
  213. /* This driver's module count bumped by fops_get in <linux/fs.h> */
  214. /* Prevent the device driver from vanishing while we sleep */
  215. retval = scsi_device_get(sdp->device);
  216. if (retval)
  217. goto sg_put;
  218. if (!((flags & O_NONBLOCK) ||
  219. scsi_block_when_processing_errors(sdp->device))) {
  220. retval = -ENXIO;
  221. /* we are in error recovery for this device */
  222. goto error_out;
  223. }
  224. if (flags & O_EXCL) {
  225. if (O_RDONLY == (flags & O_ACCMODE)) {
  226. retval = -EPERM; /* Can't lock it with read only access */
  227. goto error_out;
  228. }
  229. if (sdp->headfp && (flags & O_NONBLOCK)) {
  230. retval = -EBUSY;
  231. goto error_out;
  232. }
  233. res = 0;
  234. __wait_event_interruptible(sdp->o_excl_wait,
  235. ((sdp->headfp || sdp->exclude) ? 0 : (sdp->exclude = 1)), res);
  236. if (res) {
  237. retval = res; /* -ERESTARTSYS because signal hit process */
  238. goto error_out;
  239. }
  240. } else if (sdp->exclude) { /* some other fd has an exclusive lock on dev */
  241. if (flags & O_NONBLOCK) {
  242. retval = -EBUSY;
  243. goto error_out;
  244. }
  245. res = 0;
  246. __wait_event_interruptible(sdp->o_excl_wait, (!sdp->exclude),
  247. res);
  248. if (res) {
  249. retval = res; /* -ERESTARTSYS because signal hit process */
  250. goto error_out;
  251. }
  252. }
  253. if (sdp->detached) {
  254. retval = -ENODEV;
  255. goto error_out;
  256. }
  257. if (!sdp->headfp) { /* no existing opens on this device */
  258. sdp->sgdebug = 0;
  259. q = sdp->device->request_queue;
  260. sdp->sg_tablesize = min(q->max_hw_segments,
  261. q->max_phys_segments);
  262. }
  263. if ((sfp = sg_add_sfp(sdp, dev)))
  264. filp->private_data = sfp;
  265. else {
  266. if (flags & O_EXCL) {
  267. sdp->exclude = 0; /* undo if error */
  268. wake_up_interruptible(&sdp->o_excl_wait);
  269. }
  270. retval = -ENOMEM;
  271. goto error_out;
  272. }
  273. retval = 0;
  274. error_out:
  275. if (retval)
  276. scsi_device_put(sdp->device);
  277. sg_put:
  278. if (sdp)
  279. sg_put_dev(sdp);
  280. unlock_kernel();
  281. return retval;
  282. }
  283. /* Following function was formerly called 'sg_close' */
  284. static int
  285. sg_release(struct inode *inode, struct file *filp)
  286. {
  287. Sg_device *sdp;
  288. Sg_fd *sfp;
  289. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp)))
  290. return -ENXIO;
  291. SCSI_LOG_TIMEOUT(3, printk("sg_release: %s\n", sdp->disk->disk_name));
  292. sfp->closed = 1;
  293. sdp->exclude = 0;
  294. wake_up_interruptible(&sdp->o_excl_wait);
  295. kref_put(&sfp->f_ref, sg_remove_sfp);
  296. return 0;
  297. }
  298. static ssize_t
  299. sg_read(struct file *filp, char __user *buf, size_t count, loff_t * ppos)
  300. {
  301. Sg_device *sdp;
  302. Sg_fd *sfp;
  303. Sg_request *srp;
  304. int req_pack_id = -1;
  305. sg_io_hdr_t *hp;
  306. struct sg_header *old_hdr = NULL;
  307. int retval = 0;
  308. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp)))
  309. return -ENXIO;
  310. SCSI_LOG_TIMEOUT(3, printk("sg_read: %s, count=%d\n",
  311. sdp->disk->disk_name, (int) count));
  312. if (!access_ok(VERIFY_WRITE, buf, count))
  313. return -EFAULT;
  314. if (sfp->force_packid && (count >= SZ_SG_HEADER)) {
  315. old_hdr = kmalloc(SZ_SG_HEADER, GFP_KERNEL);
  316. if (!old_hdr)
  317. return -ENOMEM;
  318. if (__copy_from_user(old_hdr, buf, SZ_SG_HEADER)) {
  319. retval = -EFAULT;
  320. goto free_old_hdr;
  321. }
  322. if (old_hdr->reply_len < 0) {
  323. if (count >= SZ_SG_IO_HDR) {
  324. sg_io_hdr_t *new_hdr;
  325. new_hdr = kmalloc(SZ_SG_IO_HDR, GFP_KERNEL);
  326. if (!new_hdr) {
  327. retval = -ENOMEM;
  328. goto free_old_hdr;
  329. }
  330. retval =__copy_from_user
  331. (new_hdr, buf, SZ_SG_IO_HDR);
  332. req_pack_id = new_hdr->pack_id;
  333. kfree(new_hdr);
  334. if (retval) {
  335. retval = -EFAULT;
  336. goto free_old_hdr;
  337. }
  338. }
  339. } else
  340. req_pack_id = old_hdr->pack_id;
  341. }
  342. srp = sg_get_rq_mark(sfp, req_pack_id);
  343. if (!srp) { /* now wait on packet to arrive */
  344. if (sdp->detached) {
  345. retval = -ENODEV;
  346. goto free_old_hdr;
  347. }
  348. if (filp->f_flags & O_NONBLOCK) {
  349. retval = -EAGAIN;
  350. goto free_old_hdr;
  351. }
  352. while (1) {
  353. retval = 0; /* following macro beats race condition */
  354. __wait_event_interruptible(sfp->read_wait,
  355. (sdp->detached ||
  356. (srp = sg_get_rq_mark(sfp, req_pack_id))),
  357. retval);
  358. if (sdp->detached) {
  359. retval = -ENODEV;
  360. goto free_old_hdr;
  361. }
  362. if (0 == retval)
  363. break;
  364. /* -ERESTARTSYS as signal hit process */
  365. goto free_old_hdr;
  366. }
  367. }
  368. if (srp->header.interface_id != '\0') {
  369. retval = sg_new_read(sfp, buf, count, srp);
  370. goto free_old_hdr;
  371. }
  372. hp = &srp->header;
  373. if (old_hdr == NULL) {
  374. old_hdr = kmalloc(SZ_SG_HEADER, GFP_KERNEL);
  375. if (! old_hdr) {
  376. retval = -ENOMEM;
  377. goto free_old_hdr;
  378. }
  379. }
  380. memset(old_hdr, 0, SZ_SG_HEADER);
  381. old_hdr->reply_len = (int) hp->timeout;
  382. old_hdr->pack_len = old_hdr->reply_len; /* old, strange behaviour */
  383. old_hdr->pack_id = hp->pack_id;
  384. old_hdr->twelve_byte =
  385. ((srp->data.cmd_opcode >= 0xc0) && (12 == hp->cmd_len)) ? 1 : 0;
  386. old_hdr->target_status = hp->masked_status;
  387. old_hdr->host_status = hp->host_status;
  388. old_hdr->driver_status = hp->driver_status;
  389. if ((CHECK_CONDITION & hp->masked_status) ||
  390. (DRIVER_SENSE & hp->driver_status))
  391. memcpy(old_hdr->sense_buffer, srp->sense_b,
  392. sizeof (old_hdr->sense_buffer));
  393. switch (hp->host_status) {
  394. /* This setup of 'result' is for backward compatibility and is best
  395. ignored by the user who should use target, host + driver status */
  396. case DID_OK:
  397. case DID_PASSTHROUGH:
  398. case DID_SOFT_ERROR:
  399. old_hdr->result = 0;
  400. break;
  401. case DID_NO_CONNECT:
  402. case DID_BUS_BUSY:
  403. case DID_TIME_OUT:
  404. old_hdr->result = EBUSY;
  405. break;
  406. case DID_BAD_TARGET:
  407. case DID_ABORT:
  408. case DID_PARITY:
  409. case DID_RESET:
  410. case DID_BAD_INTR:
  411. old_hdr->result = EIO;
  412. break;
  413. case DID_ERROR:
  414. old_hdr->result = (srp->sense_b[0] == 0 &&
  415. hp->masked_status == GOOD) ? 0 : EIO;
  416. break;
  417. default:
  418. old_hdr->result = EIO;
  419. break;
  420. }
  421. /* Now copy the result back to the user buffer. */
  422. if (count >= SZ_SG_HEADER) {
  423. if (__copy_to_user(buf, old_hdr, SZ_SG_HEADER)) {
  424. retval = -EFAULT;
  425. goto free_old_hdr;
  426. }
  427. buf += SZ_SG_HEADER;
  428. if (count > old_hdr->reply_len)
  429. count = old_hdr->reply_len;
  430. if (count > SZ_SG_HEADER) {
  431. if (sg_read_oxfer(srp, buf, count - SZ_SG_HEADER)) {
  432. retval = -EFAULT;
  433. goto free_old_hdr;
  434. }
  435. }
  436. } else
  437. count = (old_hdr->result == 0) ? 0 : -EIO;
  438. sg_finish_rem_req(srp);
  439. retval = count;
  440. free_old_hdr:
  441. kfree(old_hdr);
  442. return retval;
  443. }
  444. static ssize_t
  445. sg_new_read(Sg_fd * sfp, char __user *buf, size_t count, Sg_request * srp)
  446. {
  447. sg_io_hdr_t *hp = &srp->header;
  448. int err = 0;
  449. int len;
  450. if (count < SZ_SG_IO_HDR) {
  451. err = -EINVAL;
  452. goto err_out;
  453. }
  454. hp->sb_len_wr = 0;
  455. if ((hp->mx_sb_len > 0) && hp->sbp) {
  456. if ((CHECK_CONDITION & hp->masked_status) ||
  457. (DRIVER_SENSE & hp->driver_status)) {
  458. int sb_len = SCSI_SENSE_BUFFERSIZE;
  459. sb_len = (hp->mx_sb_len > sb_len) ? sb_len : hp->mx_sb_len;
  460. len = 8 + (int) srp->sense_b[7]; /* Additional sense length field */
  461. len = (len > sb_len) ? sb_len : len;
  462. if (copy_to_user(hp->sbp, srp->sense_b, len)) {
  463. err = -EFAULT;
  464. goto err_out;
  465. }
  466. hp->sb_len_wr = len;
  467. }
  468. }
  469. if (hp->masked_status || hp->host_status || hp->driver_status)
  470. hp->info |= SG_INFO_CHECK;
  471. if (copy_to_user(buf, hp, SZ_SG_IO_HDR)) {
  472. err = -EFAULT;
  473. goto err_out;
  474. }
  475. err_out:
  476. sg_finish_rem_req(srp);
  477. return (0 == err) ? count : err;
  478. }
  479. static ssize_t
  480. sg_write(struct file *filp, const char __user *buf, size_t count, loff_t * ppos)
  481. {
  482. int mxsize, cmd_size, k;
  483. int input_size, blocking;
  484. unsigned char opcode;
  485. Sg_device *sdp;
  486. Sg_fd *sfp;
  487. Sg_request *srp;
  488. struct sg_header old_hdr;
  489. sg_io_hdr_t *hp;
  490. unsigned char cmnd[MAX_COMMAND_SIZE];
  491. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp)))
  492. return -ENXIO;
  493. SCSI_LOG_TIMEOUT(3, printk("sg_write: %s, count=%d\n",
  494. sdp->disk->disk_name, (int) count));
  495. if (sdp->detached)
  496. return -ENODEV;
  497. if (!((filp->f_flags & O_NONBLOCK) ||
  498. scsi_block_when_processing_errors(sdp->device)))
  499. return -ENXIO;
  500. if (!access_ok(VERIFY_READ, buf, count))
  501. return -EFAULT; /* protects following copy_from_user()s + get_user()s */
  502. if (count < SZ_SG_HEADER)
  503. return -EIO;
  504. if (__copy_from_user(&old_hdr, buf, SZ_SG_HEADER))
  505. return -EFAULT;
  506. blocking = !(filp->f_flags & O_NONBLOCK);
  507. if (old_hdr.reply_len < 0)
  508. return sg_new_write(sfp, filp, buf, count,
  509. blocking, 0, 0, NULL);
  510. if (count < (SZ_SG_HEADER + 6))
  511. return -EIO; /* The minimum scsi command length is 6 bytes. */
  512. if (!(srp = sg_add_request(sfp))) {
  513. SCSI_LOG_TIMEOUT(1, printk("sg_write: queue full\n"));
  514. return -EDOM;
  515. }
  516. buf += SZ_SG_HEADER;
  517. __get_user(opcode, buf);
  518. if (sfp->next_cmd_len > 0) {
  519. if (sfp->next_cmd_len > MAX_COMMAND_SIZE) {
  520. SCSI_LOG_TIMEOUT(1, printk("sg_write: command length too long\n"));
  521. sfp->next_cmd_len = 0;
  522. sg_remove_request(sfp, srp);
  523. return -EIO;
  524. }
  525. cmd_size = sfp->next_cmd_len;
  526. sfp->next_cmd_len = 0; /* reset so only this write() effected */
  527. } else {
  528. cmd_size = COMMAND_SIZE(opcode); /* based on SCSI command group */
  529. if ((opcode >= 0xc0) && old_hdr.twelve_byte)
  530. cmd_size = 12;
  531. }
  532. SCSI_LOG_TIMEOUT(4, printk(
  533. "sg_write: scsi opcode=0x%02x, cmd_size=%d\n", (int) opcode, cmd_size));
  534. /* Determine buffer size. */
  535. input_size = count - cmd_size;
  536. mxsize = (input_size > old_hdr.reply_len) ? input_size : old_hdr.reply_len;
  537. mxsize -= SZ_SG_HEADER;
  538. input_size -= SZ_SG_HEADER;
  539. if (input_size < 0) {
  540. sg_remove_request(sfp, srp);
  541. return -EIO; /* User did not pass enough bytes for this command. */
  542. }
  543. hp = &srp->header;
  544. hp->interface_id = '\0'; /* indicator of old interface tunnelled */
  545. hp->cmd_len = (unsigned char) cmd_size;
  546. hp->iovec_count = 0;
  547. hp->mx_sb_len = 0;
  548. if (input_size > 0)
  549. hp->dxfer_direction = (old_hdr.reply_len > SZ_SG_HEADER) ?
  550. SG_DXFER_TO_FROM_DEV : SG_DXFER_TO_DEV;
  551. else
  552. hp->dxfer_direction = (mxsize > 0) ? SG_DXFER_FROM_DEV : SG_DXFER_NONE;
  553. hp->dxfer_len = mxsize;
  554. if (hp->dxfer_direction == SG_DXFER_TO_DEV)
  555. hp->dxferp = (char __user *)buf + cmd_size;
  556. else
  557. hp->dxferp = NULL;
  558. hp->sbp = NULL;
  559. hp->timeout = old_hdr.reply_len; /* structure abuse ... */
  560. hp->flags = input_size; /* structure abuse ... */
  561. hp->pack_id = old_hdr.pack_id;
  562. hp->usr_ptr = NULL;
  563. if (__copy_from_user(cmnd, buf, cmd_size))
  564. return -EFAULT;
  565. /*
  566. * SG_DXFER_TO_FROM_DEV is functionally equivalent to SG_DXFER_FROM_DEV,
  567. * but is is possible that the app intended SG_DXFER_TO_DEV, because there
  568. * is a non-zero input_size, so emit a warning.
  569. */
  570. if (hp->dxfer_direction == SG_DXFER_TO_FROM_DEV) {
  571. static char cmd[TASK_COMM_LEN];
  572. if (strcmp(current->comm, cmd) && printk_ratelimit()) {
  573. printk(KERN_WARNING
  574. "sg_write: data in/out %d/%d bytes for SCSI command 0x%x--"
  575. "guessing data in;\n" KERN_WARNING " "
  576. "program %s not setting count and/or reply_len properly\n",
  577. old_hdr.reply_len - (int)SZ_SG_HEADER,
  578. input_size, (unsigned int) cmnd[0],
  579. current->comm);
  580. strcpy(cmd, current->comm);
  581. }
  582. }
  583. k = sg_common_write(sfp, srp, cmnd, sfp->timeout, blocking);
  584. return (k < 0) ? k : count;
  585. }
  586. static ssize_t
  587. sg_new_write(Sg_fd *sfp, struct file *file, const char __user *buf,
  588. size_t count, int blocking, int read_only, int sg_io_owned,
  589. Sg_request **o_srp)
  590. {
  591. int k;
  592. Sg_request *srp;
  593. sg_io_hdr_t *hp;
  594. unsigned char cmnd[MAX_COMMAND_SIZE];
  595. int timeout;
  596. unsigned long ul_timeout;
  597. if (count < SZ_SG_IO_HDR)
  598. return -EINVAL;
  599. if (!access_ok(VERIFY_READ, buf, count))
  600. return -EFAULT; /* protects following copy_from_user()s + get_user()s */
  601. sfp->cmd_q = 1; /* when sg_io_hdr seen, set command queuing on */
  602. if (!(srp = sg_add_request(sfp))) {
  603. SCSI_LOG_TIMEOUT(1, printk("sg_new_write: queue full\n"));
  604. return -EDOM;
  605. }
  606. srp->sg_io_owned = sg_io_owned;
  607. hp = &srp->header;
  608. if (__copy_from_user(hp, buf, SZ_SG_IO_HDR)) {
  609. sg_remove_request(sfp, srp);
  610. return -EFAULT;
  611. }
  612. if (hp->interface_id != 'S') {
  613. sg_remove_request(sfp, srp);
  614. return -ENOSYS;
  615. }
  616. if (hp->flags & SG_FLAG_MMAP_IO) {
  617. if (hp->dxfer_len > sfp->reserve.bufflen) {
  618. sg_remove_request(sfp, srp);
  619. return -ENOMEM; /* MMAP_IO size must fit in reserve buffer */
  620. }
  621. if (hp->flags & SG_FLAG_DIRECT_IO) {
  622. sg_remove_request(sfp, srp);
  623. return -EINVAL; /* either MMAP_IO or DIRECT_IO (not both) */
  624. }
  625. if (sg_res_in_use(sfp)) {
  626. sg_remove_request(sfp, srp);
  627. return -EBUSY; /* reserve buffer already being used */
  628. }
  629. }
  630. ul_timeout = msecs_to_jiffies(srp->header.timeout);
  631. timeout = (ul_timeout < INT_MAX) ? ul_timeout : INT_MAX;
  632. if ((!hp->cmdp) || (hp->cmd_len < 6) || (hp->cmd_len > sizeof (cmnd))) {
  633. sg_remove_request(sfp, srp);
  634. return -EMSGSIZE;
  635. }
  636. if (!access_ok(VERIFY_READ, hp->cmdp, hp->cmd_len)) {
  637. sg_remove_request(sfp, srp);
  638. return -EFAULT; /* protects following copy_from_user()s + get_user()s */
  639. }
  640. if (__copy_from_user(cmnd, hp->cmdp, hp->cmd_len)) {
  641. sg_remove_request(sfp, srp);
  642. return -EFAULT;
  643. }
  644. if (read_only && sg_allow_access(file, cmnd)) {
  645. sg_remove_request(sfp, srp);
  646. return -EPERM;
  647. }
  648. k = sg_common_write(sfp, srp, cmnd, timeout, blocking);
  649. if (k < 0)
  650. return k;
  651. if (o_srp)
  652. *o_srp = srp;
  653. return count;
  654. }
  655. static int
  656. sg_common_write(Sg_fd * sfp, Sg_request * srp,
  657. unsigned char *cmnd, int timeout, int blocking)
  658. {
  659. int k, data_dir;
  660. Sg_device *sdp = sfp->parentdp;
  661. sg_io_hdr_t *hp = &srp->header;
  662. srp->data.cmd_opcode = cmnd[0]; /* hold opcode of command */
  663. hp->status = 0;
  664. hp->masked_status = 0;
  665. hp->msg_status = 0;
  666. hp->info = 0;
  667. hp->host_status = 0;
  668. hp->driver_status = 0;
  669. hp->resid = 0;
  670. SCSI_LOG_TIMEOUT(4, printk("sg_common_write: scsi opcode=0x%02x, cmd_size=%d\n",
  671. (int) cmnd[0], (int) hp->cmd_len));
  672. k = sg_start_req(srp, cmnd);
  673. if (k) {
  674. SCSI_LOG_TIMEOUT(1, printk("sg_common_write: start_req err=%d\n", k));
  675. sg_finish_rem_req(srp);
  676. return k; /* probably out of space --> ENOMEM */
  677. }
  678. if (sdp->detached) {
  679. sg_finish_rem_req(srp);
  680. return -ENODEV;
  681. }
  682. switch (hp->dxfer_direction) {
  683. case SG_DXFER_TO_FROM_DEV:
  684. case SG_DXFER_FROM_DEV:
  685. data_dir = DMA_FROM_DEVICE;
  686. break;
  687. case SG_DXFER_TO_DEV:
  688. data_dir = DMA_TO_DEVICE;
  689. break;
  690. case SG_DXFER_UNKNOWN:
  691. data_dir = DMA_BIDIRECTIONAL;
  692. break;
  693. default:
  694. data_dir = DMA_NONE;
  695. break;
  696. }
  697. hp->duration = jiffies_to_msecs(jiffies);
  698. srp->rq->timeout = timeout;
  699. kref_get(&sfp->f_ref); /* sg_rq_end_io() does kref_put(). */
  700. blk_execute_rq_nowait(sdp->device->request_queue, sdp->disk,
  701. srp->rq, 1, sg_rq_end_io);
  702. return 0;
  703. }
  704. static int
  705. sg_ioctl(struct inode *inode, struct file *filp,
  706. unsigned int cmd_in, unsigned long arg)
  707. {
  708. void __user *p = (void __user *)arg;
  709. int __user *ip = p;
  710. int result, val, read_only;
  711. Sg_device *sdp;
  712. Sg_fd *sfp;
  713. Sg_request *srp;
  714. unsigned long iflags;
  715. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp)))
  716. return -ENXIO;
  717. SCSI_LOG_TIMEOUT(3, printk("sg_ioctl: %s, cmd=0x%x\n",
  718. sdp->disk->disk_name, (int) cmd_in));
  719. read_only = (O_RDWR != (filp->f_flags & O_ACCMODE));
  720. switch (cmd_in) {
  721. case SG_IO:
  722. {
  723. int blocking = 1; /* ignore O_NONBLOCK flag */
  724. if (sdp->detached)
  725. return -ENODEV;
  726. if (!scsi_block_when_processing_errors(sdp->device))
  727. return -ENXIO;
  728. if (!access_ok(VERIFY_WRITE, p, SZ_SG_IO_HDR))
  729. return -EFAULT;
  730. result =
  731. sg_new_write(sfp, filp, p, SZ_SG_IO_HDR,
  732. blocking, read_only, 1, &srp);
  733. if (result < 0)
  734. return result;
  735. while (1) {
  736. result = 0; /* following macro to beat race condition */
  737. __wait_event_interruptible(sfp->read_wait,
  738. (srp->done || sdp->detached),
  739. result);
  740. if (sdp->detached)
  741. return -ENODEV;
  742. write_lock_irq(&sfp->rq_list_lock);
  743. if (srp->done) {
  744. srp->done = 2;
  745. write_unlock_irq(&sfp->rq_list_lock);
  746. break;
  747. }
  748. srp->orphan = 1;
  749. write_unlock_irq(&sfp->rq_list_lock);
  750. return result; /* -ERESTARTSYS because signal hit process */
  751. }
  752. result = sg_new_read(sfp, p, SZ_SG_IO_HDR, srp);
  753. return (result < 0) ? result : 0;
  754. }
  755. case SG_SET_TIMEOUT:
  756. result = get_user(val, ip);
  757. if (result)
  758. return result;
  759. if (val < 0)
  760. return -EIO;
  761. if (val >= MULDIV (INT_MAX, USER_HZ, HZ))
  762. val = MULDIV (INT_MAX, USER_HZ, HZ);
  763. sfp->timeout_user = val;
  764. sfp->timeout = MULDIV (val, HZ, USER_HZ);
  765. return 0;
  766. case SG_GET_TIMEOUT: /* N.B. User receives timeout as return value */
  767. /* strange ..., for backward compatibility */
  768. return sfp->timeout_user;
  769. case SG_SET_FORCE_LOW_DMA:
  770. result = get_user(val, ip);
  771. if (result)
  772. return result;
  773. if (val) {
  774. sfp->low_dma = 1;
  775. if ((0 == sfp->low_dma) && (0 == sg_res_in_use(sfp))) {
  776. val = (int) sfp->reserve.bufflen;
  777. sg_remove_scat(&sfp->reserve);
  778. sg_build_reserve(sfp, val);
  779. }
  780. } else {
  781. if (sdp->detached)
  782. return -ENODEV;
  783. sfp->low_dma = sdp->device->host->unchecked_isa_dma;
  784. }
  785. return 0;
  786. case SG_GET_LOW_DMA:
  787. return put_user((int) sfp->low_dma, ip);
  788. case SG_GET_SCSI_ID:
  789. if (!access_ok(VERIFY_WRITE, p, sizeof (sg_scsi_id_t)))
  790. return -EFAULT;
  791. else {
  792. sg_scsi_id_t __user *sg_idp = p;
  793. if (sdp->detached)
  794. return -ENODEV;
  795. __put_user((int) sdp->device->host->host_no,
  796. &sg_idp->host_no);
  797. __put_user((int) sdp->device->channel,
  798. &sg_idp->channel);
  799. __put_user((int) sdp->device->id, &sg_idp->scsi_id);
  800. __put_user((int) sdp->device->lun, &sg_idp->lun);
  801. __put_user((int) sdp->device->type, &sg_idp->scsi_type);
  802. __put_user((short) sdp->device->host->cmd_per_lun,
  803. &sg_idp->h_cmd_per_lun);
  804. __put_user((short) sdp->device->queue_depth,
  805. &sg_idp->d_queue_depth);
  806. __put_user(0, &sg_idp->unused[0]);
  807. __put_user(0, &sg_idp->unused[1]);
  808. return 0;
  809. }
  810. case SG_SET_FORCE_PACK_ID:
  811. result = get_user(val, ip);
  812. if (result)
  813. return result;
  814. sfp->force_packid = val ? 1 : 0;
  815. return 0;
  816. case SG_GET_PACK_ID:
  817. if (!access_ok(VERIFY_WRITE, ip, sizeof (int)))
  818. return -EFAULT;
  819. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  820. for (srp = sfp->headrp; srp; srp = srp->nextrp) {
  821. if ((1 == srp->done) && (!srp->sg_io_owned)) {
  822. read_unlock_irqrestore(&sfp->rq_list_lock,
  823. iflags);
  824. __put_user(srp->header.pack_id, ip);
  825. return 0;
  826. }
  827. }
  828. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  829. __put_user(-1, ip);
  830. return 0;
  831. case SG_GET_NUM_WAITING:
  832. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  833. for (val = 0, srp = sfp->headrp; srp; srp = srp->nextrp) {
  834. if ((1 == srp->done) && (!srp->sg_io_owned))
  835. ++val;
  836. }
  837. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  838. return put_user(val, ip);
  839. case SG_GET_SG_TABLESIZE:
  840. return put_user(sdp->sg_tablesize, ip);
  841. case SG_SET_RESERVED_SIZE:
  842. result = get_user(val, ip);
  843. if (result)
  844. return result;
  845. if (val < 0)
  846. return -EINVAL;
  847. val = min_t(int, val,
  848. sdp->device->request_queue->max_sectors * 512);
  849. if (val != sfp->reserve.bufflen) {
  850. if (sg_res_in_use(sfp) || sfp->mmap_called)
  851. return -EBUSY;
  852. sg_remove_scat(&sfp->reserve);
  853. sg_build_reserve(sfp, val);
  854. }
  855. return 0;
  856. case SG_GET_RESERVED_SIZE:
  857. val = min_t(int, sfp->reserve.bufflen,
  858. sdp->device->request_queue->max_sectors * 512);
  859. return put_user(val, ip);
  860. case SG_SET_COMMAND_Q:
  861. result = get_user(val, ip);
  862. if (result)
  863. return result;
  864. sfp->cmd_q = val ? 1 : 0;
  865. return 0;
  866. case SG_GET_COMMAND_Q:
  867. return put_user((int) sfp->cmd_q, ip);
  868. case SG_SET_KEEP_ORPHAN:
  869. result = get_user(val, ip);
  870. if (result)
  871. return result;
  872. sfp->keep_orphan = val;
  873. return 0;
  874. case SG_GET_KEEP_ORPHAN:
  875. return put_user((int) sfp->keep_orphan, ip);
  876. case SG_NEXT_CMD_LEN:
  877. result = get_user(val, ip);
  878. if (result)
  879. return result;
  880. sfp->next_cmd_len = (val > 0) ? val : 0;
  881. return 0;
  882. case SG_GET_VERSION_NUM:
  883. return put_user(sg_version_num, ip);
  884. case SG_GET_ACCESS_COUNT:
  885. /* faked - we don't have a real access count anymore */
  886. val = (sdp->device ? 1 : 0);
  887. return put_user(val, ip);
  888. case SG_GET_REQUEST_TABLE:
  889. if (!access_ok(VERIFY_WRITE, p, SZ_SG_REQ_INFO * SG_MAX_QUEUE))
  890. return -EFAULT;
  891. else {
  892. sg_req_info_t *rinfo;
  893. unsigned int ms;
  894. rinfo = kmalloc(SZ_SG_REQ_INFO * SG_MAX_QUEUE,
  895. GFP_KERNEL);
  896. if (!rinfo)
  897. return -ENOMEM;
  898. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  899. for (srp = sfp->headrp, val = 0; val < SG_MAX_QUEUE;
  900. ++val, srp = srp ? srp->nextrp : srp) {
  901. memset(&rinfo[val], 0, SZ_SG_REQ_INFO);
  902. if (srp) {
  903. rinfo[val].req_state = srp->done + 1;
  904. rinfo[val].problem =
  905. srp->header.masked_status &
  906. srp->header.host_status &
  907. srp->header.driver_status;
  908. if (srp->done)
  909. rinfo[val].duration =
  910. srp->header.duration;
  911. else {
  912. ms = jiffies_to_msecs(jiffies);
  913. rinfo[val].duration =
  914. (ms > srp->header.duration) ?
  915. (ms - srp->header.duration) : 0;
  916. }
  917. rinfo[val].orphan = srp->orphan;
  918. rinfo[val].sg_io_owned =
  919. srp->sg_io_owned;
  920. rinfo[val].pack_id =
  921. srp->header.pack_id;
  922. rinfo[val].usr_ptr =
  923. srp->header.usr_ptr;
  924. }
  925. }
  926. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  927. result = __copy_to_user(p, rinfo,
  928. SZ_SG_REQ_INFO * SG_MAX_QUEUE);
  929. result = result ? -EFAULT : 0;
  930. kfree(rinfo);
  931. return result;
  932. }
  933. case SG_EMULATED_HOST:
  934. if (sdp->detached)
  935. return -ENODEV;
  936. return put_user(sdp->device->host->hostt->emulated, ip);
  937. case SG_SCSI_RESET:
  938. if (sdp->detached)
  939. return -ENODEV;
  940. if (filp->f_flags & O_NONBLOCK) {
  941. if (scsi_host_in_recovery(sdp->device->host))
  942. return -EBUSY;
  943. } else if (!scsi_block_when_processing_errors(sdp->device))
  944. return -EBUSY;
  945. result = get_user(val, ip);
  946. if (result)
  947. return result;
  948. if (SG_SCSI_RESET_NOTHING == val)
  949. return 0;
  950. switch (val) {
  951. case SG_SCSI_RESET_DEVICE:
  952. val = SCSI_TRY_RESET_DEVICE;
  953. break;
  954. case SG_SCSI_RESET_TARGET:
  955. val = SCSI_TRY_RESET_TARGET;
  956. break;
  957. case SG_SCSI_RESET_BUS:
  958. val = SCSI_TRY_RESET_BUS;
  959. break;
  960. case SG_SCSI_RESET_HOST:
  961. val = SCSI_TRY_RESET_HOST;
  962. break;
  963. default:
  964. return -EINVAL;
  965. }
  966. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  967. return -EACCES;
  968. return (scsi_reset_provider(sdp->device, val) ==
  969. SUCCESS) ? 0 : -EIO;
  970. case SCSI_IOCTL_SEND_COMMAND:
  971. if (sdp->detached)
  972. return -ENODEV;
  973. if (read_only) {
  974. unsigned char opcode = WRITE_6;
  975. Scsi_Ioctl_Command __user *siocp = p;
  976. if (copy_from_user(&opcode, siocp->data, 1))
  977. return -EFAULT;
  978. if (sg_allow_access(filp, &opcode))
  979. return -EPERM;
  980. }
  981. return sg_scsi_ioctl(sdp->device->request_queue, NULL, filp->f_mode, p);
  982. case SG_SET_DEBUG:
  983. result = get_user(val, ip);
  984. if (result)
  985. return result;
  986. sdp->sgdebug = (char) val;
  987. return 0;
  988. case SCSI_IOCTL_GET_IDLUN:
  989. case SCSI_IOCTL_GET_BUS_NUMBER:
  990. case SCSI_IOCTL_PROBE_HOST:
  991. case SG_GET_TRANSFORM:
  992. if (sdp->detached)
  993. return -ENODEV;
  994. return scsi_ioctl(sdp->device, cmd_in, p);
  995. case BLKSECTGET:
  996. return put_user(sdp->device->request_queue->max_sectors * 512,
  997. ip);
  998. case BLKTRACESETUP:
  999. return blk_trace_setup(sdp->device->request_queue,
  1000. sdp->disk->disk_name,
  1001. MKDEV(SCSI_GENERIC_MAJOR, sdp->index),
  1002. (char *)arg);
  1003. case BLKTRACESTART:
  1004. return blk_trace_startstop(sdp->device->request_queue, 1);
  1005. case BLKTRACESTOP:
  1006. return blk_trace_startstop(sdp->device->request_queue, 0);
  1007. case BLKTRACETEARDOWN:
  1008. return blk_trace_remove(sdp->device->request_queue);
  1009. default:
  1010. if (read_only)
  1011. return -EPERM; /* don't know so take safe approach */
  1012. return scsi_ioctl(sdp->device, cmd_in, p);
  1013. }
  1014. }
  1015. #ifdef CONFIG_COMPAT
  1016. static long sg_compat_ioctl(struct file *filp, unsigned int cmd_in, unsigned long arg)
  1017. {
  1018. Sg_device *sdp;
  1019. Sg_fd *sfp;
  1020. struct scsi_device *sdev;
  1021. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp)))
  1022. return -ENXIO;
  1023. sdev = sdp->device;
  1024. if (sdev->host->hostt->compat_ioctl) {
  1025. int ret;
  1026. ret = sdev->host->hostt->compat_ioctl(sdev, cmd_in, (void __user *)arg);
  1027. return ret;
  1028. }
  1029. return -ENOIOCTLCMD;
  1030. }
  1031. #endif
  1032. static unsigned int
  1033. sg_poll(struct file *filp, poll_table * wait)
  1034. {
  1035. unsigned int res = 0;
  1036. Sg_device *sdp;
  1037. Sg_fd *sfp;
  1038. Sg_request *srp;
  1039. int count = 0;
  1040. unsigned long iflags;
  1041. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp))
  1042. || sfp->closed)
  1043. return POLLERR;
  1044. poll_wait(filp, &sfp->read_wait, wait);
  1045. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  1046. for (srp = sfp->headrp; srp; srp = srp->nextrp) {
  1047. /* if any read waiting, flag it */
  1048. if ((0 == res) && (1 == srp->done) && (!srp->sg_io_owned))
  1049. res = POLLIN | POLLRDNORM;
  1050. ++count;
  1051. }
  1052. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1053. if (sdp->detached)
  1054. res |= POLLHUP;
  1055. else if (!sfp->cmd_q) {
  1056. if (0 == count)
  1057. res |= POLLOUT | POLLWRNORM;
  1058. } else if (count < SG_MAX_QUEUE)
  1059. res |= POLLOUT | POLLWRNORM;
  1060. SCSI_LOG_TIMEOUT(3, printk("sg_poll: %s, res=0x%x\n",
  1061. sdp->disk->disk_name, (int) res));
  1062. return res;
  1063. }
  1064. static int
  1065. sg_fasync(int fd, struct file *filp, int mode)
  1066. {
  1067. int retval;
  1068. Sg_device *sdp;
  1069. Sg_fd *sfp;
  1070. if ((!(sfp = (Sg_fd *) filp->private_data)) || (!(sdp = sfp->parentdp)))
  1071. return -ENXIO;
  1072. SCSI_LOG_TIMEOUT(3, printk("sg_fasync: %s, mode=%d\n",
  1073. sdp->disk->disk_name, mode));
  1074. retval = fasync_helper(fd, filp, mode, &sfp->async_qp);
  1075. return (retval < 0) ? retval : 0;
  1076. }
  1077. static int
  1078. sg_vma_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
  1079. {
  1080. Sg_fd *sfp;
  1081. unsigned long offset, len, sa;
  1082. Sg_scatter_hold *rsv_schp;
  1083. int k, length;
  1084. if ((NULL == vma) || (!(sfp = (Sg_fd *) vma->vm_private_data)))
  1085. return VM_FAULT_SIGBUS;
  1086. rsv_schp = &sfp->reserve;
  1087. offset = vmf->pgoff << PAGE_SHIFT;
  1088. if (offset >= rsv_schp->bufflen)
  1089. return VM_FAULT_SIGBUS;
  1090. SCSI_LOG_TIMEOUT(3, printk("sg_vma_fault: offset=%lu, scatg=%d\n",
  1091. offset, rsv_schp->k_use_sg));
  1092. sa = vma->vm_start;
  1093. length = 1 << (PAGE_SHIFT + rsv_schp->page_order);
  1094. for (k = 0; k < rsv_schp->k_use_sg && sa < vma->vm_end; k++) {
  1095. len = vma->vm_end - sa;
  1096. len = (len < length) ? len : length;
  1097. if (offset < len) {
  1098. struct page *page = nth_page(rsv_schp->pages[k],
  1099. offset >> PAGE_SHIFT);
  1100. get_page(page); /* increment page count */
  1101. vmf->page = page;
  1102. return 0; /* success */
  1103. }
  1104. sa += len;
  1105. offset -= len;
  1106. }
  1107. return VM_FAULT_SIGBUS;
  1108. }
  1109. static struct vm_operations_struct sg_mmap_vm_ops = {
  1110. .fault = sg_vma_fault,
  1111. };
  1112. static int
  1113. sg_mmap(struct file *filp, struct vm_area_struct *vma)
  1114. {
  1115. Sg_fd *sfp;
  1116. unsigned long req_sz, len, sa;
  1117. Sg_scatter_hold *rsv_schp;
  1118. int k, length;
  1119. if ((!filp) || (!vma) || (!(sfp = (Sg_fd *) filp->private_data)))
  1120. return -ENXIO;
  1121. req_sz = vma->vm_end - vma->vm_start;
  1122. SCSI_LOG_TIMEOUT(3, printk("sg_mmap starting, vm_start=%p, len=%d\n",
  1123. (void *) vma->vm_start, (int) req_sz));
  1124. if (vma->vm_pgoff)
  1125. return -EINVAL; /* want no offset */
  1126. rsv_schp = &sfp->reserve;
  1127. if (req_sz > rsv_schp->bufflen)
  1128. return -ENOMEM; /* cannot map more than reserved buffer */
  1129. sa = vma->vm_start;
  1130. length = 1 << (PAGE_SHIFT + rsv_schp->page_order);
  1131. for (k = 0; k < rsv_schp->k_use_sg && sa < vma->vm_end; k++) {
  1132. len = vma->vm_end - sa;
  1133. len = (len < length) ? len : length;
  1134. sa += len;
  1135. }
  1136. sfp->mmap_called = 1;
  1137. vma->vm_flags |= VM_RESERVED;
  1138. vma->vm_private_data = sfp;
  1139. vma->vm_ops = &sg_mmap_vm_ops;
  1140. return 0;
  1141. }
  1142. static void sg_rq_end_io_usercontext(struct work_struct *work)
  1143. {
  1144. struct sg_request *srp = container_of(work, struct sg_request, ew.work);
  1145. struct sg_fd *sfp = srp->parentfp;
  1146. sg_finish_rem_req(srp);
  1147. kref_put(&sfp->f_ref, sg_remove_sfp);
  1148. }
  1149. /*
  1150. * This function is a "bottom half" handler that is called by the mid
  1151. * level when a command is completed (or has failed).
  1152. */
  1153. static void sg_rq_end_io(struct request *rq, int uptodate)
  1154. {
  1155. struct sg_request *srp = rq->end_io_data;
  1156. Sg_device *sdp;
  1157. Sg_fd *sfp;
  1158. unsigned long iflags;
  1159. unsigned int ms;
  1160. char *sense;
  1161. int result, resid, done = 1;
  1162. if (WARN_ON(srp->done != 0))
  1163. return;
  1164. sfp = srp->parentfp;
  1165. if (WARN_ON(sfp == NULL))
  1166. return;
  1167. sdp = sfp->parentdp;
  1168. if (unlikely(sdp->detached))
  1169. printk(KERN_INFO "sg_rq_end_io: device detached\n");
  1170. sense = rq->sense;
  1171. result = rq->errors;
  1172. resid = rq->data_len;
  1173. SCSI_LOG_TIMEOUT(4, printk("sg_cmd_done: %s, pack_id=%d, res=0x%x\n",
  1174. sdp->disk->disk_name, srp->header.pack_id, result));
  1175. srp->header.resid = resid;
  1176. ms = jiffies_to_msecs(jiffies);
  1177. srp->header.duration = (ms > srp->header.duration) ?
  1178. (ms - srp->header.duration) : 0;
  1179. if (0 != result) {
  1180. struct scsi_sense_hdr sshdr;
  1181. srp->header.status = 0xff & result;
  1182. srp->header.masked_status = status_byte(result);
  1183. srp->header.msg_status = msg_byte(result);
  1184. srp->header.host_status = host_byte(result);
  1185. srp->header.driver_status = driver_byte(result);
  1186. if ((sdp->sgdebug > 0) &&
  1187. ((CHECK_CONDITION == srp->header.masked_status) ||
  1188. (COMMAND_TERMINATED == srp->header.masked_status)))
  1189. __scsi_print_sense("sg_cmd_done", sense,
  1190. SCSI_SENSE_BUFFERSIZE);
  1191. /* Following if statement is a patch supplied by Eric Youngdale */
  1192. if (driver_byte(result) != 0
  1193. && scsi_normalize_sense(sense, SCSI_SENSE_BUFFERSIZE, &sshdr)
  1194. && !scsi_sense_is_deferred(&sshdr)
  1195. && sshdr.sense_key == UNIT_ATTENTION
  1196. && sdp->device->removable) {
  1197. /* Detected possible disc change. Set the bit - this */
  1198. /* may be used if there are filesystems using this device */
  1199. sdp->device->changed = 1;
  1200. }
  1201. }
  1202. /* Rely on write phase to clean out srp status values, so no "else" */
  1203. write_lock_irqsave(&sfp->rq_list_lock, iflags);
  1204. if (unlikely(srp->orphan)) {
  1205. if (sfp->keep_orphan)
  1206. srp->sg_io_owned = 0;
  1207. else
  1208. done = 0;
  1209. }
  1210. srp->done = done;
  1211. write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1212. if (likely(done)) {
  1213. /* Now wake up any sg_read() that is waiting for this
  1214. * packet.
  1215. */
  1216. wake_up_interruptible(&sfp->read_wait);
  1217. kill_fasync(&sfp->async_qp, SIGPOLL, POLL_IN);
  1218. kref_put(&sfp->f_ref, sg_remove_sfp);
  1219. } else
  1220. execute_in_process_context(sg_rq_end_io_usercontext, &srp->ew);
  1221. }
  1222. static struct file_operations sg_fops = {
  1223. .owner = THIS_MODULE,
  1224. .read = sg_read,
  1225. .write = sg_write,
  1226. .poll = sg_poll,
  1227. .ioctl = sg_ioctl,
  1228. #ifdef CONFIG_COMPAT
  1229. .compat_ioctl = sg_compat_ioctl,
  1230. #endif
  1231. .open = sg_open,
  1232. .mmap = sg_mmap,
  1233. .release = sg_release,
  1234. .fasync = sg_fasync,
  1235. };
  1236. static struct class *sg_sysfs_class;
  1237. static int sg_sysfs_valid = 0;
  1238. static Sg_device *sg_alloc(struct gendisk *disk, struct scsi_device *scsidp)
  1239. {
  1240. struct request_queue *q = scsidp->request_queue;
  1241. Sg_device *sdp;
  1242. unsigned long iflags;
  1243. int error;
  1244. u32 k;
  1245. sdp = kzalloc(sizeof(Sg_device), GFP_KERNEL);
  1246. if (!sdp) {
  1247. printk(KERN_WARNING "kmalloc Sg_device failure\n");
  1248. return ERR_PTR(-ENOMEM);
  1249. }
  1250. if (!idr_pre_get(&sg_index_idr, GFP_KERNEL)) {
  1251. printk(KERN_WARNING "idr expansion Sg_device failure\n");
  1252. error = -ENOMEM;
  1253. goto out;
  1254. }
  1255. write_lock_irqsave(&sg_index_lock, iflags);
  1256. error = idr_get_new(&sg_index_idr, sdp, &k);
  1257. if (error) {
  1258. write_unlock_irqrestore(&sg_index_lock, iflags);
  1259. printk(KERN_WARNING "idr allocation Sg_device failure: %d\n",
  1260. error);
  1261. goto out;
  1262. }
  1263. if (unlikely(k >= SG_MAX_DEVS))
  1264. goto overflow;
  1265. SCSI_LOG_TIMEOUT(3, printk("sg_alloc: dev=%d \n", k));
  1266. sprintf(disk->disk_name, "sg%d", k);
  1267. disk->first_minor = k;
  1268. sdp->disk = disk;
  1269. sdp->device = scsidp;
  1270. init_waitqueue_head(&sdp->o_excl_wait);
  1271. sdp->sg_tablesize = min(q->max_hw_segments, q->max_phys_segments);
  1272. sdp->index = k;
  1273. kref_init(&sdp->d_ref);
  1274. write_unlock_irqrestore(&sg_index_lock, iflags);
  1275. error = 0;
  1276. out:
  1277. if (error) {
  1278. kfree(sdp);
  1279. return ERR_PTR(error);
  1280. }
  1281. return sdp;
  1282. overflow:
  1283. idr_remove(&sg_index_idr, k);
  1284. write_unlock_irqrestore(&sg_index_lock, iflags);
  1285. sdev_printk(KERN_WARNING, scsidp,
  1286. "Unable to attach sg device type=%d, minor "
  1287. "number exceeds %d\n", scsidp->type, SG_MAX_DEVS - 1);
  1288. error = -ENODEV;
  1289. goto out;
  1290. }
  1291. static int
  1292. sg_add(struct device *cl_dev, struct class_interface *cl_intf)
  1293. {
  1294. struct scsi_device *scsidp = to_scsi_device(cl_dev->parent);
  1295. struct gendisk *disk;
  1296. Sg_device *sdp = NULL;
  1297. struct cdev * cdev = NULL;
  1298. int error;
  1299. unsigned long iflags;
  1300. disk = alloc_disk(1);
  1301. if (!disk) {
  1302. printk(KERN_WARNING "alloc_disk failed\n");
  1303. return -ENOMEM;
  1304. }
  1305. disk->major = SCSI_GENERIC_MAJOR;
  1306. error = -ENOMEM;
  1307. cdev = cdev_alloc();
  1308. if (!cdev) {
  1309. printk(KERN_WARNING "cdev_alloc failed\n");
  1310. goto out;
  1311. }
  1312. cdev->owner = THIS_MODULE;
  1313. cdev->ops = &sg_fops;
  1314. sdp = sg_alloc(disk, scsidp);
  1315. if (IS_ERR(sdp)) {
  1316. printk(KERN_WARNING "sg_alloc failed\n");
  1317. error = PTR_ERR(sdp);
  1318. goto out;
  1319. }
  1320. error = cdev_add(cdev, MKDEV(SCSI_GENERIC_MAJOR, sdp->index), 1);
  1321. if (error)
  1322. goto cdev_add_err;
  1323. sdp->cdev = cdev;
  1324. if (sg_sysfs_valid) {
  1325. struct device *sg_class_member;
  1326. sg_class_member = device_create(sg_sysfs_class, cl_dev->parent,
  1327. MKDEV(SCSI_GENERIC_MAJOR,
  1328. sdp->index),
  1329. sdp, "%s", disk->disk_name);
  1330. if (IS_ERR(sg_class_member)) {
  1331. printk(KERN_ERR "sg_add: "
  1332. "device_create failed\n");
  1333. error = PTR_ERR(sg_class_member);
  1334. goto cdev_add_err;
  1335. }
  1336. error = sysfs_create_link(&scsidp->sdev_gendev.kobj,
  1337. &sg_class_member->kobj, "generic");
  1338. if (error)
  1339. printk(KERN_ERR "sg_add: unable to make symlink "
  1340. "'generic' back to sg%d\n", sdp->index);
  1341. } else
  1342. printk(KERN_WARNING "sg_add: sg_sys Invalid\n");
  1343. sdev_printk(KERN_NOTICE, scsidp,
  1344. "Attached scsi generic sg%d type %d\n", sdp->index,
  1345. scsidp->type);
  1346. dev_set_drvdata(cl_dev, sdp);
  1347. return 0;
  1348. cdev_add_err:
  1349. write_lock_irqsave(&sg_index_lock, iflags);
  1350. idr_remove(&sg_index_idr, sdp->index);
  1351. write_unlock_irqrestore(&sg_index_lock, iflags);
  1352. kfree(sdp);
  1353. out:
  1354. put_disk(disk);
  1355. if (cdev)
  1356. cdev_del(cdev);
  1357. return error;
  1358. }
  1359. static void sg_device_destroy(struct kref *kref)
  1360. {
  1361. struct sg_device *sdp = container_of(kref, struct sg_device, d_ref);
  1362. unsigned long flags;
  1363. /* CAUTION! Note that the device can still be found via idr_find()
  1364. * even though the refcount is 0. Therefore, do idr_remove() BEFORE
  1365. * any other cleanup.
  1366. */
  1367. write_lock_irqsave(&sg_index_lock, flags);
  1368. idr_remove(&sg_index_idr, sdp->index);
  1369. write_unlock_irqrestore(&sg_index_lock, flags);
  1370. SCSI_LOG_TIMEOUT(3,
  1371. printk("sg_device_destroy: %s\n",
  1372. sdp->disk->disk_name));
  1373. put_disk(sdp->disk);
  1374. kfree(sdp);
  1375. }
  1376. static void sg_remove(struct device *cl_dev, struct class_interface *cl_intf)
  1377. {
  1378. struct scsi_device *scsidp = to_scsi_device(cl_dev->parent);
  1379. Sg_device *sdp = dev_get_drvdata(cl_dev);
  1380. unsigned long iflags;
  1381. Sg_fd *sfp;
  1382. if (!sdp || sdp->detached)
  1383. return;
  1384. SCSI_LOG_TIMEOUT(3, printk("sg_remove: %s\n", sdp->disk->disk_name));
  1385. /* Need a write lock to set sdp->detached. */
  1386. write_lock_irqsave(&sg_index_lock, iflags);
  1387. sdp->detached = 1;
  1388. for (sfp = sdp->headfp; sfp; sfp = sfp->nextfp) {
  1389. wake_up_interruptible(&sfp->read_wait);
  1390. kill_fasync(&sfp->async_qp, SIGPOLL, POLL_HUP);
  1391. }
  1392. write_unlock_irqrestore(&sg_index_lock, iflags);
  1393. sysfs_remove_link(&scsidp->sdev_gendev.kobj, "generic");
  1394. device_destroy(sg_sysfs_class, MKDEV(SCSI_GENERIC_MAJOR, sdp->index));
  1395. cdev_del(sdp->cdev);
  1396. sdp->cdev = NULL;
  1397. sg_put_dev(sdp);
  1398. }
  1399. module_param_named(scatter_elem_sz, scatter_elem_sz, int, S_IRUGO | S_IWUSR);
  1400. module_param_named(def_reserved_size, def_reserved_size, int,
  1401. S_IRUGO | S_IWUSR);
  1402. module_param_named(allow_dio, sg_allow_dio, int, S_IRUGO | S_IWUSR);
  1403. MODULE_AUTHOR("Douglas Gilbert");
  1404. MODULE_DESCRIPTION("SCSI generic (sg) driver");
  1405. MODULE_LICENSE("GPL");
  1406. MODULE_VERSION(SG_VERSION_STR);
  1407. MODULE_ALIAS_CHARDEV_MAJOR(SCSI_GENERIC_MAJOR);
  1408. MODULE_PARM_DESC(scatter_elem_sz, "scatter gather element "
  1409. "size (default: max(SG_SCATTER_SZ, PAGE_SIZE))");
  1410. MODULE_PARM_DESC(def_reserved_size, "size of buffer reserved for each fd");
  1411. MODULE_PARM_DESC(allow_dio, "allow direct I/O (default: 0 (disallow))");
  1412. static int __init
  1413. init_sg(void)
  1414. {
  1415. int rc;
  1416. if (scatter_elem_sz < PAGE_SIZE) {
  1417. scatter_elem_sz = PAGE_SIZE;
  1418. scatter_elem_sz_prev = scatter_elem_sz;
  1419. }
  1420. if (def_reserved_size >= 0)
  1421. sg_big_buff = def_reserved_size;
  1422. else
  1423. def_reserved_size = sg_big_buff;
  1424. rc = register_chrdev_region(MKDEV(SCSI_GENERIC_MAJOR, 0),
  1425. SG_MAX_DEVS, "sg");
  1426. if (rc)
  1427. return rc;
  1428. sg_sysfs_class = class_create(THIS_MODULE, "scsi_generic");
  1429. if ( IS_ERR(sg_sysfs_class) ) {
  1430. rc = PTR_ERR(sg_sysfs_class);
  1431. goto err_out;
  1432. }
  1433. sg_sysfs_valid = 1;
  1434. rc = scsi_register_interface(&sg_interface);
  1435. if (0 == rc) {
  1436. #ifdef CONFIG_SCSI_PROC_FS
  1437. sg_proc_init();
  1438. #endif /* CONFIG_SCSI_PROC_FS */
  1439. return 0;
  1440. }
  1441. class_destroy(sg_sysfs_class);
  1442. err_out:
  1443. unregister_chrdev_region(MKDEV(SCSI_GENERIC_MAJOR, 0), SG_MAX_DEVS);
  1444. return rc;
  1445. }
  1446. static void __exit
  1447. exit_sg(void)
  1448. {
  1449. #ifdef CONFIG_SCSI_PROC_FS
  1450. sg_proc_cleanup();
  1451. #endif /* CONFIG_SCSI_PROC_FS */
  1452. scsi_unregister_interface(&sg_interface);
  1453. class_destroy(sg_sysfs_class);
  1454. sg_sysfs_valid = 0;
  1455. unregister_chrdev_region(MKDEV(SCSI_GENERIC_MAJOR, 0),
  1456. SG_MAX_DEVS);
  1457. idr_destroy(&sg_index_idr);
  1458. }
  1459. static int sg_start_req(Sg_request *srp, unsigned char *cmd)
  1460. {
  1461. int res;
  1462. struct request *rq;
  1463. Sg_fd *sfp = srp->parentfp;
  1464. sg_io_hdr_t *hp = &srp->header;
  1465. int dxfer_len = (int) hp->dxfer_len;
  1466. int dxfer_dir = hp->dxfer_direction;
  1467. unsigned int iov_count = hp->iovec_count;
  1468. Sg_scatter_hold *req_schp = &srp->data;
  1469. Sg_scatter_hold *rsv_schp = &sfp->reserve;
  1470. struct request_queue *q = sfp->parentdp->device->request_queue;
  1471. struct rq_map_data *md, map_data;
  1472. int rw = hp->dxfer_direction == SG_DXFER_TO_DEV ? WRITE : READ;
  1473. SCSI_LOG_TIMEOUT(4, printk(KERN_INFO "sg_start_req: dxfer_len=%d\n",
  1474. dxfer_len));
  1475. rq = blk_get_request(q, rw, GFP_ATOMIC);
  1476. if (!rq)
  1477. return -ENOMEM;
  1478. memcpy(rq->cmd, cmd, hp->cmd_len);
  1479. rq->cmd_len = hp->cmd_len;
  1480. rq->cmd_type = REQ_TYPE_BLOCK_PC;
  1481. srp->rq = rq;
  1482. rq->end_io_data = srp;
  1483. rq->sense = srp->sense_b;
  1484. rq->retries = SG_DEFAULT_RETRIES;
  1485. if ((dxfer_len <= 0) || (dxfer_dir == SG_DXFER_NONE))
  1486. return 0;
  1487. if (sg_allow_dio && hp->flags & SG_FLAG_DIRECT_IO &&
  1488. dxfer_dir != SG_DXFER_UNKNOWN && !iov_count &&
  1489. !sfp->parentdp->device->host->unchecked_isa_dma &&
  1490. blk_rq_aligned(q, hp->dxferp, dxfer_len))
  1491. md = NULL;
  1492. else
  1493. md = &map_data;
  1494. if (md) {
  1495. if (!sg_res_in_use(sfp) && dxfer_len <= rsv_schp->bufflen)
  1496. sg_link_reserve(sfp, srp, dxfer_len);
  1497. else {
  1498. res = sg_build_indirect(req_schp, sfp, dxfer_len);
  1499. if (res)
  1500. return res;
  1501. }
  1502. md->pages = req_schp->pages;
  1503. md->page_order = req_schp->page_order;
  1504. md->nr_entries = req_schp->k_use_sg;
  1505. md->offset = 0;
  1506. md->null_mapped = hp->dxferp ? 0 : 1;
  1507. }
  1508. if (iov_count)
  1509. res = blk_rq_map_user_iov(q, rq, md, hp->dxferp, iov_count,
  1510. hp->dxfer_len, GFP_ATOMIC);
  1511. else
  1512. res = blk_rq_map_user(q, rq, md, hp->dxferp,
  1513. hp->dxfer_len, GFP_ATOMIC);
  1514. if (!res) {
  1515. srp->bio = rq->bio;
  1516. if (!md) {
  1517. req_schp->dio_in_use = 1;
  1518. hp->info |= SG_INFO_DIRECT_IO;
  1519. }
  1520. }
  1521. return res;
  1522. }
  1523. static void
  1524. sg_finish_rem_req(Sg_request * srp)
  1525. {
  1526. Sg_fd *sfp = srp->parentfp;
  1527. Sg_scatter_hold *req_schp = &srp->data;
  1528. SCSI_LOG_TIMEOUT(4, printk("sg_finish_rem_req: res_used=%d\n", (int) srp->res_used));
  1529. if (srp->res_used)
  1530. sg_unlink_reserve(sfp, srp);
  1531. else
  1532. sg_remove_scat(req_schp);
  1533. if (srp->rq) {
  1534. if (srp->bio)
  1535. blk_rq_unmap_user(srp->bio);
  1536. blk_put_request(srp->rq);
  1537. }
  1538. sg_remove_request(sfp, srp);
  1539. }
  1540. static int
  1541. sg_build_sgat(Sg_scatter_hold * schp, const Sg_fd * sfp, int tablesize)
  1542. {
  1543. int sg_bufflen = tablesize * sizeof(struct page *);
  1544. gfp_t gfp_flags = GFP_ATOMIC | __GFP_NOWARN;
  1545. schp->pages = kzalloc(sg_bufflen, gfp_flags);
  1546. if (!schp->pages)
  1547. return -ENOMEM;
  1548. schp->sglist_len = sg_bufflen;
  1549. return tablesize; /* number of scat_gath elements allocated */
  1550. }
  1551. static int
  1552. sg_build_indirect(Sg_scatter_hold * schp, Sg_fd * sfp, int buff_size)
  1553. {
  1554. int ret_sz = 0, i, k, rem_sz, num, mx_sc_elems;
  1555. int sg_tablesize = sfp->parentdp->sg_tablesize;
  1556. int blk_size = buff_size, order;
  1557. gfp_t gfp_mask = GFP_ATOMIC | __GFP_COMP | __GFP_NOWARN;
  1558. if (blk_size < 0)
  1559. return -EFAULT;
  1560. if (0 == blk_size)
  1561. ++blk_size; /* don't know why */
  1562. /* round request up to next highest SG_SECTOR_SZ byte boundary */
  1563. blk_size = ALIGN(blk_size, SG_SECTOR_SZ);
  1564. SCSI_LOG_TIMEOUT(4, printk("sg_build_indirect: buff_size=%d, blk_size=%d\n",
  1565. buff_size, blk_size));
  1566. /* N.B. ret_sz carried into this block ... */
  1567. mx_sc_elems = sg_build_sgat(schp, sfp, sg_tablesize);
  1568. if (mx_sc_elems < 0)
  1569. return mx_sc_elems; /* most likely -ENOMEM */
  1570. num = scatter_elem_sz;
  1571. if (unlikely(num != scatter_elem_sz_prev)) {
  1572. if (num < PAGE_SIZE) {
  1573. scatter_elem_sz = PAGE_SIZE;
  1574. scatter_elem_sz_prev = PAGE_SIZE;
  1575. } else
  1576. scatter_elem_sz_prev = num;
  1577. }
  1578. if (sfp->low_dma)
  1579. gfp_mask |= GFP_DMA;
  1580. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  1581. gfp_mask |= __GFP_ZERO;
  1582. order = get_order(num);
  1583. retry:
  1584. ret_sz = 1 << (PAGE_SHIFT + order);
  1585. for (k = 0, rem_sz = blk_size; rem_sz > 0 && k < mx_sc_elems;
  1586. k++, rem_sz -= ret_sz) {
  1587. num = (rem_sz > scatter_elem_sz_prev) ?
  1588. scatter_elem_sz_prev : rem_sz;
  1589. schp->pages[k] = alloc_pages(gfp_mask, order);
  1590. if (!schp->pages[k])
  1591. goto out;
  1592. if (num == scatter_elem_sz_prev) {
  1593. if (unlikely(ret_sz > scatter_elem_sz_prev)) {
  1594. scatter_elem_sz = ret_sz;
  1595. scatter_elem_sz_prev = ret_sz;
  1596. }
  1597. }
  1598. SCSI_LOG_TIMEOUT(5, printk("sg_build_indirect: k=%d, num=%d, "
  1599. "ret_sz=%d\n", k, num, ret_sz));
  1600. } /* end of for loop */
  1601. schp->page_order = order;
  1602. schp->k_use_sg = k;
  1603. SCSI_LOG_TIMEOUT(5, printk("sg_build_indirect: k_use_sg=%d, "
  1604. "rem_sz=%d\n", k, rem_sz));
  1605. schp->bufflen = blk_size;
  1606. if (rem_sz > 0) /* must have failed */
  1607. return -ENOMEM;
  1608. return 0;
  1609. out:
  1610. for (i = 0; i < k; i++)
  1611. __free_pages(schp->pages[k], order);
  1612. if (--order >= 0)
  1613. goto retry;
  1614. return -ENOMEM;
  1615. }
  1616. static void
  1617. sg_remove_scat(Sg_scatter_hold * schp)
  1618. {
  1619. SCSI_LOG_TIMEOUT(4, printk("sg_remove_scat: k_use_sg=%d\n", schp->k_use_sg));
  1620. if (schp->pages && schp->sglist_len > 0) {
  1621. if (!schp->dio_in_use) {
  1622. int k;
  1623. for (k = 0; k < schp->k_use_sg && schp->pages[k]; k++) {
  1624. SCSI_LOG_TIMEOUT(5, printk(
  1625. "sg_remove_scat: k=%d, pg=0x%p\n",
  1626. k, schp->pages[k]));
  1627. __free_pages(schp->pages[k], schp->page_order);
  1628. }
  1629. kfree(schp->pages);
  1630. }
  1631. }
  1632. memset(schp, 0, sizeof (*schp));
  1633. }
  1634. static int
  1635. sg_read_oxfer(Sg_request * srp, char __user *outp, int num_read_xfer)
  1636. {
  1637. Sg_scatter_hold *schp = &srp->data;
  1638. int k, num;
  1639. SCSI_LOG_TIMEOUT(4, printk("sg_read_oxfer: num_read_xfer=%d\n",
  1640. num_read_xfer));
  1641. if ((!outp) || (num_read_xfer <= 0))
  1642. return 0;
  1643. num = 1 << (PAGE_SHIFT + schp->page_order);
  1644. for (k = 0; k < schp->k_use_sg && schp->pages[k]; k++) {
  1645. if (num > num_read_xfer) {
  1646. if (__copy_to_user(outp, page_address(schp->pages[k]),
  1647. num_read_xfer))
  1648. return -EFAULT;
  1649. break;
  1650. } else {
  1651. if (__copy_to_user(outp, page_address(schp->pages[k]),
  1652. num))
  1653. return -EFAULT;
  1654. num_read_xfer -= num;
  1655. if (num_read_xfer <= 0)
  1656. break;
  1657. outp += num;
  1658. }
  1659. }
  1660. return 0;
  1661. }
  1662. static void
  1663. sg_build_reserve(Sg_fd * sfp, int req_size)
  1664. {
  1665. Sg_scatter_hold *schp = &sfp->reserve;
  1666. SCSI_LOG_TIMEOUT(4, printk("sg_build_reserve: req_size=%d\n", req_size));
  1667. do {
  1668. if (req_size < PAGE_SIZE)
  1669. req_size = PAGE_SIZE;
  1670. if (0 == sg_build_indirect(schp, sfp, req_size))
  1671. return;
  1672. else
  1673. sg_remove_scat(schp);
  1674. req_size >>= 1; /* divide by 2 */
  1675. } while (req_size > (PAGE_SIZE / 2));
  1676. }
  1677. static void
  1678. sg_link_reserve(Sg_fd * sfp, Sg_request * srp, int size)
  1679. {
  1680. Sg_scatter_hold *req_schp = &srp->data;
  1681. Sg_scatter_hold *rsv_schp = &sfp->reserve;
  1682. int k, num, rem;
  1683. srp->res_used = 1;
  1684. SCSI_LOG_TIMEOUT(4, printk("sg_link_reserve: size=%d\n", size));
  1685. rem = size;
  1686. num = 1 << (PAGE_SHIFT + rsv_schp->page_order);
  1687. for (k = 0; k < rsv_schp->k_use_sg; k++) {
  1688. if (rem <= num) {
  1689. req_schp->k_use_sg = k + 1;
  1690. req_schp->sglist_len = rsv_schp->sglist_len;
  1691. req_schp->pages = rsv_schp->pages;
  1692. req_schp->bufflen = size;
  1693. req_schp->page_order = rsv_schp->page_order;
  1694. break;
  1695. } else
  1696. rem -= num;
  1697. }
  1698. if (k >= rsv_schp->k_use_sg)
  1699. SCSI_LOG_TIMEOUT(1, printk("sg_link_reserve: BAD size\n"));
  1700. }
  1701. static void
  1702. sg_unlink_reserve(Sg_fd * sfp, Sg_request * srp)
  1703. {
  1704. Sg_scatter_hold *req_schp = &srp->data;
  1705. SCSI_LOG_TIMEOUT(4, printk("sg_unlink_reserve: req->k_use_sg=%d\n",
  1706. (int) req_schp->k_use_sg));
  1707. req_schp->k_use_sg = 0;
  1708. req_schp->bufflen = 0;
  1709. req_schp->pages = NULL;
  1710. req_schp->page_order = 0;
  1711. req_schp->sglist_len = 0;
  1712. sfp->save_scat_len = 0;
  1713. srp->res_used = 0;
  1714. }
  1715. static Sg_request *
  1716. sg_get_rq_mark(Sg_fd * sfp, int pack_id)
  1717. {
  1718. Sg_request *resp;
  1719. unsigned long iflags;
  1720. write_lock_irqsave(&sfp->rq_list_lock, iflags);
  1721. for (resp = sfp->headrp; resp; resp = resp->nextrp) {
  1722. /* look for requests that are ready + not SG_IO owned */
  1723. if ((1 == resp->done) && (!resp->sg_io_owned) &&
  1724. ((-1 == pack_id) || (resp->header.pack_id == pack_id))) {
  1725. resp->done = 2; /* guard against other readers */
  1726. break;
  1727. }
  1728. }
  1729. write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1730. return resp;
  1731. }
  1732. /* always adds to end of list */
  1733. static Sg_request *
  1734. sg_add_request(Sg_fd * sfp)
  1735. {
  1736. int k;
  1737. unsigned long iflags;
  1738. Sg_request *resp;
  1739. Sg_request *rp = sfp->req_arr;
  1740. write_lock_irqsave(&sfp->rq_list_lock, iflags);
  1741. resp = sfp->headrp;
  1742. if (!resp) {
  1743. memset(rp, 0, sizeof (Sg_request));
  1744. rp->parentfp = sfp;
  1745. resp = rp;
  1746. sfp->headrp = resp;
  1747. } else {
  1748. if (0 == sfp->cmd_q)
  1749. resp = NULL; /* command queuing disallowed */
  1750. else {
  1751. for (k = 0; k < SG_MAX_QUEUE; ++k, ++rp) {
  1752. if (!rp->parentfp)
  1753. break;
  1754. }
  1755. if (k < SG_MAX_QUEUE) {
  1756. memset(rp, 0, sizeof (Sg_request));
  1757. rp->parentfp = sfp;
  1758. while (resp->nextrp)
  1759. resp = resp->nextrp;
  1760. resp->nextrp = rp;
  1761. resp = rp;
  1762. } else
  1763. resp = NULL;
  1764. }
  1765. }
  1766. if (resp) {
  1767. resp->nextrp = NULL;
  1768. resp->header.duration = jiffies_to_msecs(jiffies);
  1769. }
  1770. write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1771. return resp;
  1772. }
  1773. /* Return of 1 for found; 0 for not found */
  1774. static int
  1775. sg_remove_request(Sg_fd * sfp, Sg_request * srp)
  1776. {
  1777. Sg_request *prev_rp;
  1778. Sg_request *rp;
  1779. unsigned long iflags;
  1780. int res = 0;
  1781. if ((!sfp) || (!srp) || (!sfp->headrp))
  1782. return res;
  1783. write_lock_irqsave(&sfp->rq_list_lock, iflags);
  1784. prev_rp = sfp->headrp;
  1785. if (srp == prev_rp) {
  1786. sfp->headrp = prev_rp->nextrp;
  1787. prev_rp->parentfp = NULL;
  1788. res = 1;
  1789. } else {
  1790. while ((rp = prev_rp->nextrp)) {
  1791. if (srp == rp) {
  1792. prev_rp->nextrp = rp->nextrp;
  1793. rp->parentfp = NULL;
  1794. res = 1;
  1795. break;
  1796. }
  1797. prev_rp = rp;
  1798. }
  1799. }
  1800. write_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1801. return res;
  1802. }
  1803. static Sg_fd *
  1804. sg_add_sfp(Sg_device * sdp, int dev)
  1805. {
  1806. Sg_fd *sfp;
  1807. unsigned long iflags;
  1808. int bufflen;
  1809. sfp = kzalloc(sizeof(*sfp), GFP_ATOMIC | __GFP_NOWARN);
  1810. if (!sfp)
  1811. return NULL;
  1812. init_waitqueue_head(&sfp->read_wait);
  1813. rwlock_init(&sfp->rq_list_lock);
  1814. kref_init(&sfp->f_ref);
  1815. sfp->timeout = SG_DEFAULT_TIMEOUT;
  1816. sfp->timeout_user = SG_DEFAULT_TIMEOUT_USER;
  1817. sfp->force_packid = SG_DEF_FORCE_PACK_ID;
  1818. sfp->low_dma = (SG_DEF_FORCE_LOW_DMA == 0) ?
  1819. sdp->device->host->unchecked_isa_dma : 1;
  1820. sfp->cmd_q = SG_DEF_COMMAND_Q;
  1821. sfp->keep_orphan = SG_DEF_KEEP_ORPHAN;
  1822. sfp->parentdp = sdp;
  1823. write_lock_irqsave(&sg_index_lock, iflags);
  1824. if (!sdp->headfp)
  1825. sdp->headfp = sfp;
  1826. else { /* add to tail of existing list */
  1827. Sg_fd *pfp = sdp->headfp;
  1828. while (pfp->nextfp)
  1829. pfp = pfp->nextfp;
  1830. pfp->nextfp = sfp;
  1831. }
  1832. write_unlock_irqrestore(&sg_index_lock, iflags);
  1833. SCSI_LOG_TIMEOUT(3, printk("sg_add_sfp: sfp=0x%p\n", sfp));
  1834. if (unlikely(sg_big_buff != def_reserved_size))
  1835. sg_big_buff = def_reserved_size;
  1836. bufflen = min_t(int, sg_big_buff,
  1837. sdp->device->request_queue->max_sectors * 512);
  1838. sg_build_reserve(sfp, bufflen);
  1839. SCSI_LOG_TIMEOUT(3, printk("sg_add_sfp: bufflen=%d, k_use_sg=%d\n",
  1840. sfp->reserve.bufflen, sfp->reserve.k_use_sg));
  1841. kref_get(&sdp->d_ref);
  1842. __module_get(THIS_MODULE);
  1843. return sfp;
  1844. }
  1845. static void sg_remove_sfp_usercontext(struct work_struct *work)
  1846. {
  1847. struct sg_fd *sfp = container_of(work, struct sg_fd, ew.work);
  1848. struct sg_device *sdp = sfp->parentdp;
  1849. /* Cleanup any responses which were never read(). */
  1850. while (sfp->headrp)
  1851. sg_finish_rem_req(sfp->headrp);
  1852. if (sfp->reserve.bufflen > 0) {
  1853. SCSI_LOG_TIMEOUT(6,
  1854. printk("sg_remove_sfp: bufflen=%d, k_use_sg=%d\n",
  1855. (int) sfp->reserve.bufflen,
  1856. (int) sfp->reserve.k_use_sg));
  1857. sg_remove_scat(&sfp->reserve);
  1858. }
  1859. SCSI_LOG_TIMEOUT(6,
  1860. printk("sg_remove_sfp: %s, sfp=0x%p\n",
  1861. sdp->disk->disk_name,
  1862. sfp));
  1863. kfree(sfp);
  1864. scsi_device_put(sdp->device);
  1865. sg_put_dev(sdp);
  1866. module_put(THIS_MODULE);
  1867. }
  1868. static void sg_remove_sfp(struct kref *kref)
  1869. {
  1870. struct sg_fd *sfp = container_of(kref, struct sg_fd, f_ref);
  1871. struct sg_device *sdp = sfp->parentdp;
  1872. Sg_fd *fp;
  1873. Sg_fd *prev_fp;
  1874. unsigned long iflags;
  1875. /* CAUTION! Note that sfp can still be found by walking sdp->headfp
  1876. * even though the refcount is now 0. Therefore, unlink sfp from
  1877. * sdp->headfp BEFORE doing any other cleanup.
  1878. */
  1879. write_lock_irqsave(&sg_index_lock, iflags);
  1880. prev_fp = sdp->headfp;
  1881. if (sfp == prev_fp)
  1882. sdp->headfp = prev_fp->nextfp;
  1883. else {
  1884. while ((fp = prev_fp->nextfp)) {
  1885. if (sfp == fp) {
  1886. prev_fp->nextfp = fp->nextfp;
  1887. break;
  1888. }
  1889. prev_fp = fp;
  1890. }
  1891. }
  1892. write_unlock_irqrestore(&sg_index_lock, iflags);
  1893. wake_up_interruptible(&sdp->o_excl_wait);
  1894. execute_in_process_context(sg_remove_sfp_usercontext, &sfp->ew);
  1895. }
  1896. static int
  1897. sg_res_in_use(Sg_fd * sfp)
  1898. {
  1899. const Sg_request *srp;
  1900. unsigned long iflags;
  1901. read_lock_irqsave(&sfp->rq_list_lock, iflags);
  1902. for (srp = sfp->headrp; srp; srp = srp->nextrp)
  1903. if (srp->res_used)
  1904. break;
  1905. read_unlock_irqrestore(&sfp->rq_list_lock, iflags);
  1906. return srp ? 1 : 0;
  1907. }
  1908. #ifdef CONFIG_SCSI_PROC_FS
  1909. static int
  1910. sg_idr_max_id(int id, void *p, void *data)
  1911. {
  1912. int *k = data;
  1913. if (*k < id)
  1914. *k = id;
  1915. return 0;
  1916. }
  1917. static int
  1918. sg_last_dev(void)
  1919. {
  1920. int k = -1;
  1921. unsigned long iflags;
  1922. read_lock_irqsave(&sg_index_lock, iflags);
  1923. idr_for_each(&sg_index_idr, sg_idr_max_id, &k);
  1924. read_unlock_irqrestore(&sg_index_lock, iflags);
  1925. return k + 1; /* origin 1 */
  1926. }
  1927. #endif
  1928. /* must be called with sg_index_lock held */
  1929. static Sg_device *sg_lookup_dev(int dev)
  1930. {
  1931. return idr_find(&sg_index_idr, dev);
  1932. }
  1933. static Sg_device *sg_get_dev(int dev)
  1934. {
  1935. struct sg_device *sdp;
  1936. unsigned long flags;
  1937. read_lock_irqsave(&sg_index_lock, flags);
  1938. sdp = sg_lookup_dev(dev);
  1939. if (!sdp)
  1940. sdp = ERR_PTR(-ENXIO);
  1941. else if (sdp->detached) {
  1942. /* If sdp->detached, then the refcount may already be 0, in
  1943. * which case it would be a bug to do kref_get().
  1944. */
  1945. sdp = ERR_PTR(-ENODEV);
  1946. } else
  1947. kref_get(&sdp->d_ref);
  1948. read_unlock_irqrestore(&sg_index_lock, flags);
  1949. return sdp;
  1950. }
  1951. static void sg_put_dev(struct sg_device *sdp)
  1952. {
  1953. kref_put(&sdp->d_ref, sg_device_destroy);
  1954. }
  1955. #ifdef CONFIG_SCSI_PROC_FS
  1956. static struct proc_dir_entry *sg_proc_sgp = NULL;
  1957. static char sg_proc_sg_dirname[] = "scsi/sg";
  1958. static int sg_proc_seq_show_int(struct seq_file *s, void *v);
  1959. static int sg_proc_single_open_adio(struct inode *inode, struct file *file);
  1960. static ssize_t sg_proc_write_adio(struct file *filp, const char __user *buffer,
  1961. size_t count, loff_t *off);
  1962. static struct file_operations adio_fops = {
  1963. /* .owner, .read and .llseek added in sg_proc_init() */
  1964. .open = sg_proc_single_open_adio,
  1965. .write = sg_proc_write_adio,
  1966. .release = single_release,
  1967. };
  1968. static int sg_proc_single_open_dressz(struct inode *inode, struct file *file);
  1969. static ssize_t sg_proc_write_dressz(struct file *filp,
  1970. const char __user *buffer, size_t count, loff_t *off);
  1971. static struct file_operations dressz_fops = {
  1972. .open = sg_proc_single_open_dressz,
  1973. .write = sg_proc_write_dressz,
  1974. .release = single_release,
  1975. };
  1976. static int sg_proc_seq_show_version(struct seq_file *s, void *v);
  1977. static int sg_proc_single_open_version(struct inode *inode, struct file *file);
  1978. static struct file_operations version_fops = {
  1979. .open = sg_proc_single_open_version,
  1980. .release = single_release,
  1981. };
  1982. static int sg_proc_seq_show_devhdr(struct seq_file *s, void *v);
  1983. static int sg_proc_single_open_devhdr(struct inode *inode, struct file *file);
  1984. static struct file_operations devhdr_fops = {
  1985. .open = sg_proc_single_open_devhdr,
  1986. .release = single_release,
  1987. };
  1988. static int sg_proc_seq_show_dev(struct seq_file *s, void *v);
  1989. static int sg_proc_open_dev(struct inode *inode, struct file *file);
  1990. static void * dev_seq_start(struct seq_file *s, loff_t *pos);
  1991. static void * dev_seq_next(struct seq_file *s, void *v, loff_t *pos);
  1992. static void dev_seq_stop(struct seq_file *s, void *v);
  1993. static struct file_operations dev_fops = {
  1994. .open = sg_proc_open_dev,
  1995. .release = seq_release,
  1996. };
  1997. static struct seq_operations dev_seq_ops = {
  1998. .start = dev_seq_start,
  1999. .next = dev_seq_next,
  2000. .stop = dev_seq_stop,
  2001. .show = sg_proc_seq_show_dev,
  2002. };
  2003. static int sg_proc_seq_show_devstrs(struct seq_file *s, void *v);
  2004. static int sg_proc_open_devstrs(struct inode *inode, struct file *file);
  2005. static struct file_operations devstrs_fops = {
  2006. .open = sg_proc_open_devstrs,
  2007. .release = seq_release,
  2008. };
  2009. static struct seq_operations devstrs_seq_ops = {
  2010. .start = dev_seq_start,
  2011. .next = dev_seq_next,
  2012. .stop = dev_seq_stop,
  2013. .show = sg_proc_seq_show_devstrs,
  2014. };
  2015. static int sg_proc_seq_show_debug(struct seq_file *s, void *v);
  2016. static int sg_proc_open_debug(struct inode *inode, struct file *file);
  2017. static struct file_operations debug_fops = {
  2018. .open = sg_proc_open_debug,
  2019. .release = seq_release,
  2020. };
  2021. static struct seq_operations debug_seq_ops = {
  2022. .start = dev_seq_start,
  2023. .next = dev_seq_next,
  2024. .stop = dev_seq_stop,
  2025. .show = sg_proc_seq_show_debug,
  2026. };
  2027. struct sg_proc_leaf {
  2028. const char * name;
  2029. struct file_operations * fops;
  2030. };
  2031. static struct sg_proc_leaf sg_proc_leaf_arr[] = {
  2032. {"allow_dio", &adio_fops},
  2033. {"debug", &debug_fops},
  2034. {"def_reserved_size", &dressz_fops},
  2035. {"device_hdr", &devhdr_fops},
  2036. {"devices", &dev_fops},
  2037. {"device_strs", &devstrs_fops},
  2038. {"version", &version_fops}
  2039. };
  2040. static int
  2041. sg_proc_init(void)
  2042. {
  2043. int k, mask;
  2044. int num_leaves = ARRAY_SIZE(sg_proc_leaf_arr);
  2045. struct sg_proc_leaf * leaf;
  2046. sg_proc_sgp = proc_mkdir(sg_proc_sg_dirname, NULL);
  2047. if (!sg_proc_sgp)
  2048. return 1;
  2049. for (k = 0; k < num_leaves; ++k) {
  2050. leaf = &sg_proc_leaf_arr[k];
  2051. mask = leaf->fops->write ? S_IRUGO | S_IWUSR : S_IRUGO;
  2052. leaf->fops->owner = THIS_MODULE;
  2053. leaf->fops->read = seq_read;
  2054. leaf->fops->llseek = seq_lseek;
  2055. proc_create(leaf->name, mask, sg_proc_sgp, leaf->fops);
  2056. }
  2057. return 0;
  2058. }
  2059. static void
  2060. sg_proc_cleanup(void)
  2061. {
  2062. int k;
  2063. int num_leaves = ARRAY_SIZE(sg_proc_leaf_arr);
  2064. if (!sg_proc_sgp)
  2065. return;
  2066. for (k = 0; k < num_leaves; ++k)
  2067. remove_proc_entry(sg_proc_leaf_arr[k].name, sg_proc_sgp);
  2068. remove_proc_entry(sg_proc_sg_dirname, NULL);
  2069. }
  2070. static int sg_proc_seq_show_int(struct seq_file *s, void *v)
  2071. {
  2072. seq_printf(s, "%d\n", *((int *)s->private));
  2073. return 0;
  2074. }
  2075. static int sg_proc_single_open_adio(struct inode *inode, struct file *file)
  2076. {
  2077. return single_open(file, sg_proc_seq_show_int, &sg_allow_dio);
  2078. }
  2079. static ssize_t
  2080. sg_proc_write_adio(struct file *filp, const char __user *buffer,
  2081. size_t count, loff_t *off)
  2082. {
  2083. int num;
  2084. char buff[11];
  2085. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2086. return -EACCES;
  2087. num = (count < 10) ? count : 10;
  2088. if (copy_from_user(buff, buffer, num))
  2089. return -EFAULT;
  2090. buff[num] = '\0';
  2091. sg_allow_dio = simple_strtoul(buff, NULL, 10) ? 1 : 0;
  2092. return count;
  2093. }
  2094. static int sg_proc_single_open_dressz(struct inode *inode, struct file *file)
  2095. {
  2096. return single_open(file, sg_proc_seq_show_int, &sg_big_buff);
  2097. }
  2098. static ssize_t
  2099. sg_proc_write_dressz(struct file *filp, const char __user *buffer,
  2100. size_t count, loff_t *off)
  2101. {
  2102. int num;
  2103. unsigned long k = ULONG_MAX;
  2104. char buff[11];
  2105. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  2106. return -EACCES;
  2107. num = (count < 10) ? count : 10;
  2108. if (copy_from_user(buff, buffer, num))
  2109. return -EFAULT;
  2110. buff[num] = '\0';
  2111. k = simple_strtoul(buff, NULL, 10);
  2112. if (k <= 1048576) { /* limit "big buff" to 1 MB */
  2113. sg_big_buff = k;
  2114. return count;
  2115. }
  2116. return -ERANGE;
  2117. }
  2118. static int sg_proc_seq_show_version(struct seq_file *s, void *v)
  2119. {
  2120. seq_printf(s, "%d\t%s [%s]\n", sg_version_num, SG_VERSION_STR,
  2121. sg_version_date);
  2122. return 0;
  2123. }
  2124. static int sg_proc_single_open_version(struct inode *inode, struct file *file)
  2125. {
  2126. return single_open(file, sg_proc_seq_show_version, NULL);
  2127. }
  2128. static int sg_proc_seq_show_devhdr(struct seq_file *s, void *v)
  2129. {
  2130. seq_printf(s, "host\tchan\tid\tlun\ttype\topens\tqdepth\tbusy\t"
  2131. "online\n");
  2132. return 0;
  2133. }
  2134. static int sg_proc_single_open_devhdr(struct inode *inode, struct file *file)
  2135. {
  2136. return single_open(file, sg_proc_seq_show_devhdr, NULL);
  2137. }
  2138. struct sg_proc_deviter {
  2139. loff_t index;
  2140. size_t max;
  2141. };
  2142. static void * dev_seq_start(struct seq_file *s, loff_t *pos)
  2143. {
  2144. struct sg_proc_deviter * it = kmalloc(sizeof(*it), GFP_KERNEL);
  2145. s->private = it;
  2146. if (! it)
  2147. return NULL;
  2148. it->index = *pos;
  2149. it->max = sg_last_dev();
  2150. if (it->index >= it->max)
  2151. return NULL;
  2152. return it;
  2153. }
  2154. static void * dev_seq_next(struct seq_file *s, void *v, loff_t *pos)
  2155. {
  2156. struct sg_proc_deviter * it = s->private;
  2157. *pos = ++it->index;
  2158. return (it->index < it->max) ? it : NULL;
  2159. }
  2160. static void dev_seq_stop(struct seq_file *s, void *v)
  2161. {
  2162. kfree(s->private);
  2163. }
  2164. static int sg_proc_open_dev(struct inode *inode, struct file *file)
  2165. {
  2166. return seq_open(file, &dev_seq_ops);
  2167. }
  2168. static int sg_proc_seq_show_dev(struct seq_file *s, void *v)
  2169. {
  2170. struct sg_proc_deviter * it = (struct sg_proc_deviter *) v;
  2171. Sg_device *sdp;
  2172. struct scsi_device *scsidp;
  2173. unsigned long iflags;
  2174. read_lock_irqsave(&sg_index_lock, iflags);
  2175. sdp = it ? sg_lookup_dev(it->index) : NULL;
  2176. if (sdp && (scsidp = sdp->device) && (!sdp->detached))
  2177. seq_printf(s, "%d\t%d\t%d\t%d\t%d\t%d\t%d\t%d\t%d\n",
  2178. scsidp->host->host_no, scsidp->channel,
  2179. scsidp->id, scsidp->lun, (int) scsidp->type,
  2180. 1,
  2181. (int) scsidp->queue_depth,
  2182. (int) scsidp->device_busy,
  2183. (int) scsi_device_online(scsidp));
  2184. else
  2185. seq_printf(s, "-1\t-1\t-1\t-1\t-1\t-1\t-1\t-1\t-1\n");
  2186. read_unlock_irqrestore(&sg_index_lock, iflags);
  2187. return 0;
  2188. }
  2189. static int sg_proc_open_devstrs(struct inode *inode, struct file *file)
  2190. {
  2191. return seq_open(file, &devstrs_seq_ops);
  2192. }
  2193. static int sg_proc_seq_show_devstrs(struct seq_file *s, void *v)
  2194. {
  2195. struct sg_proc_deviter * it = (struct sg_proc_deviter *) v;
  2196. Sg_device *sdp;
  2197. struct scsi_device *scsidp;
  2198. unsigned long iflags;
  2199. read_lock_irqsave(&sg_index_lock, iflags);
  2200. sdp = it ? sg_lookup_dev(it->index) : NULL;
  2201. if (sdp && (scsidp = sdp->device) && (!sdp->detached))
  2202. seq_printf(s, "%8.8s\t%16.16s\t%4.4s\n",
  2203. scsidp->vendor, scsidp->model, scsidp->rev);
  2204. else
  2205. seq_printf(s, "<no active device>\n");
  2206. read_unlock_irqrestore(&sg_index_lock, iflags);
  2207. return 0;
  2208. }
  2209. /* must be called while holding sg_index_lock */
  2210. static void sg_proc_debug_helper(struct seq_file *s, Sg_device * sdp)
  2211. {
  2212. int k, m, new_interface, blen, usg;
  2213. Sg_request *srp;
  2214. Sg_fd *fp;
  2215. const sg_io_hdr_t *hp;
  2216. const char * cp;
  2217. unsigned int ms;
  2218. for (k = 0, fp = sdp->headfp; fp != NULL; ++k, fp = fp->nextfp) {
  2219. read_lock(&fp->rq_list_lock); /* irqs already disabled */
  2220. seq_printf(s, " FD(%d): timeout=%dms bufflen=%d "
  2221. "(res)sgat=%d low_dma=%d\n", k + 1,
  2222. jiffies_to_msecs(fp->timeout),
  2223. fp->reserve.bufflen,
  2224. (int) fp->reserve.k_use_sg,
  2225. (int) fp->low_dma);
  2226. seq_printf(s, " cmd_q=%d f_packid=%d k_orphan=%d closed=%d\n",
  2227. (int) fp->cmd_q, (int) fp->force_packid,
  2228. (int) fp->keep_orphan, (int) fp->closed);
  2229. for (m = 0, srp = fp->headrp;
  2230. srp != NULL;
  2231. ++m, srp = srp->nextrp) {
  2232. hp = &srp->header;
  2233. new_interface = (hp->interface_id == '\0') ? 0 : 1;
  2234. if (srp->res_used) {
  2235. if (new_interface &&
  2236. (SG_FLAG_MMAP_IO & hp->flags))
  2237. cp = " mmap>> ";
  2238. else
  2239. cp = " rb>> ";
  2240. } else {
  2241. if (SG_INFO_DIRECT_IO_MASK & hp->info)
  2242. cp = " dio>> ";
  2243. else
  2244. cp = " ";
  2245. }
  2246. seq_printf(s, cp);
  2247. blen = srp->data.bufflen;
  2248. usg = srp->data.k_use_sg;
  2249. seq_printf(s, srp->done ?
  2250. ((1 == srp->done) ? "rcv:" : "fin:")
  2251. : "act:");
  2252. seq_printf(s, " id=%d blen=%d",
  2253. srp->header.pack_id, blen);
  2254. if (srp->done)
  2255. seq_printf(s, " dur=%d", hp->duration);
  2256. else {
  2257. ms = jiffies_to_msecs(jiffies);
  2258. seq_printf(s, " t_o/elap=%d/%d",
  2259. (new_interface ? hp->timeout :
  2260. jiffies_to_msecs(fp->timeout)),
  2261. (ms > hp->duration ? ms - hp->duration : 0));
  2262. }
  2263. seq_printf(s, "ms sgat=%d op=0x%02x\n", usg,
  2264. (int) srp->data.cmd_opcode);
  2265. }
  2266. if (0 == m)
  2267. seq_printf(s, " No requests active\n");
  2268. read_unlock(&fp->rq_list_lock);
  2269. }
  2270. }
  2271. static int sg_proc_open_debug(struct inode *inode, struct file *file)
  2272. {
  2273. return seq_open(file, &debug_seq_ops);
  2274. }
  2275. static int sg_proc_seq_show_debug(struct seq_file *s, void *v)
  2276. {
  2277. struct sg_proc_deviter * it = (struct sg_proc_deviter *) v;
  2278. Sg_device *sdp;
  2279. unsigned long iflags;
  2280. if (it && (0 == it->index)) {
  2281. seq_printf(s, "max_active_device=%d(origin 1)\n",
  2282. (int)it->max);
  2283. seq_printf(s, " def_reserved_size=%d\n", sg_big_buff);
  2284. }
  2285. read_lock_irqsave(&sg_index_lock, iflags);
  2286. sdp = it ? sg_lookup_dev(it->index) : NULL;
  2287. if (sdp && sdp->headfp) {
  2288. struct scsi_device *scsidp = sdp->device;
  2289. seq_printf(s, " >>> device=%s ", sdp->disk->disk_name);
  2290. if (sdp->detached)
  2291. seq_printf(s, "detached pending close ");
  2292. else
  2293. seq_printf
  2294. (s, "scsi%d chan=%d id=%d lun=%d em=%d",
  2295. scsidp->host->host_no,
  2296. scsidp->channel, scsidp->id,
  2297. scsidp->lun,
  2298. scsidp->host->hostt->emulated);
  2299. seq_printf(s, " sg_tablesize=%d excl=%d\n",
  2300. sdp->sg_tablesize, sdp->exclude);
  2301. sg_proc_debug_helper(s, sdp);
  2302. }
  2303. read_unlock_irqrestore(&sg_index_lock, iflags);
  2304. return 0;
  2305. }
  2306. #endif /* CONFIG_SCSI_PROC_FS */
  2307. module_init(init_sg);
  2308. module_exit(exit_sg);