usb: gadget: f_mtp: Avoid race between mtp_read and mtp_function_disable
[GitHub/exynos8895/android_kernel_samsung_universal8895.git] / drivers / target / target_core_iblock.c
CommitLineData
c66ac9db
NB
1/*******************************************************************************
2 * Filename: target_core_iblock.c
3 *
4 * This file contains the Storage Engine <-> Linux BlockIO transport
5 * specific functions.
6 *
4c76251e 7 * (c) Copyright 2003-2013 Datera, Inc.
c66ac9db
NB
8 *
9 * Nicholas A. Bellinger <nab@kernel.org>
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24 *
25 ******************************************************************************/
26
c66ac9db
NB
27#include <linux/string.h>
28#include <linux/parser.h>
29#include <linux/timer.h>
30#include <linux/fs.h>
31#include <linux/blkdev.h>
32#include <linux/slab.h>
33#include <linux/spinlock.h>
c66ac9db
NB
34#include <linux/bio.h>
35#include <linux/genhd.h>
36#include <linux/file.h>
827509e3 37#include <linux/module.h>
ba929992 38#include <scsi/scsi_proto.h>
14150a6b 39#include <asm/unaligned.h>
c66ac9db
NB
40
41#include <target/target_core_base.h>
c4795fb2 42#include <target/target_core_backend.h>
c66ac9db
NB
43
44#include "target_core_iblock.h"
45
d5b4a21b
CH
46#define IBLOCK_MAX_BIO_PER_TASK 32 /* max # of bios to submit at a time */
47#define IBLOCK_BIO_POOL_SIZE 128
48
0fd97ccf
CH
49static inline struct iblock_dev *IBLOCK_DEV(struct se_device *dev)
50{
51 return container_of(dev, struct iblock_dev, dev);
52}
53
54
c66ac9db
NB
55static int iblock_attach_hba(struct se_hba *hba, u32 host_id)
56{
6708bb27 57 pr_debug("CORE_HBA[%d] - TCM iBlock HBA Driver %s on"
c66ac9db 58 " Generic Target Core Stack %s\n", hba->hba_id,
ce8dd25d 59 IBLOCK_VERSION, TARGET_CORE_VERSION);
c66ac9db
NB
60 return 0;
61}
62
63static void iblock_detach_hba(struct se_hba *hba)
64{
c66ac9db
NB
65}
66
0fd97ccf 67static struct se_device *iblock_alloc_device(struct se_hba *hba, const char *name)
c66ac9db
NB
68{
69 struct iblock_dev *ib_dev = NULL;
c66ac9db
NB
70
71 ib_dev = kzalloc(sizeof(struct iblock_dev), GFP_KERNEL);
6708bb27
AG
72 if (!ib_dev) {
73 pr_err("Unable to allocate struct iblock_dev\n");
c66ac9db
NB
74 return NULL;
75 }
c66ac9db 76
6708bb27 77 pr_debug( "IBLOCK: Allocated ib_dev for %s\n", name);
c66ac9db 78
0fd97ccf 79 return &ib_dev->dev;
c66ac9db
NB
80}
81
0fd97ccf 82static int iblock_configure_device(struct se_device *dev)
c66ac9db 83{
0fd97ccf 84 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
c66ac9db 85 struct request_queue *q;
0fd97ccf 86 struct block_device *bd = NULL;
ecebbf6c 87 struct blk_integrity *bi;
44bfd018 88 fmode_t mode;
0fd97ccf 89 int ret = -ENOMEM;
c66ac9db 90
0fd97ccf
CH
91 if (!(ib_dev->ibd_flags & IBDF_HAS_UDEV_PATH)) {
92 pr_err("Missing udev_path= parameters for IBLOCK\n");
93 return -EINVAL;
c66ac9db 94 }
d5b4a21b
CH
95
96 ib_dev->ibd_bio_set = bioset_create(IBLOCK_BIO_POOL_SIZE, 0);
6708bb27 97 if (!ib_dev->ibd_bio_set) {
0fd97ccf
CH
98 pr_err("IBLOCK: Unable to create bioset\n");
99 goto out;
c66ac9db 100 }
0fd97ccf 101
6708bb27 102 pr_debug( "IBLOCK: Claiming struct block_device: %s\n",
c66ac9db
NB
103 ib_dev->ibd_udev_path);
104
44bfd018
AG
105 mode = FMODE_READ|FMODE_EXCL;
106 if (!ib_dev->ibd_readonly)
107 mode |= FMODE_WRITE;
eeeb9522
NB
108 else
109 dev->dev_flags |= DF_READ_ONLY;
44bfd018
AG
110
111 bd = blkdev_get_by_path(ib_dev->ibd_udev_path, mode, ib_dev);
613640e4
NB
112 if (IS_ERR(bd)) {
113 ret = PTR_ERR(bd);
0fd97ccf 114 goto out_free_bioset;
613640e4 115 }
c66ac9db
NB
116 ib_dev->ibd_bd = bd;
117
0fd97ccf
CH
118 q = bdev_get_queue(bd);
119
120 dev->dev_attrib.hw_block_size = bdev_logical_block_size(bd);
046ba642 121 dev->dev_attrib.hw_max_sectors = queue_max_hw_sectors(q);
0fd97ccf 122 dev->dev_attrib.hw_queue_depth = q->nr_requests;
c66ac9db 123
51d84190 124 if (target_configure_unmap_from_queue(&dev->dev_attrib, q))
6708bb27 125 pr_debug("IBLOCK: BLOCK Discard support available,"
3028963a
MC
126 " disabled by default\n");
127
f6970ad3
NB
128 /*
129 * Enable write same emulation for IBLOCK and use 0xFFFF as
130 * the smaller WRITE_SAME(10) only has a two-byte block count.
131 */
132 dev->dev_attrib.max_write_same_len = 0xFFFF;
c66ac9db 133
e22a7f07 134 if (blk_queue_nonrot(q))
0fd97ccf 135 dev->dev_attrib.is_nonrot = 1;
d0c8b259 136
ecebbf6c
NB
137 bi = bdev_get_integrity(bd);
138 if (bi) {
139 struct bio_set *bs = ib_dev->ibd_bio_set;
140
0f8087ec
MP
141 if (!strcmp(bi->profile->name, "T10-DIF-TYPE3-IP") ||
142 !strcmp(bi->profile->name, "T10-DIF-TYPE1-IP")) {
ecebbf6c 143 pr_err("IBLOCK export of blk_integrity: %s not"
0f8087ec 144 " supported\n", bi->profile->name);
ecebbf6c
NB
145 ret = -ENOSYS;
146 goto out_blkdev_put;
147 }
148
0f8087ec 149 if (!strcmp(bi->profile->name, "T10-DIF-TYPE3-CRC")) {
ecebbf6c 150 dev->dev_attrib.pi_prot_type = TARGET_DIF_TYPE3_PROT;
0f8087ec 151 } else if (!strcmp(bi->profile->name, "T10-DIF-TYPE1-CRC")) {
ecebbf6c
NB
152 dev->dev_attrib.pi_prot_type = TARGET_DIF_TYPE1_PROT;
153 }
154
155 if (dev->dev_attrib.pi_prot_type) {
156 if (bioset_integrity_create(bs, IBLOCK_BIO_POOL_SIZE) < 0) {
157 pr_err("Unable to allocate bioset for PI\n");
158 ret = -ENOMEM;
159 goto out_blkdev_put;
160 }
161 pr_debug("IBLOCK setup BIP bs->bio_integrity_pool: %p\n",
162 bs->bio_integrity_pool);
163 }
164 dev->dev_attrib.hw_pi_prot_type = dev->dev_attrib.pi_prot_type;
165 }
166
0fd97ccf 167 return 0;
c66ac9db 168
ecebbf6c
NB
169out_blkdev_put:
170 blkdev_put(ib_dev->ibd_bd, FMODE_WRITE|FMODE_READ|FMODE_EXCL);
0fd97ccf
CH
171out_free_bioset:
172 bioset_free(ib_dev->ibd_bio_set);
173 ib_dev->ibd_bio_set = NULL;
174out:
175 return ret;
c66ac9db
NB
176}
177
4cc987ea
NB
178static void iblock_dev_call_rcu(struct rcu_head *p)
179{
180 struct se_device *dev = container_of(p, struct se_device, rcu_head);
181 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
182
183 kfree(ib_dev);
184}
185
0fd97ccf 186static void iblock_free_device(struct se_device *dev)
c66ac9db 187{
0fd97ccf 188 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
c66ac9db 189
bc665524
NB
190 if (ib_dev->ibd_bd != NULL)
191 blkdev_put(ib_dev->ibd_bd, FMODE_WRITE|FMODE_READ|FMODE_EXCL);
d84287bc 192 if (ib_dev->ibd_bio_set != NULL)
bc665524 193 bioset_free(ib_dev->ibd_bio_set);
d84287bc 194
4cc987ea 195 call_rcu(&dev->rcu_head, iblock_dev_call_rcu);
c66ac9db
NB
196}
197
c66ac9db
NB
198static unsigned long long iblock_emulate_read_cap_with_block_size(
199 struct se_device *dev,
200 struct block_device *bd,
201 struct request_queue *q)
202{
203 unsigned long long blocks_long = (div_u64(i_size_read(bd->bd_inode),
204 bdev_logical_block_size(bd)) - 1);
205 u32 block_size = bdev_logical_block_size(bd);
206
0fd97ccf 207 if (block_size == dev->dev_attrib.block_size)
c66ac9db
NB
208 return blocks_long;
209
210 switch (block_size) {
211 case 4096:
0fd97ccf 212 switch (dev->dev_attrib.block_size) {
c66ac9db
NB
213 case 2048:
214 blocks_long <<= 1;
215 break;
216 case 1024:
217 blocks_long <<= 2;
218 break;
219 case 512:
220 blocks_long <<= 3;
221 default:
222 break;
223 }
224 break;
225 case 2048:
0fd97ccf 226 switch (dev->dev_attrib.block_size) {
c66ac9db
NB
227 case 4096:
228 blocks_long >>= 1;
229 break;
230 case 1024:
231 blocks_long <<= 1;
232 break;
233 case 512:
234 blocks_long <<= 2;
235 break;
236 default:
237 break;
238 }
239 break;
240 case 1024:
0fd97ccf 241 switch (dev->dev_attrib.block_size) {
c66ac9db
NB
242 case 4096:
243 blocks_long >>= 2;
244 break;
245 case 2048:
246 blocks_long >>= 1;
247 break;
248 case 512:
249 blocks_long <<= 1;
250 break;
251 default:
252 break;
253 }
254 break;
255 case 512:
0fd97ccf 256 switch (dev->dev_attrib.block_size) {
c66ac9db
NB
257 case 4096:
258 blocks_long >>= 3;
259 break;
260 case 2048:
261 blocks_long >>= 2;
262 break;
263 case 1024:
264 blocks_long >>= 1;
265 break;
266 default:
267 break;
268 }
269 break;
270 default:
271 break;
272 }
273
274 return blocks_long;
275}
276
3a41d85f
NB
277static void iblock_complete_cmd(struct se_cmd *cmd)
278{
279 struct iblock_req *ibr = cmd->priv;
280 u8 status;
281
282 if (!atomic_dec_and_test(&ibr->pending))
283 return;
284
285 if (atomic_read(&ibr->ib_bio_err_cnt))
286 status = SAM_STAT_CHECK_CONDITION;
287 else
288 status = SAM_STAT_GOOD;
289
290 target_complete_cmd(cmd, status);
291 kfree(ibr);
292}
293
4246a0b6 294static void iblock_bio_done(struct bio *bio)
3a41d85f
NB
295{
296 struct se_cmd *cmd = bio->bi_private;
297 struct iblock_req *ibr = cmd->priv;
298
4246a0b6
CH
299 if (bio->bi_error) {
300 pr_err("bio error: %p, err: %d\n", bio, bio->bi_error);
3a41d85f
NB
301 /*
302 * Bump the ib_bio_err_cnt and release bio.
303 */
304 atomic_inc(&ibr->ib_bio_err_cnt);
4e857c58 305 smp_mb__after_atomic();
3a41d85f
NB
306 }
307
308 bio_put(bio);
309
310 iblock_complete_cmd(cmd);
311}
312
313static struct bio *
314iblock_get_bio(struct se_cmd *cmd, sector_t lba, u32 sg_num)
315{
316 struct iblock_dev *ib_dev = IBLOCK_DEV(cmd->se_dev);
317 struct bio *bio;
318
319 /*
320 * Only allocate as many vector entries as the bio code allows us to,
321 * we'll loop later on until we have handled the whole request.
322 */
323 if (sg_num > BIO_MAX_PAGES)
324 sg_num = BIO_MAX_PAGES;
325
326 bio = bio_alloc_bioset(GFP_NOIO, sg_num, ib_dev->ibd_bio_set);
327 if (!bio) {
328 pr_err("Unable to allocate memory for bio\n");
329 return NULL;
330 }
331
332 bio->bi_bdev = ib_dev->ibd_bd;
333 bio->bi_private = cmd;
334 bio->bi_end_io = &iblock_bio_done;
4f024f37 335 bio->bi_iter.bi_sector = lba;
3a41d85f
NB
336
337 return bio;
338}
339
340static void iblock_submit_bios(struct bio_list *list, int rw)
341{
342 struct blk_plug plug;
343 struct bio *bio;
344
345 blk_start_plug(&plug);
346 while ((bio = bio_list_pop(list)))
347 submit_bio(rw, bio);
348 blk_finish_plug(&plug);
349}
350
4246a0b6 351static void iblock_end_io_flush(struct bio *bio)
df5fa691
CH
352{
353 struct se_cmd *cmd = bio->bi_private;
354
4246a0b6
CH
355 if (bio->bi_error)
356 pr_err("IBLOCK: cache flush failed: %d\n", bio->bi_error);
df5fa691 357
5787cacd 358 if (cmd) {
4246a0b6 359 if (bio->bi_error)
5787cacd 360 target_complete_cmd(cmd, SAM_STAT_CHECK_CONDITION);
de103c93 361 else
5787cacd 362 target_complete_cmd(cmd, SAM_STAT_GOOD);
5787cacd
CH
363 }
364
df5fa691
CH
365 bio_put(bio);
366}
367
c66ac9db 368/*
df5fa691
CH
369 * Implement SYCHRONIZE CACHE. Note that we can't handle lba ranges and must
370 * always flush the whole cache.
c66ac9db 371 */
de103c93
CH
372static sense_reason_t
373iblock_execute_sync_cache(struct se_cmd *cmd)
c66ac9db 374{
0fd97ccf 375 struct iblock_dev *ib_dev = IBLOCK_DEV(cmd->se_dev);
a1d8b49a 376 int immed = (cmd->t_task_cdb[1] & 0x2);
df5fa691 377 struct bio *bio;
c66ac9db
NB
378
379 /*
380 * If the Immediate bit is set, queue up the GOOD response
df5fa691 381 * for this SYNCHRONIZE_CACHE op.
c66ac9db
NB
382 */
383 if (immed)
5787cacd 384 target_complete_cmd(cmd, SAM_STAT_GOOD);
c66ac9db 385
df5fa691
CH
386 bio = bio_alloc(GFP_KERNEL, 0);
387 bio->bi_end_io = iblock_end_io_flush;
388 bio->bi_bdev = ib_dev->ibd_bd;
c66ac9db 389 if (!immed)
df5fa691
CH
390 bio->bi_private = cmd;
391 submit_bio(WRITE_FLUSH, bio);
ad67f0d9 392 return 0;
c66ac9db
NB
393}
394
dbc21c5a 395static sense_reason_t
62e46942 396iblock_execute_unmap(struct se_cmd *cmd, sector_t lba, sector_t nolb)
dbc21c5a 397{
62e46942 398 struct block_device *bdev = IBLOCK_DEV(cmd->se_dev)->ibd_bd;
3028963a 399 struct se_device *dev = cmd->se_dev;
dbc21c5a
AH
400 int ret;
401
3028963a
MC
402 ret = blkdev_issue_discard(bdev,
403 target_to_linux_sector(dev, lba),
404 target_to_linux_sector(dev, nolb),
405 GFP_KERNEL, 0);
dbc21c5a
AH
406 if (ret < 0) {
407 pr_err("blkdev_issue_discard() failed: %d\n", ret);
408 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
409 }
410
411 return 0;
412}
413
f6970ad3
NB
414static sense_reason_t
415iblock_execute_write_same(struct se_cmd *cmd)
416{
417 struct iblock_req *ibr;
418 struct scatterlist *sg;
419 struct bio *bio;
420 struct bio_list list;
3028963a
MC
421 struct se_device *dev = cmd->se_dev;
422 sector_t block_lba = target_to_linux_sector(dev, cmd->t_task_lba);
423 sector_t sectors = target_to_linux_sector(dev,
424 sbc_get_write_same_sectors(cmd));
f6970ad3 425
afd73f1b
NB
426 if (cmd->prot_op) {
427 pr_err("WRITE_SAME: Protection information with IBLOCK"
428 " backends not supported\n");
429 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
430 }
f6970ad3
NB
431 sg = &cmd->t_data_sg[0];
432
433 if (cmd->t_data_nents > 1 ||
434 sg->length != cmd->se_dev->dev_attrib.block_size) {
435 pr_err("WRITE_SAME: Illegal SGL t_data_nents: %u length: %u"
436 " block_size: %u\n", cmd->t_data_nents, sg->length,
437 cmd->se_dev->dev_attrib.block_size);
438 return TCM_INVALID_CDB_FIELD;
439 }
440
441 ibr = kzalloc(sizeof(struct iblock_req), GFP_KERNEL);
442 if (!ibr)
443 goto fail;
444 cmd->priv = ibr;
445
446 bio = iblock_get_bio(cmd, block_lba, 1);
447 if (!bio)
448 goto fail_free_ibr;
449
450 bio_list_init(&list);
451 bio_list_add(&list, bio);
452
453 atomic_set(&ibr->pending, 1);
454
455 while (sectors) {
456 while (bio_add_page(bio, sg_page(sg), sg->length, sg->offset)
457 != sg->length) {
458
459 bio = iblock_get_bio(cmd, block_lba, 1);
460 if (!bio)
461 goto fail_put_bios;
462
463 atomic_inc(&ibr->pending);
464 bio_list_add(&list, bio);
465 }
466
467 /* Always in 512 byte units for Linux/Block */
468 block_lba += sg->length >> IBLOCK_LBA_SHIFT;
469 sectors -= 1;
470 }
471
472 iblock_submit_bios(&list, WRITE);
473 return 0;
474
475fail_put_bios:
476 while ((bio = bio_list_pop(&list)))
477 bio_put(bio);
478fail_free_ibr:
479 kfree(ibr);
480fail:
481 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
482}
483
c66ac9db 484enum {
44bfd018 485 Opt_udev_path, Opt_readonly, Opt_force, Opt_err
c66ac9db
NB
486};
487
488static match_table_t tokens = {
489 {Opt_udev_path, "udev_path=%s"},
44bfd018 490 {Opt_readonly, "readonly=%d"},
c66ac9db
NB
491 {Opt_force, "force=%d"},
492 {Opt_err, NULL}
493};
494
0fd97ccf
CH
495static ssize_t iblock_set_configfs_dev_params(struct se_device *dev,
496 const char *page, ssize_t count)
c66ac9db 497{
0fd97ccf 498 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
6d180253 499 char *orig, *ptr, *arg_p, *opts;
c66ac9db 500 substring_t args[MAX_OPT_ARGS];
21bca31c 501 int ret = 0, token;
44bfd018 502 unsigned long tmp_readonly;
c66ac9db
NB
503
504 opts = kstrdup(page, GFP_KERNEL);
505 if (!opts)
506 return -ENOMEM;
507
508 orig = opts;
509
90c161b6 510 while ((ptr = strsep(&opts, ",\n")) != NULL) {
c66ac9db
NB
511 if (!*ptr)
512 continue;
513
514 token = match_token(ptr, tokens, args);
515 switch (token) {
516 case Opt_udev_path:
517 if (ib_dev->ibd_bd) {
6708bb27 518 pr_err("Unable to set udev_path= while"
c66ac9db
NB
519 " ib_dev->ibd_bd exists\n");
520 ret = -EEXIST;
521 goto out;
522 }
852b6ed1
NB
523 if (match_strlcpy(ib_dev->ibd_udev_path, &args[0],
524 SE_UDEV_PATH_LEN) == 0) {
525 ret = -EINVAL;
6d180253
JJ
526 break;
527 }
6708bb27 528 pr_debug("IBLOCK: Referencing UDEV path: %s\n",
c66ac9db
NB
529 ib_dev->ibd_udev_path);
530 ib_dev->ibd_flags |= IBDF_HAS_UDEV_PATH;
531 break;
44bfd018
AG
532 case Opt_readonly:
533 arg_p = match_strdup(&args[0]);
534 if (!arg_p) {
535 ret = -ENOMEM;
536 break;
537 }
57103d7f 538 ret = kstrtoul(arg_p, 0, &tmp_readonly);
44bfd018
AG
539 kfree(arg_p);
540 if (ret < 0) {
57103d7f 541 pr_err("kstrtoul() failed for"
44bfd018
AG
542 " readonly=\n");
543 goto out;
544 }
545 ib_dev->ibd_readonly = tmp_readonly;
546 pr_debug("IBLOCK: readonly: %d\n", ib_dev->ibd_readonly);
547 break;
c66ac9db 548 case Opt_force:
c66ac9db
NB
549 break;
550 default:
551 break;
552 }
553 }
554
555out:
556 kfree(orig);
557 return (!ret) ? count : ret;
558}
559
0fd97ccf 560static ssize_t iblock_show_configfs_dev_params(struct se_device *dev, char *b)
c66ac9db 561{
0fd97ccf
CH
562 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
563 struct block_device *bd = ib_dev->ibd_bd;
c66ac9db
NB
564 char buf[BDEVNAME_SIZE];
565 ssize_t bl = 0;
566
567 if (bd)
568 bl += sprintf(b + bl, "iBlock device: %s",
569 bdevname(bd, buf));
0fd97ccf 570 if (ib_dev->ibd_flags & IBDF_HAS_UDEV_PATH)
44bfd018 571 bl += sprintf(b + bl, " UDEV PATH: %s",
0fd97ccf
CH
572 ib_dev->ibd_udev_path);
573 bl += sprintf(b + bl, " readonly: %d\n", ib_dev->ibd_readonly);
c66ac9db
NB
574
575 bl += sprintf(b + bl, " ");
576 if (bd) {
577 bl += sprintf(b + bl, "Major: %d Minor: %d %s\n",
21bca31c 578 MAJOR(bd->bd_dev), MINOR(bd->bd_dev), (!bd->bd_contains) ?
0fd97ccf 579 "" : (bd->bd_holder == ib_dev) ?
c66ac9db
NB
580 "CLAIMED: IBLOCK" : "CLAIMED: OS");
581 } else {
21bca31c 582 bl += sprintf(b + bl, "Major: 0 Minor: 0\n");
c66ac9db
NB
583 }
584
585 return bl;
586}
587
ecebbf6c
NB
588static int
589iblock_alloc_bip(struct se_cmd *cmd, struct bio *bio)
590{
591 struct se_device *dev = cmd->se_dev;
592 struct blk_integrity *bi;
593 struct bio_integrity_payload *bip;
594 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
595 struct scatterlist *sg;
596 int i, rc;
597
598 bi = bdev_get_integrity(ib_dev->ibd_bd);
599 if (!bi) {
600 pr_err("Unable to locate bio_integrity\n");
601 return -ENODEV;
602 }
603
604 bip = bio_integrity_alloc(bio, GFP_NOIO, cmd->t_prot_nents);
605 if (!bip) {
606 pr_err("Unable to allocate bio_integrity_payload\n");
607 return -ENOMEM;
608 }
609
4e13c5d0 610 bip->bip_iter.bi_size = (cmd->data_length / dev->dev_attrib.block_size) *
ecebbf6c 611 dev->prot_length;
4e13c5d0 612 bip->bip_iter.bi_sector = bio->bi_iter.bi_sector;
ecebbf6c 613
4e13c5d0
LT
614 pr_debug("IBLOCK BIP Size: %u Sector: %llu\n", bip->bip_iter.bi_size,
615 (unsigned long long)bip->bip_iter.bi_sector);
ecebbf6c
NB
616
617 for_each_sg(cmd->t_prot_sg, sg, cmd->t_prot_nents, i) {
618
619 rc = bio_integrity_add_page(bio, sg_page(sg), sg->length,
620 sg->offset);
621 if (rc != sg->length) {
622 pr_err("bio_integrity_add_page() failed; %d\n", rc);
623 return -ENOMEM;
624 }
625
626 pr_debug("Added bio integrity page: %p length: %d offset; %d\n",
627 sg_page(sg), sg->length, sg->offset);
628 }
629
630 return 0;
631}
632
de103c93 633static sense_reason_t
a82a9538
NB
634iblock_execute_rw(struct se_cmd *cmd, struct scatterlist *sgl, u32 sgl_nents,
635 enum dma_data_direction data_direction)
c66ac9db 636{
5951146d 637 struct se_device *dev = cmd->se_dev;
3028963a 638 sector_t block_lba = target_to_linux_sector(dev, cmd->t_task_lba);
5787cacd 639 struct iblock_req *ibr;
ecebbf6c 640 struct bio *bio, *bio_start;
dbbf3e94 641 struct bio_list list;
c66ac9db 642 struct scatterlist *sg;
5787cacd 643 u32 sg_num = sgl_nents;
d5b4a21b 644 unsigned bio_cnt;
d0c8b259 645 int rw = 0;
5787cacd 646 int i;
dbbf3e94 647
5787cacd 648 if (data_direction == DMA_TO_DEVICE) {
d0c8b259
NB
649 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
650 struct request_queue *q = bdev_get_queue(ib_dev->ibd_bd);
dbbf3e94 651 /*
d0c8b259
NB
652 * Force writethrough using WRITE_FUA if a volatile write cache
653 * is not enabled, or if initiator set the Force Unit Access bit.
dbbf3e94 654 */
d0c8b259
NB
655 if (q->flush_flags & REQ_FUA) {
656 if (cmd->se_cmd_flags & SCF_FUA)
657 rw = WRITE_FUA;
658 else if (!(q->flush_flags & REQ_FLUSH))
659 rw = WRITE_FUA;
d2bdbee0
NB
660 else
661 rw = WRITE;
d0c8b259 662 } else {
dbbf3e94 663 rw = WRITE;
d0c8b259 664 }
dbbf3e94
CH
665 } else {
666 rw = READ;
667 }
668
5787cacd
CH
669 ibr = kzalloc(sizeof(struct iblock_req), GFP_KERNEL);
670 if (!ibr)
671 goto fail;
672 cmd->priv = ibr;
673
e0de4457
PB
674 if (!sgl_nents) {
675 atomic_set(&ibr->pending, 1);
676 iblock_complete_cmd(cmd);
677 return 0;
678 }
679
5787cacd
CH
680 bio = iblock_get_bio(cmd, block_lba, sgl_nents);
681 if (!bio)
682 goto fail_free_ibr;
dbbf3e94 683
ecebbf6c 684 bio_start = bio;
dbbf3e94
CH
685 bio_list_init(&list);
686 bio_list_add(&list, bio);
5787cacd
CH
687
688 atomic_set(&ibr->pending, 2);
d5b4a21b 689 bio_cnt = 1;
c66ac9db 690
5787cacd 691 for_each_sg(sgl, sg, sgl_nents, i) {
dbbf3e94
CH
692 /*
693 * XXX: if the length the device accepts is shorter than the
694 * length of the S/G list entry this will cause and
695 * endless loop. Better hope no driver uses huge pages.
696 */
697 while (bio_add_page(bio, sg_page(sg), sg->length, sg->offset)
698 != sg->length) {
d5b4a21b
CH
699 if (bio_cnt >= IBLOCK_MAX_BIO_PER_TASK) {
700 iblock_submit_bios(&list, rw);
701 bio_cnt = 0;
702 }
703
5787cacd 704 bio = iblock_get_bio(cmd, block_lba, sg_num);
6708bb27 705 if (!bio)
5787cacd
CH
706 goto fail_put_bios;
707
708 atomic_inc(&ibr->pending);
dbbf3e94 709 bio_list_add(&list, bio);
d5b4a21b 710 bio_cnt++;
c66ac9db 711 }
dbbf3e94 712
c66ac9db
NB
713 /* Always in 512 byte units for Linux/Block */
714 block_lba += sg->length >> IBLOCK_LBA_SHIFT;
715 sg_num--;
c66ac9db
NB
716 }
717
6f16ec43 718 if (cmd->prot_type && dev->dev_attrib.pi_prot_type) {
ecebbf6c
NB
719 int rc = iblock_alloc_bip(cmd, bio_start);
720 if (rc)
721 goto fail_put_bios;
722 }
723
d5b4a21b 724 iblock_submit_bios(&list, rw);
5787cacd 725 iblock_complete_cmd(cmd);
03e98c9e 726 return 0;
dbbf3e94 727
5787cacd 728fail_put_bios:
dbbf3e94 729 while ((bio = bio_list_pop(&list)))
c66ac9db 730 bio_put(bio);
5787cacd
CH
731fail_free_ibr:
732 kfree(ibr);
5787cacd 733fail:
de103c93 734 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
c66ac9db
NB
735}
736
c66ac9db
NB
737static sector_t iblock_get_blocks(struct se_device *dev)
738{
0fd97ccf
CH
739 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
740 struct block_device *bd = ib_dev->ibd_bd;
c66ac9db
NB
741 struct request_queue *q = bdev_get_queue(bd);
742
743 return iblock_emulate_read_cap_with_block_size(dev, bd, q);
744}
745
7f7caf6a
AG
746static sector_t iblock_get_alignment_offset_lbas(struct se_device *dev)
747{
748 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
749 struct block_device *bd = ib_dev->ibd_bd;
750 int ret;
751
752 ret = bdev_alignment_offset(bd);
753 if (ret == -1)
754 return 0;
755
756 /* convert offset-bytes to offset-lbas */
757 return ret / bdev_logical_block_size(bd);
758}
759
760static unsigned int iblock_get_lbppbe(struct se_device *dev)
761{
762 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
763 struct block_device *bd = ib_dev->ibd_bd;
764 int logs_per_phys = bdev_physical_block_size(bd) / bdev_logical_block_size(bd);
765
766 return ilog2(logs_per_phys);
767}
768
769static unsigned int iblock_get_io_min(struct se_device *dev)
770{
771 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
772 struct block_device *bd = ib_dev->ibd_bd;
773
774 return bdev_io_min(bd);
775}
776
777static unsigned int iblock_get_io_opt(struct se_device *dev)
778{
779 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
780 struct block_device *bd = ib_dev->ibd_bd;
781
782 return bdev_io_opt(bd);
783}
784
9e999a6c 785static struct sbc_ops iblock_sbc_ops = {
0c2ad7d1 786 .execute_rw = iblock_execute_rw,
ad67f0d9 787 .execute_sync_cache = iblock_execute_sync_cache,
6f974e8c 788 .execute_write_same = iblock_execute_write_same,
14150a6b 789 .execute_unmap = iblock_execute_unmap,
0c2ad7d1
CH
790};
791
de103c93
CH
792static sense_reason_t
793iblock_parse_cdb(struct se_cmd *cmd)
0c2ad7d1 794{
9e999a6c 795 return sbc_parse_cdb(cmd, &iblock_sbc_ops);
0c2ad7d1
CH
796}
797
452e2010 798static bool iblock_get_write_cache(struct se_device *dev)
d0c8b259
NB
799{
800 struct iblock_dev *ib_dev = IBLOCK_DEV(dev);
801 struct block_device *bd = ib_dev->ibd_bd;
802 struct request_queue *q = bdev_get_queue(bd);
803
804 return q->flush_flags & REQ_FLUSH;
805}
806
0a06d430 807static const struct target_backend_ops iblock_ops = {
c66ac9db 808 .name = "iblock",
0fd97ccf
CH
809 .inquiry_prod = "IBLOCK",
810 .inquiry_rev = IBLOCK_VERSION,
c66ac9db 811 .owner = THIS_MODULE,
c66ac9db
NB
812 .attach_hba = iblock_attach_hba,
813 .detach_hba = iblock_detach_hba,
0fd97ccf
CH
814 .alloc_device = iblock_alloc_device,
815 .configure_device = iblock_configure_device,
c66ac9db 816 .free_device = iblock_free_device,
0c2ad7d1 817 .parse_cdb = iblock_parse_cdb,
c66ac9db
NB
818 .set_configfs_dev_params = iblock_set_configfs_dev_params,
819 .show_configfs_dev_params = iblock_show_configfs_dev_params,
6f23ac8a 820 .get_device_type = sbc_get_device_type,
c66ac9db 821 .get_blocks = iblock_get_blocks,
7f7caf6a
AG
822 .get_alignment_offset_lbas = iblock_get_alignment_offset_lbas,
823 .get_lbppbe = iblock_get_lbppbe,
824 .get_io_min = iblock_get_io_min,
825 .get_io_opt = iblock_get_io_opt,
d0c8b259 826 .get_write_cache = iblock_get_write_cache,
5873c4d1 827 .tb_dev_attrib_attrs = sbc_attrib_attrs,
c66ac9db
NB
828};
829
830static int __init iblock_module_init(void)
831{
0a06d430 832 return transport_backend_register(&iblock_ops);
c66ac9db
NB
833}
834
63b91d5a 835static void __exit iblock_module_exit(void)
c66ac9db 836{
0a06d430 837 target_backend_unregister(&iblock_ops);
c66ac9db
NB
838}
839
840MODULE_DESCRIPTION("TCM IBLOCK subsystem plugin");
841MODULE_AUTHOR("nab@Linux-iSCSI.org");
842MODULE_LICENSE("GPL");
843
844module_init(iblock_module_init);
845module_exit(iblock_module_exit);