scsi_debug.c 90 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030
  1. /*
  2. * vvvvvvvvvvvvvvvvvvvvvvv Original vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
  3. * Copyright (C) 1992 Eric Youngdale
  4. * Simulate a host adapter with 2 disks attached. Do a lot of checking
  5. * to make sure that we are not getting blocks mixed up, and PANIC if
  6. * anything out of the ordinary is seen.
  7. * ^^^^^^^^^^^^^^^^^^^^^^^ Original ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
  8. *
  9. * This version is more generic, simulating a variable number of disk
  10. * (or disk like devices) sharing a common amount of RAM. To be more
  11. * realistic, the simulated devices have the transport attributes of
  12. * SAS disks.
  13. *
  14. *
  15. * For documentation see http://www.torque.net/sg/sdebug26.html
  16. *
  17. * D. Gilbert (dpg) work for Magneto-Optical device test [20010421]
  18. * dpg: work for devfs large number of disks [20010809]
  19. * forked for lk 2.5 series [20011216, 20020101]
  20. * use vmalloc() more inquiry+mode_sense [20020302]
  21. * add timers for delayed responses [20020721]
  22. * Patrick Mansfield <patmans@us.ibm.com> max_luns+scsi_level [20021031]
  23. * Mike Anderson <andmike@us.ibm.com> sysfs work [20021118]
  24. * dpg: change style of boot options to "scsi_debug.num_tgts=2" and
  25. * module options to "modprobe scsi_debug num_tgts=2" [20021221]
  26. */
  27. #include <linux/module.h>
  28. #include <linux/kernel.h>
  29. #include <linux/errno.h>
  30. #include <linux/timer.h>
  31. #include <linux/types.h>
  32. #include <linux/string.h>
  33. #include <linux/genhd.h>
  34. #include <linux/fs.h>
  35. #include <linux/init.h>
  36. #include <linux/proc_fs.h>
  37. #include <linux/vmalloc.h>
  38. #include <linux/moduleparam.h>
  39. #include <linux/scatterlist.h>
  40. #include <linux/blkdev.h>
  41. #include <scsi/scsi.h>
  42. #include <scsi/scsi_cmnd.h>
  43. #include <scsi/scsi_device.h>
  44. #include <scsi/scsi_host.h>
  45. #include <scsi/scsicam.h>
  46. #include <scsi/scsi_eh.h>
  47. #include <linux/stat.h>
  48. #include "scsi_logging.h"
  49. #define SCSI_DEBUG_VERSION "1.81"
  50. static const char * scsi_debug_version_date = "20070104";
  51. /* Additional Sense Code (ASC) */
  52. #define NO_ADDITIONAL_SENSE 0x0
  53. #define LOGICAL_UNIT_NOT_READY 0x4
  54. #define UNRECOVERED_READ_ERR 0x11
  55. #define PARAMETER_LIST_LENGTH_ERR 0x1a
  56. #define INVALID_OPCODE 0x20
  57. #define ADDR_OUT_OF_RANGE 0x21
  58. #define INVALID_FIELD_IN_CDB 0x24
  59. #define INVALID_FIELD_IN_PARAM_LIST 0x26
  60. #define POWERON_RESET 0x29
  61. #define SAVING_PARAMS_UNSUP 0x39
  62. #define TRANSPORT_PROBLEM 0x4b
  63. #define THRESHOLD_EXCEEDED 0x5d
  64. #define LOW_POWER_COND_ON 0x5e
  65. /* Additional Sense Code Qualifier (ASCQ) */
  66. #define ACK_NAK_TO 0x3
  67. #define SDEBUG_TAGGED_QUEUING 0 /* 0 | MSG_SIMPLE_TAG | MSG_ORDERED_TAG */
  68. /* Default values for driver parameters */
  69. #define DEF_NUM_HOST 1
  70. #define DEF_NUM_TGTS 1
  71. #define DEF_MAX_LUNS 1
  72. /* With these defaults, this driver will make 1 host with 1 target
  73. * (id 0) containing 1 logical unit (lun 0). That is 1 device.
  74. */
  75. #define DEF_DELAY 1
  76. #define DEF_DEV_SIZE_MB 8
  77. #define DEF_EVERY_NTH 0
  78. #define DEF_NUM_PARTS 0
  79. #define DEF_OPTS 0
  80. #define DEF_SCSI_LEVEL 5 /* INQUIRY, byte2 [5->SPC-3] */
  81. #define DEF_PTYPE 0
  82. #define DEF_D_SENSE 0
  83. #define DEF_NO_LUN_0 0
  84. #define DEF_VIRTUAL_GB 0
  85. #define DEF_FAKE_RW 0
  86. #define DEF_VPD_USE_HOSTNO 1
  87. /* bit mask values for scsi_debug_opts */
  88. #define SCSI_DEBUG_OPT_NOISE 1
  89. #define SCSI_DEBUG_OPT_MEDIUM_ERR 2
  90. #define SCSI_DEBUG_OPT_TIMEOUT 4
  91. #define SCSI_DEBUG_OPT_RECOVERED_ERR 8
  92. #define SCSI_DEBUG_OPT_TRANSPORT_ERR 16
  93. /* When "every_nth" > 0 then modulo "every_nth" commands:
  94. * - a no response is simulated if SCSI_DEBUG_OPT_TIMEOUT is set
  95. * - a RECOVERED_ERROR is simulated on successful read and write
  96. * commands if SCSI_DEBUG_OPT_RECOVERED_ERR is set.
  97. * - a TRANSPORT_ERROR is simulated on successful read and write
  98. * commands if SCSI_DEBUG_OPT_TRANSPORT_ERR is set.
  99. *
  100. * When "every_nth" < 0 then after "- every_nth" commands:
  101. * - a no response is simulated if SCSI_DEBUG_OPT_TIMEOUT is set
  102. * - a RECOVERED_ERROR is simulated on successful read and write
  103. * commands if SCSI_DEBUG_OPT_RECOVERED_ERR is set.
  104. * - a TRANSPORT_ERROR is simulated on successful read and write
  105. * commands if SCSI_DEBUG_OPT_TRANSPORT_ERR is set.
  106. * This will continue until some other action occurs (e.g. the user
  107. * writing a new value (other than -1 or 1) to every_nth via sysfs).
  108. */
  109. /* when 1==SCSI_DEBUG_OPT_MEDIUM_ERR, a medium error is simulated at this
  110. * sector on read commands: */
  111. #define OPT_MEDIUM_ERR_ADDR 0x1234 /* that's sector 4660 in decimal */
  112. /* If REPORT LUNS has luns >= 256 it can choose "flat space" (value 1)
  113. * or "peripheral device" addressing (value 0) */
  114. #define SAM2_LUN_ADDRESS_METHOD 0
  115. #define SAM2_WLUN_REPORT_LUNS 0xc101
  116. static int scsi_debug_add_host = DEF_NUM_HOST;
  117. static int scsi_debug_delay = DEF_DELAY;
  118. static int scsi_debug_dev_size_mb = DEF_DEV_SIZE_MB;
  119. static int scsi_debug_every_nth = DEF_EVERY_NTH;
  120. static int scsi_debug_max_luns = DEF_MAX_LUNS;
  121. static int scsi_debug_num_parts = DEF_NUM_PARTS;
  122. static int scsi_debug_num_tgts = DEF_NUM_TGTS; /* targets per host */
  123. static int scsi_debug_opts = DEF_OPTS;
  124. static int scsi_debug_scsi_level = DEF_SCSI_LEVEL;
  125. static int scsi_debug_ptype = DEF_PTYPE; /* SCSI peripheral type (0==disk) */
  126. static int scsi_debug_dsense = DEF_D_SENSE;
  127. static int scsi_debug_no_lun_0 = DEF_NO_LUN_0;
  128. static int scsi_debug_virtual_gb = DEF_VIRTUAL_GB;
  129. static int scsi_debug_fake_rw = DEF_FAKE_RW;
  130. static int scsi_debug_vpd_use_hostno = DEF_VPD_USE_HOSTNO;
  131. static int scsi_debug_cmnd_count = 0;
  132. #define DEV_READONLY(TGT) (0)
  133. #define DEV_REMOVEABLE(TGT) (0)
  134. static unsigned int sdebug_store_sectors;
  135. static sector_t sdebug_capacity; /* in sectors */
  136. /* old BIOS stuff, kernel may get rid of them but some mode sense pages
  137. may still need them */
  138. static int sdebug_heads; /* heads per disk */
  139. static int sdebug_cylinders_per; /* cylinders per surface */
  140. static int sdebug_sectors_per; /* sectors per cylinder */
  141. /* default sector size is 512 bytes, 2**9 bytes */
  142. #define POW2_SECT_SIZE 9
  143. #define SECT_SIZE (1 << POW2_SECT_SIZE)
  144. #define SECT_SIZE_PER(TGT) SECT_SIZE
  145. #define SDEBUG_MAX_PARTS 4
  146. #define SDEBUG_SENSE_LEN 32
  147. #define SCSI_DEBUG_CANQUEUE 255
  148. #define SCSI_DEBUG_MAX_CMD_LEN 16
  149. struct sdebug_dev_info {
  150. struct list_head dev_list;
  151. unsigned char sense_buff[SDEBUG_SENSE_LEN]; /* weak nexus */
  152. unsigned int channel;
  153. unsigned int target;
  154. unsigned int lun;
  155. struct sdebug_host_info *sdbg_host;
  156. unsigned int wlun;
  157. char reset;
  158. char stopped;
  159. char used;
  160. };
  161. struct sdebug_host_info {
  162. struct list_head host_list;
  163. struct Scsi_Host *shost;
  164. struct device dev;
  165. struct list_head dev_info_list;
  166. };
  167. #define to_sdebug_host(d) \
  168. container_of(d, struct sdebug_host_info, dev)
  169. static LIST_HEAD(sdebug_host_list);
  170. static DEFINE_SPINLOCK(sdebug_host_list_lock);
  171. typedef void (* done_funct_t) (struct scsi_cmnd *);
  172. struct sdebug_queued_cmd {
  173. int in_use;
  174. struct timer_list cmnd_timer;
  175. done_funct_t done_funct;
  176. struct scsi_cmnd * a_cmnd;
  177. int scsi_result;
  178. };
  179. static struct sdebug_queued_cmd queued_arr[SCSI_DEBUG_CANQUEUE];
  180. static unsigned char * fake_storep; /* ramdisk storage */
  181. static int num_aborts = 0;
  182. static int num_dev_resets = 0;
  183. static int num_bus_resets = 0;
  184. static int num_host_resets = 0;
  185. static DEFINE_SPINLOCK(queued_arr_lock);
  186. static DEFINE_RWLOCK(atomic_rw);
  187. static char sdebug_proc_name[] = "scsi_debug";
  188. static int sdebug_driver_probe(struct device *);
  189. static int sdebug_driver_remove(struct device *);
  190. static struct bus_type pseudo_lld_bus;
  191. static struct device_driver sdebug_driverfs_driver = {
  192. .name = sdebug_proc_name,
  193. .bus = &pseudo_lld_bus,
  194. };
  195. static const int check_condition_result =
  196. (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
  197. static unsigned char ctrl_m_pg[] = {0xa, 10, 2, 0, 0, 0, 0, 0,
  198. 0, 0, 0x2, 0x4b};
  199. static unsigned char iec_m_pg[] = {0x1c, 0xa, 0x08, 0, 0, 0, 0, 0,
  200. 0, 0, 0x0, 0x0};
  201. static struct sdebug_dev_info * devInfoReg(struct scsi_device * sdev);
  202. static void mk_sense_buffer(struct sdebug_dev_info * devip, int key,
  203. int asc, int asq);
  204. static void stop_all_queued(void);
  205. static int stop_queued_cmnd(struct scsi_cmnd * cmnd);
  206. static int sdebug_add_adapter(void);
  207. static void sdebug_remove_adapter(void);
  208. static void sdebug_max_tgts_luns(void);
  209. static struct device pseudo_primary;
  210. static struct bus_type pseudo_lld_bus;
  211. static void get_data_transfer_info(unsigned char *cmd,
  212. unsigned long long *lba, unsigned int *num)
  213. {
  214. switch (*cmd) {
  215. case WRITE_16:
  216. case READ_16:
  217. *lba = (u64)cmd[9] | (u64)cmd[8] << 8 |
  218. (u64)cmd[7] << 16 | (u64)cmd[6] << 24 |
  219. (u64)cmd[5] << 32 | (u64)cmd[4] << 40 |
  220. (u64)cmd[3] << 48 | (u64)cmd[2] << 56;
  221. *num = (u32)cmd[13] | (u32)cmd[12] << 8 | (u32)cmd[11] << 16 |
  222. (u32)cmd[10] << 24;
  223. break;
  224. case WRITE_12:
  225. case READ_12:
  226. *lba = (u32)cmd[5] | (u32)cmd[4] << 8 | (u32)cmd[3] << 16 |
  227. (u32)cmd[2] << 24;
  228. *num = (u32)cmd[9] | (u32)cmd[8] << 8 | (u32)cmd[7] << 16 |
  229. (u32)cmd[6] << 24;
  230. break;
  231. case WRITE_10:
  232. case READ_10:
  233. case XDWRITEREAD_10:
  234. *lba = (u32)cmd[5] | (u32)cmd[4] << 8 | (u32)cmd[3] << 16 |
  235. (u32)cmd[2] << 24;
  236. *num = (u32)cmd[8] | (u32)cmd[7] << 8;
  237. break;
  238. case WRITE_6:
  239. case READ_6:
  240. *lba = (u32)cmd[3] | (u32)cmd[2] << 8 |
  241. (u32)(cmd[1] & 0x1f) << 16;
  242. *num = (0 == cmd[4]) ? 256 : cmd[4];
  243. break;
  244. default:
  245. break;
  246. }
  247. }
  248. static int scsi_debug_ioctl(struct scsi_device *dev, int cmd, void __user *arg)
  249. {
  250. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) {
  251. printk(KERN_INFO "scsi_debug: ioctl: cmd=0x%x\n", cmd);
  252. }
  253. return -EINVAL;
  254. /* return -ENOTTY; // correct return but upsets fdisk */
  255. }
  256. static int check_readiness(struct scsi_cmnd * SCpnt, int reset_only,
  257. struct sdebug_dev_info * devip)
  258. {
  259. if (devip->reset) {
  260. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  261. printk(KERN_INFO "scsi_debug: Reporting Unit "
  262. "attention: power on reset\n");
  263. devip->reset = 0;
  264. mk_sense_buffer(devip, UNIT_ATTENTION, POWERON_RESET, 0);
  265. return check_condition_result;
  266. }
  267. if ((0 == reset_only) && devip->stopped) {
  268. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  269. printk(KERN_INFO "scsi_debug: Reporting Not "
  270. "ready: initializing command required\n");
  271. mk_sense_buffer(devip, NOT_READY, LOGICAL_UNIT_NOT_READY,
  272. 0x2);
  273. return check_condition_result;
  274. }
  275. return 0;
  276. }
  277. /* Returns 0 if ok else (DID_ERROR << 16). Sets scp->resid . */
  278. static int fill_from_dev_buffer(struct scsi_cmnd *scp, unsigned char *arr,
  279. int arr_len)
  280. {
  281. int act_len;
  282. struct scsi_data_buffer *sdb = scsi_in(scp);
  283. if (!sdb->length)
  284. return 0;
  285. if (!(scsi_bidi_cmnd(scp) || scp->sc_data_direction == DMA_FROM_DEVICE))
  286. return (DID_ERROR << 16);
  287. act_len = sg_copy_from_buffer(sdb->table.sgl, sdb->table.nents,
  288. arr, arr_len);
  289. if (sdb->resid)
  290. sdb->resid -= act_len;
  291. else
  292. sdb->resid = scsi_bufflen(scp) - act_len;
  293. return 0;
  294. }
  295. /* Returns number of bytes fetched into 'arr' or -1 if error. */
  296. static int fetch_to_dev_buffer(struct scsi_cmnd *scp, unsigned char *arr,
  297. int arr_len)
  298. {
  299. if (!scsi_bufflen(scp))
  300. return 0;
  301. if (!(scsi_bidi_cmnd(scp) || scp->sc_data_direction == DMA_TO_DEVICE))
  302. return -1;
  303. return scsi_sg_copy_to_buffer(scp, arr, arr_len);
  304. }
  305. static const char * inq_vendor_id = "Linux ";
  306. static const char * inq_product_id = "scsi_debug ";
  307. static const char * inq_product_rev = "0004";
  308. static int inquiry_evpd_83(unsigned char * arr, int port_group_id,
  309. int target_dev_id, int dev_id_num,
  310. const char * dev_id_str,
  311. int dev_id_str_len)
  312. {
  313. int num, port_a;
  314. char b[32];
  315. port_a = target_dev_id + 1;
  316. /* T10 vendor identifier field format (faked) */
  317. arr[0] = 0x2; /* ASCII */
  318. arr[1] = 0x1;
  319. arr[2] = 0x0;
  320. memcpy(&arr[4], inq_vendor_id, 8);
  321. memcpy(&arr[12], inq_product_id, 16);
  322. memcpy(&arr[28], dev_id_str, dev_id_str_len);
  323. num = 8 + 16 + dev_id_str_len;
  324. arr[3] = num;
  325. num += 4;
  326. if (dev_id_num >= 0) {
  327. /* NAA-5, Logical unit identifier (binary) */
  328. arr[num++] = 0x1; /* binary (not necessarily sas) */
  329. arr[num++] = 0x3; /* PIV=0, lu, naa */
  330. arr[num++] = 0x0;
  331. arr[num++] = 0x8;
  332. arr[num++] = 0x53; /* naa-5 ieee company id=0x333333 (fake) */
  333. arr[num++] = 0x33;
  334. arr[num++] = 0x33;
  335. arr[num++] = 0x30;
  336. arr[num++] = (dev_id_num >> 24);
  337. arr[num++] = (dev_id_num >> 16) & 0xff;
  338. arr[num++] = (dev_id_num >> 8) & 0xff;
  339. arr[num++] = dev_id_num & 0xff;
  340. /* Target relative port number */
  341. arr[num++] = 0x61; /* proto=sas, binary */
  342. arr[num++] = 0x94; /* PIV=1, target port, rel port */
  343. arr[num++] = 0x0; /* reserved */
  344. arr[num++] = 0x4; /* length */
  345. arr[num++] = 0x0; /* reserved */
  346. arr[num++] = 0x0; /* reserved */
  347. arr[num++] = 0x0;
  348. arr[num++] = 0x1; /* relative port A */
  349. }
  350. /* NAA-5, Target port identifier */
  351. arr[num++] = 0x61; /* proto=sas, binary */
  352. arr[num++] = 0x93; /* piv=1, target port, naa */
  353. arr[num++] = 0x0;
  354. arr[num++] = 0x8;
  355. arr[num++] = 0x52; /* naa-5, company id=0x222222 (fake) */
  356. arr[num++] = 0x22;
  357. arr[num++] = 0x22;
  358. arr[num++] = 0x20;
  359. arr[num++] = (port_a >> 24);
  360. arr[num++] = (port_a >> 16) & 0xff;
  361. arr[num++] = (port_a >> 8) & 0xff;
  362. arr[num++] = port_a & 0xff;
  363. /* NAA-5, Target port group identifier */
  364. arr[num++] = 0x61; /* proto=sas, binary */
  365. arr[num++] = 0x95; /* piv=1, target port group id */
  366. arr[num++] = 0x0;
  367. arr[num++] = 0x4;
  368. arr[num++] = 0;
  369. arr[num++] = 0;
  370. arr[num++] = (port_group_id >> 8) & 0xff;
  371. arr[num++] = port_group_id & 0xff;
  372. /* NAA-5, Target device identifier */
  373. arr[num++] = 0x61; /* proto=sas, binary */
  374. arr[num++] = 0xa3; /* piv=1, target device, naa */
  375. arr[num++] = 0x0;
  376. arr[num++] = 0x8;
  377. arr[num++] = 0x52; /* naa-5, company id=0x222222 (fake) */
  378. arr[num++] = 0x22;
  379. arr[num++] = 0x22;
  380. arr[num++] = 0x20;
  381. arr[num++] = (target_dev_id >> 24);
  382. arr[num++] = (target_dev_id >> 16) & 0xff;
  383. arr[num++] = (target_dev_id >> 8) & 0xff;
  384. arr[num++] = target_dev_id & 0xff;
  385. /* SCSI name string: Target device identifier */
  386. arr[num++] = 0x63; /* proto=sas, UTF-8 */
  387. arr[num++] = 0xa8; /* piv=1, target device, SCSI name string */
  388. arr[num++] = 0x0;
  389. arr[num++] = 24;
  390. memcpy(arr + num, "naa.52222220", 12);
  391. num += 12;
  392. snprintf(b, sizeof(b), "%08X", target_dev_id);
  393. memcpy(arr + num, b, 8);
  394. num += 8;
  395. memset(arr + num, 0, 4);
  396. num += 4;
  397. return num;
  398. }
  399. static unsigned char vpd84_data[] = {
  400. /* from 4th byte */ 0x22,0x22,0x22,0x0,0xbb,0x0,
  401. 0x22,0x22,0x22,0x0,0xbb,0x1,
  402. 0x22,0x22,0x22,0x0,0xbb,0x2,
  403. };
  404. static int inquiry_evpd_84(unsigned char * arr)
  405. {
  406. memcpy(arr, vpd84_data, sizeof(vpd84_data));
  407. return sizeof(vpd84_data);
  408. }
  409. static int inquiry_evpd_85(unsigned char * arr)
  410. {
  411. int num = 0;
  412. const char * na1 = "https://www.kernel.org/config";
  413. const char * na2 = "http://www.kernel.org/log";
  414. int plen, olen;
  415. arr[num++] = 0x1; /* lu, storage config */
  416. arr[num++] = 0x0; /* reserved */
  417. arr[num++] = 0x0;
  418. olen = strlen(na1);
  419. plen = olen + 1;
  420. if (plen % 4)
  421. plen = ((plen / 4) + 1) * 4;
  422. arr[num++] = plen; /* length, null termianted, padded */
  423. memcpy(arr + num, na1, olen);
  424. memset(arr + num + olen, 0, plen - olen);
  425. num += plen;
  426. arr[num++] = 0x4; /* lu, logging */
  427. arr[num++] = 0x0; /* reserved */
  428. arr[num++] = 0x0;
  429. olen = strlen(na2);
  430. plen = olen + 1;
  431. if (plen % 4)
  432. plen = ((plen / 4) + 1) * 4;
  433. arr[num++] = plen; /* length, null terminated, padded */
  434. memcpy(arr + num, na2, olen);
  435. memset(arr + num + olen, 0, plen - olen);
  436. num += plen;
  437. return num;
  438. }
  439. /* SCSI ports VPD page */
  440. static int inquiry_evpd_88(unsigned char * arr, int target_dev_id)
  441. {
  442. int num = 0;
  443. int port_a, port_b;
  444. port_a = target_dev_id + 1;
  445. port_b = port_a + 1;
  446. arr[num++] = 0x0; /* reserved */
  447. arr[num++] = 0x0; /* reserved */
  448. arr[num++] = 0x0;
  449. arr[num++] = 0x1; /* relative port 1 (primary) */
  450. memset(arr + num, 0, 6);
  451. num += 6;
  452. arr[num++] = 0x0;
  453. arr[num++] = 12; /* length tp descriptor */
  454. /* naa-5 target port identifier (A) */
  455. arr[num++] = 0x61; /* proto=sas, binary */
  456. arr[num++] = 0x93; /* PIV=1, target port, NAA */
  457. arr[num++] = 0x0; /* reserved */
  458. arr[num++] = 0x8; /* length */
  459. arr[num++] = 0x52; /* NAA-5, company_id=0x222222 (fake) */
  460. arr[num++] = 0x22;
  461. arr[num++] = 0x22;
  462. arr[num++] = 0x20;
  463. arr[num++] = (port_a >> 24);
  464. arr[num++] = (port_a >> 16) & 0xff;
  465. arr[num++] = (port_a >> 8) & 0xff;
  466. arr[num++] = port_a & 0xff;
  467. arr[num++] = 0x0; /* reserved */
  468. arr[num++] = 0x0; /* reserved */
  469. arr[num++] = 0x0;
  470. arr[num++] = 0x2; /* relative port 2 (secondary) */
  471. memset(arr + num, 0, 6);
  472. num += 6;
  473. arr[num++] = 0x0;
  474. arr[num++] = 12; /* length tp descriptor */
  475. /* naa-5 target port identifier (B) */
  476. arr[num++] = 0x61; /* proto=sas, binary */
  477. arr[num++] = 0x93; /* PIV=1, target port, NAA */
  478. arr[num++] = 0x0; /* reserved */
  479. arr[num++] = 0x8; /* length */
  480. arr[num++] = 0x52; /* NAA-5, company_id=0x222222 (fake) */
  481. arr[num++] = 0x22;
  482. arr[num++] = 0x22;
  483. arr[num++] = 0x20;
  484. arr[num++] = (port_b >> 24);
  485. arr[num++] = (port_b >> 16) & 0xff;
  486. arr[num++] = (port_b >> 8) & 0xff;
  487. arr[num++] = port_b & 0xff;
  488. return num;
  489. }
  490. static unsigned char vpd89_data[] = {
  491. /* from 4th byte */ 0,0,0,0,
  492. 'l','i','n','u','x',' ',' ',' ',
  493. 'S','A','T',' ','s','c','s','i','_','d','e','b','u','g',' ',' ',
  494. '1','2','3','4',
  495. 0x34,0,0,0,1,0,0,0,0,0,0,0,1,0,0,0,0,0,0,0,
  496. 0xec,0,0,0,
  497. 0x5a,0xc,0xff,0x3f,0x37,0xc8,0x10,0,0,0,0,0,0x3f,0,0,0,
  498. 0,0,0,0,0x58,0x58,0x58,0x58,0x58,0x58,0x58,0x58,0x20,0x20,0x20,0x20,
  499. 0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0,0,0,0x40,0x4,0,0x2e,0x33,
  500. 0x38,0x31,0x20,0x20,0x20,0x20,0x54,0x53,0x38,0x33,0x30,0x30,0x33,0x31,
  501. 0x53,0x41,
  502. 0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,
  503. 0x20,0x20,
  504. 0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,
  505. 0x10,0x80,
  506. 0,0,0,0x2f,0,0,0,0x2,0,0x2,0x7,0,0xff,0xff,0x1,0,
  507. 0x3f,0,0xc1,0xff,0x3e,0,0x10,0x1,0xb0,0xf8,0x50,0x9,0,0,0x7,0,
  508. 0x3,0,0x78,0,0x78,0,0xf0,0,0x78,0,0,0,0,0,0,0,
  509. 0,0,0,0,0,0,0,0,0x2,0,0,0,0,0,0,0,
  510. 0x7e,0,0x1b,0,0x6b,0x34,0x1,0x7d,0x3,0x40,0x69,0x34,0x1,0x3c,0x3,0x40,
  511. 0x7f,0x40,0,0,0,0,0xfe,0xfe,0,0,0,0,0,0xfe,0,0,
  512. 0,0,0,0,0,0,0,0,0xb0,0xf8,0x50,0x9,0,0,0,0,
  513. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  514. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  515. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  516. 0x1,0,0xb0,0xf8,0x50,0x9,0xb0,0xf8,0x50,0x9,0x20,0x20,0x2,0,0xb6,0x42,
  517. 0,0x80,0x8a,0,0x6,0x3c,0xa,0x3c,0xff,0xff,0xc6,0x7,0,0x1,0,0x8,
  518. 0xf0,0xf,0,0x10,0x2,0,0x30,0,0,0,0,0,0,0,0x6,0xfe,
  519. 0,0,0x2,0,0x50,0,0x8a,0,0x4f,0x95,0,0,0x21,0,0xb,0,
  520. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  521. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  522. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  523. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  524. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  525. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  526. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  527. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  528. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  529. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  530. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
  531. 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0xa5,0x51,
  532. };
  533. static int inquiry_evpd_89(unsigned char * arr)
  534. {
  535. memcpy(arr, vpd89_data, sizeof(vpd89_data));
  536. return sizeof(vpd89_data);
  537. }
  538. static unsigned char vpdb0_data[] = {
  539. /* from 4th byte */ 0,0,0,4,
  540. 0,0,0x4,0,
  541. 0,0,0,64,
  542. };
  543. static int inquiry_evpd_b0(unsigned char * arr)
  544. {
  545. memcpy(arr, vpdb0_data, sizeof(vpdb0_data));
  546. if (sdebug_store_sectors > 0x400) {
  547. arr[4] = (sdebug_store_sectors >> 24) & 0xff;
  548. arr[5] = (sdebug_store_sectors >> 16) & 0xff;
  549. arr[6] = (sdebug_store_sectors >> 8) & 0xff;
  550. arr[7] = sdebug_store_sectors & 0xff;
  551. }
  552. return sizeof(vpdb0_data);
  553. }
  554. #define SDEBUG_LONG_INQ_SZ 96
  555. #define SDEBUG_MAX_INQ_ARR_SZ 584
  556. static int resp_inquiry(struct scsi_cmnd * scp, int target,
  557. struct sdebug_dev_info * devip)
  558. {
  559. unsigned char pq_pdt;
  560. unsigned char * arr;
  561. unsigned char *cmd = (unsigned char *)scp->cmnd;
  562. int alloc_len, n, ret;
  563. alloc_len = (cmd[3] << 8) + cmd[4];
  564. arr = kzalloc(SDEBUG_MAX_INQ_ARR_SZ, GFP_ATOMIC);
  565. if (! arr)
  566. return DID_REQUEUE << 16;
  567. if (devip->wlun)
  568. pq_pdt = 0x1e; /* present, wlun */
  569. else if (scsi_debug_no_lun_0 && (0 == devip->lun))
  570. pq_pdt = 0x7f; /* not present, no device type */
  571. else
  572. pq_pdt = (scsi_debug_ptype & 0x1f);
  573. arr[0] = pq_pdt;
  574. if (0x2 & cmd[1]) { /* CMDDT bit set */
  575. mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
  576. 0);
  577. kfree(arr);
  578. return check_condition_result;
  579. } else if (0x1 & cmd[1]) { /* EVPD bit set */
  580. int lu_id_num, port_group_id, target_dev_id, len;
  581. char lu_id_str[6];
  582. int host_no = devip->sdbg_host->shost->host_no;
  583. port_group_id = (((host_no + 1) & 0x7f) << 8) +
  584. (devip->channel & 0x7f);
  585. if (0 == scsi_debug_vpd_use_hostno)
  586. host_no = 0;
  587. lu_id_num = devip->wlun ? -1 : (((host_no + 1) * 2000) +
  588. (devip->target * 1000) + devip->lun);
  589. target_dev_id = ((host_no + 1) * 2000) +
  590. (devip->target * 1000) - 3;
  591. len = scnprintf(lu_id_str, 6, "%d", lu_id_num);
  592. if (0 == cmd[2]) { /* supported vital product data pages */
  593. arr[1] = cmd[2]; /*sanity */
  594. n = 4;
  595. arr[n++] = 0x0; /* this page */
  596. arr[n++] = 0x80; /* unit serial number */
  597. arr[n++] = 0x83; /* device identification */
  598. arr[n++] = 0x84; /* software interface ident. */
  599. arr[n++] = 0x85; /* management network addresses */
  600. arr[n++] = 0x86; /* extended inquiry */
  601. arr[n++] = 0x87; /* mode page policy */
  602. arr[n++] = 0x88; /* SCSI ports */
  603. arr[n++] = 0x89; /* ATA information */
  604. arr[n++] = 0xb0; /* Block limits (SBC) */
  605. arr[3] = n - 4; /* number of supported VPD pages */
  606. } else if (0x80 == cmd[2]) { /* unit serial number */
  607. arr[1] = cmd[2]; /*sanity */
  608. arr[3] = len;
  609. memcpy(&arr[4], lu_id_str, len);
  610. } else if (0x83 == cmd[2]) { /* device identification */
  611. arr[1] = cmd[2]; /*sanity */
  612. arr[3] = inquiry_evpd_83(&arr[4], port_group_id,
  613. target_dev_id, lu_id_num,
  614. lu_id_str, len);
  615. } else if (0x84 == cmd[2]) { /* Software interface ident. */
  616. arr[1] = cmd[2]; /*sanity */
  617. arr[3] = inquiry_evpd_84(&arr[4]);
  618. } else if (0x85 == cmd[2]) { /* Management network addresses */
  619. arr[1] = cmd[2]; /*sanity */
  620. arr[3] = inquiry_evpd_85(&arr[4]);
  621. } else if (0x86 == cmd[2]) { /* extended inquiry */
  622. arr[1] = cmd[2]; /*sanity */
  623. arr[3] = 0x3c; /* number of following entries */
  624. arr[4] = 0x0; /* no protection stuff */
  625. arr[5] = 0x7; /* head of q, ordered + simple q's */
  626. } else if (0x87 == cmd[2]) { /* mode page policy */
  627. arr[1] = cmd[2]; /*sanity */
  628. arr[3] = 0x8; /* number of following entries */
  629. arr[4] = 0x2; /* disconnect-reconnect mp */
  630. arr[6] = 0x80; /* mlus, shared */
  631. arr[8] = 0x18; /* protocol specific lu */
  632. arr[10] = 0x82; /* mlus, per initiator port */
  633. } else if (0x88 == cmd[2]) { /* SCSI Ports */
  634. arr[1] = cmd[2]; /*sanity */
  635. arr[3] = inquiry_evpd_88(&arr[4], target_dev_id);
  636. } else if (0x89 == cmd[2]) { /* ATA information */
  637. arr[1] = cmd[2]; /*sanity */
  638. n = inquiry_evpd_89(&arr[4]);
  639. arr[2] = (n >> 8);
  640. arr[3] = (n & 0xff);
  641. } else if (0xb0 == cmd[2]) { /* Block limits (SBC) */
  642. arr[1] = cmd[2]; /*sanity */
  643. arr[3] = inquiry_evpd_b0(&arr[4]);
  644. } else {
  645. /* Illegal request, invalid field in cdb */
  646. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  647. INVALID_FIELD_IN_CDB, 0);
  648. kfree(arr);
  649. return check_condition_result;
  650. }
  651. len = min(((arr[2] << 8) + arr[3]) + 4, alloc_len);
  652. ret = fill_from_dev_buffer(scp, arr,
  653. min(len, SDEBUG_MAX_INQ_ARR_SZ));
  654. kfree(arr);
  655. return ret;
  656. }
  657. /* drops through here for a standard inquiry */
  658. arr[1] = DEV_REMOVEABLE(target) ? 0x80 : 0; /* Removable disk */
  659. arr[2] = scsi_debug_scsi_level;
  660. arr[3] = 2; /* response_data_format==2 */
  661. arr[4] = SDEBUG_LONG_INQ_SZ - 5;
  662. if (0 == scsi_debug_vpd_use_hostno)
  663. arr[5] = 0x10; /* claim: implicit TGPS */
  664. arr[6] = 0x10; /* claim: MultiP */
  665. /* arr[6] |= 0x40; ... claim: EncServ (enclosure services) */
  666. arr[7] = 0xa; /* claim: LINKED + CMDQUE */
  667. memcpy(&arr[8], inq_vendor_id, 8);
  668. memcpy(&arr[16], inq_product_id, 16);
  669. memcpy(&arr[32], inq_product_rev, 4);
  670. /* version descriptors (2 bytes each) follow */
  671. arr[58] = 0x0; arr[59] = 0x77; /* SAM-3 ANSI */
  672. arr[60] = 0x3; arr[61] = 0x14; /* SPC-3 ANSI */
  673. n = 62;
  674. if (scsi_debug_ptype == 0) {
  675. arr[n++] = 0x3; arr[n++] = 0x3d; /* SBC-2 ANSI */
  676. } else if (scsi_debug_ptype == 1) {
  677. arr[n++] = 0x3; arr[n++] = 0x60; /* SSC-2 no version */
  678. }
  679. arr[n++] = 0xc; arr[n++] = 0xf; /* SAS-1.1 rev 10 */
  680. ret = fill_from_dev_buffer(scp, arr,
  681. min(alloc_len, SDEBUG_LONG_INQ_SZ));
  682. kfree(arr);
  683. return ret;
  684. }
  685. static int resp_requests(struct scsi_cmnd * scp,
  686. struct sdebug_dev_info * devip)
  687. {
  688. unsigned char * sbuff;
  689. unsigned char *cmd = (unsigned char *)scp->cmnd;
  690. unsigned char arr[SDEBUG_SENSE_LEN];
  691. int want_dsense;
  692. int len = 18;
  693. memset(arr, 0, sizeof(arr));
  694. if (devip->reset == 1)
  695. mk_sense_buffer(devip, 0, NO_ADDITIONAL_SENSE, 0);
  696. want_dsense = !!(cmd[1] & 1) || scsi_debug_dsense;
  697. sbuff = devip->sense_buff;
  698. if ((iec_m_pg[2] & 0x4) && (6 == (iec_m_pg[3] & 0xf))) {
  699. if (want_dsense) {
  700. arr[0] = 0x72;
  701. arr[1] = 0x0; /* NO_SENSE in sense_key */
  702. arr[2] = THRESHOLD_EXCEEDED;
  703. arr[3] = 0xff; /* TEST set and MRIE==6 */
  704. } else {
  705. arr[0] = 0x70;
  706. arr[2] = 0x0; /* NO_SENSE in sense_key */
  707. arr[7] = 0xa; /* 18 byte sense buffer */
  708. arr[12] = THRESHOLD_EXCEEDED;
  709. arr[13] = 0xff; /* TEST set and MRIE==6 */
  710. }
  711. } else {
  712. memcpy(arr, sbuff, SDEBUG_SENSE_LEN);
  713. if ((cmd[1] & 1) && (! scsi_debug_dsense)) {
  714. /* DESC bit set and sense_buff in fixed format */
  715. memset(arr, 0, sizeof(arr));
  716. arr[0] = 0x72;
  717. arr[1] = sbuff[2]; /* sense key */
  718. arr[2] = sbuff[12]; /* asc */
  719. arr[3] = sbuff[13]; /* ascq */
  720. len = 8;
  721. }
  722. }
  723. mk_sense_buffer(devip, 0, NO_ADDITIONAL_SENSE, 0);
  724. return fill_from_dev_buffer(scp, arr, len);
  725. }
  726. static int resp_start_stop(struct scsi_cmnd * scp,
  727. struct sdebug_dev_info * devip)
  728. {
  729. unsigned char *cmd = (unsigned char *)scp->cmnd;
  730. int power_cond, errsts, start;
  731. if ((errsts = check_readiness(scp, 1, devip)))
  732. return errsts;
  733. power_cond = (cmd[4] & 0xf0) >> 4;
  734. if (power_cond) {
  735. mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
  736. 0);
  737. return check_condition_result;
  738. }
  739. start = cmd[4] & 1;
  740. if (start == devip->stopped)
  741. devip->stopped = !start;
  742. return 0;
  743. }
  744. static sector_t get_sdebug_capacity(void)
  745. {
  746. if (scsi_debug_virtual_gb > 0)
  747. return 2048 * 1024 * scsi_debug_virtual_gb;
  748. else
  749. return sdebug_store_sectors;
  750. }
  751. #define SDEBUG_READCAP_ARR_SZ 8
  752. static int resp_readcap(struct scsi_cmnd * scp,
  753. struct sdebug_dev_info * devip)
  754. {
  755. unsigned char arr[SDEBUG_READCAP_ARR_SZ];
  756. unsigned int capac;
  757. int errsts;
  758. if ((errsts = check_readiness(scp, 1, devip)))
  759. return errsts;
  760. /* following just in case virtual_gb changed */
  761. sdebug_capacity = get_sdebug_capacity();
  762. memset(arr, 0, SDEBUG_READCAP_ARR_SZ);
  763. if (sdebug_capacity < 0xffffffff) {
  764. capac = (unsigned int)sdebug_capacity - 1;
  765. arr[0] = (capac >> 24);
  766. arr[1] = (capac >> 16) & 0xff;
  767. arr[2] = (capac >> 8) & 0xff;
  768. arr[3] = capac & 0xff;
  769. } else {
  770. arr[0] = 0xff;
  771. arr[1] = 0xff;
  772. arr[2] = 0xff;
  773. arr[3] = 0xff;
  774. }
  775. arr[6] = (SECT_SIZE_PER(target) >> 8) & 0xff;
  776. arr[7] = SECT_SIZE_PER(target) & 0xff;
  777. return fill_from_dev_buffer(scp, arr, SDEBUG_READCAP_ARR_SZ);
  778. }
  779. #define SDEBUG_READCAP16_ARR_SZ 32
  780. static int resp_readcap16(struct scsi_cmnd * scp,
  781. struct sdebug_dev_info * devip)
  782. {
  783. unsigned char *cmd = (unsigned char *)scp->cmnd;
  784. unsigned char arr[SDEBUG_READCAP16_ARR_SZ];
  785. unsigned long long capac;
  786. int errsts, k, alloc_len;
  787. if ((errsts = check_readiness(scp, 1, devip)))
  788. return errsts;
  789. alloc_len = ((cmd[10] << 24) + (cmd[11] << 16) + (cmd[12] << 8)
  790. + cmd[13]);
  791. /* following just in case virtual_gb changed */
  792. sdebug_capacity = get_sdebug_capacity();
  793. memset(arr, 0, SDEBUG_READCAP16_ARR_SZ);
  794. capac = sdebug_capacity - 1;
  795. for (k = 0; k < 8; ++k, capac >>= 8)
  796. arr[7 - k] = capac & 0xff;
  797. arr[8] = (SECT_SIZE_PER(target) >> 24) & 0xff;
  798. arr[9] = (SECT_SIZE_PER(target) >> 16) & 0xff;
  799. arr[10] = (SECT_SIZE_PER(target) >> 8) & 0xff;
  800. arr[11] = SECT_SIZE_PER(target) & 0xff;
  801. return fill_from_dev_buffer(scp, arr,
  802. min(alloc_len, SDEBUG_READCAP16_ARR_SZ));
  803. }
  804. #define SDEBUG_MAX_TGTPGS_ARR_SZ 1412
  805. static int resp_report_tgtpgs(struct scsi_cmnd * scp,
  806. struct sdebug_dev_info * devip)
  807. {
  808. unsigned char *cmd = (unsigned char *)scp->cmnd;
  809. unsigned char * arr;
  810. int host_no = devip->sdbg_host->shost->host_no;
  811. int n, ret, alen, rlen;
  812. int port_group_a, port_group_b, port_a, port_b;
  813. alen = ((cmd[6] << 24) + (cmd[7] << 16) + (cmd[8] << 8)
  814. + cmd[9]);
  815. arr = kzalloc(SDEBUG_MAX_TGTPGS_ARR_SZ, GFP_ATOMIC);
  816. if (! arr)
  817. return DID_REQUEUE << 16;
  818. /*
  819. * EVPD page 0x88 states we have two ports, one
  820. * real and a fake port with no device connected.
  821. * So we create two port groups with one port each
  822. * and set the group with port B to unavailable.
  823. */
  824. port_a = 0x1; /* relative port A */
  825. port_b = 0x2; /* relative port B */
  826. port_group_a = (((host_no + 1) & 0x7f) << 8) +
  827. (devip->channel & 0x7f);
  828. port_group_b = (((host_no + 1) & 0x7f) << 8) +
  829. (devip->channel & 0x7f) + 0x80;
  830. /*
  831. * The asymmetric access state is cycled according to the host_id.
  832. */
  833. n = 4;
  834. if (0 == scsi_debug_vpd_use_hostno) {
  835. arr[n++] = host_no % 3; /* Asymm access state */
  836. arr[n++] = 0x0F; /* claim: all states are supported */
  837. } else {
  838. arr[n++] = 0x0; /* Active/Optimized path */
  839. arr[n++] = 0x01; /* claim: only support active/optimized paths */
  840. }
  841. arr[n++] = (port_group_a >> 8) & 0xff;
  842. arr[n++] = port_group_a & 0xff;
  843. arr[n++] = 0; /* Reserved */
  844. arr[n++] = 0; /* Status code */
  845. arr[n++] = 0; /* Vendor unique */
  846. arr[n++] = 0x1; /* One port per group */
  847. arr[n++] = 0; /* Reserved */
  848. arr[n++] = 0; /* Reserved */
  849. arr[n++] = (port_a >> 8) & 0xff;
  850. arr[n++] = port_a & 0xff;
  851. arr[n++] = 3; /* Port unavailable */
  852. arr[n++] = 0x08; /* claim: only unavailalbe paths are supported */
  853. arr[n++] = (port_group_b >> 8) & 0xff;
  854. arr[n++] = port_group_b & 0xff;
  855. arr[n++] = 0; /* Reserved */
  856. arr[n++] = 0; /* Status code */
  857. arr[n++] = 0; /* Vendor unique */
  858. arr[n++] = 0x1; /* One port per group */
  859. arr[n++] = 0; /* Reserved */
  860. arr[n++] = 0; /* Reserved */
  861. arr[n++] = (port_b >> 8) & 0xff;
  862. arr[n++] = port_b & 0xff;
  863. rlen = n - 4;
  864. arr[0] = (rlen >> 24) & 0xff;
  865. arr[1] = (rlen >> 16) & 0xff;
  866. arr[2] = (rlen >> 8) & 0xff;
  867. arr[3] = rlen & 0xff;
  868. /*
  869. * Return the smallest value of either
  870. * - The allocated length
  871. * - The constructed command length
  872. * - The maximum array size
  873. */
  874. rlen = min(alen,n);
  875. ret = fill_from_dev_buffer(scp, arr,
  876. min(rlen, SDEBUG_MAX_TGTPGS_ARR_SZ));
  877. kfree(arr);
  878. return ret;
  879. }
  880. /* <<Following mode page info copied from ST318451LW>> */
  881. static int resp_err_recov_pg(unsigned char * p, int pcontrol, int target)
  882. { /* Read-Write Error Recovery page for mode_sense */
  883. unsigned char err_recov_pg[] = {0x1, 0xa, 0xc0, 11, 240, 0, 0, 0,
  884. 5, 0, 0xff, 0xff};
  885. memcpy(p, err_recov_pg, sizeof(err_recov_pg));
  886. if (1 == pcontrol)
  887. memset(p + 2, 0, sizeof(err_recov_pg) - 2);
  888. return sizeof(err_recov_pg);
  889. }
  890. static int resp_disconnect_pg(unsigned char * p, int pcontrol, int target)
  891. { /* Disconnect-Reconnect page for mode_sense */
  892. unsigned char disconnect_pg[] = {0x2, 0xe, 128, 128, 0, 10, 0, 0,
  893. 0, 0, 0, 0, 0, 0, 0, 0};
  894. memcpy(p, disconnect_pg, sizeof(disconnect_pg));
  895. if (1 == pcontrol)
  896. memset(p + 2, 0, sizeof(disconnect_pg) - 2);
  897. return sizeof(disconnect_pg);
  898. }
  899. static int resp_format_pg(unsigned char * p, int pcontrol, int target)
  900. { /* Format device page for mode_sense */
  901. unsigned char format_pg[] = {0x3, 0x16, 0, 0, 0, 0, 0, 0,
  902. 0, 0, 0, 0, 0, 0, 0, 0,
  903. 0, 0, 0, 0, 0x40, 0, 0, 0};
  904. memcpy(p, format_pg, sizeof(format_pg));
  905. p[10] = (sdebug_sectors_per >> 8) & 0xff;
  906. p[11] = sdebug_sectors_per & 0xff;
  907. p[12] = (SECT_SIZE >> 8) & 0xff;
  908. p[13] = SECT_SIZE & 0xff;
  909. if (DEV_REMOVEABLE(target))
  910. p[20] |= 0x20; /* should agree with INQUIRY */
  911. if (1 == pcontrol)
  912. memset(p + 2, 0, sizeof(format_pg) - 2);
  913. return sizeof(format_pg);
  914. }
  915. static int resp_caching_pg(unsigned char * p, int pcontrol, int target)
  916. { /* Caching page for mode_sense */
  917. unsigned char caching_pg[] = {0x8, 18, 0x14, 0, 0xff, 0xff, 0, 0,
  918. 0xff, 0xff, 0xff, 0xff, 0x80, 0x14, 0, 0, 0, 0, 0, 0};
  919. memcpy(p, caching_pg, sizeof(caching_pg));
  920. if (1 == pcontrol)
  921. memset(p + 2, 0, sizeof(caching_pg) - 2);
  922. return sizeof(caching_pg);
  923. }
  924. static int resp_ctrl_m_pg(unsigned char * p, int pcontrol, int target)
  925. { /* Control mode page for mode_sense */
  926. unsigned char ch_ctrl_m_pg[] = {/* 0xa, 10, */ 0x6, 0, 0, 0, 0, 0,
  927. 0, 0, 0, 0};
  928. unsigned char d_ctrl_m_pg[] = {0xa, 10, 2, 0, 0, 0, 0, 0,
  929. 0, 0, 0x2, 0x4b};
  930. if (scsi_debug_dsense)
  931. ctrl_m_pg[2] |= 0x4;
  932. else
  933. ctrl_m_pg[2] &= ~0x4;
  934. memcpy(p, ctrl_m_pg, sizeof(ctrl_m_pg));
  935. if (1 == pcontrol)
  936. memcpy(p + 2, ch_ctrl_m_pg, sizeof(ch_ctrl_m_pg));
  937. else if (2 == pcontrol)
  938. memcpy(p, d_ctrl_m_pg, sizeof(d_ctrl_m_pg));
  939. return sizeof(ctrl_m_pg);
  940. }
  941. static int resp_iec_m_pg(unsigned char * p, int pcontrol, int target)
  942. { /* Informational Exceptions control mode page for mode_sense */
  943. unsigned char ch_iec_m_pg[] = {/* 0x1c, 0xa, */ 0x4, 0xf, 0, 0, 0, 0,
  944. 0, 0, 0x0, 0x0};
  945. unsigned char d_iec_m_pg[] = {0x1c, 0xa, 0x08, 0, 0, 0, 0, 0,
  946. 0, 0, 0x0, 0x0};
  947. memcpy(p, iec_m_pg, sizeof(iec_m_pg));
  948. if (1 == pcontrol)
  949. memcpy(p + 2, ch_iec_m_pg, sizeof(ch_iec_m_pg));
  950. else if (2 == pcontrol)
  951. memcpy(p, d_iec_m_pg, sizeof(d_iec_m_pg));
  952. return sizeof(iec_m_pg);
  953. }
  954. static int resp_sas_sf_m_pg(unsigned char * p, int pcontrol, int target)
  955. { /* SAS SSP mode page - short format for mode_sense */
  956. unsigned char sas_sf_m_pg[] = {0x19, 0x6,
  957. 0x6, 0x0, 0x7, 0xd0, 0x0, 0x0};
  958. memcpy(p, sas_sf_m_pg, sizeof(sas_sf_m_pg));
  959. if (1 == pcontrol)
  960. memset(p + 2, 0, sizeof(sas_sf_m_pg) - 2);
  961. return sizeof(sas_sf_m_pg);
  962. }
  963. static int resp_sas_pcd_m_spg(unsigned char * p, int pcontrol, int target,
  964. int target_dev_id)
  965. { /* SAS phy control and discover mode page for mode_sense */
  966. unsigned char sas_pcd_m_pg[] = {0x59, 0x1, 0, 0x64, 0, 0x6, 0, 2,
  967. 0, 0, 0, 0, 0x10, 0x9, 0x8, 0x0,
  968. 0x52, 0x22, 0x22, 0x20, 0x0, 0x0, 0x0, 0x0,
  969. 0x51, 0x11, 0x11, 0x10, 0x0, 0x0, 0x0, 0x1,
  970. 0x2, 0, 0, 0, 0, 0, 0, 0,
  971. 0x88, 0x99, 0, 0, 0, 0, 0, 0,
  972. 0, 0, 0, 0, 0, 0, 0, 0,
  973. 0, 1, 0, 0, 0x10, 0x9, 0x8, 0x0,
  974. 0x52, 0x22, 0x22, 0x20, 0x0, 0x0, 0x0, 0x0,
  975. 0x51, 0x11, 0x11, 0x10, 0x0, 0x0, 0x0, 0x1,
  976. 0x3, 0, 0, 0, 0, 0, 0, 0,
  977. 0x88, 0x99, 0, 0, 0, 0, 0, 0,
  978. 0, 0, 0, 0, 0, 0, 0, 0,
  979. };
  980. int port_a, port_b;
  981. port_a = target_dev_id + 1;
  982. port_b = port_a + 1;
  983. memcpy(p, sas_pcd_m_pg, sizeof(sas_pcd_m_pg));
  984. p[20] = (port_a >> 24);
  985. p[21] = (port_a >> 16) & 0xff;
  986. p[22] = (port_a >> 8) & 0xff;
  987. p[23] = port_a & 0xff;
  988. p[48 + 20] = (port_b >> 24);
  989. p[48 + 21] = (port_b >> 16) & 0xff;
  990. p[48 + 22] = (port_b >> 8) & 0xff;
  991. p[48 + 23] = port_b & 0xff;
  992. if (1 == pcontrol)
  993. memset(p + 4, 0, sizeof(sas_pcd_m_pg) - 4);
  994. return sizeof(sas_pcd_m_pg);
  995. }
  996. static int resp_sas_sha_m_spg(unsigned char * p, int pcontrol)
  997. { /* SAS SSP shared protocol specific port mode subpage */
  998. unsigned char sas_sha_m_pg[] = {0x59, 0x2, 0, 0xc, 0, 0x6, 0x10, 0,
  999. 0, 0, 0, 0, 0, 0, 0, 0,
  1000. };
  1001. memcpy(p, sas_sha_m_pg, sizeof(sas_sha_m_pg));
  1002. if (1 == pcontrol)
  1003. memset(p + 4, 0, sizeof(sas_sha_m_pg) - 4);
  1004. return sizeof(sas_sha_m_pg);
  1005. }
  1006. #define SDEBUG_MAX_MSENSE_SZ 256
  1007. static int resp_mode_sense(struct scsi_cmnd * scp, int target,
  1008. struct sdebug_dev_info * devip)
  1009. {
  1010. unsigned char dbd, llbaa;
  1011. int pcontrol, pcode, subpcode, bd_len;
  1012. unsigned char dev_spec;
  1013. int k, alloc_len, msense_6, offset, len, errsts, target_dev_id;
  1014. unsigned char * ap;
  1015. unsigned char arr[SDEBUG_MAX_MSENSE_SZ];
  1016. unsigned char *cmd = (unsigned char *)scp->cmnd;
  1017. if ((errsts = check_readiness(scp, 1, devip)))
  1018. return errsts;
  1019. dbd = !!(cmd[1] & 0x8);
  1020. pcontrol = (cmd[2] & 0xc0) >> 6;
  1021. pcode = cmd[2] & 0x3f;
  1022. subpcode = cmd[3];
  1023. msense_6 = (MODE_SENSE == cmd[0]);
  1024. llbaa = msense_6 ? 0 : !!(cmd[1] & 0x10);
  1025. if ((0 == scsi_debug_ptype) && (0 == dbd))
  1026. bd_len = llbaa ? 16 : 8;
  1027. else
  1028. bd_len = 0;
  1029. alloc_len = msense_6 ? cmd[4] : ((cmd[7] << 8) | cmd[8]);
  1030. memset(arr, 0, SDEBUG_MAX_MSENSE_SZ);
  1031. if (0x3 == pcontrol) { /* Saving values not supported */
  1032. mk_sense_buffer(devip, ILLEGAL_REQUEST, SAVING_PARAMS_UNSUP,
  1033. 0);
  1034. return check_condition_result;
  1035. }
  1036. target_dev_id = ((devip->sdbg_host->shost->host_no + 1) * 2000) +
  1037. (devip->target * 1000) - 3;
  1038. /* set DPOFUA bit for disks */
  1039. if (0 == scsi_debug_ptype)
  1040. dev_spec = (DEV_READONLY(target) ? 0x80 : 0x0) | 0x10;
  1041. else
  1042. dev_spec = 0x0;
  1043. if (msense_6) {
  1044. arr[2] = dev_spec;
  1045. arr[3] = bd_len;
  1046. offset = 4;
  1047. } else {
  1048. arr[3] = dev_spec;
  1049. if (16 == bd_len)
  1050. arr[4] = 0x1; /* set LONGLBA bit */
  1051. arr[7] = bd_len; /* assume 255 or less */
  1052. offset = 8;
  1053. }
  1054. ap = arr + offset;
  1055. if ((bd_len > 0) && (!sdebug_capacity))
  1056. sdebug_capacity = get_sdebug_capacity();
  1057. if (8 == bd_len) {
  1058. if (sdebug_capacity > 0xfffffffe) {
  1059. ap[0] = 0xff;
  1060. ap[1] = 0xff;
  1061. ap[2] = 0xff;
  1062. ap[3] = 0xff;
  1063. } else {
  1064. ap[0] = (sdebug_capacity >> 24) & 0xff;
  1065. ap[1] = (sdebug_capacity >> 16) & 0xff;
  1066. ap[2] = (sdebug_capacity >> 8) & 0xff;
  1067. ap[3] = sdebug_capacity & 0xff;
  1068. }
  1069. ap[6] = (SECT_SIZE_PER(target) >> 8) & 0xff;
  1070. ap[7] = SECT_SIZE_PER(target) & 0xff;
  1071. offset += bd_len;
  1072. ap = arr + offset;
  1073. } else if (16 == bd_len) {
  1074. unsigned long long capac = sdebug_capacity;
  1075. for (k = 0; k < 8; ++k, capac >>= 8)
  1076. ap[7 - k] = capac & 0xff;
  1077. ap[12] = (SECT_SIZE_PER(target) >> 24) & 0xff;
  1078. ap[13] = (SECT_SIZE_PER(target) >> 16) & 0xff;
  1079. ap[14] = (SECT_SIZE_PER(target) >> 8) & 0xff;
  1080. ap[15] = SECT_SIZE_PER(target) & 0xff;
  1081. offset += bd_len;
  1082. ap = arr + offset;
  1083. }
  1084. if ((subpcode > 0x0) && (subpcode < 0xff) && (0x19 != pcode)) {
  1085. /* TODO: Control Extension page */
  1086. mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
  1087. 0);
  1088. return check_condition_result;
  1089. }
  1090. switch (pcode) {
  1091. case 0x1: /* Read-Write error recovery page, direct access */
  1092. len = resp_err_recov_pg(ap, pcontrol, target);
  1093. offset += len;
  1094. break;
  1095. case 0x2: /* Disconnect-Reconnect page, all devices */
  1096. len = resp_disconnect_pg(ap, pcontrol, target);
  1097. offset += len;
  1098. break;
  1099. case 0x3: /* Format device page, direct access */
  1100. len = resp_format_pg(ap, pcontrol, target);
  1101. offset += len;
  1102. break;
  1103. case 0x8: /* Caching page, direct access */
  1104. len = resp_caching_pg(ap, pcontrol, target);
  1105. offset += len;
  1106. break;
  1107. case 0xa: /* Control Mode page, all devices */
  1108. len = resp_ctrl_m_pg(ap, pcontrol, target);
  1109. offset += len;
  1110. break;
  1111. case 0x19: /* if spc==1 then sas phy, control+discover */
  1112. if ((subpcode > 0x2) && (subpcode < 0xff)) {
  1113. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1114. INVALID_FIELD_IN_CDB, 0);
  1115. return check_condition_result;
  1116. }
  1117. len = 0;
  1118. if ((0x0 == subpcode) || (0xff == subpcode))
  1119. len += resp_sas_sf_m_pg(ap + len, pcontrol, target);
  1120. if ((0x1 == subpcode) || (0xff == subpcode))
  1121. len += resp_sas_pcd_m_spg(ap + len, pcontrol, target,
  1122. target_dev_id);
  1123. if ((0x2 == subpcode) || (0xff == subpcode))
  1124. len += resp_sas_sha_m_spg(ap + len, pcontrol);
  1125. offset += len;
  1126. break;
  1127. case 0x1c: /* Informational Exceptions Mode page, all devices */
  1128. len = resp_iec_m_pg(ap, pcontrol, target);
  1129. offset += len;
  1130. break;
  1131. case 0x3f: /* Read all Mode pages */
  1132. if ((0 == subpcode) || (0xff == subpcode)) {
  1133. len = resp_err_recov_pg(ap, pcontrol, target);
  1134. len += resp_disconnect_pg(ap + len, pcontrol, target);
  1135. len += resp_format_pg(ap + len, pcontrol, target);
  1136. len += resp_caching_pg(ap + len, pcontrol, target);
  1137. len += resp_ctrl_m_pg(ap + len, pcontrol, target);
  1138. len += resp_sas_sf_m_pg(ap + len, pcontrol, target);
  1139. if (0xff == subpcode) {
  1140. len += resp_sas_pcd_m_spg(ap + len, pcontrol,
  1141. target, target_dev_id);
  1142. len += resp_sas_sha_m_spg(ap + len, pcontrol);
  1143. }
  1144. len += resp_iec_m_pg(ap + len, pcontrol, target);
  1145. } else {
  1146. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1147. INVALID_FIELD_IN_CDB, 0);
  1148. return check_condition_result;
  1149. }
  1150. offset += len;
  1151. break;
  1152. default:
  1153. mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
  1154. 0);
  1155. return check_condition_result;
  1156. }
  1157. if (msense_6)
  1158. arr[0] = offset - 1;
  1159. else {
  1160. arr[0] = ((offset - 2) >> 8) & 0xff;
  1161. arr[1] = (offset - 2) & 0xff;
  1162. }
  1163. return fill_from_dev_buffer(scp, arr, min(alloc_len, offset));
  1164. }
  1165. #define SDEBUG_MAX_MSELECT_SZ 512
  1166. static int resp_mode_select(struct scsi_cmnd * scp, int mselect6,
  1167. struct sdebug_dev_info * devip)
  1168. {
  1169. int pf, sp, ps, md_len, bd_len, off, spf, pg_len;
  1170. int param_len, res, errsts, mpage;
  1171. unsigned char arr[SDEBUG_MAX_MSELECT_SZ];
  1172. unsigned char *cmd = (unsigned char *)scp->cmnd;
  1173. if ((errsts = check_readiness(scp, 1, devip)))
  1174. return errsts;
  1175. memset(arr, 0, sizeof(arr));
  1176. pf = cmd[1] & 0x10;
  1177. sp = cmd[1] & 0x1;
  1178. param_len = mselect6 ? cmd[4] : ((cmd[7] << 8) + cmd[8]);
  1179. if ((0 == pf) || sp || (param_len > SDEBUG_MAX_MSELECT_SZ)) {
  1180. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1181. INVALID_FIELD_IN_CDB, 0);
  1182. return check_condition_result;
  1183. }
  1184. res = fetch_to_dev_buffer(scp, arr, param_len);
  1185. if (-1 == res)
  1186. return (DID_ERROR << 16);
  1187. else if ((res < param_len) &&
  1188. (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts))
  1189. printk(KERN_INFO "scsi_debug: mode_select: cdb indicated=%d, "
  1190. " IO sent=%d bytes\n", param_len, res);
  1191. md_len = mselect6 ? (arr[0] + 1) : ((arr[0] << 8) + arr[1] + 2);
  1192. bd_len = mselect6 ? arr[3] : ((arr[6] << 8) + arr[7]);
  1193. if (md_len > 2) {
  1194. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1195. INVALID_FIELD_IN_PARAM_LIST, 0);
  1196. return check_condition_result;
  1197. }
  1198. off = bd_len + (mselect6 ? 4 : 8);
  1199. mpage = arr[off] & 0x3f;
  1200. ps = !!(arr[off] & 0x80);
  1201. if (ps) {
  1202. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1203. INVALID_FIELD_IN_PARAM_LIST, 0);
  1204. return check_condition_result;
  1205. }
  1206. spf = !!(arr[off] & 0x40);
  1207. pg_len = spf ? ((arr[off + 2] << 8) + arr[off + 3] + 4) :
  1208. (arr[off + 1] + 2);
  1209. if ((pg_len + off) > param_len) {
  1210. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1211. PARAMETER_LIST_LENGTH_ERR, 0);
  1212. return check_condition_result;
  1213. }
  1214. switch (mpage) {
  1215. case 0xa: /* Control Mode page */
  1216. if (ctrl_m_pg[1] == arr[off + 1]) {
  1217. memcpy(ctrl_m_pg + 2, arr + off + 2,
  1218. sizeof(ctrl_m_pg) - 2);
  1219. scsi_debug_dsense = !!(ctrl_m_pg[2] & 0x4);
  1220. return 0;
  1221. }
  1222. break;
  1223. case 0x1c: /* Informational Exceptions Mode page */
  1224. if (iec_m_pg[1] == arr[off + 1]) {
  1225. memcpy(iec_m_pg + 2, arr + off + 2,
  1226. sizeof(iec_m_pg) - 2);
  1227. return 0;
  1228. }
  1229. break;
  1230. default:
  1231. break;
  1232. }
  1233. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1234. INVALID_FIELD_IN_PARAM_LIST, 0);
  1235. return check_condition_result;
  1236. }
  1237. static int resp_temp_l_pg(unsigned char * arr)
  1238. {
  1239. unsigned char temp_l_pg[] = {0x0, 0x0, 0x3, 0x2, 0x0, 38,
  1240. 0x0, 0x1, 0x3, 0x2, 0x0, 65,
  1241. };
  1242. memcpy(arr, temp_l_pg, sizeof(temp_l_pg));
  1243. return sizeof(temp_l_pg);
  1244. }
  1245. static int resp_ie_l_pg(unsigned char * arr)
  1246. {
  1247. unsigned char ie_l_pg[] = {0x0, 0x0, 0x3, 0x3, 0x0, 0x0, 38,
  1248. };
  1249. memcpy(arr, ie_l_pg, sizeof(ie_l_pg));
  1250. if (iec_m_pg[2] & 0x4) { /* TEST bit set */
  1251. arr[4] = THRESHOLD_EXCEEDED;
  1252. arr[5] = 0xff;
  1253. }
  1254. return sizeof(ie_l_pg);
  1255. }
  1256. #define SDEBUG_MAX_LSENSE_SZ 512
  1257. static int resp_log_sense(struct scsi_cmnd * scp,
  1258. struct sdebug_dev_info * devip)
  1259. {
  1260. int ppc, sp, pcontrol, pcode, subpcode, alloc_len, errsts, len, n;
  1261. unsigned char arr[SDEBUG_MAX_LSENSE_SZ];
  1262. unsigned char *cmd = (unsigned char *)scp->cmnd;
  1263. if ((errsts = check_readiness(scp, 1, devip)))
  1264. return errsts;
  1265. memset(arr, 0, sizeof(arr));
  1266. ppc = cmd[1] & 0x2;
  1267. sp = cmd[1] & 0x1;
  1268. if (ppc || sp) {
  1269. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1270. INVALID_FIELD_IN_CDB, 0);
  1271. return check_condition_result;
  1272. }
  1273. pcontrol = (cmd[2] & 0xc0) >> 6;
  1274. pcode = cmd[2] & 0x3f;
  1275. subpcode = cmd[3] & 0xff;
  1276. alloc_len = (cmd[7] << 8) + cmd[8];
  1277. arr[0] = pcode;
  1278. if (0 == subpcode) {
  1279. switch (pcode) {
  1280. case 0x0: /* Supported log pages log page */
  1281. n = 4;
  1282. arr[n++] = 0x0; /* this page */
  1283. arr[n++] = 0xd; /* Temperature */
  1284. arr[n++] = 0x2f; /* Informational exceptions */
  1285. arr[3] = n - 4;
  1286. break;
  1287. case 0xd: /* Temperature log page */
  1288. arr[3] = resp_temp_l_pg(arr + 4);
  1289. break;
  1290. case 0x2f: /* Informational exceptions log page */
  1291. arr[3] = resp_ie_l_pg(arr + 4);
  1292. break;
  1293. default:
  1294. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1295. INVALID_FIELD_IN_CDB, 0);
  1296. return check_condition_result;
  1297. }
  1298. } else if (0xff == subpcode) {
  1299. arr[0] |= 0x40;
  1300. arr[1] = subpcode;
  1301. switch (pcode) {
  1302. case 0x0: /* Supported log pages and subpages log page */
  1303. n = 4;
  1304. arr[n++] = 0x0;
  1305. arr[n++] = 0x0; /* 0,0 page */
  1306. arr[n++] = 0x0;
  1307. arr[n++] = 0xff; /* this page */
  1308. arr[n++] = 0xd;
  1309. arr[n++] = 0x0; /* Temperature */
  1310. arr[n++] = 0x2f;
  1311. arr[n++] = 0x0; /* Informational exceptions */
  1312. arr[3] = n - 4;
  1313. break;
  1314. case 0xd: /* Temperature subpages */
  1315. n = 4;
  1316. arr[n++] = 0xd;
  1317. arr[n++] = 0x0; /* Temperature */
  1318. arr[3] = n - 4;
  1319. break;
  1320. case 0x2f: /* Informational exceptions subpages */
  1321. n = 4;
  1322. arr[n++] = 0x2f;
  1323. arr[n++] = 0x0; /* Informational exceptions */
  1324. arr[3] = n - 4;
  1325. break;
  1326. default:
  1327. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1328. INVALID_FIELD_IN_CDB, 0);
  1329. return check_condition_result;
  1330. }
  1331. } else {
  1332. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  1333. INVALID_FIELD_IN_CDB, 0);
  1334. return check_condition_result;
  1335. }
  1336. len = min(((arr[2] << 8) + arr[3]) + 4, alloc_len);
  1337. return fill_from_dev_buffer(scp, arr,
  1338. min(len, SDEBUG_MAX_INQ_ARR_SZ));
  1339. }
  1340. static int check_device_access_params(struct sdebug_dev_info *devi,
  1341. unsigned long long lba, unsigned int num)
  1342. {
  1343. if (lba + num > sdebug_capacity) {
  1344. mk_sense_buffer(devi, ILLEGAL_REQUEST, ADDR_OUT_OF_RANGE, 0);
  1345. return check_condition_result;
  1346. }
  1347. /* transfer length excessive (tie in to block limits VPD page) */
  1348. if (num > sdebug_store_sectors) {
  1349. mk_sense_buffer(devi, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB, 0);
  1350. return check_condition_result;
  1351. }
  1352. return 0;
  1353. }
  1354. static int do_device_access(struct scsi_cmnd *scmd,
  1355. struct sdebug_dev_info *devi,
  1356. unsigned long long lba, unsigned int num, int write)
  1357. {
  1358. int ret;
  1359. unsigned int block, rest = 0;
  1360. int (*func)(struct scsi_cmnd *, unsigned char *, int);
  1361. func = write ? fetch_to_dev_buffer : fill_from_dev_buffer;
  1362. block = do_div(lba, sdebug_store_sectors);
  1363. if (block + num > sdebug_store_sectors)
  1364. rest = block + num - sdebug_store_sectors;
  1365. ret = func(scmd, fake_storep + (block * SECT_SIZE),
  1366. (num - rest) * SECT_SIZE);
  1367. if (!ret && rest)
  1368. ret = func(scmd, fake_storep, rest * SECT_SIZE);
  1369. return ret;
  1370. }
  1371. static int resp_read(struct scsi_cmnd *SCpnt, unsigned long long lba,
  1372. unsigned int num, struct sdebug_dev_info *devip)
  1373. {
  1374. unsigned long iflags;
  1375. int ret;
  1376. ret = check_device_access_params(devip, lba, num);
  1377. if (ret)
  1378. return ret;
  1379. if ((SCSI_DEBUG_OPT_MEDIUM_ERR & scsi_debug_opts) &&
  1380. (lba <= OPT_MEDIUM_ERR_ADDR) &&
  1381. ((lba + num) > OPT_MEDIUM_ERR_ADDR)) {
  1382. /* claim unrecoverable read error */
  1383. mk_sense_buffer(devip, MEDIUM_ERROR, UNRECOVERED_READ_ERR,
  1384. 0);
  1385. /* set info field and valid bit for fixed descriptor */
  1386. if (0x70 == (devip->sense_buff[0] & 0x7f)) {
  1387. devip->sense_buff[0] |= 0x80; /* Valid bit */
  1388. ret = OPT_MEDIUM_ERR_ADDR;
  1389. devip->sense_buff[3] = (ret >> 24) & 0xff;
  1390. devip->sense_buff[4] = (ret >> 16) & 0xff;
  1391. devip->sense_buff[5] = (ret >> 8) & 0xff;
  1392. devip->sense_buff[6] = ret & 0xff;
  1393. }
  1394. return check_condition_result;
  1395. }
  1396. read_lock_irqsave(&atomic_rw, iflags);
  1397. ret = do_device_access(SCpnt, devip, lba, num, 0);
  1398. read_unlock_irqrestore(&atomic_rw, iflags);
  1399. return ret;
  1400. }
  1401. static int resp_write(struct scsi_cmnd *SCpnt, unsigned long long lba,
  1402. unsigned int num, struct sdebug_dev_info *devip)
  1403. {
  1404. unsigned long iflags;
  1405. int ret;
  1406. ret = check_device_access_params(devip, lba, num);
  1407. if (ret)
  1408. return ret;
  1409. write_lock_irqsave(&atomic_rw, iflags);
  1410. ret = do_device_access(SCpnt, devip, lba, num, 1);
  1411. write_unlock_irqrestore(&atomic_rw, iflags);
  1412. if (-1 == ret)
  1413. return (DID_ERROR << 16);
  1414. else if ((ret < (num * SECT_SIZE)) &&
  1415. (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts))
  1416. printk(KERN_INFO "scsi_debug: write: cdb indicated=%u, "
  1417. " IO sent=%d bytes\n", num * SECT_SIZE, ret);
  1418. return 0;
  1419. }
  1420. #define SDEBUG_RLUN_ARR_SZ 256
  1421. static int resp_report_luns(struct scsi_cmnd * scp,
  1422. struct sdebug_dev_info * devip)
  1423. {
  1424. unsigned int alloc_len;
  1425. int lun_cnt, i, upper, num, n, wlun, lun;
  1426. unsigned char *cmd = (unsigned char *)scp->cmnd;
  1427. int select_report = (int)cmd[2];
  1428. struct scsi_lun *one_lun;
  1429. unsigned char arr[SDEBUG_RLUN_ARR_SZ];
  1430. unsigned char * max_addr;
  1431. alloc_len = cmd[9] + (cmd[8] << 8) + (cmd[7] << 16) + (cmd[6] << 24);
  1432. if ((alloc_len < 4) || (select_report > 2)) {
  1433. mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
  1434. 0);
  1435. return check_condition_result;
  1436. }
  1437. /* can produce response with up to 16k luns (lun 0 to lun 16383) */
  1438. memset(arr, 0, SDEBUG_RLUN_ARR_SZ);
  1439. lun_cnt = scsi_debug_max_luns;
  1440. if (1 == select_report)
  1441. lun_cnt = 0;
  1442. else if (scsi_debug_no_lun_0 && (lun_cnt > 0))
  1443. --lun_cnt;
  1444. wlun = (select_report > 0) ? 1 : 0;
  1445. num = lun_cnt + wlun;
  1446. arr[2] = ((sizeof(struct scsi_lun) * num) >> 8) & 0xff;
  1447. arr[3] = (sizeof(struct scsi_lun) * num) & 0xff;
  1448. n = min((int)((SDEBUG_RLUN_ARR_SZ - 8) /
  1449. sizeof(struct scsi_lun)), num);
  1450. if (n < num) {
  1451. wlun = 0;
  1452. lun_cnt = n;
  1453. }
  1454. one_lun = (struct scsi_lun *) &arr[8];
  1455. max_addr = arr + SDEBUG_RLUN_ARR_SZ;
  1456. for (i = 0, lun = (scsi_debug_no_lun_0 ? 1 : 0);
  1457. ((i < lun_cnt) && ((unsigned char *)(one_lun + i) < max_addr));
  1458. i++, lun++) {
  1459. upper = (lun >> 8) & 0x3f;
  1460. if (upper)
  1461. one_lun[i].scsi_lun[0] =
  1462. (upper | (SAM2_LUN_ADDRESS_METHOD << 6));
  1463. one_lun[i].scsi_lun[1] = lun & 0xff;
  1464. }
  1465. if (wlun) {
  1466. one_lun[i].scsi_lun[0] = (SAM2_WLUN_REPORT_LUNS >> 8) & 0xff;
  1467. one_lun[i].scsi_lun[1] = SAM2_WLUN_REPORT_LUNS & 0xff;
  1468. i++;
  1469. }
  1470. alloc_len = (unsigned char *)(one_lun + i) - arr;
  1471. return fill_from_dev_buffer(scp, arr,
  1472. min((int)alloc_len, SDEBUG_RLUN_ARR_SZ));
  1473. }
  1474. static int resp_xdwriteread(struct scsi_cmnd *scp, unsigned long long lba,
  1475. unsigned int num, struct sdebug_dev_info *devip)
  1476. {
  1477. int i, j, ret = -1;
  1478. unsigned char *kaddr, *buf;
  1479. unsigned int offset;
  1480. struct scatterlist *sg;
  1481. struct scsi_data_buffer *sdb = scsi_in(scp);
  1482. /* better not to use temporary buffer. */
  1483. buf = kmalloc(scsi_bufflen(scp), GFP_ATOMIC);
  1484. if (!buf)
  1485. return ret;
  1486. scsi_sg_copy_to_buffer(scp, buf, scsi_bufflen(scp));
  1487. offset = 0;
  1488. for_each_sg(sdb->table.sgl, sg, sdb->table.nents, i) {
  1489. kaddr = (unsigned char *)kmap_atomic(sg_page(sg), KM_USER0);
  1490. if (!kaddr)
  1491. goto out;
  1492. for (j = 0; j < sg->length; j++)
  1493. *(kaddr + sg->offset + j) ^= *(buf + offset + j);
  1494. offset += sg->length;
  1495. kunmap_atomic(kaddr, KM_USER0);
  1496. }
  1497. ret = 0;
  1498. out:
  1499. kfree(buf);
  1500. return ret;
  1501. }
  1502. /* When timer goes off this function is called. */
  1503. static void timer_intr_handler(unsigned long indx)
  1504. {
  1505. struct sdebug_queued_cmd * sqcp;
  1506. unsigned long iflags;
  1507. if (indx >= SCSI_DEBUG_CANQUEUE) {
  1508. printk(KERN_ERR "scsi_debug:timer_intr_handler: indx too "
  1509. "large\n");
  1510. return;
  1511. }
  1512. spin_lock_irqsave(&queued_arr_lock, iflags);
  1513. sqcp = &queued_arr[(int)indx];
  1514. if (! sqcp->in_use) {
  1515. printk(KERN_ERR "scsi_debug:timer_intr_handler: Unexpected "
  1516. "interrupt\n");
  1517. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1518. return;
  1519. }
  1520. sqcp->in_use = 0;
  1521. if (sqcp->done_funct) {
  1522. sqcp->a_cmnd->result = sqcp->scsi_result;
  1523. sqcp->done_funct(sqcp->a_cmnd); /* callback to mid level */
  1524. }
  1525. sqcp->done_funct = NULL;
  1526. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1527. }
  1528. static int scsi_debug_slave_alloc(struct scsi_device * sdp)
  1529. {
  1530. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1531. printk(KERN_INFO "scsi_debug: slave_alloc <%u %u %u %u>\n",
  1532. sdp->host->host_no, sdp->channel, sdp->id, sdp->lun);
  1533. set_bit(QUEUE_FLAG_BIDI, &sdp->request_queue->queue_flags);
  1534. return 0;
  1535. }
  1536. static int scsi_debug_slave_configure(struct scsi_device * sdp)
  1537. {
  1538. struct sdebug_dev_info * devip;
  1539. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1540. printk(KERN_INFO "scsi_debug: slave_configure <%u %u %u %u>\n",
  1541. sdp->host->host_no, sdp->channel, sdp->id, sdp->lun);
  1542. if (sdp->host->max_cmd_len != SCSI_DEBUG_MAX_CMD_LEN)
  1543. sdp->host->max_cmd_len = SCSI_DEBUG_MAX_CMD_LEN;
  1544. devip = devInfoReg(sdp);
  1545. if (NULL == devip)
  1546. return 1; /* no resources, will be marked offline */
  1547. sdp->hostdata = devip;
  1548. if (sdp->host->cmd_per_lun)
  1549. scsi_adjust_queue_depth(sdp, SDEBUG_TAGGED_QUEUING,
  1550. sdp->host->cmd_per_lun);
  1551. blk_queue_max_segment_size(sdp->request_queue, 256 * 1024);
  1552. return 0;
  1553. }
  1554. static void scsi_debug_slave_destroy(struct scsi_device * sdp)
  1555. {
  1556. struct sdebug_dev_info * devip =
  1557. (struct sdebug_dev_info *)sdp->hostdata;
  1558. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1559. printk(KERN_INFO "scsi_debug: slave_destroy <%u %u %u %u>\n",
  1560. sdp->host->host_no, sdp->channel, sdp->id, sdp->lun);
  1561. if (devip) {
  1562. /* make this slot avaliable for re-use */
  1563. devip->used = 0;
  1564. sdp->hostdata = NULL;
  1565. }
  1566. }
  1567. struct sdebug_dev_info *sdebug_device_create(struct sdebug_host_info *sdbg_host,
  1568. gfp_t flags)
  1569. {
  1570. struct sdebug_dev_info *devip;
  1571. devip = kzalloc(sizeof(*devip), flags);
  1572. if (devip) {
  1573. devip->sdbg_host = sdbg_host;
  1574. list_add_tail(&devip->dev_list, &sdbg_host->dev_info_list);
  1575. }
  1576. return devip;
  1577. }
  1578. static struct sdebug_dev_info * devInfoReg(struct scsi_device * sdev)
  1579. {
  1580. struct sdebug_host_info * sdbg_host;
  1581. struct sdebug_dev_info * open_devip = NULL;
  1582. struct sdebug_dev_info * devip =
  1583. (struct sdebug_dev_info *)sdev->hostdata;
  1584. if (devip)
  1585. return devip;
  1586. sdbg_host = *(struct sdebug_host_info **)shost_priv(sdev->host);
  1587. if (!sdbg_host) {
  1588. printk(KERN_ERR "Host info NULL\n");
  1589. return NULL;
  1590. }
  1591. list_for_each_entry(devip, &sdbg_host->dev_info_list, dev_list) {
  1592. if ((devip->used) && (devip->channel == sdev->channel) &&
  1593. (devip->target == sdev->id) &&
  1594. (devip->lun == sdev->lun))
  1595. return devip;
  1596. else {
  1597. if ((!devip->used) && (!open_devip))
  1598. open_devip = devip;
  1599. }
  1600. }
  1601. if (!open_devip) { /* try and make a new one */
  1602. open_devip = sdebug_device_create(sdbg_host, GFP_ATOMIC);
  1603. if (!open_devip) {
  1604. printk(KERN_ERR "%s: out of memory at line %d\n",
  1605. __FUNCTION__, __LINE__);
  1606. return NULL;
  1607. }
  1608. }
  1609. open_devip->channel = sdev->channel;
  1610. open_devip->target = sdev->id;
  1611. open_devip->lun = sdev->lun;
  1612. open_devip->sdbg_host = sdbg_host;
  1613. open_devip->reset = 1;
  1614. open_devip->used = 1;
  1615. memset(open_devip->sense_buff, 0, SDEBUG_SENSE_LEN);
  1616. if (scsi_debug_dsense)
  1617. open_devip->sense_buff[0] = 0x72;
  1618. else {
  1619. open_devip->sense_buff[0] = 0x70;
  1620. open_devip->sense_buff[7] = 0xa;
  1621. }
  1622. if (sdev->lun == SAM2_WLUN_REPORT_LUNS)
  1623. open_devip->wlun = SAM2_WLUN_REPORT_LUNS & 0xff;
  1624. return open_devip;
  1625. }
  1626. static void mk_sense_buffer(struct sdebug_dev_info * devip, int key,
  1627. int asc, int asq)
  1628. {
  1629. unsigned char *sbuff;
  1630. sbuff = devip->sense_buff;
  1631. memset(sbuff, 0, SDEBUG_SENSE_LEN);
  1632. scsi_build_sense_buffer(scsi_debug_dsense, sbuff, key, asc, asq);
  1633. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1634. printk(KERN_INFO "scsi_debug: [sense_key,asc,ascq]: "
  1635. "[0x%x,0x%x,0x%x]\n", key, asc, asq);
  1636. }
  1637. static int scsi_debug_abort(struct scsi_cmnd * SCpnt)
  1638. {
  1639. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1640. printk(KERN_INFO "scsi_debug: abort\n");
  1641. ++num_aborts;
  1642. stop_queued_cmnd(SCpnt);
  1643. return SUCCESS;
  1644. }
  1645. static int scsi_debug_biosparam(struct scsi_device *sdev,
  1646. struct block_device * bdev, sector_t capacity, int *info)
  1647. {
  1648. int res;
  1649. unsigned char *buf;
  1650. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1651. printk(KERN_INFO "scsi_debug: biosparam\n");
  1652. buf = scsi_bios_ptable(bdev);
  1653. if (buf) {
  1654. res = scsi_partsize(buf, capacity,
  1655. &info[2], &info[0], &info[1]);
  1656. kfree(buf);
  1657. if (! res)
  1658. return res;
  1659. }
  1660. info[0] = sdebug_heads;
  1661. info[1] = sdebug_sectors_per;
  1662. info[2] = sdebug_cylinders_per;
  1663. return 0;
  1664. }
  1665. static int scsi_debug_device_reset(struct scsi_cmnd * SCpnt)
  1666. {
  1667. struct sdebug_dev_info * devip;
  1668. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1669. printk(KERN_INFO "scsi_debug: device_reset\n");
  1670. ++num_dev_resets;
  1671. if (SCpnt) {
  1672. devip = devInfoReg(SCpnt->device);
  1673. if (devip)
  1674. devip->reset = 1;
  1675. }
  1676. return SUCCESS;
  1677. }
  1678. static int scsi_debug_bus_reset(struct scsi_cmnd * SCpnt)
  1679. {
  1680. struct sdebug_host_info *sdbg_host;
  1681. struct sdebug_dev_info * dev_info;
  1682. struct scsi_device * sdp;
  1683. struct Scsi_Host * hp;
  1684. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1685. printk(KERN_INFO "scsi_debug: bus_reset\n");
  1686. ++num_bus_resets;
  1687. if (SCpnt && ((sdp = SCpnt->device)) && ((hp = sdp->host))) {
  1688. sdbg_host = *(struct sdebug_host_info **)shost_priv(hp);
  1689. if (sdbg_host) {
  1690. list_for_each_entry(dev_info,
  1691. &sdbg_host->dev_info_list,
  1692. dev_list)
  1693. dev_info->reset = 1;
  1694. }
  1695. }
  1696. return SUCCESS;
  1697. }
  1698. static int scsi_debug_host_reset(struct scsi_cmnd * SCpnt)
  1699. {
  1700. struct sdebug_host_info * sdbg_host;
  1701. struct sdebug_dev_info * dev_info;
  1702. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  1703. printk(KERN_INFO "scsi_debug: host_reset\n");
  1704. ++num_host_resets;
  1705. spin_lock(&sdebug_host_list_lock);
  1706. list_for_each_entry(sdbg_host, &sdebug_host_list, host_list) {
  1707. list_for_each_entry(dev_info, &sdbg_host->dev_info_list,
  1708. dev_list)
  1709. dev_info->reset = 1;
  1710. }
  1711. spin_unlock(&sdebug_host_list_lock);
  1712. stop_all_queued();
  1713. return SUCCESS;
  1714. }
  1715. /* Returns 1 if found 'cmnd' and deleted its timer. else returns 0 */
  1716. static int stop_queued_cmnd(struct scsi_cmnd * cmnd)
  1717. {
  1718. unsigned long iflags;
  1719. int k;
  1720. struct sdebug_queued_cmd * sqcp;
  1721. spin_lock_irqsave(&queued_arr_lock, iflags);
  1722. for (k = 0; k < SCSI_DEBUG_CANQUEUE; ++k) {
  1723. sqcp = &queued_arr[k];
  1724. if (sqcp->in_use && (cmnd == sqcp->a_cmnd)) {
  1725. del_timer_sync(&sqcp->cmnd_timer);
  1726. sqcp->in_use = 0;
  1727. sqcp->a_cmnd = NULL;
  1728. break;
  1729. }
  1730. }
  1731. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1732. return (k < SCSI_DEBUG_CANQUEUE) ? 1 : 0;
  1733. }
  1734. /* Deletes (stops) timers of all queued commands */
  1735. static void stop_all_queued(void)
  1736. {
  1737. unsigned long iflags;
  1738. int k;
  1739. struct sdebug_queued_cmd * sqcp;
  1740. spin_lock_irqsave(&queued_arr_lock, iflags);
  1741. for (k = 0; k < SCSI_DEBUG_CANQUEUE; ++k) {
  1742. sqcp = &queued_arr[k];
  1743. if (sqcp->in_use && sqcp->a_cmnd) {
  1744. del_timer_sync(&sqcp->cmnd_timer);
  1745. sqcp->in_use = 0;
  1746. sqcp->a_cmnd = NULL;
  1747. }
  1748. }
  1749. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1750. }
  1751. /* Initializes timers in queued array */
  1752. static void __init init_all_queued(void)
  1753. {
  1754. unsigned long iflags;
  1755. int k;
  1756. struct sdebug_queued_cmd * sqcp;
  1757. spin_lock_irqsave(&queued_arr_lock, iflags);
  1758. for (k = 0; k < SCSI_DEBUG_CANQUEUE; ++k) {
  1759. sqcp = &queued_arr[k];
  1760. init_timer(&sqcp->cmnd_timer);
  1761. sqcp->in_use = 0;
  1762. sqcp->a_cmnd = NULL;
  1763. }
  1764. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1765. }
  1766. static void __init sdebug_build_parts(unsigned char *ramp,
  1767. unsigned long store_size)
  1768. {
  1769. struct partition * pp;
  1770. int starts[SDEBUG_MAX_PARTS + 2];
  1771. int sectors_per_part, num_sectors, k;
  1772. int heads_by_sects, start_sec, end_sec;
  1773. /* assume partition table already zeroed */
  1774. if ((scsi_debug_num_parts < 1) || (store_size < 1048576))
  1775. return;
  1776. if (scsi_debug_num_parts > SDEBUG_MAX_PARTS) {
  1777. scsi_debug_num_parts = SDEBUG_MAX_PARTS;
  1778. printk(KERN_WARNING "scsi_debug:build_parts: reducing "
  1779. "partitions to %d\n", SDEBUG_MAX_PARTS);
  1780. }
  1781. num_sectors = (int)sdebug_store_sectors;
  1782. sectors_per_part = (num_sectors - sdebug_sectors_per)
  1783. / scsi_debug_num_parts;
  1784. heads_by_sects = sdebug_heads * sdebug_sectors_per;
  1785. starts[0] = sdebug_sectors_per;
  1786. for (k = 1; k < scsi_debug_num_parts; ++k)
  1787. starts[k] = ((k * sectors_per_part) / heads_by_sects)
  1788. * heads_by_sects;
  1789. starts[scsi_debug_num_parts] = num_sectors;
  1790. starts[scsi_debug_num_parts + 1] = 0;
  1791. ramp[510] = 0x55; /* magic partition markings */
  1792. ramp[511] = 0xAA;
  1793. pp = (struct partition *)(ramp + 0x1be);
  1794. for (k = 0; starts[k + 1]; ++k, ++pp) {
  1795. start_sec = starts[k];
  1796. end_sec = starts[k + 1] - 1;
  1797. pp->boot_ind = 0;
  1798. pp->cyl = start_sec / heads_by_sects;
  1799. pp->head = (start_sec - (pp->cyl * heads_by_sects))
  1800. / sdebug_sectors_per;
  1801. pp->sector = (start_sec % sdebug_sectors_per) + 1;
  1802. pp->end_cyl = end_sec / heads_by_sects;
  1803. pp->end_head = (end_sec - (pp->end_cyl * heads_by_sects))
  1804. / sdebug_sectors_per;
  1805. pp->end_sector = (end_sec % sdebug_sectors_per) + 1;
  1806. pp->start_sect = start_sec;
  1807. pp->nr_sects = end_sec - start_sec + 1;
  1808. pp->sys_ind = 0x83; /* plain Linux partition */
  1809. }
  1810. }
  1811. static int schedule_resp(struct scsi_cmnd * cmnd,
  1812. struct sdebug_dev_info * devip,
  1813. done_funct_t done, int scsi_result, int delta_jiff)
  1814. {
  1815. if ((SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) && cmnd) {
  1816. if (scsi_result) {
  1817. struct scsi_device * sdp = cmnd->device;
  1818. printk(KERN_INFO "scsi_debug: <%u %u %u %u> "
  1819. "non-zero result=0x%x\n", sdp->host->host_no,
  1820. sdp->channel, sdp->id, sdp->lun, scsi_result);
  1821. }
  1822. }
  1823. if (cmnd && devip) {
  1824. /* simulate autosense by this driver */
  1825. if (SAM_STAT_CHECK_CONDITION == (scsi_result & 0xff))
  1826. memcpy(cmnd->sense_buffer, devip->sense_buff,
  1827. (SCSI_SENSE_BUFFERSIZE > SDEBUG_SENSE_LEN) ?
  1828. SDEBUG_SENSE_LEN : SCSI_SENSE_BUFFERSIZE);
  1829. }
  1830. if (delta_jiff <= 0) {
  1831. if (cmnd)
  1832. cmnd->result = scsi_result;
  1833. if (done)
  1834. done(cmnd);
  1835. return 0;
  1836. } else {
  1837. unsigned long iflags;
  1838. int k;
  1839. struct sdebug_queued_cmd * sqcp = NULL;
  1840. spin_lock_irqsave(&queued_arr_lock, iflags);
  1841. for (k = 0; k < SCSI_DEBUG_CANQUEUE; ++k) {
  1842. sqcp = &queued_arr[k];
  1843. if (! sqcp->in_use)
  1844. break;
  1845. }
  1846. if (k >= SCSI_DEBUG_CANQUEUE) {
  1847. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1848. printk(KERN_WARNING "scsi_debug: can_queue exceeded\n");
  1849. return 1; /* report busy to mid level */
  1850. }
  1851. sqcp->in_use = 1;
  1852. sqcp->a_cmnd = cmnd;
  1853. sqcp->scsi_result = scsi_result;
  1854. sqcp->done_funct = done;
  1855. sqcp->cmnd_timer.function = timer_intr_handler;
  1856. sqcp->cmnd_timer.data = k;
  1857. sqcp->cmnd_timer.expires = jiffies + delta_jiff;
  1858. add_timer(&sqcp->cmnd_timer);
  1859. spin_unlock_irqrestore(&queued_arr_lock, iflags);
  1860. if (cmnd)
  1861. cmnd->result = 0;
  1862. return 0;
  1863. }
  1864. }
  1865. /* Note: The following macros create attribute files in the
  1866. /sys/module/scsi_debug/parameters directory. Unfortunately this
  1867. driver is unaware of a change and cannot trigger auxiliary actions
  1868. as it can when the corresponding attribute in the
  1869. /sys/bus/pseudo/drivers/scsi_debug directory is changed.
  1870. */
  1871. module_param_named(add_host, scsi_debug_add_host, int, S_IRUGO | S_IWUSR);
  1872. module_param_named(delay, scsi_debug_delay, int, S_IRUGO | S_IWUSR);
  1873. module_param_named(dev_size_mb, scsi_debug_dev_size_mb, int, S_IRUGO);
  1874. module_param_named(dsense, scsi_debug_dsense, int, S_IRUGO | S_IWUSR);
  1875. module_param_named(every_nth, scsi_debug_every_nth, int, S_IRUGO | S_IWUSR);
  1876. module_param_named(fake_rw, scsi_debug_fake_rw, int, S_IRUGO | S_IWUSR);
  1877. module_param_named(max_luns, scsi_debug_max_luns, int, S_IRUGO | S_IWUSR);
  1878. module_param_named(no_lun_0, scsi_debug_no_lun_0, int, S_IRUGO | S_IWUSR);
  1879. module_param_named(num_parts, scsi_debug_num_parts, int, S_IRUGO);
  1880. module_param_named(num_tgts, scsi_debug_num_tgts, int, S_IRUGO | S_IWUSR);
  1881. module_param_named(opts, scsi_debug_opts, int, S_IRUGO | S_IWUSR);
  1882. module_param_named(ptype, scsi_debug_ptype, int, S_IRUGO | S_IWUSR);
  1883. module_param_named(scsi_level, scsi_debug_scsi_level, int, S_IRUGO);
  1884. module_param_named(virtual_gb, scsi_debug_virtual_gb, int, S_IRUGO | S_IWUSR);
  1885. module_param_named(vpd_use_hostno, scsi_debug_vpd_use_hostno, int,
  1886. S_IRUGO | S_IWUSR);
  1887. MODULE_AUTHOR("Eric Youngdale + Douglas Gilbert");
  1888. MODULE_DESCRIPTION("SCSI debug adapter driver");
  1889. MODULE_LICENSE("GPL");
  1890. MODULE_VERSION(SCSI_DEBUG_VERSION);
  1891. MODULE_PARM_DESC(add_host, "0..127 hosts allowed(def=1)");
  1892. MODULE_PARM_DESC(delay, "# of jiffies to delay response(def=1)");
  1893. MODULE_PARM_DESC(dev_size_mb, "size in MB of ram shared by devs(def=8)");
  1894. MODULE_PARM_DESC(dsense, "use descriptor sense format(def=0 -> fixed)");
  1895. MODULE_PARM_DESC(every_nth, "timeout every nth command(def=0)");
  1896. MODULE_PARM_DESC(fake_rw, "fake reads/writes instead of copying (def=0)");
  1897. MODULE_PARM_DESC(max_luns, "number of LUNs per target to simulate(def=1)");
  1898. MODULE_PARM_DESC(no_lun_0, "no LU number 0 (def=0 -> have lun 0)");
  1899. MODULE_PARM_DESC(num_parts, "number of partitions(def=0)");
  1900. MODULE_PARM_DESC(num_tgts, "number of targets per host to simulate(def=1)");
  1901. MODULE_PARM_DESC(opts, "1->noise, 2->medium_err, 4->timeout, 8->recovered_err... (def=0)");
  1902. MODULE_PARM_DESC(ptype, "SCSI peripheral type(def=0[disk])");
  1903. MODULE_PARM_DESC(scsi_level, "SCSI level to simulate(def=5[SPC-3])");
  1904. MODULE_PARM_DESC(virtual_gb, "virtual gigabyte size (def=0 -> use dev_size_mb)");
  1905. MODULE_PARM_DESC(vpd_use_hostno, "0 -> dev ids ignore hostno (def=1 -> unique dev ids)");
  1906. static char sdebug_info[256];
  1907. static const char * scsi_debug_info(struct Scsi_Host * shp)
  1908. {
  1909. sprintf(sdebug_info, "scsi_debug, version %s [%s], "
  1910. "dev_size_mb=%d, opts=0x%x", SCSI_DEBUG_VERSION,
  1911. scsi_debug_version_date, scsi_debug_dev_size_mb,
  1912. scsi_debug_opts);
  1913. return sdebug_info;
  1914. }
  1915. /* scsi_debug_proc_info
  1916. * Used if the driver currently has no own support for /proc/scsi
  1917. */
  1918. static int scsi_debug_proc_info(struct Scsi_Host *host, char *buffer, char **start, off_t offset,
  1919. int length, int inout)
  1920. {
  1921. int len, pos, begin;
  1922. int orig_length;
  1923. orig_length = length;
  1924. if (inout == 1) {
  1925. char arr[16];
  1926. int minLen = length > 15 ? 15 : length;
  1927. if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
  1928. return -EACCES;
  1929. memcpy(arr, buffer, minLen);
  1930. arr[minLen] = '\0';
  1931. if (1 != sscanf(arr, "%d", &pos))
  1932. return -EINVAL;
  1933. scsi_debug_opts = pos;
  1934. if (scsi_debug_every_nth != 0)
  1935. scsi_debug_cmnd_count = 0;
  1936. return length;
  1937. }
  1938. begin = 0;
  1939. pos = len = sprintf(buffer, "scsi_debug adapter driver, version "
  1940. "%s [%s]\n"
  1941. "num_tgts=%d, shared (ram) size=%d MB, opts=0x%x, "
  1942. "every_nth=%d(curr:%d)\n"
  1943. "delay=%d, max_luns=%d, scsi_level=%d\n"
  1944. "sector_size=%d bytes, cylinders=%d, heads=%d, sectors=%d\n"
  1945. "number of aborts=%d, device_reset=%d, bus_resets=%d, "
  1946. "host_resets=%d\n",
  1947. SCSI_DEBUG_VERSION, scsi_debug_version_date, scsi_debug_num_tgts,
  1948. scsi_debug_dev_size_mb, scsi_debug_opts, scsi_debug_every_nth,
  1949. scsi_debug_cmnd_count, scsi_debug_delay,
  1950. scsi_debug_max_luns, scsi_debug_scsi_level,
  1951. SECT_SIZE, sdebug_cylinders_per, sdebug_heads, sdebug_sectors_per,
  1952. num_aborts, num_dev_resets, num_bus_resets, num_host_resets);
  1953. if (pos < offset) {
  1954. len = 0;
  1955. begin = pos;
  1956. }
  1957. *start = buffer + (offset - begin); /* Start of wanted data */
  1958. len -= (offset - begin);
  1959. if (len > length)
  1960. len = length;
  1961. return len;
  1962. }
  1963. static ssize_t sdebug_delay_show(struct device_driver * ddp, char * buf)
  1964. {
  1965. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_delay);
  1966. }
  1967. static ssize_t sdebug_delay_store(struct device_driver * ddp,
  1968. const char * buf, size_t count)
  1969. {
  1970. int delay;
  1971. char work[20];
  1972. if (1 == sscanf(buf, "%10s", work)) {
  1973. if ((1 == sscanf(work, "%d", &delay)) && (delay >= 0)) {
  1974. scsi_debug_delay = delay;
  1975. return count;
  1976. }
  1977. }
  1978. return -EINVAL;
  1979. }
  1980. DRIVER_ATTR(delay, S_IRUGO | S_IWUSR, sdebug_delay_show,
  1981. sdebug_delay_store);
  1982. static ssize_t sdebug_opts_show(struct device_driver * ddp, char * buf)
  1983. {
  1984. return scnprintf(buf, PAGE_SIZE, "0x%x\n", scsi_debug_opts);
  1985. }
  1986. static ssize_t sdebug_opts_store(struct device_driver * ddp,
  1987. const char * buf, size_t count)
  1988. {
  1989. int opts;
  1990. char work[20];
  1991. if (1 == sscanf(buf, "%10s", work)) {
  1992. if (0 == strnicmp(work,"0x", 2)) {
  1993. if (1 == sscanf(&work[2], "%x", &opts))
  1994. goto opts_done;
  1995. } else {
  1996. if (1 == sscanf(work, "%d", &opts))
  1997. goto opts_done;
  1998. }
  1999. }
  2000. return -EINVAL;
  2001. opts_done:
  2002. scsi_debug_opts = opts;
  2003. scsi_debug_cmnd_count = 0;
  2004. return count;
  2005. }
  2006. DRIVER_ATTR(opts, S_IRUGO | S_IWUSR, sdebug_opts_show,
  2007. sdebug_opts_store);
  2008. static ssize_t sdebug_ptype_show(struct device_driver * ddp, char * buf)
  2009. {
  2010. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_ptype);
  2011. }
  2012. static ssize_t sdebug_ptype_store(struct device_driver * ddp,
  2013. const char * buf, size_t count)
  2014. {
  2015. int n;
  2016. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2017. scsi_debug_ptype = n;
  2018. return count;
  2019. }
  2020. return -EINVAL;
  2021. }
  2022. DRIVER_ATTR(ptype, S_IRUGO | S_IWUSR, sdebug_ptype_show, sdebug_ptype_store);
  2023. static ssize_t sdebug_dsense_show(struct device_driver * ddp, char * buf)
  2024. {
  2025. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_dsense);
  2026. }
  2027. static ssize_t sdebug_dsense_store(struct device_driver * ddp,
  2028. const char * buf, size_t count)
  2029. {
  2030. int n;
  2031. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2032. scsi_debug_dsense = n;
  2033. return count;
  2034. }
  2035. return -EINVAL;
  2036. }
  2037. DRIVER_ATTR(dsense, S_IRUGO | S_IWUSR, sdebug_dsense_show,
  2038. sdebug_dsense_store);
  2039. static ssize_t sdebug_fake_rw_show(struct device_driver * ddp, char * buf)
  2040. {
  2041. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_fake_rw);
  2042. }
  2043. static ssize_t sdebug_fake_rw_store(struct device_driver * ddp,
  2044. const char * buf, size_t count)
  2045. {
  2046. int n;
  2047. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2048. scsi_debug_fake_rw = n;
  2049. return count;
  2050. }
  2051. return -EINVAL;
  2052. }
  2053. DRIVER_ATTR(fake_rw, S_IRUGO | S_IWUSR, sdebug_fake_rw_show,
  2054. sdebug_fake_rw_store);
  2055. static ssize_t sdebug_no_lun_0_show(struct device_driver * ddp, char * buf)
  2056. {
  2057. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_no_lun_0);
  2058. }
  2059. static ssize_t sdebug_no_lun_0_store(struct device_driver * ddp,
  2060. const char * buf, size_t count)
  2061. {
  2062. int n;
  2063. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2064. scsi_debug_no_lun_0 = n;
  2065. return count;
  2066. }
  2067. return -EINVAL;
  2068. }
  2069. DRIVER_ATTR(no_lun_0, S_IRUGO | S_IWUSR, sdebug_no_lun_0_show,
  2070. sdebug_no_lun_0_store);
  2071. static ssize_t sdebug_num_tgts_show(struct device_driver * ddp, char * buf)
  2072. {
  2073. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_num_tgts);
  2074. }
  2075. static ssize_t sdebug_num_tgts_store(struct device_driver * ddp,
  2076. const char * buf, size_t count)
  2077. {
  2078. int n;
  2079. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2080. scsi_debug_num_tgts = n;
  2081. sdebug_max_tgts_luns();
  2082. return count;
  2083. }
  2084. return -EINVAL;
  2085. }
  2086. DRIVER_ATTR(num_tgts, S_IRUGO | S_IWUSR, sdebug_num_tgts_show,
  2087. sdebug_num_tgts_store);
  2088. static ssize_t sdebug_dev_size_mb_show(struct device_driver * ddp, char * buf)
  2089. {
  2090. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_dev_size_mb);
  2091. }
  2092. DRIVER_ATTR(dev_size_mb, S_IRUGO, sdebug_dev_size_mb_show, NULL);
  2093. static ssize_t sdebug_num_parts_show(struct device_driver * ddp, char * buf)
  2094. {
  2095. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_num_parts);
  2096. }
  2097. DRIVER_ATTR(num_parts, S_IRUGO, sdebug_num_parts_show, NULL);
  2098. static ssize_t sdebug_every_nth_show(struct device_driver * ddp, char * buf)
  2099. {
  2100. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_every_nth);
  2101. }
  2102. static ssize_t sdebug_every_nth_store(struct device_driver * ddp,
  2103. const char * buf, size_t count)
  2104. {
  2105. int nth;
  2106. if ((count > 0) && (1 == sscanf(buf, "%d", &nth))) {
  2107. scsi_debug_every_nth = nth;
  2108. scsi_debug_cmnd_count = 0;
  2109. return count;
  2110. }
  2111. return -EINVAL;
  2112. }
  2113. DRIVER_ATTR(every_nth, S_IRUGO | S_IWUSR, sdebug_every_nth_show,
  2114. sdebug_every_nth_store);
  2115. static ssize_t sdebug_max_luns_show(struct device_driver * ddp, char * buf)
  2116. {
  2117. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_max_luns);
  2118. }
  2119. static ssize_t sdebug_max_luns_store(struct device_driver * ddp,
  2120. const char * buf, size_t count)
  2121. {
  2122. int n;
  2123. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2124. scsi_debug_max_luns = n;
  2125. sdebug_max_tgts_luns();
  2126. return count;
  2127. }
  2128. return -EINVAL;
  2129. }
  2130. DRIVER_ATTR(max_luns, S_IRUGO | S_IWUSR, sdebug_max_luns_show,
  2131. sdebug_max_luns_store);
  2132. static ssize_t sdebug_scsi_level_show(struct device_driver * ddp, char * buf)
  2133. {
  2134. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_scsi_level);
  2135. }
  2136. DRIVER_ATTR(scsi_level, S_IRUGO, sdebug_scsi_level_show, NULL);
  2137. static ssize_t sdebug_virtual_gb_show(struct device_driver * ddp, char * buf)
  2138. {
  2139. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_virtual_gb);
  2140. }
  2141. static ssize_t sdebug_virtual_gb_store(struct device_driver * ddp,
  2142. const char * buf, size_t count)
  2143. {
  2144. int n;
  2145. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2146. scsi_debug_virtual_gb = n;
  2147. sdebug_capacity = get_sdebug_capacity();
  2148. return count;
  2149. }
  2150. return -EINVAL;
  2151. }
  2152. DRIVER_ATTR(virtual_gb, S_IRUGO | S_IWUSR, sdebug_virtual_gb_show,
  2153. sdebug_virtual_gb_store);
  2154. static ssize_t sdebug_add_host_show(struct device_driver * ddp, char * buf)
  2155. {
  2156. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_add_host);
  2157. }
  2158. static ssize_t sdebug_add_host_store(struct device_driver * ddp,
  2159. const char * buf, size_t count)
  2160. {
  2161. int delta_hosts;
  2162. if (sscanf(buf, "%d", &delta_hosts) != 1)
  2163. return -EINVAL;
  2164. if (delta_hosts > 0) {
  2165. do {
  2166. sdebug_add_adapter();
  2167. } while (--delta_hosts);
  2168. } else if (delta_hosts < 0) {
  2169. do {
  2170. sdebug_remove_adapter();
  2171. } while (++delta_hosts);
  2172. }
  2173. return count;
  2174. }
  2175. DRIVER_ATTR(add_host, S_IRUGO | S_IWUSR, sdebug_add_host_show,
  2176. sdebug_add_host_store);
  2177. static ssize_t sdebug_vpd_use_hostno_show(struct device_driver * ddp,
  2178. char * buf)
  2179. {
  2180. return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_vpd_use_hostno);
  2181. }
  2182. static ssize_t sdebug_vpd_use_hostno_store(struct device_driver * ddp,
  2183. const char * buf, size_t count)
  2184. {
  2185. int n;
  2186. if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
  2187. scsi_debug_vpd_use_hostno = n;
  2188. return count;
  2189. }
  2190. return -EINVAL;
  2191. }
  2192. DRIVER_ATTR(vpd_use_hostno, S_IRUGO | S_IWUSR, sdebug_vpd_use_hostno_show,
  2193. sdebug_vpd_use_hostno_store);
  2194. /* Note: The following function creates attribute files in the
  2195. /sys/bus/pseudo/drivers/scsi_debug directory. The advantage of these
  2196. files (over those found in the /sys/module/scsi_debug/parameters
  2197. directory) is that auxiliary actions can be triggered when an attribute
  2198. is changed. For example see: sdebug_add_host_store() above.
  2199. */
  2200. static int do_create_driverfs_files(void)
  2201. {
  2202. int ret;
  2203. ret = driver_create_file(&sdebug_driverfs_driver, &driver_attr_add_host);
  2204. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_delay);
  2205. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_dev_size_mb);
  2206. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_dsense);
  2207. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_every_nth);
  2208. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_fake_rw);
  2209. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_max_luns);
  2210. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_no_lun_0);
  2211. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_num_parts);
  2212. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_num_tgts);
  2213. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_ptype);
  2214. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_opts);
  2215. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_scsi_level);
  2216. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_virtual_gb);
  2217. ret |= driver_create_file(&sdebug_driverfs_driver, &driver_attr_vpd_use_hostno);
  2218. return ret;
  2219. }
  2220. static void do_remove_driverfs_files(void)
  2221. {
  2222. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_vpd_use_hostno);
  2223. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_virtual_gb);
  2224. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_scsi_level);
  2225. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_opts);
  2226. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_ptype);
  2227. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_num_tgts);
  2228. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_num_parts);
  2229. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_no_lun_0);
  2230. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_max_luns);
  2231. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_fake_rw);
  2232. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_every_nth);
  2233. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_dsense);
  2234. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_dev_size_mb);
  2235. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_delay);
  2236. driver_remove_file(&sdebug_driverfs_driver, &driver_attr_add_host);
  2237. }
  2238. static int __init scsi_debug_init(void)
  2239. {
  2240. unsigned long sz;
  2241. int host_to_add;
  2242. int k;
  2243. int ret;
  2244. if (scsi_debug_dev_size_mb < 1)
  2245. scsi_debug_dev_size_mb = 1; /* force minimum 1 MB ramdisk */
  2246. sz = (unsigned long)scsi_debug_dev_size_mb * 1048576;
  2247. sdebug_store_sectors = sz / SECT_SIZE;
  2248. sdebug_capacity = get_sdebug_capacity();
  2249. /* play around with geometry, don't waste too much on track 0 */
  2250. sdebug_heads = 8;
  2251. sdebug_sectors_per = 32;
  2252. if (scsi_debug_dev_size_mb >= 16)
  2253. sdebug_heads = 32;
  2254. else if (scsi_debug_dev_size_mb >= 256)
  2255. sdebug_heads = 64;
  2256. sdebug_cylinders_per = (unsigned long)sdebug_capacity /
  2257. (sdebug_sectors_per * sdebug_heads);
  2258. if (sdebug_cylinders_per >= 1024) {
  2259. /* other LLDs do this; implies >= 1GB ram disk ... */
  2260. sdebug_heads = 255;
  2261. sdebug_sectors_per = 63;
  2262. sdebug_cylinders_per = (unsigned long)sdebug_capacity /
  2263. (sdebug_sectors_per * sdebug_heads);
  2264. }
  2265. fake_storep = vmalloc(sz);
  2266. if (NULL == fake_storep) {
  2267. printk(KERN_ERR "scsi_debug_init: out of memory, 1\n");
  2268. return -ENOMEM;
  2269. }
  2270. memset(fake_storep, 0, sz);
  2271. if (scsi_debug_num_parts > 0)
  2272. sdebug_build_parts(fake_storep, sz);
  2273. ret = device_register(&pseudo_primary);
  2274. if (ret < 0) {
  2275. printk(KERN_WARNING "scsi_debug: device_register error: %d\n",
  2276. ret);
  2277. goto free_vm;
  2278. }
  2279. ret = bus_register(&pseudo_lld_bus);
  2280. if (ret < 0) {
  2281. printk(KERN_WARNING "scsi_debug: bus_register error: %d\n",
  2282. ret);
  2283. goto dev_unreg;
  2284. }
  2285. ret = driver_register(&sdebug_driverfs_driver);
  2286. if (ret < 0) {
  2287. printk(KERN_WARNING "scsi_debug: driver_register error: %d\n",
  2288. ret);
  2289. goto bus_unreg;
  2290. }
  2291. ret = do_create_driverfs_files();
  2292. if (ret < 0) {
  2293. printk(KERN_WARNING "scsi_debug: driver_create_file error: %d\n",
  2294. ret);
  2295. goto del_files;
  2296. }
  2297. init_all_queued();
  2298. host_to_add = scsi_debug_add_host;
  2299. scsi_debug_add_host = 0;
  2300. for (k = 0; k < host_to_add; k++) {
  2301. if (sdebug_add_adapter()) {
  2302. printk(KERN_ERR "scsi_debug_init: "
  2303. "sdebug_add_adapter failed k=%d\n", k);
  2304. break;
  2305. }
  2306. }
  2307. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) {
  2308. printk(KERN_INFO "scsi_debug_init: built %d host(s)\n",
  2309. scsi_debug_add_host);
  2310. }
  2311. return 0;
  2312. del_files:
  2313. do_remove_driverfs_files();
  2314. driver_unregister(&sdebug_driverfs_driver);
  2315. bus_unreg:
  2316. bus_unregister(&pseudo_lld_bus);
  2317. dev_unreg:
  2318. device_unregister(&pseudo_primary);
  2319. free_vm:
  2320. vfree(fake_storep);
  2321. return ret;
  2322. }
  2323. static void __exit scsi_debug_exit(void)
  2324. {
  2325. int k = scsi_debug_add_host;
  2326. stop_all_queued();
  2327. for (; k; k--)
  2328. sdebug_remove_adapter();
  2329. do_remove_driverfs_files();
  2330. driver_unregister(&sdebug_driverfs_driver);
  2331. bus_unregister(&pseudo_lld_bus);
  2332. device_unregister(&pseudo_primary);
  2333. vfree(fake_storep);
  2334. }
  2335. device_initcall(scsi_debug_init);
  2336. module_exit(scsi_debug_exit);
  2337. static void pseudo_0_release(struct device * dev)
  2338. {
  2339. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  2340. printk(KERN_INFO "scsi_debug: pseudo_0_release() called\n");
  2341. }
  2342. static struct device pseudo_primary = {
  2343. .bus_id = "pseudo_0",
  2344. .release = pseudo_0_release,
  2345. };
  2346. static int pseudo_lld_bus_match(struct device *dev,
  2347. struct device_driver *dev_driver)
  2348. {
  2349. return 1;
  2350. }
  2351. static struct bus_type pseudo_lld_bus = {
  2352. .name = "pseudo",
  2353. .match = pseudo_lld_bus_match,
  2354. .probe = sdebug_driver_probe,
  2355. .remove = sdebug_driver_remove,
  2356. };
  2357. static void sdebug_release_adapter(struct device * dev)
  2358. {
  2359. struct sdebug_host_info *sdbg_host;
  2360. sdbg_host = to_sdebug_host(dev);
  2361. kfree(sdbg_host);
  2362. }
  2363. static int sdebug_add_adapter(void)
  2364. {
  2365. int k, devs_per_host;
  2366. int error = 0;
  2367. struct sdebug_host_info *sdbg_host;
  2368. struct sdebug_dev_info *sdbg_devinfo, *tmp;
  2369. sdbg_host = kzalloc(sizeof(*sdbg_host),GFP_KERNEL);
  2370. if (NULL == sdbg_host) {
  2371. printk(KERN_ERR "%s: out of memory at line %d\n",
  2372. __FUNCTION__, __LINE__);
  2373. return -ENOMEM;
  2374. }
  2375. INIT_LIST_HEAD(&sdbg_host->dev_info_list);
  2376. devs_per_host = scsi_debug_num_tgts * scsi_debug_max_luns;
  2377. for (k = 0; k < devs_per_host; k++) {
  2378. sdbg_devinfo = sdebug_device_create(sdbg_host, GFP_KERNEL);
  2379. if (!sdbg_devinfo) {
  2380. printk(KERN_ERR "%s: out of memory at line %d\n",
  2381. __FUNCTION__, __LINE__);
  2382. error = -ENOMEM;
  2383. goto clean;
  2384. }
  2385. }
  2386. spin_lock(&sdebug_host_list_lock);
  2387. list_add_tail(&sdbg_host->host_list, &sdebug_host_list);
  2388. spin_unlock(&sdebug_host_list_lock);
  2389. sdbg_host->dev.bus = &pseudo_lld_bus;
  2390. sdbg_host->dev.parent = &pseudo_primary;
  2391. sdbg_host->dev.release = &sdebug_release_adapter;
  2392. sprintf(sdbg_host->dev.bus_id, "adapter%d", scsi_debug_add_host);
  2393. error = device_register(&sdbg_host->dev);
  2394. if (error)
  2395. goto clean;
  2396. ++scsi_debug_add_host;
  2397. return error;
  2398. clean:
  2399. list_for_each_entry_safe(sdbg_devinfo, tmp, &sdbg_host->dev_info_list,
  2400. dev_list) {
  2401. list_del(&sdbg_devinfo->dev_list);
  2402. kfree(sdbg_devinfo);
  2403. }
  2404. kfree(sdbg_host);
  2405. return error;
  2406. }
  2407. static void sdebug_remove_adapter(void)
  2408. {
  2409. struct sdebug_host_info * sdbg_host = NULL;
  2410. spin_lock(&sdebug_host_list_lock);
  2411. if (!list_empty(&sdebug_host_list)) {
  2412. sdbg_host = list_entry(sdebug_host_list.prev,
  2413. struct sdebug_host_info, host_list);
  2414. list_del(&sdbg_host->host_list);
  2415. }
  2416. spin_unlock(&sdebug_host_list_lock);
  2417. if (!sdbg_host)
  2418. return;
  2419. device_unregister(&sdbg_host->dev);
  2420. --scsi_debug_add_host;
  2421. }
  2422. static
  2423. int scsi_debug_queuecommand(struct scsi_cmnd *SCpnt, done_funct_t done)
  2424. {
  2425. unsigned char *cmd = (unsigned char *) SCpnt->cmnd;
  2426. int len, k;
  2427. unsigned int num;
  2428. unsigned long long lba;
  2429. int errsts = 0;
  2430. int target = SCpnt->device->id;
  2431. struct sdebug_dev_info *devip = NULL;
  2432. int inj_recovered = 0;
  2433. int inj_transport = 0;
  2434. int delay_override = 0;
  2435. scsi_set_resid(SCpnt, 0);
  2436. if ((SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) && cmd) {
  2437. printk(KERN_INFO "scsi_debug: cmd ");
  2438. for (k = 0, len = SCpnt->cmd_len; k < len; ++k)
  2439. printk("%02x ", (int)cmd[k]);
  2440. printk("\n");
  2441. }
  2442. if (target == SCpnt->device->host->hostt->this_id) {
  2443. printk(KERN_INFO "scsi_debug: initiator's id used as "
  2444. "target!\n");
  2445. return schedule_resp(SCpnt, NULL, done,
  2446. DID_NO_CONNECT << 16, 0);
  2447. }
  2448. if ((SCpnt->device->lun >= scsi_debug_max_luns) &&
  2449. (SCpnt->device->lun != SAM2_WLUN_REPORT_LUNS))
  2450. return schedule_resp(SCpnt, NULL, done,
  2451. DID_NO_CONNECT << 16, 0);
  2452. devip = devInfoReg(SCpnt->device);
  2453. if (NULL == devip)
  2454. return schedule_resp(SCpnt, NULL, done,
  2455. DID_NO_CONNECT << 16, 0);
  2456. if ((scsi_debug_every_nth != 0) &&
  2457. (++scsi_debug_cmnd_count >= abs(scsi_debug_every_nth))) {
  2458. scsi_debug_cmnd_count = 0;
  2459. if (scsi_debug_every_nth < -1)
  2460. scsi_debug_every_nth = -1;
  2461. if (SCSI_DEBUG_OPT_TIMEOUT & scsi_debug_opts)
  2462. return 0; /* ignore command causing timeout */
  2463. else if (SCSI_DEBUG_OPT_RECOVERED_ERR & scsi_debug_opts)
  2464. inj_recovered = 1; /* to reads and writes below */
  2465. else if (SCSI_DEBUG_OPT_TRANSPORT_ERR & scsi_debug_opts)
  2466. inj_transport = 1; /* to reads and writes below */
  2467. }
  2468. if (devip->wlun) {
  2469. switch (*cmd) {
  2470. case INQUIRY:
  2471. case REQUEST_SENSE:
  2472. case TEST_UNIT_READY:
  2473. case REPORT_LUNS:
  2474. break; /* only allowable wlun commands */
  2475. default:
  2476. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  2477. printk(KERN_INFO "scsi_debug: Opcode: 0x%x "
  2478. "not supported for wlun\n", *cmd);
  2479. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  2480. INVALID_OPCODE, 0);
  2481. errsts = check_condition_result;
  2482. return schedule_resp(SCpnt, devip, done, errsts,
  2483. 0);
  2484. }
  2485. }
  2486. switch (*cmd) {
  2487. case INQUIRY: /* mandatory, ignore unit attention */
  2488. delay_override = 1;
  2489. errsts = resp_inquiry(SCpnt, target, devip);
  2490. break;
  2491. case REQUEST_SENSE: /* mandatory, ignore unit attention */
  2492. delay_override = 1;
  2493. errsts = resp_requests(SCpnt, devip);
  2494. break;
  2495. case REZERO_UNIT: /* actually this is REWIND for SSC */
  2496. case START_STOP:
  2497. errsts = resp_start_stop(SCpnt, devip);
  2498. break;
  2499. case ALLOW_MEDIUM_REMOVAL:
  2500. errsts = check_readiness(SCpnt, 1, devip);
  2501. if (errsts)
  2502. break;
  2503. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  2504. printk(KERN_INFO "scsi_debug: Medium removal %s\n",
  2505. cmd[4] ? "inhibited" : "enabled");
  2506. break;
  2507. case SEND_DIAGNOSTIC: /* mandatory */
  2508. errsts = check_readiness(SCpnt, 1, devip);
  2509. break;
  2510. case TEST_UNIT_READY: /* mandatory */
  2511. delay_override = 1;
  2512. errsts = check_readiness(SCpnt, 0, devip);
  2513. break;
  2514. case RESERVE:
  2515. errsts = check_readiness(SCpnt, 1, devip);
  2516. break;
  2517. case RESERVE_10:
  2518. errsts = check_readiness(SCpnt, 1, devip);
  2519. break;
  2520. case RELEASE:
  2521. errsts = check_readiness(SCpnt, 1, devip);
  2522. break;
  2523. case RELEASE_10:
  2524. errsts = check_readiness(SCpnt, 1, devip);
  2525. break;
  2526. case READ_CAPACITY:
  2527. errsts = resp_readcap(SCpnt, devip);
  2528. break;
  2529. case SERVICE_ACTION_IN:
  2530. if (SAI_READ_CAPACITY_16 != cmd[1]) {
  2531. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  2532. INVALID_OPCODE, 0);
  2533. errsts = check_condition_result;
  2534. break;
  2535. }
  2536. errsts = resp_readcap16(SCpnt, devip);
  2537. break;
  2538. case MAINTENANCE_IN:
  2539. if (MI_REPORT_TARGET_PGS != cmd[1]) {
  2540. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  2541. INVALID_OPCODE, 0);
  2542. errsts = check_condition_result;
  2543. break;
  2544. }
  2545. errsts = resp_report_tgtpgs(SCpnt, devip);
  2546. break;
  2547. case READ_16:
  2548. case READ_12:
  2549. case READ_10:
  2550. case READ_6:
  2551. errsts = check_readiness(SCpnt, 0, devip);
  2552. if (errsts)
  2553. break;
  2554. if (scsi_debug_fake_rw)
  2555. break;
  2556. get_data_transfer_info(cmd, &lba, &num);
  2557. errsts = resp_read(SCpnt, lba, num, devip);
  2558. if (inj_recovered && (0 == errsts)) {
  2559. mk_sense_buffer(devip, RECOVERED_ERROR,
  2560. THRESHOLD_EXCEEDED, 0);
  2561. errsts = check_condition_result;
  2562. } else if (inj_transport && (0 == errsts)) {
  2563. mk_sense_buffer(devip, ABORTED_COMMAND,
  2564. TRANSPORT_PROBLEM, ACK_NAK_TO);
  2565. errsts = check_condition_result;
  2566. }
  2567. break;
  2568. case REPORT_LUNS: /* mandatory, ignore unit attention */
  2569. delay_override = 1;
  2570. errsts = resp_report_luns(SCpnt, devip);
  2571. break;
  2572. case VERIFY: /* 10 byte SBC-2 command */
  2573. errsts = check_readiness(SCpnt, 0, devip);
  2574. break;
  2575. case WRITE_16:
  2576. case WRITE_12:
  2577. case WRITE_10:
  2578. case WRITE_6:
  2579. errsts = check_readiness(SCpnt, 0, devip);
  2580. if (errsts)
  2581. break;
  2582. if (scsi_debug_fake_rw)
  2583. break;
  2584. get_data_transfer_info(cmd, &lba, &num);
  2585. errsts = resp_write(SCpnt, lba, num, devip);
  2586. if (inj_recovered && (0 == errsts)) {
  2587. mk_sense_buffer(devip, RECOVERED_ERROR,
  2588. THRESHOLD_EXCEEDED, 0);
  2589. errsts = check_condition_result;
  2590. }
  2591. break;
  2592. case MODE_SENSE:
  2593. case MODE_SENSE_10:
  2594. errsts = resp_mode_sense(SCpnt, target, devip);
  2595. break;
  2596. case MODE_SELECT:
  2597. errsts = resp_mode_select(SCpnt, 1, devip);
  2598. break;
  2599. case MODE_SELECT_10:
  2600. errsts = resp_mode_select(SCpnt, 0, devip);
  2601. break;
  2602. case LOG_SENSE:
  2603. errsts = resp_log_sense(SCpnt, devip);
  2604. break;
  2605. case SYNCHRONIZE_CACHE:
  2606. delay_override = 1;
  2607. errsts = check_readiness(SCpnt, 0, devip);
  2608. break;
  2609. case WRITE_BUFFER:
  2610. errsts = check_readiness(SCpnt, 1, devip);
  2611. break;
  2612. case XDWRITEREAD_10:
  2613. if (!scsi_bidi_cmnd(SCpnt)) {
  2614. mk_sense_buffer(devip, ILLEGAL_REQUEST,
  2615. INVALID_FIELD_IN_CDB, 0);
  2616. errsts = check_condition_result;
  2617. break;
  2618. }
  2619. errsts = check_readiness(SCpnt, 0, devip);
  2620. if (errsts)
  2621. break;
  2622. if (scsi_debug_fake_rw)
  2623. break;
  2624. get_data_transfer_info(cmd, &lba, &num);
  2625. errsts = resp_read(SCpnt, lba, num, devip);
  2626. if (errsts)
  2627. break;
  2628. errsts = resp_write(SCpnt, lba, num, devip);
  2629. if (errsts)
  2630. break;
  2631. errsts = resp_xdwriteread(SCpnt, lba, num, devip);
  2632. break;
  2633. default:
  2634. if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
  2635. printk(KERN_INFO "scsi_debug: Opcode: 0x%x not "
  2636. "supported\n", *cmd);
  2637. errsts = check_readiness(SCpnt, 1, devip);
  2638. if (errsts)
  2639. break; /* Unit attention takes precedence */
  2640. mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_OPCODE, 0);
  2641. errsts = check_condition_result;
  2642. break;
  2643. }
  2644. return schedule_resp(SCpnt, devip, done, errsts,
  2645. (delay_override ? 0 : scsi_debug_delay));
  2646. }
  2647. static struct scsi_host_template sdebug_driver_template = {
  2648. .proc_info = scsi_debug_proc_info,
  2649. .proc_name = sdebug_proc_name,
  2650. .name = "SCSI DEBUG",
  2651. .info = scsi_debug_info,
  2652. .slave_alloc = scsi_debug_slave_alloc,
  2653. .slave_configure = scsi_debug_slave_configure,
  2654. .slave_destroy = scsi_debug_slave_destroy,
  2655. .ioctl = scsi_debug_ioctl,
  2656. .queuecommand = scsi_debug_queuecommand,
  2657. .eh_abort_handler = scsi_debug_abort,
  2658. .eh_bus_reset_handler = scsi_debug_bus_reset,
  2659. .eh_device_reset_handler = scsi_debug_device_reset,
  2660. .eh_host_reset_handler = scsi_debug_host_reset,
  2661. .bios_param = scsi_debug_biosparam,
  2662. .can_queue = SCSI_DEBUG_CANQUEUE,
  2663. .this_id = 7,
  2664. .sg_tablesize = 256,
  2665. .cmd_per_lun = 16,
  2666. .max_sectors = 0xffff,
  2667. .use_clustering = DISABLE_CLUSTERING,
  2668. .module = THIS_MODULE,
  2669. };
  2670. static int sdebug_driver_probe(struct device * dev)
  2671. {
  2672. int error = 0;
  2673. struct sdebug_host_info *sdbg_host;
  2674. struct Scsi_Host *hpnt;
  2675. sdbg_host = to_sdebug_host(dev);
  2676. hpnt = scsi_host_alloc(&sdebug_driver_template, sizeof(sdbg_host));
  2677. if (NULL == hpnt) {
  2678. printk(KERN_ERR "%s: scsi_register failed\n", __FUNCTION__);
  2679. error = -ENODEV;
  2680. return error;
  2681. }
  2682. sdbg_host->shost = hpnt;
  2683. *((struct sdebug_host_info **)hpnt->hostdata) = sdbg_host;
  2684. if ((hpnt->this_id >= 0) && (scsi_debug_num_tgts > hpnt->this_id))
  2685. hpnt->max_id = scsi_debug_num_tgts + 1;
  2686. else
  2687. hpnt->max_id = scsi_debug_num_tgts;
  2688. hpnt->max_lun = SAM2_WLUN_REPORT_LUNS; /* = scsi_debug_max_luns; */
  2689. error = scsi_add_host(hpnt, &sdbg_host->dev);
  2690. if (error) {
  2691. printk(KERN_ERR "%s: scsi_add_host failed\n", __FUNCTION__);
  2692. error = -ENODEV;
  2693. scsi_host_put(hpnt);
  2694. } else
  2695. scsi_scan_host(hpnt);
  2696. return error;
  2697. }
  2698. static int sdebug_driver_remove(struct device * dev)
  2699. {
  2700. struct sdebug_host_info *sdbg_host;
  2701. struct sdebug_dev_info *sdbg_devinfo, *tmp;
  2702. sdbg_host = to_sdebug_host(dev);
  2703. if (!sdbg_host) {
  2704. printk(KERN_ERR "%s: Unable to locate host info\n",
  2705. __FUNCTION__);
  2706. return -ENODEV;
  2707. }
  2708. scsi_remove_host(sdbg_host->shost);
  2709. list_for_each_entry_safe(sdbg_devinfo, tmp, &sdbg_host->dev_info_list,
  2710. dev_list) {
  2711. list_del(&sdbg_devinfo->dev_list);
  2712. kfree(sdbg_devinfo);
  2713. }
  2714. scsi_host_put(sdbg_host->shost);
  2715. return 0;
  2716. }
  2717. static void sdebug_max_tgts_luns(void)
  2718. {
  2719. struct sdebug_host_info * sdbg_host;
  2720. struct Scsi_Host *hpnt;
  2721. spin_lock(&sdebug_host_list_lock);
  2722. list_for_each_entry(sdbg_host, &sdebug_host_list, host_list) {
  2723. hpnt = sdbg_host->shost;
  2724. if ((hpnt->this_id >= 0) &&
  2725. (scsi_debug_num_tgts > hpnt->this_id))
  2726. hpnt->max_id = scsi_debug_num_tgts + 1;
  2727. else
  2728. hpnt->max_id = scsi_debug_num_tgts;
  2729. hpnt->max_lun = SAM2_WLUN_REPORT_LUNS; /* scsi_debug_max_luns; */
  2730. }
  2731. spin_unlock(&sdebug_host_list_lock);
  2732. }