target_core_sbc.c 37 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400
  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 || !se_dev_check_wce(dev)) {
  630. pr_err("Got CDB: 0x%02x with FUA bit set, but device"
  631. " does not advertise support for FUA write\n",
  632. cdb[0]);
  633. return -EINVAL;
  634. }
  635. cmd->se_cmd_flags |= SCF_FUA;
  636. }
  637. return 0;
  638. }
  639. sense_reason_t
  640. sbc_parse_cdb(struct se_cmd *cmd, struct sbc_ops *ops)
  641. {
  642. struct se_device *dev = cmd->se_dev;
  643. unsigned char *cdb = cmd->t_task_cdb;
  644. unsigned int size;
  645. u32 sectors = 0;
  646. sense_reason_t ret;
  647. switch (cdb[0]) {
  648. case READ_6:
  649. sectors = transport_get_sectors_6(cdb);
  650. cmd->t_task_lba = transport_lba_21(cdb);
  651. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  652. cmd->execute_rw = ops->execute_rw;
  653. cmd->execute_cmd = sbc_execute_rw;
  654. break;
  655. case READ_10:
  656. sectors = transport_get_sectors_10(cdb);
  657. cmd->t_task_lba = transport_lba_32(cdb);
  658. if (sbc_check_dpofua(dev, cmd, cdb))
  659. return TCM_INVALID_CDB_FIELD;
  660. ret = sbc_check_prot(dev, cmd, cdb, sectors, false);
  661. if (ret)
  662. return ret;
  663. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  664. cmd->execute_rw = ops->execute_rw;
  665. cmd->execute_cmd = sbc_execute_rw;
  666. break;
  667. case READ_12:
  668. sectors = transport_get_sectors_12(cdb);
  669. cmd->t_task_lba = transport_lba_32(cdb);
  670. if (sbc_check_dpofua(dev, cmd, cdb))
  671. return TCM_INVALID_CDB_FIELD;
  672. ret = sbc_check_prot(dev, cmd, cdb, sectors, false);
  673. if (ret)
  674. return ret;
  675. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  676. cmd->execute_rw = ops->execute_rw;
  677. cmd->execute_cmd = sbc_execute_rw;
  678. break;
  679. case READ_16:
  680. sectors = transport_get_sectors_16(cdb);
  681. cmd->t_task_lba = transport_lba_64(cdb);
  682. if (sbc_check_dpofua(dev, cmd, cdb))
  683. return TCM_INVALID_CDB_FIELD;
  684. ret = sbc_check_prot(dev, cmd, cdb, sectors, false);
  685. if (ret)
  686. return ret;
  687. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  688. cmd->execute_rw = ops->execute_rw;
  689. cmd->execute_cmd = sbc_execute_rw;
  690. break;
  691. case WRITE_6:
  692. sectors = transport_get_sectors_6(cdb);
  693. cmd->t_task_lba = transport_lba_21(cdb);
  694. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  695. cmd->execute_rw = ops->execute_rw;
  696. cmd->execute_cmd = sbc_execute_rw;
  697. break;
  698. case WRITE_10:
  699. case WRITE_VERIFY:
  700. sectors = transport_get_sectors_10(cdb);
  701. cmd->t_task_lba = transport_lba_32(cdb);
  702. if (sbc_check_dpofua(dev, cmd, cdb))
  703. return TCM_INVALID_CDB_FIELD;
  704. ret = sbc_check_prot(dev, cmd, cdb, sectors, true);
  705. if (ret)
  706. return ret;
  707. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  708. cmd->execute_rw = ops->execute_rw;
  709. cmd->execute_cmd = sbc_execute_rw;
  710. break;
  711. case WRITE_12:
  712. sectors = transport_get_sectors_12(cdb);
  713. cmd->t_task_lba = transport_lba_32(cdb);
  714. if (sbc_check_dpofua(dev, cmd, cdb))
  715. return TCM_INVALID_CDB_FIELD;
  716. ret = sbc_check_prot(dev, cmd, cdb, sectors, true);
  717. if (ret)
  718. return ret;
  719. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  720. cmd->execute_rw = ops->execute_rw;
  721. cmd->execute_cmd = sbc_execute_rw;
  722. break;
  723. case WRITE_16:
  724. sectors = transport_get_sectors_16(cdb);
  725. cmd->t_task_lba = transport_lba_64(cdb);
  726. if (sbc_check_dpofua(dev, cmd, cdb))
  727. return TCM_INVALID_CDB_FIELD;
  728. ret = sbc_check_prot(dev, cmd, cdb, sectors, true);
  729. if (ret)
  730. return ret;
  731. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  732. cmd->execute_rw = ops->execute_rw;
  733. cmd->execute_cmd = sbc_execute_rw;
  734. break;
  735. case XDWRITEREAD_10:
  736. if (cmd->data_direction != DMA_TO_DEVICE ||
  737. !(cmd->se_cmd_flags & SCF_BIDI))
  738. return TCM_INVALID_CDB_FIELD;
  739. sectors = transport_get_sectors_10(cdb);
  740. if (sbc_check_dpofua(dev, cmd, cdb))
  741. return TCM_INVALID_CDB_FIELD;
  742. cmd->t_task_lba = transport_lba_32(cdb);
  743. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  744. /*
  745. * Setup BIDI XOR callback to be run after I/O completion.
  746. */
  747. cmd->execute_rw = ops->execute_rw;
  748. cmd->execute_cmd = sbc_execute_rw;
  749. cmd->transport_complete_callback = &xdreadwrite_callback;
  750. break;
  751. case VARIABLE_LENGTH_CMD:
  752. {
  753. u16 service_action = get_unaligned_be16(&cdb[8]);
  754. switch (service_action) {
  755. case XDWRITEREAD_32:
  756. sectors = transport_get_sectors_32(cdb);
  757. if (sbc_check_dpofua(dev, cmd, cdb))
  758. return TCM_INVALID_CDB_FIELD;
  759. /*
  760. * Use WRITE_32 and READ_32 opcodes for the emulated
  761. * XDWRITE_READ_32 logic.
  762. */
  763. cmd->t_task_lba = transport_lba_64_ext(cdb);
  764. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
  765. /*
  766. * Setup BIDI XOR callback to be run during after I/O
  767. * completion.
  768. */
  769. cmd->execute_rw = ops->execute_rw;
  770. cmd->execute_cmd = sbc_execute_rw;
  771. cmd->transport_complete_callback = &xdreadwrite_callback;
  772. break;
  773. case WRITE_SAME_32:
  774. sectors = transport_get_sectors_32(cdb);
  775. if (!sectors) {
  776. pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not"
  777. " supported\n");
  778. return TCM_INVALID_CDB_FIELD;
  779. }
  780. size = sbc_get_size(cmd, 1);
  781. cmd->t_task_lba = get_unaligned_be64(&cdb[12]);
  782. ret = sbc_setup_write_same(cmd, &cdb[10], ops);
  783. if (ret)
  784. return ret;
  785. break;
  786. default:
  787. pr_err("VARIABLE_LENGTH_CMD service action"
  788. " 0x%04x not supported\n", service_action);
  789. return TCM_UNSUPPORTED_SCSI_OPCODE;
  790. }
  791. break;
  792. }
  793. case COMPARE_AND_WRITE:
  794. sectors = cdb[13];
  795. /*
  796. * Currently enforce COMPARE_AND_WRITE for a single sector
  797. */
  798. if (sectors > 1) {
  799. pr_err("COMPARE_AND_WRITE contains NoLB: %u greater"
  800. " than 1\n", sectors);
  801. return TCM_INVALID_CDB_FIELD;
  802. }
  803. /*
  804. * Double size because we have two buffers, note that
  805. * zero is not an error..
  806. */
  807. size = 2 * sbc_get_size(cmd, sectors);
  808. cmd->t_task_lba = get_unaligned_be64(&cdb[2]);
  809. cmd->t_task_nolb = sectors;
  810. cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB | SCF_COMPARE_AND_WRITE;
  811. cmd->execute_rw = ops->execute_rw;
  812. cmd->execute_cmd = sbc_compare_and_write;
  813. cmd->transport_complete_callback = compare_and_write_callback;
  814. break;
  815. case READ_CAPACITY:
  816. size = READ_CAP_LEN;
  817. cmd->execute_cmd = sbc_emulate_readcapacity;
  818. break;
  819. case SERVICE_ACTION_IN_16:
  820. switch (cmd->t_task_cdb[1] & 0x1f) {
  821. case SAI_READ_CAPACITY_16:
  822. cmd->execute_cmd = sbc_emulate_readcapacity_16;
  823. break;
  824. case SAI_REPORT_REFERRALS:
  825. cmd->execute_cmd = target_emulate_report_referrals;
  826. break;
  827. default:
  828. pr_err("Unsupported SA: 0x%02x\n",
  829. cmd->t_task_cdb[1] & 0x1f);
  830. return TCM_INVALID_CDB_FIELD;
  831. }
  832. size = (cdb[10] << 24) | (cdb[11] << 16) |
  833. (cdb[12] << 8) | cdb[13];
  834. break;
  835. case SYNCHRONIZE_CACHE:
  836. case SYNCHRONIZE_CACHE_16:
  837. if (cdb[0] == SYNCHRONIZE_CACHE) {
  838. sectors = transport_get_sectors_10(cdb);
  839. cmd->t_task_lba = transport_lba_32(cdb);
  840. } else {
  841. sectors = transport_get_sectors_16(cdb);
  842. cmd->t_task_lba = transport_lba_64(cdb);
  843. }
  844. if (ops->execute_sync_cache) {
  845. cmd->execute_cmd = ops->execute_sync_cache;
  846. goto check_lba;
  847. }
  848. size = 0;
  849. cmd->execute_cmd = sbc_emulate_noop;
  850. break;
  851. case UNMAP:
  852. if (!ops->execute_unmap)
  853. return TCM_UNSUPPORTED_SCSI_OPCODE;
  854. if (!dev->dev_attrib.emulate_tpu) {
  855. pr_err("Got UNMAP, but backend device has"
  856. " emulate_tpu disabled\n");
  857. return TCM_UNSUPPORTED_SCSI_OPCODE;
  858. }
  859. size = get_unaligned_be16(&cdb[7]);
  860. cmd->execute_cmd = ops->execute_unmap;
  861. break;
  862. case WRITE_SAME_16:
  863. sectors = transport_get_sectors_16(cdb);
  864. if (!sectors) {
  865. pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n");
  866. return TCM_INVALID_CDB_FIELD;
  867. }
  868. size = sbc_get_size(cmd, 1);
  869. cmd->t_task_lba = get_unaligned_be64(&cdb[2]);
  870. ret = sbc_setup_write_same(cmd, &cdb[1], ops);
  871. if (ret)
  872. return ret;
  873. break;
  874. case WRITE_SAME:
  875. sectors = transport_get_sectors_10(cdb);
  876. if (!sectors) {
  877. pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n");
  878. return TCM_INVALID_CDB_FIELD;
  879. }
  880. size = sbc_get_size(cmd, 1);
  881. cmd->t_task_lba = get_unaligned_be32(&cdb[2]);
  882. /*
  883. * Follow sbcr26 with WRITE_SAME (10) and check for the existence
  884. * of byte 1 bit 3 UNMAP instead of original reserved field
  885. */
  886. ret = sbc_setup_write_same(cmd, &cdb[1], ops);
  887. if (ret)
  888. return ret;
  889. break;
  890. case VERIFY:
  891. size = 0;
  892. sectors = transport_get_sectors_10(cdb);
  893. cmd->t_task_lba = transport_lba_32(cdb);
  894. cmd->execute_cmd = sbc_emulate_noop;
  895. goto check_lba;
  896. case REZERO_UNIT:
  897. case SEEK_6:
  898. case SEEK_10:
  899. /*
  900. * There are still clients out there which use these old SCSI-2
  901. * commands. This mainly happens when running VMs with legacy
  902. * guest systems, connected via SCSI command pass-through to
  903. * iSCSI targets. Make them happy and return status GOOD.
  904. */
  905. size = 0;
  906. cmd->execute_cmd = sbc_emulate_noop;
  907. break;
  908. default:
  909. ret = spc_parse_cdb(cmd, &size);
  910. if (ret)
  911. return ret;
  912. }
  913. /* reject any command that we don't have a handler for */
  914. if (!cmd->execute_cmd)
  915. return TCM_UNSUPPORTED_SCSI_OPCODE;
  916. if (cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) {
  917. unsigned long long end_lba;
  918. check_lba:
  919. end_lba = dev->transport->get_blocks(dev) + 1;
  920. if (((cmd->t_task_lba + sectors) < cmd->t_task_lba) ||
  921. ((cmd->t_task_lba + sectors) > end_lba)) {
  922. pr_err("cmd exceeds last lba %llu "
  923. "(lba %llu, sectors %u)\n",
  924. end_lba, cmd->t_task_lba, sectors);
  925. return TCM_ADDRESS_OUT_OF_RANGE;
  926. }
  927. if (!(cmd->se_cmd_flags & SCF_COMPARE_AND_WRITE))
  928. size = sbc_get_size(cmd, sectors);
  929. }
  930. return target_cmd_size_check(cmd, size);
  931. }
  932. EXPORT_SYMBOL(sbc_parse_cdb);
  933. u32 sbc_get_device_type(struct se_device *dev)
  934. {
  935. return TYPE_DISK;
  936. }
  937. EXPORT_SYMBOL(sbc_get_device_type);
  938. sense_reason_t
  939. sbc_execute_unmap(struct se_cmd *cmd,
  940. sense_reason_t (*do_unmap_fn)(struct se_cmd *, void *,
  941. sector_t, sector_t),
  942. void *priv)
  943. {
  944. struct se_device *dev = cmd->se_dev;
  945. unsigned char *buf, *ptr = NULL;
  946. sector_t lba;
  947. int size;
  948. u32 range;
  949. sense_reason_t ret = 0;
  950. int dl, bd_dl;
  951. /* We never set ANC_SUP */
  952. if (cmd->t_task_cdb[1])
  953. return TCM_INVALID_CDB_FIELD;
  954. if (cmd->data_length == 0) {
  955. target_complete_cmd(cmd, SAM_STAT_GOOD);
  956. return 0;
  957. }
  958. if (cmd->data_length < 8) {
  959. pr_warn("UNMAP parameter list length %u too small\n",
  960. cmd->data_length);
  961. return TCM_PARAMETER_LIST_LENGTH_ERROR;
  962. }
  963. buf = transport_kmap_data_sg(cmd);
  964. if (!buf)
  965. return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
  966. dl = get_unaligned_be16(&buf[0]);
  967. bd_dl = get_unaligned_be16(&buf[2]);
  968. size = cmd->data_length - 8;
  969. if (bd_dl > size)
  970. pr_warn("UNMAP parameter list length %u too small, ignoring bd_dl %u\n",
  971. cmd->data_length, bd_dl);
  972. else
  973. size = bd_dl;
  974. if (size / 16 > dev->dev_attrib.max_unmap_block_desc_count) {
  975. ret = TCM_INVALID_PARAMETER_LIST;
  976. goto err;
  977. }
  978. /* First UNMAP block descriptor starts at 8 byte offset */
  979. ptr = &buf[8];
  980. pr_debug("UNMAP: Sub: %s Using dl: %u bd_dl: %u size: %u"
  981. " ptr: %p\n", dev->transport->name, dl, bd_dl, size, ptr);
  982. while (size >= 16) {
  983. lba = get_unaligned_be64(&ptr[0]);
  984. range = get_unaligned_be32(&ptr[8]);
  985. pr_debug("UNMAP: Using lba: %llu and range: %u\n",
  986. (unsigned long long)lba, range);
  987. if (range > dev->dev_attrib.max_unmap_lba_count) {
  988. ret = TCM_INVALID_PARAMETER_LIST;
  989. goto err;
  990. }
  991. if (lba + range > dev->transport->get_blocks(dev) + 1) {
  992. ret = TCM_ADDRESS_OUT_OF_RANGE;
  993. goto err;
  994. }
  995. ret = do_unmap_fn(cmd, priv, lba, range);
  996. if (ret)
  997. goto err;
  998. ptr += 16;
  999. size -= 16;
  1000. }
  1001. err:
  1002. transport_kunmap_data_sg(cmd);
  1003. if (!ret)
  1004. target_complete_cmd(cmd, GOOD);
  1005. return ret;
  1006. }
  1007. EXPORT_SYMBOL(sbc_execute_unmap);
  1008. void
  1009. sbc_dif_generate(struct se_cmd *cmd)
  1010. {
  1011. struct se_device *dev = cmd->se_dev;
  1012. struct se_dif_v1_tuple *sdt;
  1013. struct scatterlist *dsg, *psg = cmd->t_prot_sg;
  1014. sector_t sector = cmd->t_task_lba;
  1015. void *daddr, *paddr;
  1016. int i, j, offset = 0;
  1017. for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) {
  1018. daddr = kmap_atomic(sg_page(dsg)) + dsg->offset;
  1019. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1020. for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) {
  1021. if (offset >= psg->length) {
  1022. kunmap_atomic(paddr);
  1023. psg = sg_next(psg);
  1024. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1025. offset = 0;
  1026. }
  1027. sdt = paddr + offset;
  1028. sdt->guard_tag = cpu_to_be16(crc_t10dif(daddr + j,
  1029. dev->dev_attrib.block_size));
  1030. if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT)
  1031. sdt->ref_tag = cpu_to_be32(sector & 0xffffffff);
  1032. sdt->app_tag = 0;
  1033. pr_debug("DIF WRITE INSERT sector: %llu guard_tag: 0x%04x"
  1034. " app_tag: 0x%04x ref_tag: %u\n",
  1035. (unsigned long long)sector, sdt->guard_tag,
  1036. sdt->app_tag, be32_to_cpu(sdt->ref_tag));
  1037. sector++;
  1038. offset += sizeof(struct se_dif_v1_tuple);
  1039. }
  1040. kunmap_atomic(paddr);
  1041. kunmap_atomic(daddr);
  1042. }
  1043. }
  1044. static sense_reason_t
  1045. sbc_dif_v1_verify(struct se_device *dev, struct se_dif_v1_tuple *sdt,
  1046. const void *p, sector_t sector, unsigned int ei_lba)
  1047. {
  1048. int block_size = dev->dev_attrib.block_size;
  1049. __be16 csum;
  1050. csum = cpu_to_be16(crc_t10dif(p, block_size));
  1051. if (sdt->guard_tag != csum) {
  1052. pr_err("DIFv1 checksum failed on sector %llu guard tag 0x%04x"
  1053. " csum 0x%04x\n", (unsigned long long)sector,
  1054. be16_to_cpu(sdt->guard_tag), be16_to_cpu(csum));
  1055. return TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED;
  1056. }
  1057. if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT &&
  1058. be32_to_cpu(sdt->ref_tag) != (sector & 0xffffffff)) {
  1059. pr_err("DIFv1 Type 1 reference failed on sector: %llu tag: 0x%08x"
  1060. " sector MSB: 0x%08x\n", (unsigned long long)sector,
  1061. be32_to_cpu(sdt->ref_tag), (u32)(sector & 0xffffffff));
  1062. return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
  1063. }
  1064. if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE2_PROT &&
  1065. be32_to_cpu(sdt->ref_tag) != ei_lba) {
  1066. pr_err("DIFv1 Type 2 reference failed on sector: %llu tag: 0x%08x"
  1067. " ei_lba: 0x%08x\n", (unsigned long long)sector,
  1068. be32_to_cpu(sdt->ref_tag), ei_lba);
  1069. return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
  1070. }
  1071. return 0;
  1072. }
  1073. static void
  1074. sbc_dif_copy_prot(struct se_cmd *cmd, unsigned int sectors, bool read,
  1075. struct scatterlist *sg, int sg_off)
  1076. {
  1077. struct se_device *dev = cmd->se_dev;
  1078. struct scatterlist *psg;
  1079. void *paddr, *addr;
  1080. unsigned int i, len, left;
  1081. unsigned int offset = sg_off;
  1082. left = sectors * dev->prot_length;
  1083. for_each_sg(cmd->t_prot_sg, psg, cmd->t_prot_nents, i) {
  1084. unsigned int psg_len, copied = 0;
  1085. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1086. psg_len = min(left, psg->length);
  1087. while (psg_len) {
  1088. len = min(psg_len, sg->length - offset);
  1089. addr = kmap_atomic(sg_page(sg)) + sg->offset + offset;
  1090. if (read)
  1091. memcpy(paddr + copied, addr, len);
  1092. else
  1093. memcpy(addr, paddr + copied, len);
  1094. left -= len;
  1095. offset += len;
  1096. copied += len;
  1097. psg_len -= len;
  1098. if (offset >= sg->length) {
  1099. sg = sg_next(sg);
  1100. offset = 0;
  1101. }
  1102. kunmap_atomic(addr);
  1103. }
  1104. kunmap_atomic(paddr);
  1105. }
  1106. }
  1107. sense_reason_t
  1108. sbc_dif_verify_write(struct se_cmd *cmd, sector_t start, unsigned int sectors,
  1109. unsigned int ei_lba, struct scatterlist *sg, int sg_off)
  1110. {
  1111. struct se_device *dev = cmd->se_dev;
  1112. struct se_dif_v1_tuple *sdt;
  1113. struct scatterlist *dsg, *psg = cmd->t_prot_sg;
  1114. sector_t sector = start;
  1115. void *daddr, *paddr;
  1116. int i, j, offset = 0;
  1117. sense_reason_t rc;
  1118. for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) {
  1119. daddr = kmap_atomic(sg_page(dsg)) + dsg->offset;
  1120. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1121. for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) {
  1122. if (offset >= psg->length) {
  1123. kunmap_atomic(paddr);
  1124. psg = sg_next(psg);
  1125. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1126. offset = 0;
  1127. }
  1128. sdt = paddr + offset;
  1129. pr_debug("DIF WRITE sector: %llu guard_tag: 0x%04x"
  1130. " app_tag: 0x%04x ref_tag: %u\n",
  1131. (unsigned long long)sector, sdt->guard_tag,
  1132. sdt->app_tag, be32_to_cpu(sdt->ref_tag));
  1133. rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector,
  1134. ei_lba);
  1135. if (rc) {
  1136. kunmap_atomic(paddr);
  1137. kunmap_atomic(daddr);
  1138. cmd->bad_sector = sector;
  1139. return rc;
  1140. }
  1141. sector++;
  1142. ei_lba++;
  1143. offset += sizeof(struct se_dif_v1_tuple);
  1144. }
  1145. kunmap_atomic(paddr);
  1146. kunmap_atomic(daddr);
  1147. }
  1148. sbc_dif_copy_prot(cmd, sectors, false, sg, sg_off);
  1149. return 0;
  1150. }
  1151. EXPORT_SYMBOL(sbc_dif_verify_write);
  1152. static sense_reason_t
  1153. __sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors,
  1154. unsigned int ei_lba, struct scatterlist *sg, int sg_off)
  1155. {
  1156. struct se_device *dev = cmd->se_dev;
  1157. struct se_dif_v1_tuple *sdt;
  1158. struct scatterlist *dsg, *psg = sg;
  1159. sector_t sector = start;
  1160. void *daddr, *paddr;
  1161. int i, j, offset = sg_off;
  1162. sense_reason_t rc;
  1163. for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) {
  1164. daddr = kmap_atomic(sg_page(dsg)) + dsg->offset;
  1165. paddr = kmap_atomic(sg_page(psg)) + sg->offset;
  1166. for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) {
  1167. if (offset >= psg->length) {
  1168. kunmap_atomic(paddr);
  1169. psg = sg_next(psg);
  1170. paddr = kmap_atomic(sg_page(psg)) + psg->offset;
  1171. offset = 0;
  1172. }
  1173. sdt = paddr + offset;
  1174. pr_debug("DIF READ sector: %llu guard_tag: 0x%04x"
  1175. " app_tag: 0x%04x ref_tag: %u\n",
  1176. (unsigned long long)sector, sdt->guard_tag,
  1177. sdt->app_tag, be32_to_cpu(sdt->ref_tag));
  1178. if (sdt->app_tag == cpu_to_be16(0xffff)) {
  1179. sector++;
  1180. offset += sizeof(struct se_dif_v1_tuple);
  1181. continue;
  1182. }
  1183. rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector,
  1184. ei_lba);
  1185. if (rc) {
  1186. kunmap_atomic(paddr);
  1187. kunmap_atomic(daddr);
  1188. cmd->bad_sector = sector;
  1189. return rc;
  1190. }
  1191. sector++;
  1192. ei_lba++;
  1193. offset += sizeof(struct se_dif_v1_tuple);
  1194. }
  1195. kunmap_atomic(paddr);
  1196. kunmap_atomic(daddr);
  1197. }
  1198. return 0;
  1199. }
  1200. sense_reason_t
  1201. sbc_dif_read_strip(struct se_cmd *cmd)
  1202. {
  1203. struct se_device *dev = cmd->se_dev;
  1204. u32 sectors = cmd->prot_length / dev->prot_length;
  1205. return __sbc_dif_verify_read(cmd, cmd->t_task_lba, sectors, 0,
  1206. cmd->t_prot_sg, 0);
  1207. }
  1208. sense_reason_t
  1209. sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors,
  1210. unsigned int ei_lba, struct scatterlist *sg, int sg_off)
  1211. {
  1212. sense_reason_t rc;
  1213. rc = __sbc_dif_verify_read(cmd, start, sectors, ei_lba, sg, sg_off);
  1214. if (rc)
  1215. return rc;
  1216. sbc_dif_copy_prot(cmd, sectors, true, sg, sg_off);
  1217. return 0;
  1218. }
  1219. EXPORT_SYMBOL(sbc_dif_verify_read);