ide-scsi.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047
  1. /*
  2. * Copyright (C) 1996-1999 Gadi Oxman <gadio@netvision.net.il>
  3. * Copyright (C) 2004-2005 Bartlomiej Zolnierkiewicz
  4. */
  5. /*
  6. * Emulation of a SCSI host adapter for IDE ATAPI devices.
  7. *
  8. * With this driver, one can use the Linux SCSI drivers instead of the
  9. * native IDE ATAPI drivers.
  10. *
  11. * Ver 0.1 Dec 3 96 Initial version.
  12. * Ver 0.2 Jan 26 97 Fixed bug in cleanup_module() and added emulation
  13. * of MODE_SENSE_6/MODE_SELECT_6 for cdroms. Thanks
  14. * to Janos Farkas for pointing this out.
  15. * Avoid using bitfields in structures for m68k.
  16. * Added Scatter/Gather and DMA support.
  17. * Ver 0.4 Dec 7 97 Add support for ATAPI PD/CD drives.
  18. * Use variable timeout for each command.
  19. * Ver 0.5 Jan 2 98 Fix previous PD/CD support.
  20. * Allow disabling of SCSI-6 to SCSI-10 transformation.
  21. * Ver 0.6 Jan 27 98 Allow disabling of SCSI command translation layer
  22. * for access through /dev/sg.
  23. * Fix MODE_SENSE_6/MODE_SELECT_6/INQUIRY translation.
  24. * Ver 0.7 Dec 04 98 Ignore commands where lun != 0 to avoid multiple
  25. * detection of devices with CONFIG_SCSI_MULTI_LUN
  26. * Ver 0.8 Feb 05 99 Optical media need translation too. Reverse 0.7.
  27. * Ver 0.9 Jul 04 99 Fix a bug in SG_SET_TRANSFORM.
  28. * Ver 0.91 Jun 10 02 Fix "off by one" error in transforms
  29. * Ver 0.92 Dec 31 02 Implement new SCSI mid level API
  30. */
  31. #define IDESCSI_VERSION "0.92"
  32. #include <linux/module.h>
  33. #include <linux/types.h>
  34. #include <linux/string.h>
  35. #include <linux/kernel.h>
  36. #include <linux/mm.h>
  37. #include <linux/ioport.h>
  38. #include <linux/blkdev.h>
  39. #include <linux/errno.h>
  40. #include <linux/hdreg.h>
  41. #include <linux/slab.h>
  42. #include <linux/ide.h>
  43. #include <linux/scatterlist.h>
  44. #include <linux/delay.h>
  45. #include <linux/mutex.h>
  46. #include <linux/bitops.h>
  47. #include <asm/io.h>
  48. #include <asm/uaccess.h>
  49. #include <scsi/scsi.h>
  50. #include <scsi/scsi_cmnd.h>
  51. #include <scsi/scsi_device.h>
  52. #include <scsi/scsi_host.h>
  53. #include <scsi/scsi_tcq.h>
  54. #include <scsi/sg.h>
  55. #define IDESCSI_DEBUG_LOG 0
  56. /*
  57. * SCSI command transformation layer
  58. */
  59. #define IDESCSI_SG_TRANSFORM 1 /* /dev/sg transformation */
  60. /*
  61. * Log flags
  62. */
  63. #define IDESCSI_LOG_CMD 0 /* Log SCSI commands */
  64. typedef struct ide_scsi_obj {
  65. ide_drive_t *drive;
  66. ide_driver_t *driver;
  67. struct gendisk *disk;
  68. struct Scsi_Host *host;
  69. struct ide_atapi_pc *pc; /* Current packet command */
  70. unsigned long flags; /* Status/Action flags */
  71. unsigned long transform; /* SCSI cmd translation layer */
  72. unsigned long log; /* log flags */
  73. } idescsi_scsi_t;
  74. static DEFINE_MUTEX(idescsi_ref_mutex);
  75. /* Set by module param to skip cd */
  76. static int idescsi_nocd;
  77. #define ide_scsi_g(disk) \
  78. container_of((disk)->private_data, struct ide_scsi_obj, driver)
  79. static struct ide_scsi_obj *ide_scsi_get(struct gendisk *disk)
  80. {
  81. struct ide_scsi_obj *scsi = NULL;
  82. mutex_lock(&idescsi_ref_mutex);
  83. scsi = ide_scsi_g(disk);
  84. if (scsi)
  85. scsi_host_get(scsi->host);
  86. mutex_unlock(&idescsi_ref_mutex);
  87. return scsi;
  88. }
  89. static void ide_scsi_put(struct ide_scsi_obj *scsi)
  90. {
  91. mutex_lock(&idescsi_ref_mutex);
  92. scsi_host_put(scsi->host);
  93. mutex_unlock(&idescsi_ref_mutex);
  94. }
  95. static inline idescsi_scsi_t *scsihost_to_idescsi(struct Scsi_Host *host)
  96. {
  97. return (idescsi_scsi_t*) (&host[1]);
  98. }
  99. static inline idescsi_scsi_t *drive_to_idescsi(ide_drive_t *ide_drive)
  100. {
  101. return scsihost_to_idescsi(ide_drive->driver_data);
  102. }
  103. /*
  104. * Per ATAPI device status bits.
  105. */
  106. #define IDESCSI_DRQ_INTERRUPT 0 /* DRQ interrupt device */
  107. /*
  108. * ide-scsi requests.
  109. */
  110. #define IDESCSI_PC_RQ 90
  111. /*
  112. * PIO data transfer routines using the scatter gather table.
  113. */
  114. static void idescsi_input_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
  115. unsigned int bcount)
  116. {
  117. ide_hwif_t *hwif = drive->hwif;
  118. int count;
  119. char *buf;
  120. while (bcount) {
  121. count = min(pc->sg->length - pc->b_count, bcount);
  122. if (PageHighMem(sg_page(pc->sg))) {
  123. unsigned long flags;
  124. local_irq_save(flags);
  125. buf = kmap_atomic(sg_page(pc->sg), KM_IRQ0) +
  126. pc->sg->offset;
  127. hwif->input_data(drive, NULL, buf + pc->b_count, count);
  128. kunmap_atomic(buf - pc->sg->offset, KM_IRQ0);
  129. local_irq_restore(flags);
  130. } else {
  131. buf = sg_virt(pc->sg);
  132. hwif->input_data(drive, NULL, buf + pc->b_count, count);
  133. }
  134. bcount -= count; pc->b_count += count;
  135. if (pc->b_count == pc->sg->length) {
  136. if (!--pc->sg_cnt)
  137. break;
  138. pc->sg = sg_next(pc->sg);
  139. pc->b_count = 0;
  140. }
  141. }
  142. if (bcount) {
  143. printk (KERN_ERR "ide-scsi: scatter gather table too small, discarding data\n");
  144. ide_pad_transfer(drive, 0, bcount);
  145. }
  146. }
  147. static void idescsi_output_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
  148. unsigned int bcount)
  149. {
  150. ide_hwif_t *hwif = drive->hwif;
  151. int count;
  152. char *buf;
  153. while (bcount) {
  154. count = min(pc->sg->length - pc->b_count, bcount);
  155. if (PageHighMem(sg_page(pc->sg))) {
  156. unsigned long flags;
  157. local_irq_save(flags);
  158. buf = kmap_atomic(sg_page(pc->sg), KM_IRQ0) +
  159. pc->sg->offset;
  160. hwif->output_data(drive, NULL, buf + pc->b_count, count);
  161. kunmap_atomic(buf - pc->sg->offset, KM_IRQ0);
  162. local_irq_restore(flags);
  163. } else {
  164. buf = sg_virt(pc->sg);
  165. hwif->output_data(drive, NULL, buf + pc->b_count, count);
  166. }
  167. bcount -= count; pc->b_count += count;
  168. if (pc->b_count == pc->sg->length) {
  169. if (!--pc->sg_cnt)
  170. break;
  171. pc->sg = sg_next(pc->sg);
  172. pc->b_count = 0;
  173. }
  174. }
  175. if (bcount) {
  176. printk (KERN_ERR "ide-scsi: scatter gather table too small, padding with zeros\n");
  177. ide_pad_transfer(drive, 1, bcount);
  178. }
  179. }
  180. static void ide_scsi_hex_dump(u8 *data, int len)
  181. {
  182. print_hex_dump(KERN_CONT, "", DUMP_PREFIX_NONE, 16, 1, data, len, 0);
  183. }
  184. static int idescsi_check_condition(ide_drive_t *drive,
  185. struct request *failed_cmd)
  186. {
  187. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  188. struct ide_atapi_pc *pc;
  189. struct request *rq;
  190. u8 *buf;
  191. /* stuff a sense request in front of our current request */
  192. pc = kzalloc(sizeof(struct ide_atapi_pc), GFP_ATOMIC);
  193. rq = kmalloc(sizeof(struct request), GFP_ATOMIC);
  194. buf = kzalloc(SCSI_SENSE_BUFFERSIZE, GFP_ATOMIC);
  195. if (!pc || !rq || !buf) {
  196. kfree(buf);
  197. kfree(rq);
  198. kfree(pc);
  199. return -ENOMEM;
  200. }
  201. blk_rq_init(NULL, rq);
  202. rq->special = (char *) pc;
  203. pc->rq = rq;
  204. pc->buf = buf;
  205. pc->c[0] = REQUEST_SENSE;
  206. pc->c[4] = pc->req_xfer = pc->buf_size = SCSI_SENSE_BUFFERSIZE;
  207. rq->cmd_type = REQ_TYPE_SENSE;
  208. rq->cmd_flags |= REQ_PREEMPT;
  209. pc->timeout = jiffies + WAIT_READY;
  210. /* NOTE! Save the failed packet command in "rq->buffer" */
  211. rq->buffer = (void *) failed_cmd->special;
  212. pc->scsi_cmd = ((struct ide_atapi_pc *) failed_cmd->special)->scsi_cmd;
  213. if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) {
  214. printk ("ide-scsi: %s: queue cmd = ", drive->name);
  215. ide_scsi_hex_dump(pc->c, 6);
  216. }
  217. rq->rq_disk = scsi->disk;
  218. return ide_do_drive_cmd(drive, rq, ide_preempt);
  219. }
  220. static int idescsi_end_request(ide_drive_t *, int, int);
  221. static ide_startstop_t
  222. idescsi_atapi_error(ide_drive_t *drive, struct request *rq, u8 stat, u8 err)
  223. {
  224. ide_hwif_t *hwif = drive->hwif;
  225. if (ide_read_status(drive) & (BUSY_STAT | DRQ_STAT))
  226. /* force an abort */
  227. hwif->OUTBSYNC(drive, WIN_IDLEIMMEDIATE,
  228. hwif->io_ports.command_addr);
  229. rq->errors++;
  230. idescsi_end_request(drive, 0, 0);
  231. return ide_stopped;
  232. }
  233. static ide_startstop_t
  234. idescsi_atapi_abort(ide_drive_t *drive, struct request *rq)
  235. {
  236. #if IDESCSI_DEBUG_LOG
  237. printk(KERN_WARNING "idescsi_atapi_abort called for %lu\n",
  238. ((struct ide_atapi_pc *) rq->special)->scsi_cmd->serial_number);
  239. #endif
  240. rq->errors |= ERROR_MAX;
  241. idescsi_end_request(drive, 0, 0);
  242. return ide_stopped;
  243. }
  244. static int idescsi_end_request (ide_drive_t *drive, int uptodate, int nrsecs)
  245. {
  246. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  247. struct request *rq = HWGROUP(drive)->rq;
  248. struct ide_atapi_pc *pc = (struct ide_atapi_pc *) rq->special;
  249. int log = test_bit(IDESCSI_LOG_CMD, &scsi->log);
  250. struct Scsi_Host *host;
  251. int errors = rq->errors;
  252. unsigned long flags;
  253. if (!blk_special_request(rq) && !blk_sense_request(rq)) {
  254. ide_end_request(drive, uptodate, nrsecs);
  255. return 0;
  256. }
  257. ide_end_drive_cmd (drive, 0, 0);
  258. if (blk_sense_request(rq)) {
  259. struct ide_atapi_pc *opc = (struct ide_atapi_pc *) rq->buffer;
  260. if (log) {
  261. printk ("ide-scsi: %s: wrap up check %lu, rst = ", drive->name, opc->scsi_cmd->serial_number);
  262. ide_scsi_hex_dump(pc->buf, 16);
  263. }
  264. memcpy((void *) opc->scsi_cmd->sense_buffer, pc->buf,
  265. SCSI_SENSE_BUFFERSIZE);
  266. kfree(pc->buf);
  267. kfree(pc);
  268. kfree(rq);
  269. pc = opc;
  270. rq = pc->rq;
  271. pc->scsi_cmd->result = (CHECK_CONDITION << 1) |
  272. (((pc->flags & PC_FLAG_TIMEDOUT) ?
  273. DID_TIME_OUT :
  274. DID_OK) << 16);
  275. } else if (pc->flags & PC_FLAG_TIMEDOUT) {
  276. if (log)
  277. printk (KERN_WARNING "ide-scsi: %s: timed out for %lu\n",
  278. drive->name, pc->scsi_cmd->serial_number);
  279. pc->scsi_cmd->result = DID_TIME_OUT << 16;
  280. } else if (errors >= ERROR_MAX) {
  281. pc->scsi_cmd->result = DID_ERROR << 16;
  282. if (log)
  283. printk ("ide-scsi: %s: I/O error for %lu\n", drive->name, pc->scsi_cmd->serial_number);
  284. } else if (errors) {
  285. if (log)
  286. printk ("ide-scsi: %s: check condition for %lu\n", drive->name, pc->scsi_cmd->serial_number);
  287. if (!idescsi_check_condition(drive, rq))
  288. /* we started a request sense, so we'll be back, exit for now */
  289. return 0;
  290. pc->scsi_cmd->result = (CHECK_CONDITION << 1) | (DID_OK << 16);
  291. } else {
  292. pc->scsi_cmd->result = DID_OK << 16;
  293. }
  294. host = pc->scsi_cmd->device->host;
  295. spin_lock_irqsave(host->host_lock, flags);
  296. pc->done(pc->scsi_cmd);
  297. spin_unlock_irqrestore(host->host_lock, flags);
  298. kfree(pc);
  299. kfree(rq);
  300. scsi->pc = NULL;
  301. return 0;
  302. }
  303. static inline unsigned long get_timeout(struct ide_atapi_pc *pc)
  304. {
  305. return max_t(unsigned long, WAIT_CMD, pc->timeout - jiffies);
  306. }
  307. static int idescsi_expiry(ide_drive_t *drive)
  308. {
  309. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  310. struct ide_atapi_pc *pc = scsi->pc;
  311. #if IDESCSI_DEBUG_LOG
  312. printk(KERN_WARNING "idescsi_expiry called for %lu at %lu\n", pc->scsi_cmd->serial_number, jiffies);
  313. #endif
  314. pc->flags |= PC_FLAG_TIMEDOUT;
  315. return 0; /* we do not want the ide subsystem to retry */
  316. }
  317. /*
  318. * Our interrupt handler.
  319. */
  320. static ide_startstop_t idescsi_pc_intr (ide_drive_t *drive)
  321. {
  322. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  323. ide_hwif_t *hwif = drive->hwif;
  324. struct ide_atapi_pc *pc = scsi->pc;
  325. struct request *rq = pc->rq;
  326. unsigned int temp;
  327. u16 bcount;
  328. u8 stat, ireason;
  329. #if IDESCSI_DEBUG_LOG
  330. printk (KERN_INFO "ide-scsi: Reached idescsi_pc_intr interrupt handler\n");
  331. #endif /* IDESCSI_DEBUG_LOG */
  332. if (pc->flags & PC_FLAG_TIMEDOUT) {
  333. #if IDESCSI_DEBUG_LOG
  334. printk(KERN_WARNING "idescsi_pc_intr: got timed out packet %lu at %lu\n",
  335. pc->scsi_cmd->serial_number, jiffies);
  336. #endif
  337. /* end this request now - scsi should retry it*/
  338. idescsi_end_request (drive, 1, 0);
  339. return ide_stopped;
  340. }
  341. if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
  342. pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
  343. #if IDESCSI_DEBUG_LOG
  344. printk ("ide-scsi: %s: DMA complete\n", drive->name);
  345. #endif /* IDESCSI_DEBUG_LOG */
  346. pc->xferred = pc->req_xfer;
  347. (void)hwif->dma_ops->dma_end(drive);
  348. }
  349. /* Clear the interrupt */
  350. stat = ide_read_status(drive);
  351. if ((stat & DRQ_STAT) == 0) {
  352. /* No more interrupts */
  353. if (test_bit(IDESCSI_LOG_CMD, &scsi->log))
  354. printk(KERN_INFO "Packet command completed, %d bytes"
  355. " transferred\n", pc->xferred);
  356. local_irq_enable_in_hardirq();
  357. if (stat & ERR_STAT)
  358. rq->errors++;
  359. idescsi_end_request (drive, 1, 0);
  360. return ide_stopped;
  361. }
  362. bcount = (hwif->INB(hwif->io_ports.lbah_addr) << 8) |
  363. hwif->INB(hwif->io_ports.lbam_addr);
  364. ireason = hwif->INB(hwif->io_ports.nsect_addr);
  365. if (ireason & CD) {
  366. printk(KERN_ERR "ide-scsi: CoD != 0 in idescsi_pc_intr\n");
  367. return ide_do_reset (drive);
  368. }
  369. if (ireason & IO) {
  370. temp = pc->xferred + bcount;
  371. if (temp > pc->req_xfer) {
  372. if (temp > pc->buf_size) {
  373. printk(KERN_ERR "ide-scsi: The scsi wants to "
  374. "send us more data than expected "
  375. "- discarding data\n");
  376. temp = pc->buf_size - pc->xferred;
  377. if (temp) {
  378. pc->flags &= ~PC_FLAG_WRITING;
  379. if (pc->sg)
  380. idescsi_input_buffers(drive, pc,
  381. temp);
  382. else
  383. hwif->input_data(drive, NULL,
  384. pc->cur_pos, temp);
  385. printk(KERN_ERR "ide-scsi: transferred"
  386. " %d of %d bytes\n",
  387. temp, bcount);
  388. }
  389. pc->xferred += temp;
  390. pc->cur_pos += temp;
  391. ide_pad_transfer(drive, 0, bcount - temp);
  392. ide_set_handler(drive, &idescsi_pc_intr, get_timeout(pc), idescsi_expiry);
  393. return ide_started;
  394. }
  395. #if IDESCSI_DEBUG_LOG
  396. printk (KERN_NOTICE "ide-scsi: The scsi wants to send us more data than expected - allowing transfer\n");
  397. #endif /* IDESCSI_DEBUG_LOG */
  398. }
  399. }
  400. if (ireason & IO) {
  401. pc->flags &= ~PC_FLAG_WRITING;
  402. if (pc->sg)
  403. idescsi_input_buffers(drive, pc, bcount);
  404. else
  405. hwif->input_data(drive, NULL, pc->cur_pos, bcount);
  406. } else {
  407. pc->flags |= PC_FLAG_WRITING;
  408. if (pc->sg)
  409. idescsi_output_buffers(drive, pc, bcount);
  410. else
  411. hwif->output_data(drive, NULL, pc->cur_pos, bcount);
  412. }
  413. /* Update the current position */
  414. pc->xferred += bcount;
  415. pc->cur_pos += bcount;
  416. /* And set the interrupt handler again */
  417. ide_set_handler(drive, &idescsi_pc_intr, get_timeout(pc), idescsi_expiry);
  418. return ide_started;
  419. }
  420. static ide_startstop_t idescsi_transfer_pc(ide_drive_t *drive)
  421. {
  422. ide_hwif_t *hwif = drive->hwif;
  423. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  424. struct ide_atapi_pc *pc = scsi->pc;
  425. ide_startstop_t startstop;
  426. u8 ireason;
  427. if (ide_wait_stat(&startstop,drive,DRQ_STAT,BUSY_STAT,WAIT_READY)) {
  428. printk(KERN_ERR "ide-scsi: Strange, packet command "
  429. "initiated yet DRQ isn't asserted\n");
  430. return startstop;
  431. }
  432. ireason = hwif->INB(hwif->io_ports.nsect_addr);
  433. if ((ireason & CD) == 0 || (ireason & IO)) {
  434. printk(KERN_ERR "ide-scsi: (IO,CoD) != (0,1) while "
  435. "issuing a packet command\n");
  436. return ide_do_reset (drive);
  437. }
  438. BUG_ON(HWGROUP(drive)->handler != NULL);
  439. /* Set the interrupt routine */
  440. ide_set_handler(drive, &idescsi_pc_intr, get_timeout(pc), idescsi_expiry);
  441. /* Send the actual packet */
  442. hwif->output_data(drive, NULL, scsi->pc->c, 12);
  443. if (pc->flags & PC_FLAG_DMA_OK) {
  444. pc->flags |= PC_FLAG_DMA_IN_PROGRESS;
  445. hwif->dma_ops->dma_start(drive);
  446. }
  447. return ide_started;
  448. }
  449. static inline int idescsi_set_direction(struct ide_atapi_pc *pc)
  450. {
  451. switch (pc->c[0]) {
  452. case READ_6: case READ_10: case READ_12:
  453. pc->flags &= ~PC_FLAG_WRITING;
  454. return 0;
  455. case WRITE_6: case WRITE_10: case WRITE_12:
  456. pc->flags |= PC_FLAG_WRITING;
  457. return 0;
  458. default:
  459. return 1;
  460. }
  461. }
  462. static int idescsi_map_sg(ide_drive_t *drive, struct ide_atapi_pc *pc)
  463. {
  464. ide_hwif_t *hwif = drive->hwif;
  465. struct scatterlist *sg, *scsi_sg;
  466. int segments;
  467. if (!pc->req_xfer || pc->req_xfer % 1024)
  468. return 1;
  469. if (idescsi_set_direction(pc))
  470. return 1;
  471. sg = hwif->sg_table;
  472. scsi_sg = scsi_sglist(pc->scsi_cmd);
  473. segments = scsi_sg_count(pc->scsi_cmd);
  474. if (segments > hwif->sg_max_nents)
  475. return 1;
  476. hwif->sg_nents = segments;
  477. memcpy(sg, scsi_sg, sizeof(*sg) * segments);
  478. return 0;
  479. }
  480. static ide_startstop_t idescsi_issue_pc(ide_drive_t *drive,
  481. struct ide_atapi_pc *pc)
  482. {
  483. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  484. ide_hwif_t *hwif = drive->hwif;
  485. u16 bcount;
  486. u8 dma = 0;
  487. /* Set the current packet command */
  488. scsi->pc = pc;
  489. /* We haven't transferred any data yet */
  490. pc->xferred = 0;
  491. pc->cur_pos = pc->buf;
  492. /* Request to transfer the entire buffer at once */
  493. bcount = min(pc->req_xfer, 63 * 1024);
  494. if (drive->using_dma && !idescsi_map_sg(drive, pc)) {
  495. hwif->sg_mapped = 1;
  496. dma = !hwif->dma_ops->dma_setup(drive);
  497. hwif->sg_mapped = 0;
  498. }
  499. ide_pktcmd_tf_load(drive, IDE_TFLAG_NO_SELECT_MASK, bcount, dma);
  500. if (dma)
  501. pc->flags |= PC_FLAG_DMA_OK;
  502. if (test_bit(IDESCSI_DRQ_INTERRUPT, &scsi->flags)) {
  503. ide_execute_command(drive, WIN_PACKETCMD, &idescsi_transfer_pc,
  504. get_timeout(pc), idescsi_expiry);
  505. return ide_started;
  506. } else {
  507. /* Issue the packet command */
  508. ide_execute_pkt_cmd(drive);
  509. return idescsi_transfer_pc(drive);
  510. }
  511. }
  512. /*
  513. * idescsi_do_request is our request handling function.
  514. */
  515. static ide_startstop_t idescsi_do_request (ide_drive_t *drive, struct request *rq, sector_t block)
  516. {
  517. #if IDESCSI_DEBUG_LOG
  518. printk (KERN_INFO "dev: %s, cmd: %x, errors: %d\n", rq->rq_disk->disk_name,rq->cmd[0],rq->errors);
  519. printk (KERN_INFO "sector: %ld, nr_sectors: %ld, current_nr_sectors: %d\n",rq->sector,rq->nr_sectors,rq->current_nr_sectors);
  520. #endif /* IDESCSI_DEBUG_LOG */
  521. if (blk_sense_request(rq) || blk_special_request(rq)) {
  522. return idescsi_issue_pc(drive,
  523. (struct ide_atapi_pc *) rq->special);
  524. }
  525. blk_dump_rq_flags(rq, "ide-scsi: unsup command");
  526. idescsi_end_request (drive, 0, 0);
  527. return ide_stopped;
  528. }
  529. #ifdef CONFIG_IDE_PROC_FS
  530. static void idescsi_add_settings(ide_drive_t *drive)
  531. {
  532. idescsi_scsi_t *scsi = drive_to_idescsi(drive);
  533. /*
  534. * drive setting name read/write data type min max mul_factor div_factor data pointer set function
  535. */
  536. ide_add_setting(drive, "bios_cyl", SETTING_RW, TYPE_INT, 0, 1023, 1, 1, &drive->bios_cyl, NULL);
  537. ide_add_setting(drive, "bios_head", SETTING_RW, TYPE_BYTE, 0, 255, 1, 1, &drive->bios_head, NULL);
  538. ide_add_setting(drive, "bios_sect", SETTING_RW, TYPE_BYTE, 0, 63, 1, 1, &drive->bios_sect, NULL);
  539. ide_add_setting(drive, "transform", SETTING_RW, TYPE_INT, 0, 3, 1, 1, &scsi->transform, NULL);
  540. ide_add_setting(drive, "log", SETTING_RW, TYPE_INT, 0, 1, 1, 1, &scsi->log, NULL);
  541. }
  542. #else
  543. static inline void idescsi_add_settings(ide_drive_t *drive) { ; }
  544. #endif
  545. /*
  546. * Driver initialization.
  547. */
  548. static void idescsi_setup (ide_drive_t *drive, idescsi_scsi_t *scsi)
  549. {
  550. if (drive->id && (drive->id->config & 0x0060) == 0x20)
  551. set_bit (IDESCSI_DRQ_INTERRUPT, &scsi->flags);
  552. clear_bit(IDESCSI_SG_TRANSFORM, &scsi->transform);
  553. #if IDESCSI_DEBUG_LOG
  554. set_bit(IDESCSI_LOG_CMD, &scsi->log);
  555. #endif /* IDESCSI_DEBUG_LOG */
  556. idescsi_add_settings(drive);
  557. }
  558. static void ide_scsi_remove(ide_drive_t *drive)
  559. {
  560. struct Scsi_Host *scsihost = drive->driver_data;
  561. struct ide_scsi_obj *scsi = scsihost_to_idescsi(scsihost);
  562. struct gendisk *g = scsi->disk;
  563. scsi_remove_host(scsihost);
  564. ide_proc_unregister_driver(drive, scsi->driver);
  565. ide_unregister_region(g);
  566. drive->driver_data = NULL;
  567. g->private_data = NULL;
  568. put_disk(g);
  569. ide_scsi_put(scsi);
  570. }
  571. static int ide_scsi_probe(ide_drive_t *);
  572. #ifdef CONFIG_IDE_PROC_FS
  573. static ide_proc_entry_t idescsi_proc[] = {
  574. { "capacity", S_IFREG|S_IRUGO, proc_ide_read_capacity, NULL },
  575. { NULL, 0, NULL, NULL }
  576. };
  577. #endif
  578. static ide_driver_t idescsi_driver = {
  579. .gen_driver = {
  580. .owner = THIS_MODULE,
  581. .name = "ide-scsi",
  582. .bus = &ide_bus_type,
  583. },
  584. .probe = ide_scsi_probe,
  585. .remove = ide_scsi_remove,
  586. .version = IDESCSI_VERSION,
  587. .media = ide_scsi,
  588. .supports_dsc_overlap = 0,
  589. .do_request = idescsi_do_request,
  590. .end_request = idescsi_end_request,
  591. .error = idescsi_atapi_error,
  592. .abort = idescsi_atapi_abort,
  593. #ifdef CONFIG_IDE_PROC_FS
  594. .proc = idescsi_proc,
  595. #endif
  596. };
  597. static int idescsi_ide_open(struct inode *inode, struct file *filp)
  598. {
  599. struct gendisk *disk = inode->i_bdev->bd_disk;
  600. struct ide_scsi_obj *scsi;
  601. if (!(scsi = ide_scsi_get(disk)))
  602. return -ENXIO;
  603. return 0;
  604. }
  605. static int idescsi_ide_release(struct inode *inode, struct file *filp)
  606. {
  607. struct gendisk *disk = inode->i_bdev->bd_disk;
  608. struct ide_scsi_obj *scsi = ide_scsi_g(disk);
  609. ide_scsi_put(scsi);
  610. return 0;
  611. }
  612. static int idescsi_ide_ioctl(struct inode *inode, struct file *file,
  613. unsigned int cmd, unsigned long arg)
  614. {
  615. struct block_device *bdev = inode->i_bdev;
  616. struct ide_scsi_obj *scsi = ide_scsi_g(bdev->bd_disk);
  617. return generic_ide_ioctl(scsi->drive, file, bdev, cmd, arg);
  618. }
  619. static struct block_device_operations idescsi_ops = {
  620. .owner = THIS_MODULE,
  621. .open = idescsi_ide_open,
  622. .release = idescsi_ide_release,
  623. .ioctl = idescsi_ide_ioctl,
  624. };
  625. static int idescsi_slave_configure(struct scsi_device * sdp)
  626. {
  627. /* Configure detected device */
  628. sdp->use_10_for_rw = 1;
  629. sdp->use_10_for_ms = 1;
  630. scsi_adjust_queue_depth(sdp, MSG_SIMPLE_TAG, sdp->host->cmd_per_lun);
  631. return 0;
  632. }
  633. static const char *idescsi_info (struct Scsi_Host *host)
  634. {
  635. return "SCSI host adapter emulation for IDE ATAPI devices";
  636. }
  637. static int idescsi_ioctl (struct scsi_device *dev, int cmd, void __user *arg)
  638. {
  639. idescsi_scsi_t *scsi = scsihost_to_idescsi(dev->host);
  640. if (cmd == SG_SET_TRANSFORM) {
  641. if (arg)
  642. set_bit(IDESCSI_SG_TRANSFORM, &scsi->transform);
  643. else
  644. clear_bit(IDESCSI_SG_TRANSFORM, &scsi->transform);
  645. return 0;
  646. } else if (cmd == SG_GET_TRANSFORM)
  647. return put_user(test_bit(IDESCSI_SG_TRANSFORM, &scsi->transform), (int __user *) arg);
  648. return -EINVAL;
  649. }
  650. static int idescsi_queue (struct scsi_cmnd *cmd,
  651. void (*done)(struct scsi_cmnd *))
  652. {
  653. struct Scsi_Host *host = cmd->device->host;
  654. idescsi_scsi_t *scsi = scsihost_to_idescsi(host);
  655. ide_drive_t *drive = scsi->drive;
  656. struct request *rq = NULL;
  657. struct ide_atapi_pc *pc = NULL;
  658. if (!drive) {
  659. scmd_printk (KERN_ERR, cmd, "drive not present\n");
  660. goto abort;
  661. }
  662. scsi = drive_to_idescsi(drive);
  663. pc = kmalloc(sizeof(struct ide_atapi_pc), GFP_ATOMIC);
  664. rq = kmalloc(sizeof(struct request), GFP_ATOMIC);
  665. if (rq == NULL || pc == NULL) {
  666. printk (KERN_ERR "ide-scsi: %s: out of memory\n", drive->name);
  667. goto abort;
  668. }
  669. memset (pc->c, 0, 12);
  670. pc->flags = 0;
  671. pc->rq = rq;
  672. memcpy (pc->c, cmd->cmnd, cmd->cmd_len);
  673. pc->buf = NULL;
  674. pc->sg = scsi_sglist(cmd);
  675. pc->sg_cnt = scsi_sg_count(cmd);
  676. pc->b_count = 0;
  677. pc->req_xfer = pc->buf_size = scsi_bufflen(cmd);
  678. pc->scsi_cmd = cmd;
  679. pc->done = done;
  680. pc->timeout = jiffies + cmd->timeout_per_command;
  681. if (test_bit(IDESCSI_LOG_CMD, &scsi->log)) {
  682. printk ("ide-scsi: %s: que %lu, cmd = ", drive->name, cmd->serial_number);
  683. ide_scsi_hex_dump(cmd->cmnd, cmd->cmd_len);
  684. if (memcmp(pc->c, cmd->cmnd, cmd->cmd_len)) {
  685. printk ("ide-scsi: %s: que %lu, tsl = ", drive->name, cmd->serial_number);
  686. ide_scsi_hex_dump(pc->c, 12);
  687. }
  688. }
  689. blk_rq_init(NULL, rq);
  690. rq->special = (char *) pc;
  691. rq->cmd_type = REQ_TYPE_SPECIAL;
  692. spin_unlock_irq(host->host_lock);
  693. rq->rq_disk = scsi->disk;
  694. (void) ide_do_drive_cmd (drive, rq, ide_end);
  695. spin_lock_irq(host->host_lock);
  696. return 0;
  697. abort:
  698. kfree (pc);
  699. kfree (rq);
  700. cmd->result = DID_ERROR << 16;
  701. done(cmd);
  702. return 0;
  703. }
  704. static int idescsi_eh_abort (struct scsi_cmnd *cmd)
  705. {
  706. idescsi_scsi_t *scsi = scsihost_to_idescsi(cmd->device->host);
  707. ide_drive_t *drive = scsi->drive;
  708. int busy;
  709. int ret = FAILED;
  710. /* In idescsi_eh_abort we try to gently pry our command from the ide subsystem */
  711. if (test_bit(IDESCSI_LOG_CMD, &scsi->log))
  712. printk (KERN_WARNING "ide-scsi: abort called for %lu\n", cmd->serial_number);
  713. if (!drive) {
  714. printk (KERN_WARNING "ide-scsi: Drive not set in idescsi_eh_abort\n");
  715. WARN_ON(1);
  716. goto no_drive;
  717. }
  718. /* First give it some more time, how much is "right" is hard to say :-( */
  719. busy = ide_wait_not_busy(HWIF(drive), 100); /* FIXME - uses mdelay which causes latency? */
  720. if (test_bit(IDESCSI_LOG_CMD, &scsi->log))
  721. printk (KERN_WARNING "ide-scsi: drive did%s become ready\n", busy?" not":"");
  722. spin_lock_irq(&ide_lock);
  723. /* If there is no pc running we're done (our interrupt took care of it) */
  724. if (!scsi->pc) {
  725. ret = SUCCESS;
  726. goto ide_unlock;
  727. }
  728. /* It's somewhere in flight. Does ide subsystem agree? */
  729. if (scsi->pc->scsi_cmd->serial_number == cmd->serial_number && !busy &&
  730. elv_queue_empty(drive->queue) && HWGROUP(drive)->rq != scsi->pc->rq) {
  731. /*
  732. * FIXME - not sure this condition can ever occur
  733. */
  734. printk (KERN_ERR "ide-scsi: cmd aborted!\n");
  735. if (blk_sense_request(scsi->pc->rq))
  736. kfree(scsi->pc->buf);
  737. kfree(scsi->pc->rq);
  738. kfree(scsi->pc);
  739. scsi->pc = NULL;
  740. ret = SUCCESS;
  741. }
  742. ide_unlock:
  743. spin_unlock_irq(&ide_lock);
  744. no_drive:
  745. if (test_bit(IDESCSI_LOG_CMD, &scsi->log))
  746. printk (KERN_WARNING "ide-scsi: abort returns %s\n", ret == SUCCESS?"success":"failed");
  747. return ret;
  748. }
  749. static int idescsi_eh_reset (struct scsi_cmnd *cmd)
  750. {
  751. struct request *req;
  752. idescsi_scsi_t *scsi = scsihost_to_idescsi(cmd->device->host);
  753. ide_drive_t *drive = scsi->drive;
  754. int ready = 0;
  755. int ret = SUCCESS;
  756. /* In idescsi_eh_reset we forcefully remove the command from the ide subsystem and reset the device. */
  757. if (test_bit(IDESCSI_LOG_CMD, &scsi->log))
  758. printk (KERN_WARNING "ide-scsi: reset called for %lu\n", cmd->serial_number);
  759. if (!drive) {
  760. printk (KERN_WARNING "ide-scsi: Drive not set in idescsi_eh_reset\n");
  761. WARN_ON(1);
  762. return FAILED;
  763. }
  764. spin_lock_irq(cmd->device->host->host_lock);
  765. spin_lock(&ide_lock);
  766. if (!scsi->pc || (req = scsi->pc->rq) != HWGROUP(drive)->rq || !HWGROUP(drive)->handler) {
  767. printk (KERN_WARNING "ide-scsi: No active request in idescsi_eh_reset\n");
  768. spin_unlock(&ide_lock);
  769. spin_unlock_irq(cmd->device->host->host_lock);
  770. return FAILED;
  771. }
  772. /* kill current request */
  773. if (__blk_end_request(req, -EIO, 0))
  774. BUG();
  775. if (blk_sense_request(req))
  776. kfree(scsi->pc->buf);
  777. kfree(scsi->pc);
  778. scsi->pc = NULL;
  779. kfree(req);
  780. /* now nuke the drive queue */
  781. while ((req = elv_next_request(drive->queue))) {
  782. if (__blk_end_request(req, -EIO, 0))
  783. BUG();
  784. }
  785. HWGROUP(drive)->rq = NULL;
  786. HWGROUP(drive)->handler = NULL;
  787. HWGROUP(drive)->busy = 1; /* will set this to zero when ide reset finished */
  788. spin_unlock(&ide_lock);
  789. ide_do_reset(drive);
  790. /* ide_do_reset starts a polling handler which restarts itself every 50ms until the reset finishes */
  791. do {
  792. spin_unlock_irq(cmd->device->host->host_lock);
  793. msleep(50);
  794. spin_lock_irq(cmd->device->host->host_lock);
  795. } while ( HWGROUP(drive)->handler );
  796. ready = drive_is_ready(drive);
  797. HWGROUP(drive)->busy--;
  798. if (!ready) {
  799. printk (KERN_ERR "ide-scsi: reset failed!\n");
  800. ret = FAILED;
  801. }
  802. spin_unlock_irq(cmd->device->host->host_lock);
  803. return ret;
  804. }
  805. static int idescsi_bios(struct scsi_device *sdev, struct block_device *bdev,
  806. sector_t capacity, int *parm)
  807. {
  808. idescsi_scsi_t *idescsi = scsihost_to_idescsi(sdev->host);
  809. ide_drive_t *drive = idescsi->drive;
  810. if (drive->bios_cyl && drive->bios_head && drive->bios_sect) {
  811. parm[0] = drive->bios_head;
  812. parm[1] = drive->bios_sect;
  813. parm[2] = drive->bios_cyl;
  814. }
  815. return 0;
  816. }
  817. static struct scsi_host_template idescsi_template = {
  818. .module = THIS_MODULE,
  819. .name = "idescsi",
  820. .info = idescsi_info,
  821. .slave_configure = idescsi_slave_configure,
  822. .ioctl = idescsi_ioctl,
  823. .queuecommand = idescsi_queue,
  824. .eh_abort_handler = idescsi_eh_abort,
  825. .eh_host_reset_handler = idescsi_eh_reset,
  826. .bios_param = idescsi_bios,
  827. .can_queue = 40,
  828. .this_id = -1,
  829. .sg_tablesize = 256,
  830. .cmd_per_lun = 5,
  831. .max_sectors = 128,
  832. .use_clustering = DISABLE_CLUSTERING,
  833. .emulated = 1,
  834. .proc_name = "ide-scsi",
  835. };
  836. static int ide_scsi_probe(ide_drive_t *drive)
  837. {
  838. idescsi_scsi_t *idescsi;
  839. struct Scsi_Host *host;
  840. struct gendisk *g;
  841. static int warned;
  842. int err = -ENOMEM;
  843. if (!warned && drive->media == ide_cdrom) {
  844. printk(KERN_WARNING "ide-scsi is deprecated for cd burning! Use ide-cd and give dev=/dev/hdX as device\n");
  845. warned = 1;
  846. }
  847. if (idescsi_nocd && drive->media == ide_cdrom)
  848. return -ENODEV;
  849. if (!strstr("ide-scsi", drive->driver_req) ||
  850. !drive->present ||
  851. drive->media == ide_disk ||
  852. !(host = scsi_host_alloc(&idescsi_template,sizeof(idescsi_scsi_t))))
  853. return -ENODEV;
  854. g = alloc_disk(1 << PARTN_BITS);
  855. if (!g)
  856. goto out_host_put;
  857. ide_init_disk(g, drive);
  858. host->max_id = 1;
  859. #if IDESCSI_DEBUG_LOG
  860. if (drive->id->last_lun)
  861. printk(KERN_NOTICE "%s: id->last_lun=%u\n", drive->name, drive->id->last_lun);
  862. #endif
  863. if ((drive->id->last_lun & 0x7) != 7)
  864. host->max_lun = (drive->id->last_lun & 0x7) + 1;
  865. else
  866. host->max_lun = 1;
  867. drive->driver_data = host;
  868. idescsi = scsihost_to_idescsi(host);
  869. idescsi->drive = drive;
  870. idescsi->driver = &idescsi_driver;
  871. idescsi->host = host;
  872. idescsi->disk = g;
  873. g->private_data = &idescsi->driver;
  874. ide_proc_register_driver(drive, &idescsi_driver);
  875. err = 0;
  876. idescsi_setup(drive, idescsi);
  877. g->fops = &idescsi_ops;
  878. ide_register_region(g);
  879. err = scsi_add_host(host, &drive->gendev);
  880. if (!err) {
  881. scsi_scan_host(host);
  882. return 0;
  883. }
  884. /* fall through on error */
  885. ide_unregister_region(g);
  886. ide_proc_unregister_driver(drive, &idescsi_driver);
  887. put_disk(g);
  888. out_host_put:
  889. scsi_host_put(host);
  890. return err;
  891. }
  892. static int __init init_idescsi_module(void)
  893. {
  894. return driver_register(&idescsi_driver.gen_driver);
  895. }
  896. static void __exit exit_idescsi_module(void)
  897. {
  898. driver_unregister(&idescsi_driver.gen_driver);
  899. }
  900. module_param(idescsi_nocd, int, 0600);
  901. MODULE_PARM_DESC(idescsi_nocd, "Disable handling of CD-ROMs so they may be driven by ide-cd");
  902. module_init(init_idescsi_module);
  903. module_exit(exit_idescsi_module);
  904. MODULE_LICENSE("GPL");