mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
359 lines
8.8 KiB
359 lines
8.8 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Copyright (c) 2010 Cisco Systems, Inc. |
|
* |
|
* Portions based on tcm_loop_fabric_scsi.c and libfc/fc_fcp.c |
|
* |
|
* Copyright (c) 2007 Intel Corporation. All rights reserved. |
|
* Copyright (c) 2008 Red Hat, Inc. All rights reserved. |
|
* Copyright (c) 2008 Mike Christie |
|
* Copyright (c) 2009 Rising Tide, Inc. |
|
* Copyright (c) 2009 Linux-iSCSI.org |
|
* Copyright (c) 2009 Nicholas A. Bellinger <[email protected]> |
|
*/ |
|
|
|
/* XXX TBD some includes may be extraneous */ |
|
|
|
#include <linux/module.h> |
|
#include <linux/moduleparam.h> |
|
#include <linux/utsname.h> |
|
#include <linux/init.h> |
|
#include <linux/slab.h> |
|
#include <linux/kthread.h> |
|
#include <linux/types.h> |
|
#include <linux/string.h> |
|
#include <linux/configfs.h> |
|
#include <linux/ctype.h> |
|
#include <linux/hash.h> |
|
#include <linux/ratelimit.h> |
|
#include <asm/unaligned.h> |
|
#include <scsi/libfc.h> |
|
|
|
#include <target/target_core_base.h> |
|
#include <target/target_core_fabric.h> |
|
|
|
#include "tcm_fc.h" |
|
|
|
/* |
|
* Deliver read data back to initiator. |
|
* XXX TBD handle resource problems later. |
|
*/ |
|
int ft_queue_data_in(struct se_cmd *se_cmd) |
|
{ |
|
struct ft_cmd *cmd = container_of(se_cmd, struct ft_cmd, se_cmd); |
|
struct fc_frame *fp = NULL; |
|
struct fc_exch *ep; |
|
struct fc_lport *lport; |
|
struct scatterlist *sg = NULL; |
|
size_t remaining; |
|
u32 f_ctl = FC_FC_EX_CTX | FC_FC_REL_OFF; |
|
u32 mem_off = 0; |
|
u32 fh_off = 0; |
|
u32 frame_off = 0; |
|
size_t frame_len = 0; |
|
size_t mem_len = 0; |
|
size_t tlen; |
|
size_t off_in_page; |
|
struct page *page = NULL; |
|
int use_sg; |
|
int error; |
|
void *page_addr; |
|
void *from; |
|
void *to = NULL; |
|
|
|
if (cmd->aborted) |
|
return 0; |
|
|
|
if (se_cmd->scsi_status == SAM_STAT_TASK_SET_FULL) |
|
goto queue_status; |
|
|
|
ep = fc_seq_exch(cmd->seq); |
|
lport = ep->lp; |
|
cmd->seq = fc_seq_start_next(cmd->seq); |
|
|
|
remaining = se_cmd->data_length; |
|
|
|
/* |
|
* Setup to use first mem list entry, unless no data. |
|
*/ |
|
BUG_ON(remaining && !se_cmd->t_data_sg); |
|
if (remaining) { |
|
sg = se_cmd->t_data_sg; |
|
mem_len = sg->length; |
|
mem_off = sg->offset; |
|
page = sg_page(sg); |
|
} |
|
|
|
/* no scatter/gather in skb for odd word length due to fc_seq_send() */ |
|
use_sg = !(remaining % 4); |
|
|
|
while (remaining) { |
|
struct fc_seq *seq = cmd->seq; |
|
|
|
if (!seq) { |
|
pr_debug("%s: Command aborted, xid 0x%x\n", |
|
__func__, ep->xid); |
|
break; |
|
} |
|
if (!mem_len) { |
|
sg = sg_next(sg); |
|
mem_len = min((size_t)sg->length, remaining); |
|
mem_off = sg->offset; |
|
page = sg_page(sg); |
|
} |
|
if (!frame_len) { |
|
/* |
|
* If lport's has capability of Large Send Offload LSO) |
|
* , then allow 'frame_len' to be as big as 'lso_max' |
|
* if indicated transfer length is >= lport->lso_max |
|
*/ |
|
frame_len = (lport->seq_offload) ? lport->lso_max : |
|
cmd->sess->max_frame; |
|
frame_len = min(frame_len, remaining); |
|
fp = fc_frame_alloc(lport, use_sg ? 0 : frame_len); |
|
if (!fp) |
|
return -ENOMEM; |
|
to = fc_frame_payload_get(fp, 0); |
|
fh_off = frame_off; |
|
frame_off += frame_len; |
|
/* |
|
* Setup the frame's max payload which is used by base |
|
* driver to indicate HW about max frame size, so that |
|
* HW can do fragmentation appropriately based on |
|
* "gso_max_size" of underline netdev. |
|
*/ |
|
fr_max_payload(fp) = cmd->sess->max_frame; |
|
} |
|
tlen = min(mem_len, frame_len); |
|
|
|
if (use_sg) { |
|
off_in_page = mem_off; |
|
BUG_ON(!page); |
|
get_page(page); |
|
skb_fill_page_desc(fp_skb(fp), |
|
skb_shinfo(fp_skb(fp))->nr_frags, |
|
page, off_in_page, tlen); |
|
fr_len(fp) += tlen; |
|
fp_skb(fp)->data_len += tlen; |
|
fp_skb(fp)->truesize += page_size(page); |
|
} else { |
|
BUG_ON(!page); |
|
from = kmap_atomic(page + (mem_off >> PAGE_SHIFT)); |
|
page_addr = from; |
|
from += offset_in_page(mem_off); |
|
tlen = min(tlen, (size_t)(PAGE_SIZE - |
|
offset_in_page(mem_off))); |
|
memcpy(to, from, tlen); |
|
kunmap_atomic(page_addr); |
|
to += tlen; |
|
} |
|
|
|
mem_off += tlen; |
|
mem_len -= tlen; |
|
frame_len -= tlen; |
|
remaining -= tlen; |
|
|
|
if (frame_len && |
|
(skb_shinfo(fp_skb(fp))->nr_frags < FC_FRAME_SG_LEN)) |
|
continue; |
|
if (!remaining) |
|
f_ctl |= FC_FC_END_SEQ; |
|
fc_fill_fc_hdr(fp, FC_RCTL_DD_SOL_DATA, ep->did, ep->sid, |
|
FC_TYPE_FCP, f_ctl, fh_off); |
|
error = fc_seq_send(lport, seq, fp); |
|
if (error) { |
|
pr_info_ratelimited("%s: Failed to send frame %p, " |
|
"xid <0x%x>, remaining %zu, " |
|
"lso_max <0x%x>\n", |
|
__func__, fp, ep->xid, |
|
remaining, lport->lso_max); |
|
/* |
|
* Go ahead and set TASK_SET_FULL status ignoring the |
|
* rest of the DataIN, and immediately attempt to |
|
* send the response via ft_queue_status() in order |
|
* to notify the initiator that it should reduce it's |
|
* per LUN queue_depth. |
|
*/ |
|
se_cmd->scsi_status = SAM_STAT_TASK_SET_FULL; |
|
break; |
|
} |
|
} |
|
queue_status: |
|
return ft_queue_status(se_cmd); |
|
} |
|
|
|
static void ft_execute_work(struct work_struct *work) |
|
{ |
|
struct ft_cmd *cmd = container_of(work, struct ft_cmd, work); |
|
|
|
target_execute_cmd(&cmd->se_cmd); |
|
} |
|
|
|
/* |
|
* Receive write data frame. |
|
*/ |
|
void ft_recv_write_data(struct ft_cmd *cmd, struct fc_frame *fp) |
|
{ |
|
struct se_cmd *se_cmd = &cmd->se_cmd; |
|
struct fc_seq *seq = cmd->seq; |
|
struct fc_exch *ep; |
|
struct fc_lport *lport; |
|
struct fc_frame_header *fh; |
|
struct scatterlist *sg = NULL; |
|
u32 mem_off = 0; |
|
u32 rel_off; |
|
size_t frame_len; |
|
size_t mem_len = 0; |
|
size_t tlen; |
|
struct page *page = NULL; |
|
void *page_addr; |
|
void *from; |
|
void *to; |
|
u32 f_ctl; |
|
void *buf; |
|
|
|
fh = fc_frame_header_get(fp); |
|
if (!(ntoh24(fh->fh_f_ctl) & FC_FC_REL_OFF)) |
|
goto drop; |
|
|
|
f_ctl = ntoh24(fh->fh_f_ctl); |
|
ep = fc_seq_exch(seq); |
|
lport = ep->lp; |
|
if (cmd->was_ddp_setup) { |
|
BUG_ON(!lport); |
|
/* |
|
* Since DDP (Large Rx offload) was setup for this request, |
|
* payload is expected to be copied directly to user buffers. |
|
*/ |
|
buf = fc_frame_payload_get(fp, 1); |
|
if (buf) |
|
pr_err("%s: xid 0x%x, f_ctl 0x%x, cmd->sg %p, " |
|
"cmd->sg_cnt 0x%x. DDP was setup" |
|
" hence not expected to receive frame with " |
|
"payload, Frame will be dropped if" |
|
"'Sequence Initiative' bit in f_ctl is" |
|
"not set\n", __func__, ep->xid, f_ctl, |
|
se_cmd->t_data_sg, se_cmd->t_data_nents); |
|
/* |
|
* Invalidate HW DDP context if it was setup for respective |
|
* command. Invalidation of HW DDP context is requited in both |
|
* situation (success and error). |
|
*/ |
|
ft_invl_hw_context(cmd); |
|
|
|
/* |
|
* If "Sequence Initiative (TSI)" bit set in f_ctl, means last |
|
* write data frame is received successfully where payload is |
|
* posted directly to user buffer and only the last frame's |
|
* header is posted in receive queue. |
|
* |
|
* If "Sequence Initiative (TSI)" bit is not set, means error |
|
* condition w.r.t. DDP, hence drop the packet and let explict |
|
* ABORTS from other end of exchange timer trigger the recovery. |
|
*/ |
|
if (f_ctl & FC_FC_SEQ_INIT) |
|
goto last_frame; |
|
else |
|
goto drop; |
|
} |
|
|
|
rel_off = ntohl(fh->fh_parm_offset); |
|
frame_len = fr_len(fp); |
|
if (frame_len <= sizeof(*fh)) |
|
goto drop; |
|
frame_len -= sizeof(*fh); |
|
from = fc_frame_payload_get(fp, 0); |
|
if (rel_off >= se_cmd->data_length) |
|
goto drop; |
|
if (frame_len + rel_off > se_cmd->data_length) |
|
frame_len = se_cmd->data_length - rel_off; |
|
|
|
/* |
|
* Setup to use first mem list entry, unless no data. |
|
*/ |
|
BUG_ON(frame_len && !se_cmd->t_data_sg); |
|
if (frame_len) { |
|
sg = se_cmd->t_data_sg; |
|
mem_len = sg->length; |
|
mem_off = sg->offset; |
|
page = sg_page(sg); |
|
} |
|
|
|
while (frame_len) { |
|
if (!mem_len) { |
|
sg = sg_next(sg); |
|
mem_len = sg->length; |
|
mem_off = sg->offset; |
|
page = sg_page(sg); |
|
} |
|
if (rel_off >= mem_len) { |
|
rel_off -= mem_len; |
|
mem_len = 0; |
|
continue; |
|
} |
|
mem_off += rel_off; |
|
mem_len -= rel_off; |
|
rel_off = 0; |
|
|
|
tlen = min(mem_len, frame_len); |
|
|
|
to = kmap_atomic(page + (mem_off >> PAGE_SHIFT)); |
|
page_addr = to; |
|
to += offset_in_page(mem_off); |
|
tlen = min(tlen, (size_t)(PAGE_SIZE - |
|
offset_in_page(mem_off))); |
|
memcpy(to, from, tlen); |
|
kunmap_atomic(page_addr); |
|
|
|
from += tlen; |
|
frame_len -= tlen; |
|
mem_off += tlen; |
|
mem_len -= tlen; |
|
cmd->write_data_len += tlen; |
|
} |
|
last_frame: |
|
if (cmd->write_data_len == se_cmd->data_length) { |
|
INIT_WORK(&cmd->work, ft_execute_work); |
|
queue_work(cmd->sess->tport->tpg->workqueue, &cmd->work); |
|
} |
|
drop: |
|
fc_frame_free(fp); |
|
} |
|
|
|
/* |
|
* Handle and cleanup any HW specific resources if |
|
* received ABORTS, errors, timeouts. |
|
*/ |
|
void ft_invl_hw_context(struct ft_cmd *cmd) |
|
{ |
|
struct fc_seq *seq; |
|
struct fc_exch *ep = NULL; |
|
struct fc_lport *lport = NULL; |
|
|
|
BUG_ON(!cmd); |
|
seq = cmd->seq; |
|
|
|
/* Cleanup the DDP context in HW if DDP was setup */ |
|
if (cmd->was_ddp_setup && seq) { |
|
ep = fc_seq_exch(seq); |
|
if (ep) { |
|
lport = ep->lp; |
|
if (lport && (ep->xid <= lport->lro_xid)) { |
|
/* |
|
* "ddp_done" trigger invalidation of HW |
|
* specific DDP context |
|
*/ |
|
cmd->write_data_len = lport->tt.ddp_done(lport, |
|
ep->xid); |
|
|
|
/* |
|
* Resetting same variable to indicate HW's |
|
* DDP context has been invalidated to avoid |
|
* re_invalidation of same context (context is |
|
* identified using ep->xid) |
|
*/ |
|
cmd->was_ddp_setup = 0; |
|
} |
|
} |
|
} |
|
}
|
|
|