target_core_sbc.c 37 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401
  1. /*
  2. * SCSI Block Commands (SBC) parsing and emulation.
  3. *
  4. * (c) Copyright 2002-2013 Datera, Inc.
  5. *
  6. * Nicholas A. Bellinger <nab@kernel.org>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  21. */
  22. #include <linux/kernel.h>
  23. #include <linux/module.h>
  24. #include <linux/ratelimit.h>
  25. #include <linux/crc-t10dif.h>
  26. #include <asm/unaligned.h>
  27. #include <scsi/scsi.h>
  28. #include <scsi/scsi_tcq.h>
  29. #include <target/target_core_base.h>
  30. #include <target/target_core_backend.h>
  31. #include <target/target_core_fabric.h>
  32. #include "target_core_internal.h"
  33. #include "target_core_ua.h"
  34. #include "target_core_alua.h"
  35. static sense_reason_t
  36. sbc_check_prot(struct se_device *, struct se_cmd *, unsigned char *, u32, bool);
  37. static sense_reason_t
  38. sbc_emulate_readcapacity(struct se_cmd *cmd)
  39. {
  40. struct se_device *dev = cmd->se_dev;
  41. unsigned char *cdb = cmd->t_task_cdb;
  42. unsigned long long blocks_long = dev->transport->get_blocks(dev);
  43. unsigned char *rbuf;
  44. unsigned char buf[8];
  45. u32 blocks;
  46. /*
  47. * SBC-2 says:
  48. * If the PMI bit is set to zero and the LOGICAL BLOCK
  49. * ADDRESS field is not set to zero, the device server shall
  50. * terminate the command with CHECK CONDITION status with
  51. * the sense key set to ILLEGAL REQUEST and the additional
  52. * sense code set to INVALID FIELD IN CDB.
  53. *
  54. * In SBC-3, these fields are obsolete, but some SCSI
  55. * compliance tests actually check this, so we might as well
  56. * follow SBC-2.
  57. */
  58. if (!(cdb[8] & 1) && !!(cdb[2] | cdb[3] | cdb[4] | cdb[5]))
  59. return TCM_INVALID_CDB_FIELD;
  60. if (blocks_long >= 0x00000000ffffffff)
  61. blocks = 0xffffffff;
  62. else
  63. blocks = (u32)blocks_long;
  64. buf[0] = (blocks >> 24) & 0xff;
  65. buf[1] = (blocks >> 16) & 0xff;
  66. buf[2] = (blocks >> 8) & 0xff;
  67. buf[3] = blocks & 0xff;
  68. buf[4] = (dev->dev_attrib.block_size >> 24) & 0xff;
  69. buf[5] = (dev->dev_attrib.block_size >> 16) & 0xff;
  70. buf[6] = (dev->dev_attrib.block_size >> 8) & 0xff;
  71. buf[7] = dev->dev_attrib.block_size & 0xff;
  72. rbuf = transport_kmap_data_sg(cmd);
  73. if (rbuf) {
  74. memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
  75. transport_kunmap_data_sg(cmd);
  76. }
  77. target_complete_cmd_with_length(cmd, GOOD, 8);
  78. return 0;
  79. }
  80. static sense_reason_t
  81. sbc_emulate_readcapacity_16(struct se_cmd *cmd)
  82. {
  83. struct se_device *dev = cmd->se_dev;
  84. struct se_session *sess = cmd->se_sess;
  85. unsigned char *rbuf;
  86. unsigned char buf[32];
  87. unsigned long long blocks = dev->transport->get_blocks(dev);
  88. memset(buf, 0, sizeof(buf));
  89. buf[0] = (blocks >> 56) & 0xff;
  90. buf[1] = (blocks >> 48) & 0xff;
  91. buf[2] = (blocks >> 40) & 0xff;
  92. buf[3] = (blocks >> 32) & 0xff;
  93. buf[4] = (blocks >> 24) & 0xff;
  94. buf[5] = (blocks >> 16) & 0xff;
  95. buf[6] = (blocks >> 8) & 0xff;
  96. buf[7] = blocks & 0xff;
  97. buf[8] = (dev->dev_attrib.block_size >> 24) & 0xff;
  98. buf[9] = (dev->dev_attrib.block_size >> 16) & 0xff;
  99. buf[10] = (dev->dev_attrib.block_size >> 8) & 0xff;
  100. buf[11] = dev->dev_attrib.block_size & 0xff;
  101. /*
  102. * Set P_TYPE and PROT_EN bits for DIF support
  103. */
  104. if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
  105. if (dev->dev_attrib.pi_prot_type)
  106. buf[12] = (dev->dev_attrib.pi_prot_type - 1) << 1 | 0x1;
  107. }
  108. if (dev->transport->get_lbppbe)
  109. buf[13] = dev->transport->get_lbppbe(dev) & 0x0f;
  110. if (dev->transport->get_alignment_offset_lbas) {
  111. u16 lalba = dev->transport->get_alignment_offset_lbas(dev);
  112. buf[14] = (lalba >> 8) & 0x3f;
  113. buf[15] = lalba & 0xff;
  114. }
  115. /*
  116. * Set Thin Provisioning Enable bit following sbc3r22 in section
  117. * READ CAPACITY (16) byte 14 if emulate_tpu or emulate_tpws is enabled.
  118. */
  119. if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws)
  120. buf[14] |= 0x80;
  121. rbuf = transport_kmap_data_sg(cmd);
  122. if (rbuf) {
  123. memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
  124. transport_kunmap_data_sg(cmd);
  125. }
  126. target_complete_cmd_with_length(cmd, GOOD, 32);
  127. return 0;
  128. }
  129. sector_t sbc_get_write_same_sectors(struct se_cmd *cmd)
  130. {
  131. u32 num_blocks;
  132. if (cmd->t_task_cdb[0] == WRITE_SAME)
  133. num_blocks = get_unaligned_be16(&cmd->t_task_cdb[7]);
  134. else if (cmd->t_task_cdb[0] == WRITE_SAME_16)
  135. num_blocks = get_unaligned_be32(&cmd->t_task_cdb[10]);
  136. else /* WRITE_SAME_32 via VARIABLE_LENGTH_CMD */
  137. num_blocks = get_unaligned_be32(&cmd->t_task_cdb[28]);
  138. /*
  139. * Use the explicit range when non zero is supplied, otherwise calculate
  140. * the remaining range based on ->get_blocks() - starting LBA.
  141. */
  142. if (num_blocks)
  143. return num_blocks;
  144. return cmd->se_dev->transport->get_blocks(cmd->se_dev) -
  145. cmd->t_task_lba + 1;
  146. }
  147. EXPORT_SYMBOL(sbc_get_write_same_sectors);
  148. static sense_reason_t
  149. sbc_emulate_noop(struct se_cmd *cmd)
  150. {
  151. target_complete_cmd(cmd, GOOD);
  152. return 0;
  153. }
  154. static inline u32 sbc_get_size(struct se_cmd *cmd, u32 sectors)
  155. {
  156. return cmd->se_dev->dev_attrib.block_size * sectors;
  157. }
  158. static inline u32 transport_get_sectors_6(unsigned char *cdb)
  159. {
  160. /*
  161. * Use 8-bit sector value. SBC-3 says:
  162. *
  163. * A TRANSFER LENGTH field set to zero specifies that 256
  164. * logical blocks shall be written. Any other value
  165. * specifies the number of logical blocks that shall be
  166. * written.
  167. */
  168. return cdb[4] ? : 256;
  169. }
  170. static inline u32 transport_get_sectors_10(unsigned char *cdb)
  171. {
  172. return (u32)(cdb[7] << 8) + cdb[8];
  173. }
  174. static inline u32 transport_get_sectors_12(unsigned char *cdb)
  175. {
  176. return (u32)(cdb[6] << 24) + (cdb[7] << 16) + (cdb[8] << 8) + cdb[9];
  177. }
  178. static inline u32 transport_get_sectors_16(unsigned char *cdb)
  179. {
  180. return (u32)(cdb[10] << 24) + (cdb[11] << 16) +
  181. (cdb[12] << 8) + cdb[13];
  182. }
  183. /*
  184. * Used for VARIABLE_LENGTH_CDB WRITE_32 and READ_32 variants
  185. */
  186. static inline u32 transport_get_sectors_32(unsigned char *cdb)
  187. {
  188. return (u32)(cdb[28] << 24) + (cdb[29] << 16) +
  189. (cdb[30] << 8) + cdb[31];
  190. }
  191. static inline u32 transport_lba_21(unsigned char *cdb)
  192. {
  193. return ((cdb[1] & 0x1f) << 16) | (cdb[2] << 8) | cdb[3];
  194. }
  195. static inline u32 transport_lba_32(unsigned char *cdb)
  196. {
  197. return (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5];
  198. }
  199. static inline unsigned long long transport_lba_64(unsigned char *cdb)
  200. {
  201. unsigned int __v1, __v2;
  202. __v1 = (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5];
  203. __v2 = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9];
  204. return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32;
  205. }
  206. /*
  207. * For VARIABLE_LENGTH_CDB w/ 32 byte extended CDBs
  208. */
  209. static inline unsigned long long transport_lba_64_ext(unsigned char *cdb)
  210. {
  211. unsigned int __v1, __v2;
  212. __v1 = (cdb[12] << 24) | (cdb[13] << 16) | (cdb[14] << 8) | cdb[15];
  213. __v2 = (cdb[16] << 24) | (cdb[17] << 16) | (cdb[18] << 8) | cdb[19];
  214. return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32;
  215. }
  216. static sense_reason_t
  217. sbc_setup_write_same(struct se_cmd *cmd, unsigned char *flags, struct sbc_ops *ops)
  218. {
  219. struct se_device *dev = cmd->se_dev;
  220. sector_t end_lba = dev->transport->get_blocks(dev) + 1;
  221. unsigned int sectors = sbc_get_write_same_sectors(cmd);
  222. sense_reason_t ret;
  223. if ((flags[0] & 0x04) || (flags[0] & 0x02)) {
  224. pr_err("WRITE_SAME PBDATA and LBDATA"
  225. " bits not supported for Block Discard"
  226. " Emulation\n");
  227. return TCM_UNSUPPORTED_SCSI_OPCODE;
  228. }
  229. if (sectors > cmd->se_dev->dev_attrib.max_write_same_len) {
  230. pr_warn("WRITE_SAME sectors: %u exceeds max_write_same_len: %u\n",
  231. sectors, cmd->se_dev->dev_attrib.max_write_same_len);
  232. return TCM_INVALID_CDB_FIELD;
  233. }
  234. /*
  235. * Sanity check for LBA wrap and request past end of device.
  236. */
  237. if (((cmd->t_task_lba + sectors) < cmd->t_task_lba) ||
  238. ((cmd->t_task_lba + sectors) > end_lba)) {
  239. pr_err("WRITE_SAME exceeds last lba %llu (lba %llu, sectors %u)\n",
  240. (unsigned long long)end_lba, cmd->t_task_lba, sectors);
  241. return TCM_ADDRESS_OUT_OF_RANGE;
  242. }
  243. /* We always have ANC_SUP == 0 so setting ANCHOR is always an error */
  244. if (flags[0] & 0x10) {
  245. pr_warn("WRITE SAME with ANCHOR not supported\n");
  246. return TCM_INVALID_CDB_FIELD;
  247. }
  248. /*
  249. * Special case for WRITE_SAME w/ UNMAP=1 that ends up getting
  250. * translated into block discard requests within backend code.
  251. */
  252. if (flags[0] & 0x08) {
  253. if (!ops->execute_write_same_unmap)
  254. return TCM_UNSUPPORTED_SCSI_OPCODE;
  255. if (!dev->dev_attrib.emulate_tpws) {
  256. pr_err("Got WRITE_SAME w/ UNMAP=1, but backend device"
  257. " has emulate_tpws disabled\n");
  258. return TCM_UNSUPPORTED_SCSI_OPCODE;
  259. }
  260. cmd->execute_cmd = ops->execute_write_same_unmap;
  261. return 0;
  262. }
  263. if (!ops->execute_write_same)
  264. return TCM_UNSUPPORTED_SCSI_OPCODE;
  265. ret = sbc_check_prot(dev, cmd, &cmd->t_task_cdb[0], sectors, true);
  266. if (ret)
  267. return ret;
  268. cmd->execute_cmd = ops->execute_write_same;
  269. return 0;
  270. }
  271. static sense_reason_t xdreadwrite_callback(struct se_cmd *cmd)
  272. {
  273. unsigned char *buf, *addr;
  274. struct scatterlist *sg;
  275. unsigned int offset;
  276. sense_reason_t ret = TCM_NO_SENSE;
  277. int i, count;
  278. /*
  279. * From sbc3r22.pdf section 5.48 XDWRITEREAD (10) command
  280. *
  281. * 1) read the specified logical block(s);
  282. * 2) transfer logical blocks from the data-out buffer;
  283. * 3) XOR the logical blocks transferred from the data-out buffer with
  284. * the logical blocks read, storing the resulting XOR data in a buffer;
  285. * 4) if the DISABLE WRITE bit is set to zero, then write the logical
  286. * blocks transferred from the data-out buffer; and
  287. * 5) transfer the resulting XOR data to the data-in buffer.
  288. */
  289. buf = kmalloc(cmd->data_length, GFP_KERNEL);
  290. if (!buf) {
  291. pr_err("Unable to allocate xor_callback buf\n");
  292. return TCM_OUT_OF_RESOURCES;
  293. }
  294. /*
  295. * Copy the scatterlist WRITE buffer located at cmd->t_data_sg
  296. * into the locally allocated *buf
  297. */
  298. sg_copy_to_buffer(cmd->t_data_sg,
  299. cmd->t_data_nents,
  300. buf,
  301. cmd->data_length);
  302. /*
  303. * Now perform the XOR against the BIDI read memory located at
  304. * cmd->t_mem_bidi_list
  305. */
  306. offset = 0;
  307. for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, count) {
  308. addr = kmap_atomic(sg_page(sg));
  309. if (!addr) {
  310. ret = TCM_OUT_OF_RESOURCES;
  311. goto out;
  312. }
  313. for (i = 0; i < sg->length; i++)
  314. *(addr + sg->offset + i) ^= *(buf + offset + i);
  315. offset += sg->length;
  316. kunmap_atomic(addr);
  317. }
  318. out:
  319. kfree(buf);
  320. return ret;
  321. }
  322. static sense_reason_t
  323. sbc_execute_rw(struct se_cmd *cmd)
  324. {
  325. return cmd->execute_rw(cmd, cmd->t_data_sg, cmd->t_data_nents,
  326. cmd->data_direction);
  327. }
  328. static sense_reason_t compare_and_write_post(struct se_cmd *cmd)
  329. {
  330. struct se_device *dev = cmd->se_dev;
  331. /*
  332. * Only set SCF_COMPARE_AND_WRITE_POST to force a response fall-through
  333. * within target_complete_ok_work() if the command was successfully
  334. * sent to the backend driver.
  335. */
  336. spin_lock_irq(&cmd->t_state_lock);
  337. if ((cmd->transport_state & CMD_T_SENT) && !cmd->scsi_status)
  338. cmd->se_cmd_flags |= SCF_COMPARE_AND_WRITE_POST;
  339. spin_unlock_irq(&cmd->t_state_lock);
  340. /*
  341. * Unlock ->caw_sem originally obtained during sbc_compare_and_write()
  342. * before the original READ I/O submission.
  343. */
  344. up(&dev->caw_sem);
  345. return TCM_NO_SENSE;
  346. }
  347. static sense_reason_t compare_and_write_callback(struct se_cmd *cmd)
  348. {
  349. struct se_device *dev = cmd->se_dev;
  350. struct scatterlist *write_sg = NULL, *sg;
  351. unsigned char *buf = NULL, *addr;
  352. struct sg_mapping_iter m;
  353. unsigned int offset = 0, len;
  354. unsigned int nlbas = cmd->t_task_nolb;
  355. unsigned int block_size = dev->dev_attrib.block_size;
  356. unsigned int compare_len = (nlbas * block_size);
  357. sense_reason_t ret = TCM_NO_SENSE;
  358. int rc, i;
  359. /*
  360. * Handle early failure in transport_generic_request_failure(),
  361. * which will not have taken ->caw_mutex yet..
  362. */
  363. if (!cmd->t_data_sg || !cmd->t_bidi_data_sg)
  364. return TCM_NO_SENSE;
  365. /*
  366. * Immediately exit + release dev->caw_sem if command has already
  367. * been failed with a non-zero SCSI status.
  368. */
  369. if (cmd->scsi_status) {
  370. pr_err("compare_and_write_callback: non zero scsi_status:"
  371. " 0x%02x\n", cmd->scsi_status);
  372. goto out;
  373. }
  374. buf = kzalloc(cmd->data_length, GFP_KERNEL);
  375. if (!buf) {
  376. pr_err("Unable to allocate compare_and_write buf\n");
  377. ret = TCM_OUT_OF_RESOURCES;
  378. goto out;
  379. }
  380. write_sg = kmalloc(sizeof(struct scatterlist) * cmd->t_data_nents,
  381. GFP_KERNEL);
  382. if (!write_sg) {
  383. pr_err("Unable to allocate compare_and_write sg\n");
  384. ret = TCM_OUT_OF_RESOURCES;
  385. goto out;
  386. }
  387. sg_init_table(write_sg, cmd->t_data_nents);
  388. /*
  389. * Setup verify and write data payloads from total NumberLBAs.
  390. */
  391. rc = sg_copy_to_buffer(cmd->t_data_sg, cmd->t_data_nents, buf,
  392. cmd->data_length);
  393. if (!rc) {
  394. pr_err("sg_copy_to_buffer() failed for compare_and_write\n");
  395. ret = TCM_OUT_OF_RESOURCES;
  396. goto out;
  397. }
  398. /*
  399. * Compare against SCSI READ payload against verify payload
  400. */
  401. for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, i) {
  402. addr = (unsigned char *)kmap_atomic(sg_page(sg));
  403. if (!addr) {
  404. ret = TCM_OUT_OF_RESOURCES;
  405. goto out;
  406. }
  407. len = min(sg->length, compare_len);
  408. if (memcmp(addr, buf + offset, len)) {
  409. pr_warn("Detected MISCOMPARE for addr: %p buf: %p\n",
  410. addr, buf + offset);
  411. kunmap_atomic(addr);
  412. goto miscompare;
  413. }
  414. kunmap_atomic(addr);
  415. offset += len;
  416. compare_len -= len;
  417. if (!compare_len)
  418. break;
  419. }
  420. i = 0;
  421. len = cmd->t_task_nolb * block_size;
  422. sg_miter_start(&m, cmd->t_data_sg, cmd->t_data_nents, SG_MITER_TO_SG);
  423. /*
  424. * Currently assumes NoLB=1 and SGLs are PAGE_SIZE..
  425. */
  426. while (len) {
  427. sg_miter_next(&m);
  428. if (block_size < PAGE_SIZE) {
  429. sg_set_page(&write_sg[i], m.page, block_size,
  430. block_size);
  431. } else {
  432. sg_miter_next(&m);
  433. sg_set_page(&write_sg[i], m.page, block_size,
  434. 0);
  435. }
  436. len -= block_size;
  437. i++;
  438. }
  439. sg_miter_stop(&m);
  440. /*
  441. * Save the original SGL + nents values before updating to new
  442. * assignments, to be released in transport_free_pages() ->
  443. * transport_reset_sgl_orig()
  444. */
  445. cmd->t_data_sg_orig = cmd->t_data_sg;
  446. cmd->t_data_sg = write_sg;
  447. cmd->t_data_nents_orig = cmd->t_data_nents;
  448. cmd->t_data_nents = 1;
  449. cmd->sam_task_attr = TCM_HEAD_TAG;
  450. cmd->transport_complete_callback = compare_and_write_post;
  451. /*
  452. * Now reset ->execute_cmd() to the normal sbc_execute_rw() handler
  453. * for submitting the adjusted SGL to write instance user-data.
  454. */
  455. cmd->execute_cmd = sbc_execute_rw;
  456. spin_lock_irq(&cmd->t_state_lock);
  457. cmd->t_state = TRANSPORT_PROCESSING;
  458. cmd->transport_state |= CMD_T_ACTIVE|CMD_T_BUSY|CMD_T_SENT;
  459. spin_unlock_irq(&cmd->t_state_lock);
  460. __target_execute_cmd(cmd);
  461. kfree(buf);
  462. return ret;
  463. miscompare:
  464. pr_warn("Target/%s: Send MISCOMPARE check condition and sense\n",
  465. dev->transport->name);
  466. ret = TCM_MISCOMPARE_VERIFY;
  467. out:
  468. /*
  469. * In the MISCOMPARE or failure case, unlock ->caw_sem obtained in
  470. * sbc_compare_and_write() before the original READ I/O submission.
  471. */
  472. up(&dev->caw_sem);
  473. kfree(write_sg);
  474. kfree(buf);
  475. return ret;
  476. }
  477. static sense_reason_t
  478. sbc_compare_and_write(struct se_cmd *cmd)
  479. {
  480. struct se_device *dev = cmd->se_dev;
  481. sense_reason_t ret;
  482. int rc;
  483. /*
  484. * Submit the READ first for COMPARE_AND_WRITE to perform the
  485. * comparision using SGLs at cmd->t_bidi_data_sg..
  486. */
  487. rc = down_interruptible(&dev->caw_sem);
  488. if ((rc != 0) || signal_pending(current)) {
  489. cmd->transport_complete_callback = NULL;
  490. return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
  491. }
  492. /*
  493. * Reset cmd->data_length to individual block_size in order to not
  494. * confuse backend drivers that depend on this value matching the
  495. * size of the I/O being submitted.
  496. */
  497. cmd->data_length = cmd->t_task_nolb * dev->dev_attrib.block_size;
  498. ret = cmd->execute_rw(cmd, cmd->t_bidi_data_sg, cmd->t_bidi_data_nents,
  499. DMA_FROM_DEVICE);
  500. if (ret) {
  501. cmd->transport_complete_callback = NULL;
  502. up(&dev->caw_sem);
  503. return ret;
  504. }
  505. /*
  506. * Unlock of dev->caw_sem to occur in compare_and_write_callback()
  507. * upon MISCOMPARE, or in compare_and_write_done() upon completion
  508. * of WRITE instance user-data.
  509. */
  510. return TCM_NO_SENSE;
  511. }
  512. static int
  513. sbc_set_prot_op_checks(u8 protect, enum target_prot_type prot_type,
  514. bool is_write, struct se_cmd *cmd)
  515. {
  516. if (is_write) {
  517. cmd->prot_op = protect ? TARGET_PROT_DOUT_PASS :
  518. TARGET_PROT_DOUT_INSERT;
  519. switch (protect) {
  520. case 0x0:
  521. case 0x3:
  522. cmd->prot_checks = 0;
  523. break;
  524. case 0x1:
  525. case 0x5:
  526. cmd->prot_checks = TARGET_DIF_CHECK_GUARD;
  527. if (prot_type == TARGET_DIF_TYPE1_PROT)
  528. cmd->prot_checks |= TARGET_DIF_CHECK_REFTAG;
  529. break;
  530. case 0x2:
  531. if (prot_type == TARGET_DIF_TYPE1_PROT)
  532. cmd->prot_checks = TARGET_DIF_CHECK_REFTAG;
  533. break;
  534. case 0x4:
  535. cmd->prot_checks = TARGET_DIF_CHECK_GUARD;
  536. break;
  537. default:
  538. pr_err("Unsupported protect field %d\n", protect);
  539. return -EINVAL;
  540. }
  541. } else {
  542. cmd->prot_op = protect ? TARGET_PROT_DIN_PASS :
  543. TARGET_PROT_DIN_STRIP;
  544. switch (protect) {
  545. case 0x0:
  546. case 0x1:
  547. case 0x5:
  548. cmd->prot_checks = TARGET_DIF_CHECK_GUARD;
  549. if (prot_type == TARGET_DIF_TYPE1_PROT)
  550. cmd->prot_checks |= TARGET_DIF_CHECK_REFTAG;
  551. break;
  552. case 0x2:
  553. if (prot_type == TARGET_DIF_TYPE1_PROT)
  554. cmd->prot_checks = TARGET_DIF_CHECK_REFTAG;
  555. break;
  556. case 0x3:
  557. cmd->prot_checks = 0;
  558. break;
  559. case 0x4:
  560. cmd->prot_checks = TARGET_DIF_CHECK_GUARD;
  561. break;
  562. default:
  563. pr_err("Unsupported protect field %d\n", protect);
  564. return -EINVAL;
  565. }
  566. }
  567. return 0;
  568. }
  569. static sense_reason_t
  570. sbc_check_prot(struct se_device *dev, struct se_cmd *cmd, unsigned char *cdb,
  571. u32 sectors, bool is_write)
  572. {
  573. u8 protect = cdb[1] >> 5;
  574. if (!cmd->t_prot_sg || !cmd->t_prot_nents) {
  575. if (protect && !dev->dev_attrib.pi_prot_type) {
  576. pr_err("CDB contains protect bit, but device does not"
  577. " advertise PROTECT=1 feature bit\n");
  578. return TCM_INVALID_CDB_FIELD;
  579. }
  580. if (cmd->prot_pto)
  581. return TCM_NO_SENSE;
  582. }
  583. switch (dev->dev_attrib.pi_prot_type) {
  584. case TARGET_DIF_TYPE3_PROT:
  585. cmd->reftag_seed = 0xffffffff;
  586. break;
  587. case TARGET_DIF_TYPE2_PROT:
  588. if (protect)
  589. return TCM_INVALID_CDB_FIELD;
  590. cmd->reftag_seed = cmd->t_task_lba;
  591. break;
  592. case TARGET_DIF_TYPE1_PROT:
  593. cmd->reftag_seed = cmd->t_task_lba;
  594. break;
  595. case TARGET_DIF_TYPE0_PROT:
  596. default:
  597. return TCM_NO_SENSE;
  598. }
  599. if (sbc_set_prot_op_checks(protect, dev->dev_attrib.pi_prot_type,
  600. is_write, cmd))
  601. return TCM_INVALID_CDB_FIELD;
  602. cmd->prot_type = dev->dev_attrib.pi_prot_type;
  603. cmd->prot_length = dev->prot_length * sectors;
  604. /**
  605. * In case protection information exists over the wire
  606. * we modify command data length to describe pure data.
  607. * The actual transfer length is data length + protection
  608. * length
  609. **/
  610. if (protect)
  611. cmd->data_length = sectors * dev->dev_attrib.block_size;
  612. pr_debug("%s: prot_type=%d, data_length=%d, prot_length=%d "
  613. "prot_op=%d prot_checks=%d\n",
  614. __func__, cmd->prot_type, cmd->data_length, cmd->prot_length,
  615. cmd->prot_op, cmd->prot_checks);
  616. return TCM_NO_SENSE;
  617. }
  618. static int
  619. sbc_check_dpofua(struct se_device *dev, struct se_cmd *cmd, unsigned char *cdb)
  620. {
  621. if (cdb[1] & 0x10) {
  622. if (!dev->dev_attrib.emulate_dpo) {
  623. pr_err("Got CDB: 0x%02x with DPO bit set, but device"
  624. " does not advertise support for DPO\n", cdb[0]);
  625. return -EINVAL;
  626. }
  627. }
  628. if (cdb[1] & 0x8) {
  629. if (!dev->dev_attrib.emulate_fua_write ||
  630. !dev->dev_attrib.emulate_write_cache) {
  631. pr_err("Got CDB: 0x%02x with FUA bit set, but device"
  632. " does not advertise support for FUA write\n",
  633. cdb[0]);
  634. return -EINVAL;
  635. }
  636. cmd->se_cmd_flags |= SCF_FUA;
  637. }
  638. return 0;
  639. }
  640. sense_reason_t
  641. sbc_parse_cdb(struct se_cmd *cmd, struct sbc_ops *ops)
  642. {
  643. struct se_device *dev = cmd->se_dev;
  644. unsigned char *cdb = cmd->t_task_cdb;
  645. unsigned int size;
  646. u32 sectors = 0;
  647. sense_reason_t ret;
  648. switch (cdb[0]) {
  649. case READ_6:
  650. sectors = transport_get_sectors_6(cdb);
  651. cmd->t_task_lba = transport_lba_21(cdb);
  652. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  653. cmd->execute_rw = ops->execute_rw;
  654. cmd->execute_cmd = sbc_execute_rw;
  655. break;
  656. case READ_10:
  657. sectors = transport_get_sectors_10(cdb);
  658. cmd->t_task_lba = transport_lba_32(cdb);
  659. if (sbc_check_dpofua(dev, cmd, cdb))
  660. return TCM_INVALID_CDB_FIELD;
  661. ret = sbc_check_prot(dev, cmd, cdb, sectors, false);
  662. if (ret)
  663. return ret;
  664. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  665. cmd->execute_rw = ops->execute_rw;
  666. cmd->execute_cmd = sbc_execute_rw;
  667. break;
  668. case READ_12:
  669. sectors = transport_get_sectors_12(cdb);
  670. cmd->t_task_lba = transport_lba_32(cdb);
  671. if (sbc_check_dpofua(dev, cmd, cdb))
  672. return TCM_INVALID_CDB_FIELD;
  673. ret = sbc_check_prot(dev, cmd, cdb, sectors, false);
  674. if (ret)
  675. return ret;
  676. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  677. cmd->execute_rw = ops->execute_rw;
  678. cmd->execute_cmd = sbc_execute_rw;
  679. break;
  680. case READ_16:
  681. sectors = transport_get_sectors_16(cdb);
  682. cmd->t_task_lba = transport_lba_64(cdb);
  683. if (sbc_check_dpofua(dev, cmd, cdb))
  684. return TCM_INVALID_CDB_FIELD;
  685. ret = sbc_check_prot(dev, cmd, cdb, sectors, false);
  686. if (ret)
  687. return ret;
  688. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  689. cmd->execute_rw = ops->execute_rw;
  690. cmd->execute_cmd = sbc_execute_rw;
  691. break;
  692. case WRITE_6:
  693. sectors = transport_get_sectors_6(cdb);
  694. cmd->t_task_lba = transport_lba_21(cdb);
  695. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  696. cmd->execute_rw = ops->execute_rw;
  697. cmd->execute_cmd = sbc_execute_rw;
  698. break;
  699. case WRITE_10:
  700. case WRITE_VERIFY:
  701. sectors = transport_get_sectors_10(cdb);
  702. cmd->t_task_lba = transport_lba_32(cdb);
  703. if (sbc_check_dpofua(dev, cmd, cdb))
  704. return TCM_INVALID_CDB_FIELD;
  705. ret = sbc_check_prot(dev, cmd, cdb, sectors, true);
  706. if (ret)
  707. return ret;
  708. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  709. cmd->execute_rw = ops->execute_rw;
  710. cmd->execute_cmd = sbc_execute_rw;
  711. break;
  712. case WRITE_12:
  713. sectors = transport_get_sectors_12(cdb);
  714. cmd->t_task_lba = transport_lba_32(cdb);
  715. if (sbc_check_dpofua(dev, cmd, cdb))
  716. return TCM_INVALID_CDB_FIELD;
  717. ret = sbc_check_prot(dev, cmd, cdb, sectors, true);
  718. if (ret)
  719. return ret;
  720. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  721. cmd->execute_rw = ops->execute_rw;
  722. cmd->execute_cmd = sbc_execute_rw;
  723. break;
  724. case WRITE_16:
  725. sectors = transport_get_sectors_16(cdb);
  726. cmd->t_task_lba = transport_lba_64(cdb);
  727. if (sbc_check_dpofua(dev, cmd, cdb))
  728. return TCM_INVALID_CDB_FIELD;
  729. ret = sbc_check_prot(dev, cmd, cdb, sectors, true);
  730. if (ret)
  731. return ret;
  732. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  733. cmd->execute_rw = ops->execute_rw;
  734. cmd->execute_cmd = sbc_execute_rw;
  735. break;
  736. case XDWRITEREAD_10:
  737. if (cmd->data_direction != DMA_TO_DEVICE ||
  738. !(cmd->se_cmd_flags & SCF_BIDI))
  739. return TCM_INVALID_CDB_FIELD;
  740. sectors = transport_get_sectors_10(cdb);
  741. if (sbc_check_dpofua(dev, cmd, cdb))
  742. return TCM_INVALID_CDB_FIELD;
  743. cmd->t_task_lba = transport_lba_32(cdb);
  744. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  745. /*
  746. * Setup BIDI XOR callback to be run after I/O completion.
  747. */
  748. cmd->execute_rw = ops->execute_rw;
  749. cmd->execute_cmd = sbc_execute_rw;
  750. cmd->transport_complete_callback = &xdreadwrite_callback;
  751. break;
  752. case VARIABLE_LENGTH_CMD:
  753. {
  754. u16 service_action = get_unaligned_be16(&cdb[8]);
  755. switch (service_action) {
  756. case XDWRITEREAD_32:
  757. sectors = transport_get_sectors_32(cdb);
  758. if (sbc_check_dpofua(dev, cmd, cdb))
  759. return TCM_INVALID_CDB_FIELD;
  760. /*
  761. * Use WRITE_32 and READ_32 opcodes for the emulated
  762. * XDWRITE_READ_32 logic.
  763. */
  764. cmd->t_task_lba = transport_lba_64_ext(cdb);
  765. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  766. /*
  767. * Setup BIDI XOR callback to be run during after I/O
  768. * completion.
  769. */
  770. cmd->execute_rw = ops->execute_rw;
  771. cmd->execute_cmd = sbc_execute_rw;
  772. cmd->transport_complete_callback = &xdreadwrite_callback;
  773. break;
  774. case WRITE_SAME_32:
  775. sectors = transport_get_sectors_32(cdb);
  776. if (!sectors) {
  777. pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not"
  778. " supported\n");
  779. return TCM_INVALID_CDB_FIELD;
  780. }
  781. size = sbc_get_size(cmd, 1);
  782. cmd->t_task_lba = get_unaligned_be64(&cdb[12]);
  783. ret = sbc_setup_write_same(cmd, &cdb[10], ops);
  784. if (ret)
  785. return ret;
  786. break;
  787. default:
  788. pr_err("VARIABLE_LENGTH_CMD service action"
  789. " 0x%04x not supported\n", service_action);
  790. return TCM_UNSUPPORTED_SCSI_OPCODE;
  791. }
  792. break;
  793. }
  794. case COMPARE_AND_WRITE:
  795. sectors = cdb[13];
  796. /*
  797. * Currently enforce COMPARE_AND_WRITE for a single sector
  798. */
  799. if (sectors > 1) {
  800. pr_err("COMPARE_AND_WRITE contains NoLB: %u greater"
  801. " than 1\n", sectors);
  802. return TCM_INVALID_CDB_FIELD;
  803. }
  804. /*
  805. * Double size because we have two buffers, note that
  806. * zero is not an error..
  807. */
  808. size = 2 * sbc_get_size(cmd, sectors);
  809. cmd->t_task_lba = get_unaligned_be64(&cdb[2]);
  810. cmd->t_task_nolb = sectors;
  811. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB | SCF_COMPARE_AND_WRITE;
  812. cmd->execute_rw = ops->execute_rw;
  813. cmd->execute_cmd = sbc_compare_and_write;
  814. cmd->transport_complete_callback = compare_and_write_callback;
  815. break;
  816. case READ_CAPACITY:
  817. size = READ_CAP_LEN;
  818. cmd->execute_cmd = sbc_emulate_readcapacity;
  819. break;
  820. case SERVICE_ACTION_IN_16:
  821. switch (cmd->t_task_cdb[1] & 0x1f) {
  822. case SAI_READ_CAPACITY_16:
  823. cmd->execute_cmd = sbc_emulate_readcapacity_16;
  824. break;
  825. case SAI_REPORT_REFERRALS:
  826. cmd->execute_cmd = target_emulate_report_referrals;
  827. break;
  828. default:
  829. pr_err("Unsupported SA: 0x%02x\n",
  830. cmd->t_task_cdb[1] & 0x1f);
  831. return TCM_INVALID_CDB_FIELD;
  832. }
  833. size = (cdb[10] << 24) | (cdb[11] << 16) |
  834. (cdb[12] << 8) | cdb[13];
  835. break;
  836. case SYNCHRONIZE_CACHE:
  837. case SYNCHRONIZE_CACHE_16:
  838. if (cdb[0] == SYNCHRONIZE_CACHE) {
  839. sectors = transport_get_sectors_10(cdb);
  840. cmd->t_task_lba = transport_lba_32(cdb);
  841. } else {
  842. sectors = transport_get_sectors_16(cdb);
  843. cmd->t_task_lba = transport_lba_64(cdb);
  844. }
  845. if (ops->execute_sync_cache) {
  846. cmd->execute_cmd = ops->execute_sync_cache;
  847. goto check_lba;
  848. }
  849. size = 0;
  850. cmd->execute_cmd = sbc_emulate_noop;
  851. break;
  852. case UNMAP:
  853. if (!ops->execute_unmap)
  854. return TCM_UNSUPPORTED_SCSI_OPCODE;
  855. if (!dev->dev_attrib.emulate_tpu) {
  856. pr_err("Got UNMAP, but backend device has"
  857. " emulate_tpu disabled\n");
  858. return TCM_UNSUPPORTED_SCSI_OPCODE;
  859. }
  860. size = get_unaligned_be16(&cdb[7]);
  861. cmd->execute_cmd = ops->execute_unmap;
  862. break;
  863. case WRITE_SAME_16:
  864. sectors = transport_get_sectors_16(cdb);
  865. if (!sectors) {
  866. pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n");
  867. return TCM_INVALID_CDB_FIELD;
  868. }
  869. size = sbc_get_size(cmd, 1);
  870. cmd->t_task_lba = get_unaligned_be64(&cdb[2]);
  871. ret = sbc_setup_write_same(cmd, &cdb[1], ops);
  872. if (ret)
  873. return ret;
  874. break;
  875. case WRITE_SAME:
  876. sectors = transport_get_sectors_10(cdb);
  877. if (!sectors) {
  878. pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n");
  879. return TCM_INVALID_CDB_FIELD;
  880. }
  881. size = sbc_get_size(cmd, 1);
  882. cmd->t_task_lba = get_unaligned_be32(&cdb[2]);
  883. /*
  884. * Follow sbcr26 with WRITE_SAME (10) and check for the existence
  885. * of byte 1 bit 3 UNMAP instead of original reserved field
  886. */
  887. ret = sbc_setup_write_same(cmd, &cdb[1], ops);
  888. if (ret)
  889. return ret;
  890. break;
  891. case VERIFY:
  892. size = 0;
  893. sectors = transport_get_sectors_10(cdb);
  894. cmd->t_task_lba = transport_lba_32(cdb);
  895. cmd->execute_cmd = sbc_emulate_noop;
  896. goto check_lba;
  897. case REZERO_UNIT:
  898. case SEEK_6:
  899. case SEEK_10:
  900. /*
  901. * There are still clients out there which use these old SCSI-2
  902. * commands. This mainly happens when running VMs with legacy
  903. * guest systems, connected via SCSI command pass-through to
  904. * iSCSI targets. Make them happy and return status GOOD.
  905. */
  906. size = 0;
  907. cmd->execute_cmd = sbc_emulate_noop;
  908. break;
  909. default:
  910. ret = spc_parse_cdb(cmd, &size);
  911. if (ret)
  912. return ret;
  913. }
  914. /* reject any command that we don't have a handler for */
  915. if (!cmd->execute_cmd)
  916. return TCM_UNSUPPORTED_SCSI_OPCODE;
  917. if (cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) {
  918. unsigned long long end_lba;
  919. check_lba:
  920. end_lba = dev->transport->get_blocks(dev) + 1;
  921. if (((cmd->t_task_lba + sectors) < cmd->t_task_lba) ||
  922. ((cmd->t_task_lba + sectors) > end_lba)) {
  923. pr_err("cmd exceeds last lba %llu "
  924. "(lba %llu, sectors %u)\n",
  925. end_lba, cmd->t_task_lba, sectors);
  926. return TCM_ADDRESS_OUT_OF_RANGE;
  927. }
  928. if (!(cmd->se_cmd_flags & SCF_COMPARE_AND_WRITE))
  929. size = sbc_get_size(cmd, sectors);
  930. }
  931. return target_cmd_size_check(cmd, size);
  932. }
  933. EXPORT_SYMBOL(sbc_parse_cdb);
  934. u32 sbc_get_device_type(struct se_device *dev)
  935. {
  936. return TYPE_DISK;
  937. }
  938. EXPORT_SYMBOL(sbc_get_device_type);
  939. sense_reason_t
  940. sbc_execute_unmap(struct se_cmd *cmd,
  941. sense_reason_t (*do_unmap_fn)(struct se_cmd *, void *,
  942. sector_t, sector_t),
  943. void *priv)
  944. {
  945. struct se_device *dev = cmd->se_dev;
  946. unsigned char *buf, *ptr = NULL;
  947. sector_t lba;
  948. int size;
  949. u32 range;
  950. sense_reason_t ret = 0;
  951. int dl, bd_dl;
  952. /* We never set ANC_SUP */
  953. if (cmd->t_task_cdb[1])
  954. return TCM_INVALID_CDB_FIELD;
  955. if (cmd->data_length == 0) {
  956. target_complete_cmd(cmd, SAM_STAT_GOOD);
  957. return 0;
  958. }
  959. if (cmd->data_length < 8) {
  960. pr_warn("UNMAP parameter list length %u too small\n",
  961. cmd->data_length);
  962. return TCM_PARAMETER_LIST_LENGTH_ERROR;
  963. }
  964. buf = transport_kmap_data_sg(cmd);
  965. if (!buf)
  966. return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
  967. dl = get_unaligned_be16(&buf[0]);
  968. bd_dl = get_unaligned_be16(&buf[2]);
  969. size = cmd->data_length - 8;
  970. if (bd_dl > size)
  971. pr_warn("UNMAP parameter list length %u too small, ignoring bd_dl %u\n",
  972. cmd->data_length, bd_dl);
  973. else
  974. size = bd_dl;
  975. if (size / 16 > dev->dev_attrib.max_unmap_block_desc_count) {
  976. ret = TCM_INVALID_PARAMETER_LIST;
  977. goto err;
  978. }
  979. /* First UNMAP block descriptor starts at 8 byte offset */
  980. ptr = &buf[8];
  981. pr_debug("UNMAP: Sub: %s Using dl: %u bd_dl: %u size: %u"
  982. " ptr: %p\n", dev->transport->name, dl, bd_dl, size, ptr);
  983. while (size >= 16) {
  984. lba = get_unaligned_be64(&ptr[0]);
  985. range = get_unaligned_be32(&ptr[8]);
  986. pr_debug("UNMAP: Using lba: %llu and range: %u\n",
  987. (unsigned long long)lba, range);
  988. if (range > dev->dev_attrib.max_unmap_lba_count) {
  989. ret = TCM_INVALID_PARAMETER_LIST;
  990. goto err;
  991. }
  992. if (lba + range > dev->transport->get_blocks(dev) + 1) {
  993. ret = TCM_ADDRESS_OUT_OF_RANGE;
  994. goto err;
  995. }
  996. ret = do_unmap_fn(cmd, priv, lba, range);
  997. if (ret)
  998. goto err;
  999. ptr += 16;
  1000. size -= 16;
  1001. }
  1002. err:
  1003. transport_kunmap_data_sg(cmd);
  1004. if (!ret)
  1005. target_complete_cmd(cmd, GOOD);
  1006. return ret;
  1007. }
  1008. EXPORT_SYMBOL(sbc_execute_unmap);
  1009. void
  1010. sbc_dif_generate(struct se_cmd *cmd)
  1011. {
  1012. struct se_device *dev = cmd->se_dev;
  1013. struct se_dif_v1_tuple *sdt;
  1014. struct scatterlist *dsg, *psg = cmd->t_prot_sg;
  1015. sector_t sector = cmd->t_task_lba;
  1016. void *daddr, *paddr;
  1017. int i, j, offset = 0;
  1018. for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) {
  1019. daddr = kmap_atomic(sg_page(dsg)) + dsg->offset;
  1020. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1021. for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) {
  1022. if (offset >= psg->length) {
  1023. kunmap_atomic(paddr);
  1024. psg = sg_next(psg);
  1025. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1026. offset = 0;
  1027. }
  1028. sdt = paddr + offset;
  1029. sdt->guard_tag = cpu_to_be16(crc_t10dif(daddr + j,
  1030. dev->dev_attrib.block_size));
  1031. if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT)
  1032. sdt->ref_tag = cpu_to_be32(sector & 0xffffffff);
  1033. sdt->app_tag = 0;
  1034. pr_debug("DIF WRITE INSERT sector: %llu guard_tag: 0x%04x"
  1035. " app_tag: 0x%04x ref_tag: %u\n",
  1036. (unsigned long long)sector, sdt->guard_tag,
  1037. sdt->app_tag, be32_to_cpu(sdt->ref_tag));
  1038. sector++;
  1039. offset += sizeof(struct se_dif_v1_tuple);
  1040. }
  1041. kunmap_atomic(paddr);
  1042. kunmap_atomic(daddr);
  1043. }
  1044. }
  1045. static sense_reason_t
  1046. sbc_dif_v1_verify(struct se_device *dev, struct se_dif_v1_tuple *sdt,
  1047. const void *p, sector_t sector, unsigned int ei_lba)
  1048. {
  1049. int block_size = dev->dev_attrib.block_size;
  1050. __be16 csum;
  1051. csum = cpu_to_be16(crc_t10dif(p, block_size));
  1052. if (sdt->guard_tag != csum) {
  1053. pr_err("DIFv1 checksum failed on sector %llu guard tag 0x%04x"
  1054. " csum 0x%04x\n", (unsigned long long)sector,
  1055. be16_to_cpu(sdt->guard_tag), be16_to_cpu(csum));
  1056. return TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED;
  1057. }
  1058. if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT &&
  1059. be32_to_cpu(sdt->ref_tag) != (sector & 0xffffffff)) {
  1060. pr_err("DIFv1 Type 1 reference failed on sector: %llu tag: 0x%08x"
  1061. " sector MSB: 0x%08x\n", (unsigned long long)sector,
  1062. be32_to_cpu(sdt->ref_tag), (u32)(sector & 0xffffffff));
  1063. return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
  1064. }
  1065. if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE2_PROT &&
  1066. be32_to_cpu(sdt->ref_tag) != ei_lba) {
  1067. pr_err("DIFv1 Type 2 reference failed on sector: %llu tag: 0x%08x"
  1068. " ei_lba: 0x%08x\n", (unsigned long long)sector,
  1069. be32_to_cpu(sdt->ref_tag), ei_lba);
  1070. return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
  1071. }
  1072. return 0;
  1073. }
  1074. static void
  1075. sbc_dif_copy_prot(struct se_cmd *cmd, unsigned int sectors, bool read,
  1076. struct scatterlist *sg, int sg_off)
  1077. {
  1078. struct se_device *dev = cmd->se_dev;
  1079. struct scatterlist *psg;
  1080. void *paddr, *addr;
  1081. unsigned int i, len, left;
  1082. unsigned int offset = sg_off;
  1083. left = sectors * dev->prot_length;
  1084. for_each_sg(cmd->t_prot_sg, psg, cmd->t_prot_nents, i) {
  1085. unsigned int psg_len, copied = 0;
  1086. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1087. psg_len = min(left, psg->length);
  1088. while (psg_len) {
  1089. len = min(psg_len, sg->length - offset);
  1090. addr = kmap_atomic(sg_page(sg)) + sg->offset + offset;
  1091. if (read)
  1092. memcpy(paddr + copied, addr, len);
  1093. else
  1094. memcpy(addr, paddr + copied, len);
  1095. left -= len;
  1096. offset += len;
  1097. copied += len;
  1098. psg_len -= len;
  1099. if (offset >= sg->length) {
  1100. sg = sg_next(sg);
  1101. offset = 0;
  1102. }
  1103. kunmap_atomic(addr);
  1104. }
  1105. kunmap_atomic(paddr);
  1106. }
  1107. }
  1108. sense_reason_t
  1109. sbc_dif_verify_write(struct se_cmd *cmd, sector_t start, unsigned int sectors,
  1110. unsigned int ei_lba, struct scatterlist *sg, int sg_off)
  1111. {
  1112. struct se_device *dev = cmd->se_dev;
  1113. struct se_dif_v1_tuple *sdt;
  1114. struct scatterlist *dsg, *psg = cmd->t_prot_sg;
  1115. sector_t sector = start;
  1116. void *daddr, *paddr;
  1117. int i, j, offset = 0;
  1118. sense_reason_t rc;
  1119. for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) {
  1120. daddr = kmap_atomic(sg_page(dsg)) + dsg->offset;
  1121. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1122. for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) {
  1123. if (offset >= psg->length) {
  1124. kunmap_atomic(paddr);
  1125. psg = sg_next(psg);
  1126. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1127. offset = 0;
  1128. }
  1129. sdt = paddr + offset;
  1130. pr_debug("DIF WRITE sector: %llu guard_tag: 0x%04x"
  1131. " app_tag: 0x%04x ref_tag: %u\n",
  1132. (unsigned long long)sector, sdt->guard_tag,
  1133. sdt->app_tag, be32_to_cpu(sdt->ref_tag));
  1134. rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector,
  1135. ei_lba);
  1136. if (rc) {
  1137. kunmap_atomic(paddr);
  1138. kunmap_atomic(daddr);
  1139. cmd->bad_sector = sector;
  1140. return rc;
  1141. }
  1142. sector++;
  1143. ei_lba++;
  1144. offset += sizeof(struct se_dif_v1_tuple);
  1145. }
  1146. kunmap_atomic(paddr);
  1147. kunmap_atomic(daddr);
  1148. }
  1149. sbc_dif_copy_prot(cmd, sectors, false, sg, sg_off);
  1150. return 0;
  1151. }
  1152. EXPORT_SYMBOL(sbc_dif_verify_write);
  1153. static sense_reason_t
  1154. __sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors,
  1155. unsigned int ei_lba, struct scatterlist *sg, int sg_off)
  1156. {
  1157. struct se_device *dev = cmd->se_dev;
  1158. struct se_dif_v1_tuple *sdt;
  1159. struct scatterlist *dsg, *psg = sg;
  1160. sector_t sector = start;
  1161. void *daddr, *paddr;
  1162. int i, j, offset = sg_off;
  1163. sense_reason_t rc;
  1164. for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) {
  1165. daddr = kmap_atomic(sg_page(dsg)) + dsg->offset;
  1166. paddr = kmap_atomic(sg_page(psg)) + sg->offset;
  1167. for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) {
  1168. if (offset >= psg->length) {
  1169. kunmap_atomic(paddr);
  1170. psg = sg_next(psg);
  1171. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1172. offset = 0;
  1173. }
  1174. sdt = paddr + offset;
  1175. pr_debug("DIF READ sector: %llu guard_tag: 0x%04x"
  1176. " app_tag: 0x%04x ref_tag: %u\n",
  1177. (unsigned long long)sector, sdt->guard_tag,
  1178. sdt->app_tag, be32_to_cpu(sdt->ref_tag));
  1179. if (sdt->app_tag == cpu_to_be16(0xffff)) {
  1180. sector++;
  1181. offset += sizeof(struct se_dif_v1_tuple);
  1182. continue;
  1183. }
  1184. rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector,
  1185. ei_lba);
  1186. if (rc) {
  1187. kunmap_atomic(paddr);
  1188. kunmap_atomic(daddr);
  1189. cmd->bad_sector = sector;
  1190. return rc;
  1191. }
  1192. sector++;
  1193. ei_lba++;
  1194. offset += sizeof(struct se_dif_v1_tuple);
  1195. }
  1196. kunmap_atomic(paddr);
  1197. kunmap_atomic(daddr);
  1198. }
  1199. return 0;
  1200. }
  1201. sense_reason_t
  1202. sbc_dif_read_strip(struct se_cmd *cmd)
  1203. {
  1204. struct se_device *dev = cmd->se_dev;
  1205. u32 sectors = cmd->prot_length / dev->prot_length;
  1206. return __sbc_dif_verify_read(cmd, cmd->t_task_lba, sectors, 0,
  1207. cmd->t_prot_sg, 0);
  1208. }
  1209. sense_reason_t
  1210. sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors,
  1211. unsigned int ei_lba, struct scatterlist *sg, int sg_off)
  1212. {
  1213. sense_reason_t rc;
  1214. rc = __sbc_dif_verify_read(cmd, start, sectors, ei_lba, sg, sg_off);
  1215. if (rc)
  1216. return rc;
  1217. sbc_dif_copy_prot(cmd, sectors, true, sg, sg_off);
  1218. return 0;
  1219. }
  1220. EXPORT_SYMBOL(sbc_dif_verify_read);