]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/scsi/qla2xxx/qla_target.c
projects / mirror_ubuntu-artful-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
qla2xxx: Enable target mode for ISP27XX
[mirror_ubuntu-artful-kernel.git] / drivers / scsi / qla2xxx / qla_target.c
CommitLineData
2d70c103
NB		 1/*
2 * qla_target.c SCSI LLD infrastructure for QLogic 22xx/23xx/24xx/25xx
3 *
4 * based on qla2x00t.c code:
5 *
6 * Copyright (C) 2004 - 2010 Vladislav Bolkhovitin <vst@vlnb.net>
7 * Copyright (C) 2004 - 2005 Leonid Stoljar
8 * Copyright (C) 2006 Nathaniel Clark <nate@misrule.us>
9 * Copyright (C) 2006 - 2010 ID7 Ltd.
10 *
11 * Forward port and refactoring to modern qla2xxx and target/configfs
12 *
4c76251e 13 * Copyright (C) 2010-2013 Nicholas A. Bellinger <nab@kernel.org>
2d70c103
NB		 14 *
15 * This program is free software; you can redistribute it and/or
16 * modify it under the terms of the GNU General Public License
17 * as published by the Free Software Foundation, version 2
18 * of the License.
19 *
20 * This program is distributed in the hope that it will be useful,
21 * but WITHOUT ANY WARRANTY; without even the implied warranty of
22 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 * GNU General Public License for more details.
24 */
25
26#include <linux/module.h>
27#include <linux/init.h>
28#include <linux/types.h>
2d70c103
NB		 29#include <linux/blkdev.h>
30#include <linux/interrupt.h>
31#include <linux/pci.h>
32#include <linux/delay.h>
33#include <linux/list.h>
34#include <linux/workqueue.h>
35#include <asm/unaligned.h>
36#include <scsi/scsi.h>
37#include <scsi/scsi_host.h>
38#include <scsi/scsi_tcq.h>
39#include <target/target_core_base.h>
40#include <target/target_core_fabric.h>
41
42#include "qla_def.h"
43#include "qla_target.h"
44
d154f350
AE		 45static int ql2xtgt_tape_enable;
46module_param(ql2xtgt_tape_enable, int, S_IRUGO|S_IWUSR);
47MODULE_PARM_DESC(ql2xtgt_tape_enable,
48 "Enables Sequence level error recovery (aka FC Tape). Default is 0 - no SLER. 1 - Enable SLER.");
49
2d70c103
NB		 50static char *qlini_mode = QLA2XXX_INI_MODE_STR_ENABLED;
51module_param(qlini_mode, charp, S_IRUGO);
52MODULE_PARM_DESC(qlini_mode,
53 "Determines when initiator mode will be enabled. Possible values: "
54 "\"exclusive\" - initiator mode will be enabled on load, "
55 "disabled on enabling target mode and then on disabling target mode "
56 "enabled back; "
57 "\"disabled\" - initiator mode will never be enabled; "
58 "\"enabled\" (default) - initiator mode will always stay enabled.");
59
aa230bc5 60int ql2x_ini_mode = QLA2XXX_INI_MODE_EXCLUSIVE;
2d70c103 61
33e79977
QT		 62static int temp_sam_status = SAM_STAT_BUSY;
63
2d70c103
NB		 64/*
65 * From scsi/fc/fc_fcp.h
66 */
67enum fcp_resp_rsp_codes {
68 FCP_TMF_CMPL = 0,
69 FCP_DATA_LEN_INVALID = 1,
70 FCP_CMND_FIELDS_INVALID = 2,
71 FCP_DATA_PARAM_MISMATCH = 3,
72 FCP_TMF_REJECTED = 4,
73 FCP_TMF_FAILED = 5,
74 FCP_TMF_INVALID_LUN = 9,
75};
76
77/*
78 * fc_pri_ta from scsi/fc/fc_fcp.h
79 */
80#define FCP_PTA_SIMPLE 0 /* simple task attribute */
81#define FCP_PTA_HEADQ 1 /* head of queue task attribute */
82#define FCP_PTA_ORDERED 2 /* ordered task attribute */
6efb3c0a 83#define FCP_PTA_ACA 4 /* auto. contingent allegiance */
2d70c103
NB		 84#define FCP_PTA_MASK 7 /* mask for task attribute field */
85#define FCP_PRI_SHIFT 3 /* priority field starts in bit 3 */
86#define FCP_PRI_RESVD_MASK 0x80 /* reserved bits in priority field */
87
88/*
89 * This driver calls qla2x00_alloc_iocbs() and qla2x00_issue_marker(), which
90 * must be called under HW lock and could unlock/lock it inside.
91 * It isn't an issue, since in the current implementation on the time when
92 * those functions are called:
93 *
94 * - Either context is IRQ and only IRQ handler can modify HW data,
95 * including rings related fields,
96 *
97 * - Or access to target mode variables from struct qla_tgt doesn't
98 * cross those functions boundaries, except tgt_stop, which
99 * additionally protected by irq_cmd_count.
100 */
101/* Predefs for callbacks handed to qla2xxx LLD */
102static void qlt_24xx_atio_pkt(struct scsi_qla_host *ha,
103 struct atio_from_isp *pkt);
104static void qlt_response_pkt(struct scsi_qla_host *ha, response_t *pkt);
105static int qlt_issue_task_mgmt(struct qla_tgt_sess *sess, uint32_t lun,
106 int fn, void *iocb, int flags);
107static void qlt_send_term_exchange(struct scsi_qla_host *ha, struct qla_tgt_cmd
108 *cmd, struct atio_from_isp *atio, int ha_locked);
109static void qlt_reject_free_srr_imm(struct scsi_qla_host *ha,
110 struct qla_tgt_srr_imm *imm, int ha_lock);
b6a029e1
AE		 111static void qlt_abort_cmd_on_host_reset(struct scsi_qla_host *vha,
112 struct qla_tgt_cmd *cmd);
33e79977
QT		 113static void qlt_alloc_qfull_cmd(struct scsi_qla_host *vha,
114 struct atio_from_isp *atio, uint16_t status, int qfull);
55a9066f 115static void qlt_disable_vha(struct scsi_qla_host *vha);
2d70c103
NB		 116/*
117 * Global Variables
118 */
2d70c103
NB		 119static struct kmem_cache *qla_tgt_mgmt_cmd_cachep;
120static mempool_t *qla_tgt_mgmt_cmd_mempool;
121static struct workqueue_struct *qla_tgt_wq;
122static DEFINE_MUTEX(qla_tgt_mutex);
123static LIST_HEAD(qla_tgt_glist);
124
125/* ha->hardware_lock supposed to be held on entry (to protect tgt->sess_list) */
126static struct qla_tgt_sess *qlt_find_sess_by_port_name(
127 struct qla_tgt *tgt,
128 const uint8_t *port_name)
129{
130 struct qla_tgt_sess *sess;
131
132 list_for_each_entry(sess, &tgt->sess_list, sess_list_entry) {
133 if (!memcmp(sess->port_name, port_name, WWN_SIZE))
134 return sess;
135 }
136
137 return NULL;
138}
139
140/* Might release hw lock, then reaquire!! */
141static inline int qlt_issue_marker(struct scsi_qla_host *vha, int vha_locked)
142{
143 /* Send marker if required */
144 if (unlikely(vha->marker_needed != 0)) {
145 int rc = qla2x00_issue_marker(vha, vha_locked);
146 if (rc != QLA_SUCCESS) {
147 ql_dbg(ql_dbg_tgt, vha, 0xe03d,
148 "qla_target(%d): issue_marker() failed\n",
149 vha->vp_idx);
150 }
151 return rc;
152 }
153 return QLA_SUCCESS;
154}
155
156static inline
157struct scsi_qla_host *qlt_find_host_by_d_id(struct scsi_qla_host *vha,
158 uint8_t *d_id)
159{
160 struct qla_hw_data *ha = vha->hw;
161 uint8_t vp_idx;
162
163 if ((vha->d_id.b.area != d_id[1]) || (vha->d_id.b.domain != d_id[0]))
164 return NULL;
165
166 if (vha->d_id.b.al_pa == d_id[2])
167 return vha;
168
169 BUG_ON(ha->tgt.tgt_vp_map == NULL);
170 vp_idx = ha->tgt.tgt_vp_map[d_id[2]].idx;
171 if (likely(test_bit(vp_idx, ha->vp_idx_map)))
172 return ha->tgt.tgt_vp_map[vp_idx].vha;
173
174 return NULL;
175}
176
177static inline
178struct scsi_qla_host *qlt_find_host_by_vp_idx(struct scsi_qla_host *vha,
179 uint16_t vp_idx)
180{
181 struct qla_hw_data *ha = vha->hw;
182
183 if (vha->vp_idx == vp_idx)
184 return vha;
185
186 BUG_ON(ha->tgt.tgt_vp_map == NULL);
187 if (likely(test_bit(vp_idx, ha->vp_idx_map)))
188 return ha->tgt.tgt_vp_map[vp_idx].vha;
189
190 return NULL;
191}
192
33e79977
QT		 193static inline void qlt_incr_num_pend_cmds(struct scsi_qla_host *vha)
194{
195 unsigned long flags;
196
197 spin_lock_irqsave(&vha->hw->tgt.q_full_lock, flags);
198
199 vha->hw->tgt.num_pend_cmds++;
200 if (vha->hw->tgt.num_pend_cmds > vha->hw->qla_stats.stat_max_pend_cmds)
201 vha->hw->qla_stats.stat_max_pend_cmds =
202 vha->hw->tgt.num_pend_cmds;
203 spin_unlock_irqrestore(&vha->hw->tgt.q_full_lock, flags);
204}
205static inline void qlt_decr_num_pend_cmds(struct scsi_qla_host *vha)
206{
207 unsigned long flags;
208
209 spin_lock_irqsave(&vha->hw->tgt.q_full_lock, flags);
210 vha->hw->tgt.num_pend_cmds--;
211 spin_unlock_irqrestore(&vha->hw->tgt.q_full_lock, flags);
212}
213
55a9066f 214static void qlt_24xx_atio_pkt_all_vps(struct scsi_qla_host *vha,
2d70c103
NB		 215 struct atio_from_isp *atio)
216{
f83adb61
QT		 217 ql_dbg(ql_dbg_tgt, vha, 0xe072,
218 "%s: qla_target(%d): type %x ox_id %04x\n",
219 __func__, vha->vp_idx, atio->u.raw.entry_type,
220 be16_to_cpu(atio->u.isp24.fcp_hdr.ox_id));
221
2d70c103
NB		 222 switch (atio->u.raw.entry_type) {
223 case ATIO_TYPE7:
224 {
225 struct scsi_qla_host *host = qlt_find_host_by_d_id(vha,
226 atio->u.isp24.fcp_hdr.d_id);
227 if (unlikely(NULL == host)) {
228 ql_dbg(ql_dbg_tgt, vha, 0xe03e,
229 "qla_target(%d): Received ATIO_TYPE7 "
230 "with unknown d_id %x:%x:%x\n", vha->vp_idx,
231 atio->u.isp24.fcp_hdr.d_id[0],
232 atio->u.isp24.fcp_hdr.d_id[1],
233 atio->u.isp24.fcp_hdr.d_id[2]);
234 break;
235 }
236 qlt_24xx_atio_pkt(host, atio);
237 break;
238 }
239
240 case IMMED_NOTIFY_TYPE:
241 {
242 struct scsi_qla_host *host = vha;
243 struct imm_ntfy_from_isp *entry =
244 (struct imm_ntfy_from_isp *)atio;
245
246 if ((entry->u.isp24.vp_index != 0xFF) &&
247 (entry->u.isp24.nport_handle != 0xFFFF)) {
248 host = qlt_find_host_by_vp_idx(vha,
249 entry->u.isp24.vp_index);
250 if (unlikely(!host)) {
251 ql_dbg(ql_dbg_tgt, vha, 0xe03f,
252 "qla_target(%d): Received "
253 "ATIO (IMMED_NOTIFY_TYPE) "
254 "with unknown vp_index %d\n",
255 vha->vp_idx, entry->u.isp24.vp_index);
256 break;
257 }
258 }
259 qlt_24xx_atio_pkt(host, atio);
260 break;
261 }
262
263 default:
264 ql_dbg(ql_dbg_tgt, vha, 0xe040,
265 "qla_target(%d): Received unknown ATIO atio "
266 "type %x\n", vha->vp_idx, atio->u.raw.entry_type);
267 break;
268 }
269
270 return;
271}
272
273void qlt_response_pkt_all_vps(struct scsi_qla_host *vha, response_t *pkt)
274{
275 switch (pkt->entry_type) {
f83adb61
QT		 276 case CTIO_CRC2:
277 ql_dbg(ql_dbg_tgt, vha, 0xe073,
278 "qla_target(%d):%s: CRC2 Response pkt\n",
279 vha->vp_idx, __func__);
2d70c103
NB		 280 case CTIO_TYPE7:
281 {
282 struct ctio7_from_24xx *entry = (struct ctio7_from_24xx *)pkt;
283 struct scsi_qla_host *host = qlt_find_host_by_vp_idx(vha,
284 entry->vp_index);
285 if (unlikely(!host)) {
286 ql_dbg(ql_dbg_tgt, vha, 0xe041,
287 "qla_target(%d): Response pkt (CTIO_TYPE7) "
288 "received, with unknown vp_index %d\n",
289 vha->vp_idx, entry->vp_index);
290 break;
291 }
292 qlt_response_pkt(host, pkt);
293 break;
294 }
295
296 case IMMED_NOTIFY_TYPE:
297 {
298 struct scsi_qla_host *host = vha;
299 struct imm_ntfy_from_isp *entry =
300 (struct imm_ntfy_from_isp *)pkt;
301
302 host = qlt_find_host_by_vp_idx(vha, entry->u.isp24.vp_index);
303 if (unlikely(!host)) {
304 ql_dbg(ql_dbg_tgt, vha, 0xe042,
305 "qla_target(%d): Response pkt (IMMED_NOTIFY_TYPE) "
306 "received, with unknown vp_index %d\n",
307 vha->vp_idx, entry->u.isp24.vp_index);
308 break;
309 }
310 qlt_response_pkt(host, pkt);
311 break;
312 }
313
314 case NOTIFY_ACK_TYPE:
315 {
316 struct scsi_qla_host *host = vha;
317 struct nack_to_isp *entry = (struct nack_to_isp *)pkt;
318
319 if (0xFF != entry->u.isp24.vp_index) {
320 host = qlt_find_host_by_vp_idx(vha,
321 entry->u.isp24.vp_index);
322 if (unlikely(!host)) {
323 ql_dbg(ql_dbg_tgt, vha, 0xe043,
324 "qla_target(%d): Response "
325 "pkt (NOTIFY_ACK_TYPE) "
326 "received, with unknown "
327 "vp_index %d\n", vha->vp_idx,
328 entry->u.isp24.vp_index);
329 break;
330 }
331 }
332 qlt_response_pkt(host, pkt);
333 break;
334 }
335
336 case ABTS_RECV_24XX:
337 {
338 struct abts_recv_from_24xx *entry =
339 (struct abts_recv_from_24xx *)pkt;
340 struct scsi_qla_host *host = qlt_find_host_by_vp_idx(vha,
341 entry->vp_index);
342 if (unlikely(!host)) {
343 ql_dbg(ql_dbg_tgt, vha, 0xe044,
344 "qla_target(%d): Response pkt "
345 "(ABTS_RECV_24XX) received, with unknown "
346 "vp_index %d\n", vha->vp_idx, entry->vp_index);
347 break;
348 }
349 qlt_response_pkt(host, pkt);
350 break;
351 }
352
353 case ABTS_RESP_24XX:
354 {
355 struct abts_resp_to_24xx *entry =
356 (struct abts_resp_to_24xx *)pkt;
357 struct scsi_qla_host *host = qlt_find_host_by_vp_idx(vha,
358 entry->vp_index);
359 if (unlikely(!host)) {
360 ql_dbg(ql_dbg_tgt, vha, 0xe045,
361 "qla_target(%d): Response pkt "
362 "(ABTS_RECV_24XX) received, with unknown "
363 "vp_index %d\n", vha->vp_idx, entry->vp_index);
364 break;
365 }
366 qlt_response_pkt(host, pkt);
367 break;
368 }
369
370 default:
371 qlt_response_pkt(vha, pkt);
372 break;
373 }
374
375}
376
377static void qlt_free_session_done(struct work_struct *work)
378{
379 struct qla_tgt_sess *sess = container_of(work, struct qla_tgt_sess,
380 free_work);
381 struct qla_tgt *tgt = sess->tgt;
382 struct scsi_qla_host *vha = sess->vha;
383 struct qla_hw_data *ha = vha->hw;
384
385 BUG_ON(!tgt);
386 /*
387 * Release the target session for FC Nexus from fabric module code.
388 */
389 if (sess->se_sess != NULL)
390 ha->tgt.tgt_ops->free_session(sess);
391
392 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf001,
393 "Unregistration of sess %p finished\n", sess);
394
395 kfree(sess);
396 /*
397 * We need to protect against race, when tgt is freed before or
398 * inside wake_up()
399 */
400 tgt->sess_count--;
401 if (tgt->sess_count == 0)
402 wake_up_all(&tgt->waitQ);
403}
404
405/* ha->hardware_lock supposed to be held on entry */
406void qlt_unreg_sess(struct qla_tgt_sess *sess)
407{
408 struct scsi_qla_host *vha = sess->vha;
409
410 vha->hw->tgt.tgt_ops->clear_nacl_from_fcport_map(sess);
411
412 list_del(&sess->sess_list_entry);
413 if (sess->deleted)
414 list_del(&sess->del_list_entry);
415
416 INIT_WORK(&sess->free_work, qlt_free_session_done);
417 schedule_work(&sess->free_work);
418}
419EXPORT_SYMBOL(qlt_unreg_sess);
420
421/* ha->hardware_lock supposed to be held on entry */
422static int qlt_reset(struct scsi_qla_host *vha, void *iocb, int mcmd)
423{
424 struct qla_hw_data *ha = vha->hw;
425 struct qla_tgt_sess *sess = NULL;
426 uint32_t unpacked_lun, lun = 0;
427 uint16_t loop_id;
428 int res = 0;
429 struct imm_ntfy_from_isp *n = (struct imm_ntfy_from_isp *)iocb;
430 struct atio_from_isp *a = (struct atio_from_isp *)iocb;
431
432 loop_id = le16_to_cpu(n->u.isp24.nport_handle);
433 if (loop_id == 0xFFFF) {
434#if 0 /* FIXME: Re-enable Global event handling.. */
435 /* Global event */
436 atomic_inc(&ha->tgt.qla_tgt->tgt_global_resets_count);
c5701042 437 qlt_clear_tgt_db(ha->tgt.qla_tgt);
2d70c103
NB		 438 if (!list_empty(&ha->tgt.qla_tgt->sess_list)) {
439 sess = list_entry(ha->tgt.qla_tgt->sess_list.next,
440 typeof(*sess), sess_list_entry);
441 switch (mcmd) {
442 case QLA_TGT_NEXUS_LOSS_SESS:
443 mcmd = QLA_TGT_NEXUS_LOSS;
444 break;
445 case QLA_TGT_ABORT_ALL_SESS:
446 mcmd = QLA_TGT_ABORT_ALL;
447 break;
448 case QLA_TGT_NEXUS_LOSS:
449 case QLA_TGT_ABORT_ALL:
450 break;
451 default:
452 ql_dbg(ql_dbg_tgt, vha, 0xe046,
453 "qla_target(%d): Not allowed "
454 "command %x in %s", vha->vp_idx,
455 mcmd, __func__);
456 sess = NULL;
457 break;
458 }
459 } else
460 sess = NULL;
461#endif
462 } else {
463 sess = ha->tgt.tgt_ops->find_sess_by_loop_id(vha, loop_id);
464 }
465
466 ql_dbg(ql_dbg_tgt, vha, 0xe000,
467 "Using sess for qla_tgt_reset: %p\n", sess);
468 if (!sess) {
469 res = -ESRCH;
470 return res;
471 }
472
473 ql_dbg(ql_dbg_tgt, vha, 0xe047,
7b833558
OK		 474 "scsi(%ld): resetting (session %p from port %8phC mcmd %x, "
475 "loop_id %d)\n", vha->host_no, sess, sess->port_name,
2d70c103
NB		 476 mcmd, loop_id);
477
478 lun = a->u.isp24.fcp_cmnd.lun;
479 unpacked_lun = scsilun_to_int((struct scsi_lun *)&lun);
480
481 return qlt_issue_task_mgmt(sess, unpacked_lun, mcmd,
482 iocb, QLA24XX_MGMT_SEND_NACK);
483}
484
485/* ha->hardware_lock supposed to be held on entry */
486static void qlt_schedule_sess_for_deletion(struct qla_tgt_sess *sess,
487 bool immediate)
488{
489 struct qla_tgt *tgt = sess->tgt;
490 uint32_t dev_loss_tmo = tgt->ha->port_down_retry_count + 5;
491
492 if (sess->deleted)
493 return;
494
495 ql_dbg(ql_dbg_tgt, sess->vha, 0xe001,
496 "Scheduling sess %p for deletion\n", sess);
497 list_add_tail(&sess->del_list_entry, &tgt->del_sess_list);
498 sess->deleted = 1;
499
500 if (immediate)
501 dev_loss_tmo = 0;
502
503 sess->expires = jiffies + dev_loss_tmo * HZ;
504
505 ql_dbg(ql_dbg_tgt, sess->vha, 0xe048,
7b833558 506 "qla_target(%d): session for port %8phC (loop ID %d) scheduled for "
2d70c103 507 "deletion in %u secs (expires: %lu) immed: %d\n",
7b833558
OK		 508 sess->vha->vp_idx, sess->port_name, sess->loop_id, dev_loss_tmo,
509 sess->expires, immediate);
2d70c103
NB		 510
511 if (immediate)
512 schedule_delayed_work(&tgt->sess_del_work, 0);
513 else
514 schedule_delayed_work(&tgt->sess_del_work,
63832aab 515 sess->expires - jiffies);
2d70c103
NB		 516}
517
518/* ha->hardware_lock supposed to be held on entry */
c5701042 519static void qlt_clear_tgt_db(struct qla_tgt *tgt)
2d70c103
NB		 520{
521 struct qla_tgt_sess *sess;
522
523 list_for_each_entry(sess, &tgt->sess_list, sess_list_entry)
524 qlt_schedule_sess_for_deletion(sess, true);
525
526 /* At this point tgt could be already dead */
527}
528
529static int qla24xx_get_loop_id(struct scsi_qla_host *vha, const uint8_t *s_id,
530 uint16_t *loop_id)
531{
532 struct qla_hw_data *ha = vha->hw;
533 dma_addr_t gid_list_dma;
534 struct gid_list_info *gid_list;
535 char *id_iter;
536 int res, rc, i;
537 uint16_t entries;
538
539 gid_list = dma_alloc_coherent(&ha->pdev->dev, qla2x00_gid_list_size(ha),
540 &gid_list_dma, GFP_KERNEL);
541 if (!gid_list) {
542 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf044,
543 "qla_target(%d): DMA Alloc failed of %u\n",
544 vha->vp_idx, qla2x00_gid_list_size(ha));
545 return -ENOMEM;
546 }
547
548 /* Get list of logged in devices */
549 rc = qla2x00_get_id_list(vha, gid_list, gid_list_dma, &entries);
550 if (rc != QLA_SUCCESS) {
551 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf045,
552 "qla_target(%d): get_id_list() failed: %x\n",
553 vha->vp_idx, rc);
554 res = -1;
555 goto out_free_id_list;
556 }
557
558 id_iter = (char *)gid_list;
559 res = -1;
560 for (i = 0; i < entries; i++) {
561 struct gid_list_info *gid = (struct gid_list_info *)id_iter;
562 if ((gid->al_pa == s_id[2]) &&
563 (gid->area == s_id[1]) &&
564 (gid->domain == s_id[0])) {
565 *loop_id = le16_to_cpu(gid->loop_id);
566 res = 0;
567 break;
568 }
569 id_iter += ha->gid_list_info_size;
570 }
571
572out_free_id_list:
573 dma_free_coherent(&ha->pdev->dev, qla2x00_gid_list_size(ha),
574 gid_list, gid_list_dma);
575 return res;
576}
577
2d70c103
NB		 578/* ha->hardware_lock supposed to be held on entry */
579static void qlt_undelete_sess(struct qla_tgt_sess *sess)
580{
581 BUG_ON(!sess->deleted);
582
583 list_del(&sess->del_list_entry);
584 sess->deleted = 0;
585}
586
587static void qlt_del_sess_work_fn(struct delayed_work *work)
588{
589 struct qla_tgt *tgt = container_of(work, struct qla_tgt,
590 sess_del_work);
591 struct scsi_qla_host *vha = tgt->vha;
592 struct qla_hw_data *ha = vha->hw;
593 struct qla_tgt_sess *sess;
63832aab 594 unsigned long flags, elapsed;
2d70c103
NB		 595
596 spin_lock_irqsave(&ha->hardware_lock, flags);
597 while (!list_empty(&tgt->del_sess_list)) {
598 sess = list_entry(tgt->del_sess_list.next, typeof(*sess),
599 del_list_entry);
63832aab
SU		 600 elapsed = jiffies;
601 if (time_after_eq(elapsed, sess->expires)) {
2d70c103
NB		 602 qlt_undelete_sess(sess);
603
08234e3a
JE		 604 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf004,
605 "Timeout: sess %p about to be deleted\n",
606 sess);
607 ha->tgt.tgt_ops->shutdown_sess(sess);
608 ha->tgt.tgt_ops->put_sess(sess);
2d70c103
NB		 609 } else {
610 schedule_delayed_work(&tgt->sess_del_work,
63832aab 611 sess->expires - elapsed);
2d70c103
NB		 612 break;
613 }
614 }
615 spin_unlock_irqrestore(&ha->hardware_lock, flags);
616}
617
618/*
619 * Adds an extra ref to allow to drop hw lock after adding sess to the list.
620 * Caller must put it.
621 */
622static struct qla_tgt_sess *qlt_create_sess(
623 struct scsi_qla_host *vha,
624 fc_port_t *fcport,
625 bool local)
626{
627 struct qla_hw_data *ha = vha->hw;
628 struct qla_tgt_sess *sess;
629 unsigned long flags;
630 unsigned char be_sid[3];
631
632 /* Check to avoid double sessions */
633 spin_lock_irqsave(&ha->hardware_lock, flags);
0e8cd71c 634 list_for_each_entry(sess, &vha->vha_tgt.qla_tgt->sess_list,
2d70c103
NB		 635 sess_list_entry) {
636 if (!memcmp(sess->port_name, fcport->port_name, WWN_SIZE)) {
637 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf005,
638 "Double sess %p found (s_id %x:%x:%x, "
639 "loop_id %d), updating to d_id %x:%x:%x, "
640 "loop_id %d", sess, sess->s_id.b.domain,
641 sess->s_id.b.al_pa, sess->s_id.b.area,
642 sess->loop_id, fcport->d_id.b.domain,
643 fcport->d_id.b.al_pa, fcport->d_id.b.area,
644 fcport->loop_id);
645
646 if (sess->deleted)
647 qlt_undelete_sess(sess);
648
649 kref_get(&sess->se_sess->sess_kref);
c8292d1d
RD		 650 ha->tgt.tgt_ops->update_sess(sess, fcport->d_id, fcport->loop_id,
651 (fcport->flags & FCF_CONF_COMP_SUPPORTED));
652
2d70c103
NB		 653 if (sess->local && !local)
654 sess->local = 0;
655 spin_unlock_irqrestore(&ha->hardware_lock, flags);
656
657 return sess;
658 }
659 }
660 spin_unlock_irqrestore(&ha->hardware_lock, flags);
661
662 sess = kzalloc(sizeof(*sess), GFP_KERNEL);
663 if (!sess) {
664 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf04a,
7b833558
OK		 665 "qla_target(%u): session allocation failed, all commands "
666 "from port %8phC will be refused", vha->vp_idx,
667 fcport->port_name);
2d70c103
NB		 668
669 return NULL;
670 }
0e8cd71c 671 sess->tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 672 sess->vha = vha;
673 sess->s_id = fcport->d_id;
674 sess->loop_id = fcport->loop_id;
675 sess->local = local;
676
677 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf006,
678 "Adding sess %p to tgt %p via ->check_initiator_node_acl()\n",
0e8cd71c 679 sess, vha->vha_tgt.qla_tgt);
2d70c103
NB		 680
681 be_sid[0] = sess->s_id.b.domain;
682 be_sid[1] = sess->s_id.b.area;
683 be_sid[2] = sess->s_id.b.al_pa;
684 /*
685 * Determine if this fc_port->port_name is allowed to access
686 * target mode using explict NodeACLs+MappedLUNs, or using
687 * TPG demo mode. If this is successful a target mode FC nexus
688 * is created.
689 */
690 if (ha->tgt.tgt_ops->check_initiator_node_acl(vha,
691 &fcport->port_name[0], sess, &be_sid[0], fcport->loop_id) < 0) {
692 kfree(sess);
693 return NULL;
694 }
695 /*
696 * Take an extra reference to ->sess_kref here to handle qla_tgt_sess
697 * access across ->hardware_lock reaquire.
698 */
699 kref_get(&sess->se_sess->sess_kref);
700
c8292d1d 701 sess->conf_compl_supported = (fcport->flags & FCF_CONF_COMP_SUPPORTED);
2d70c103
NB		 702 BUILD_BUG_ON(sizeof(sess->port_name) != sizeof(fcport->port_name));
703 memcpy(sess->port_name, fcport->port_name, sizeof(sess->port_name));
704
705 spin_lock_irqsave(&ha->hardware_lock, flags);
0e8cd71c
SK		 706 list_add_tail(&sess->sess_list_entry, &vha->vha_tgt.qla_tgt->sess_list);
707 vha->vha_tgt.qla_tgt->sess_count++;
2d70c103
NB		 708 spin_unlock_irqrestore(&ha->hardware_lock, flags);
709
710 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf04b,
7b833558
OK		 711 "qla_target(%d): %ssession for wwn %8phC (loop_id %d, "
712 "s_id %x:%x:%x, confirmed completion %ssupported) added\n",
713 vha->vp_idx, local ? "local " : "", fcport->port_name,
714 fcport->loop_id, sess->s_id.b.domain, sess->s_id.b.area,
715 sess->s_id.b.al_pa, sess->conf_compl_supported ? "" : "not ");
2d70c103
NB		 716
717 return sess;
718}
719
720/*
721 * Called from drivers/scsi/qla2xxx/qla_init.c:qla2x00_reg_remote_port()
722 */
723void qlt_fc_port_added(struct scsi_qla_host *vha, fc_port_t *fcport)
724{
725 struct qla_hw_data *ha = vha->hw;
0e8cd71c 726 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 727 struct qla_tgt_sess *sess;
728 unsigned long flags;
729
730 if (!vha->hw->tgt.tgt_ops)
731 return;
732
733 if (!tgt || (fcport->port_type != FCT_INITIATOR))
734 return;
735
0e8cd71c
SK		 736 if (qla_ini_mode_enabled(vha))
737 return;
738
2d70c103
NB		 739 spin_lock_irqsave(&ha->hardware_lock, flags);
740 if (tgt->tgt_stop) {
741 spin_unlock_irqrestore(&ha->hardware_lock, flags);
742 return;
743 }
744 sess = qlt_find_sess_by_port_name(tgt, fcport->port_name);
745 if (!sess) {
746 spin_unlock_irqrestore(&ha->hardware_lock, flags);
747
0e8cd71c 748 mutex_lock(&vha->vha_tgt.tgt_mutex);
2d70c103 749 sess = qlt_create_sess(vha, fcport, false);
0e8cd71c 750 mutex_unlock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 751
752 spin_lock_irqsave(&ha->hardware_lock, flags);
753 } else {
754 kref_get(&sess->se_sess->sess_kref);
755
756 if (sess->deleted) {
757 qlt_undelete_sess(sess);
758
759 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf04c,
7b833558
OK		 760 "qla_target(%u): %ssession for port %8phC "
761 "(loop ID %d) reappeared\n", vha->vp_idx,
762 sess->local ? "local " : "", sess->port_name,
2d70c103
NB		 763 sess->loop_id);
764
765 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf007,
766 "Reappeared sess %p\n", sess);
767 }
c8292d1d
RD		 768 ha->tgt.tgt_ops->update_sess(sess, fcport->d_id, fcport->loop_id,
769 (fcport->flags & FCF_CONF_COMP_SUPPORTED));
2d70c103
NB		 770 }
771
772 if (sess && sess->local) {
773 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf04d,
774 "qla_target(%u): local session for "
7b833558
OK		 775 "port %8phC (loop ID %d) became global\n", vha->vp_idx,
776 fcport->port_name, sess->loop_id);
2d70c103
NB		 777 sess->local = 0;
778 }
2d70c103 779 ha->tgt.tgt_ops->put_sess(sess);
08234e3a 780 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2d70c103
NB		 781}
782
783void qlt_fc_port_deleted(struct scsi_qla_host *vha, fc_port_t *fcport)
784{
0e8cd71c 785 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103 786 struct qla_tgt_sess *sess;
2d70c103
NB		 787
788 if (!vha->hw->tgt.tgt_ops)
789 return;
790
791 if (!tgt || (fcport->port_type != FCT_INITIATOR))
792 return;
793
2d70c103 794 if (tgt->tgt_stop) {
2d70c103
NB		 795 return;
796 }
797 sess = qlt_find_sess_by_port_name(tgt, fcport->port_name);
798 if (!sess) {
2d70c103
NB		 799 return;
800 }
801
802 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf008, "qla_tgt_fc_port_deleted %p", sess);
803
804 sess->local = 1;
805 qlt_schedule_sess_for_deletion(sess, false);
2d70c103
NB		 806}
807
808static inline int test_tgt_sess_count(struct qla_tgt *tgt)
809{
810 struct qla_hw_data *ha = tgt->ha;
811 unsigned long flags;
812 int res;
813 /*
814 * We need to protect against race, when tgt is freed before or
815 * inside wake_up()
816 */
817 spin_lock_irqsave(&ha->hardware_lock, flags);
818 ql_dbg(ql_dbg_tgt, tgt->vha, 0xe002,
819 "tgt %p, empty(sess_list)=%d sess_count=%d\n",
820 tgt, list_empty(&tgt->sess_list), tgt->sess_count);
821 res = (tgt->sess_count == 0);
822 spin_unlock_irqrestore(&ha->hardware_lock, flags);
823
824 return res;
825}
826
827/* Called by tcm_qla2xxx configfs code */
3c231bda 828int qlt_stop_phase1(struct qla_tgt *tgt)
2d70c103
NB		 829{
830 struct scsi_qla_host *vha = tgt->vha;
831 struct qla_hw_data *ha = tgt->ha;
832 unsigned long flags;
833
3c231bda
NB		 834 mutex_lock(&qla_tgt_mutex);
835 if (!vha->fc_vport) {
836 struct Scsi_Host *sh = vha->host;
837 struct fc_host_attrs *fc_host = shost_to_fc_host(sh);
838 bool npiv_vports;
839
840 spin_lock_irqsave(sh->host_lock, flags);
841 npiv_vports = (fc_host->npiv_vports_inuse);
842 spin_unlock_irqrestore(sh->host_lock, flags);
843
844 if (npiv_vports) {
845 mutex_unlock(&qla_tgt_mutex);
846 return -EPERM;
847 }
848 }
2d70c103
NB		 849 if (tgt->tgt_stop || tgt->tgt_stopped) {
850 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf04e,
851 "Already in tgt->tgt_stop or tgt_stopped state\n");
3c231bda
NB		 852 mutex_unlock(&qla_tgt_mutex);
853 return -EPERM;
2d70c103
NB		 854 }
855
856 ql_dbg(ql_dbg_tgt, vha, 0xe003, "Stopping target for host %ld(%p)\n",
857 vha->host_no, vha);
858 /*
859 * Mutex needed to sync with qla_tgt_fc_port_[added,deleted].
860 * Lock is needed, because we still can get an incoming packet.
861 */
0e8cd71c 862 mutex_lock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 863 spin_lock_irqsave(&ha->hardware_lock, flags);
864 tgt->tgt_stop = 1;
c5701042 865 qlt_clear_tgt_db(tgt);
2d70c103 866 spin_unlock_irqrestore(&ha->hardware_lock, flags);
0e8cd71c 867 mutex_unlock(&vha->vha_tgt.tgt_mutex);
3c231bda 868 mutex_unlock(&qla_tgt_mutex);
2d70c103 869
43829731 870 flush_delayed_work(&tgt->sess_del_work);
2d70c103
NB		 871
872 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf009,
873 "Waiting for sess works (tgt %p)", tgt);
874 spin_lock_irqsave(&tgt->sess_work_lock, flags);
875 while (!list_empty(&tgt->sess_works_list)) {
876 spin_unlock_irqrestore(&tgt->sess_work_lock, flags);
877 flush_scheduled_work();
878 spin_lock_irqsave(&tgt->sess_work_lock, flags);
879 }
880 spin_unlock_irqrestore(&tgt->sess_work_lock, flags);
881
882 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf00a,
883 "Waiting for tgt %p: list_empty(sess_list)=%d "
884 "sess_count=%d\n", tgt, list_empty(&tgt->sess_list),
885 tgt->sess_count);
886
887 wait_event(tgt->waitQ, test_tgt_sess_count(tgt));
888
889 /* Big hammer */
890 if (!ha->flags.host_shutting_down && qla_tgt_mode_enabled(vha))
891 qlt_disable_vha(vha);
892
893 /* Wait for sessions to clear out (just in case) */
894 wait_event(tgt->waitQ, test_tgt_sess_count(tgt));
3c231bda 895 return 0;
2d70c103
NB		 896}
897EXPORT_SYMBOL(qlt_stop_phase1);
898
899/* Called by tcm_qla2xxx configfs code */
900void qlt_stop_phase2(struct qla_tgt *tgt)
901{
902 struct qla_hw_data *ha = tgt->ha;
0e8cd71c 903 scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
2d70c103
NB		 904 unsigned long flags;
905
906 if (tgt->tgt_stopped) {
0e8cd71c 907 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf04f,
2d70c103
NB		 908 "Already in tgt->tgt_stopped state\n");
909 dump_stack();
910 return;
911 }
912
0e8cd71c 913 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf00b,
2d70c103
NB		 914 "Waiting for %d IRQ commands to complete (tgt %p)",
915 tgt->irq_cmd_count, tgt);
916
0e8cd71c 917 mutex_lock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 918 spin_lock_irqsave(&ha->hardware_lock, flags);
919 while (tgt->irq_cmd_count != 0) {
920 spin_unlock_irqrestore(&ha->hardware_lock, flags);
921 udelay(2);
922 spin_lock_irqsave(&ha->hardware_lock, flags);
923 }
924 tgt->tgt_stop = 0;
925 tgt->tgt_stopped = 1;
926 spin_unlock_irqrestore(&ha->hardware_lock, flags);
0e8cd71c 927 mutex_unlock(&vha->vha_tgt.tgt_mutex);
2d70c103 928
0e8cd71c 929 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf00c, "Stop of tgt %p finished",
2d70c103
NB		 930 tgt);
931}
932EXPORT_SYMBOL(qlt_stop_phase2);
933
934/* Called from qlt_remove_target() -> qla2x00_remove_one() */
fa492630 935static void qlt_release(struct qla_tgt *tgt)
2d70c103 936{
0e8cd71c 937 scsi_qla_host_t *vha = tgt->vha;
2d70c103 938
0e8cd71c 939 if ((vha->vha_tgt.qla_tgt != NULL) && !tgt->tgt_stopped)
2d70c103
NB		 940 qlt_stop_phase2(tgt);
941
0e8cd71c 942 vha->vha_tgt.qla_tgt = NULL;
2d70c103 943
0e8cd71c 944 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf00d,
2d70c103
NB		 945 "Release of tgt %p finished\n", tgt);
946
947 kfree(tgt);
948}
949
950/* ha->hardware_lock supposed to be held on entry */
951static int qlt_sched_sess_work(struct qla_tgt *tgt, int type,
952 const void *param, unsigned int param_size)
953{
954 struct qla_tgt_sess_work_param *prm;
955 unsigned long flags;
956
957 prm = kzalloc(sizeof(*prm), GFP_ATOMIC);
958 if (!prm) {
959 ql_dbg(ql_dbg_tgt_mgt, tgt->vha, 0xf050,
960 "qla_target(%d): Unable to create session "
961 "work, command will be refused", 0);
962 return -ENOMEM;
963 }
964
965 ql_dbg(ql_dbg_tgt_mgt, tgt->vha, 0xf00e,
966 "Scheduling work (type %d, prm %p)"
967 " to find session for param %p (size %d, tgt %p)\n",
968 type, prm, param, param_size, tgt);
969
970 prm->type = type;
971 memcpy(&prm->tm_iocb, param, param_size);
972
973 spin_lock_irqsave(&tgt->sess_work_lock, flags);
974 list_add_tail(&prm->sess_works_list_entry, &tgt->sess_works_list);
975 spin_unlock_irqrestore(&tgt->sess_work_lock, flags);
976
977 schedule_work(&tgt->sess_work);
978
979 return 0;
980}
981
982/*
983 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
984 */
985static void qlt_send_notify_ack(struct scsi_qla_host *vha,
986 struct imm_ntfy_from_isp *ntfy,
987 uint32_t add_flags, uint16_t resp_code, int resp_code_valid,
988 uint16_t srr_flags, uint16_t srr_reject_code, uint8_t srr_explan)
989{
990 struct qla_hw_data *ha = vha->hw;
991 request_t *pkt;
992 struct nack_to_isp *nack;
993
994 ql_dbg(ql_dbg_tgt, vha, 0xe004, "Sending NOTIFY_ACK (ha=%p)\n", ha);
995
996 /* Send marker if required */
997 if (qlt_issue_marker(vha, 1) != QLA_SUCCESS)
998 return;
999
1000 pkt = (request_t *)qla2x00_alloc_iocbs(vha, NULL);
1001 if (!pkt) {
1002 ql_dbg(ql_dbg_tgt, vha, 0xe049,
1003 "qla_target(%d): %s failed: unable to allocate "
1004 "request packet\n", vha->vp_idx, __func__);
1005 return;
1006 }
1007
0e8cd71c
SK		 1008 if (vha->vha_tgt.qla_tgt != NULL)
1009 vha->vha_tgt.qla_tgt->notify_ack_expected++;
2d70c103
NB		 1010
1011 pkt->entry_type = NOTIFY_ACK_TYPE;
1012 pkt->entry_count = 1;
1013
1014 nack = (struct nack_to_isp *)pkt;
1015 nack->ox_id = ntfy->ox_id;
1016
1017 nack->u.isp24.nport_handle = ntfy->u.isp24.nport_handle;
1018 if (le16_to_cpu(ntfy->u.isp24.status) == IMM_NTFY_ELS) {
1019 nack->u.isp24.flags = ntfy->u.isp24.flags &
1020 __constant_cpu_to_le32(NOTIFY24XX_FLAGS_PUREX_IOCB);
1021 }
1022 nack->u.isp24.srr_rx_id = ntfy->u.isp24.srr_rx_id;
1023 nack->u.isp24.status = ntfy->u.isp24.status;
1024 nack->u.isp24.status_subcode = ntfy->u.isp24.status_subcode;
aa230bc5 1025 nack->u.isp24.fw_handle = ntfy->u.isp24.fw_handle;
2d70c103
NB		 1026 nack->u.isp24.exchange_address = ntfy->u.isp24.exchange_address;
1027 nack->u.isp24.srr_rel_offs = ntfy->u.isp24.srr_rel_offs;
1028 nack->u.isp24.srr_ui = ntfy->u.isp24.srr_ui;
1029 nack->u.isp24.srr_flags = cpu_to_le16(srr_flags);
1030 nack->u.isp24.srr_reject_code = srr_reject_code;
1031 nack->u.isp24.srr_reject_code_expl = srr_explan;
1032 nack->u.isp24.vp_index = ntfy->u.isp24.vp_index;
1033
1034 ql_dbg(ql_dbg_tgt, vha, 0xe005,
1035 "qla_target(%d): Sending 24xx Notify Ack %d\n",
1036 vha->vp_idx, nack->u.isp24.status);
1037
63163e06
HM		 1038 /* Memory Barrier */
1039 wmb();
2d70c103
NB		 1040 qla2x00_start_iocbs(vha, vha->req);
1041}
1042
1043/*
1044 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
1045 */
1046static void qlt_24xx_send_abts_resp(struct scsi_qla_host *vha,
1047 struct abts_recv_from_24xx *abts, uint32_t status,
1048 bool ids_reversed)
1049{
1050 struct qla_hw_data *ha = vha->hw;
1051 struct abts_resp_to_24xx *resp;
1052 uint32_t f_ctl;
1053 uint8_t *p;
1054
1055 ql_dbg(ql_dbg_tgt, vha, 0xe006,
1056 "Sending task mgmt ABTS response (ha=%p, atio=%p, status=%x\n",
1057 ha, abts, status);
1058
1059 /* Send marker if required */
1060 if (qlt_issue_marker(vha, 1) != QLA_SUCCESS)
1061 return;
1062
b6a029e1 1063 resp = (struct abts_resp_to_24xx *)qla2x00_alloc_iocbs_ready(vha, NULL);
2d70c103
NB		 1064 if (!resp) {
1065 ql_dbg(ql_dbg_tgt, vha, 0xe04a,
1066 "qla_target(%d): %s failed: unable to allocate "
1067 "request packet", vha->vp_idx, __func__);
1068 return;
1069 }
1070
1071 resp->entry_type = ABTS_RESP_24XX;
1072 resp->entry_count = 1;
1073 resp->nport_handle = abts->nport_handle;
1074 resp->vp_index = vha->vp_idx;
1075 resp->sof_type = abts->sof_type;
1076 resp->exchange_address = abts->exchange_address;
1077 resp->fcp_hdr_le = abts->fcp_hdr_le;
1078 f_ctl = __constant_cpu_to_le32(F_CTL_EXCH_CONTEXT_RESP |
1079 F_CTL_LAST_SEQ | F_CTL_END_SEQ |
1080 F_CTL_SEQ_INITIATIVE);
1081 p = (uint8_t *)&f_ctl;
1082 resp->fcp_hdr_le.f_ctl[0] = *p++;
1083 resp->fcp_hdr_le.f_ctl[1] = *p++;
1084 resp->fcp_hdr_le.f_ctl[2] = *p;
1085 if (ids_reversed) {
1086 resp->fcp_hdr_le.d_id[0] = abts->fcp_hdr_le.d_id[0];
1087 resp->fcp_hdr_le.d_id[1] = abts->fcp_hdr_le.d_id[1];
1088 resp->fcp_hdr_le.d_id[2] = abts->fcp_hdr_le.d_id[2];
1089 resp->fcp_hdr_le.s_id[0] = abts->fcp_hdr_le.s_id[0];
1090 resp->fcp_hdr_le.s_id[1] = abts->fcp_hdr_le.s_id[1];
1091 resp->fcp_hdr_le.s_id[2] = abts->fcp_hdr_le.s_id[2];
1092 } else {
1093 resp->fcp_hdr_le.d_id[0] = abts->fcp_hdr_le.s_id[0];
1094 resp->fcp_hdr_le.d_id[1] = abts->fcp_hdr_le.s_id[1];
1095 resp->fcp_hdr_le.d_id[2] = abts->fcp_hdr_le.s_id[2];
1096 resp->fcp_hdr_le.s_id[0] = abts->fcp_hdr_le.d_id[0];
1097 resp->fcp_hdr_le.s_id[1] = abts->fcp_hdr_le.d_id[1];
1098 resp->fcp_hdr_le.s_id[2] = abts->fcp_hdr_le.d_id[2];
1099 }
1100 resp->exchange_addr_to_abort = abts->exchange_addr_to_abort;
1101 if (status == FCP_TMF_CMPL) {
1102 resp->fcp_hdr_le.r_ctl = R_CTL_BASIC_LINK_SERV | R_CTL_B_ACC;
1103 resp->payload.ba_acct.seq_id_valid = SEQ_ID_INVALID;
1104 resp->payload.ba_acct.low_seq_cnt = 0x0000;
1105 resp->payload.ba_acct.high_seq_cnt = 0xFFFF;
1106 resp->payload.ba_acct.ox_id = abts->fcp_hdr_le.ox_id;
1107 resp->payload.ba_acct.rx_id = abts->fcp_hdr_le.rx_id;
1108 } else {
1109 resp->fcp_hdr_le.r_ctl = R_CTL_BASIC_LINK_SERV | R_CTL_B_RJT;
1110 resp->payload.ba_rjt.reason_code =
1111 BA_RJT_REASON_CODE_UNABLE_TO_PERFORM;
1112 /* Other bytes are zero */
1113 }
1114
0e8cd71c 1115 vha->vha_tgt.qla_tgt->abts_resp_expected++;
2d70c103 1116
63163e06
HM		 1117 /* Memory Barrier */
1118 wmb();
2d70c103
NB		 1119 qla2x00_start_iocbs(vha, vha->req);
1120}
1121
1122/*
1123 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
1124 */
1125static void qlt_24xx_retry_term_exchange(struct scsi_qla_host *vha,
1126 struct abts_resp_from_24xx_fw *entry)
1127{
1128 struct ctio7_to_24xx *ctio;
1129
1130 ql_dbg(ql_dbg_tgt, vha, 0xe007,
1131 "Sending retry TERM EXCH CTIO7 (ha=%p)\n", vha->hw);
1132 /* Send marker if required */
1133 if (qlt_issue_marker(vha, 1) != QLA_SUCCESS)
1134 return;
1135
b6a029e1 1136 ctio = (struct ctio7_to_24xx *)qla2x00_alloc_iocbs_ready(vha, NULL);
2d70c103
NB		 1137 if (ctio == NULL) {
1138 ql_dbg(ql_dbg_tgt, vha, 0xe04b,
1139 "qla_target(%d): %s failed: unable to allocate "
1140 "request packet\n", vha->vp_idx, __func__);
1141 return;
1142 }
1143
1144 /*
1145 * We've got on entrance firmware's response on by us generated
1146 * ABTS response. So, in it ID fields are reversed.
1147 */
1148
1149 ctio->entry_type = CTIO_TYPE7;
1150 ctio->entry_count = 1;
1151 ctio->nport_handle = entry->nport_handle;
1152 ctio->handle = QLA_TGT_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK;
1153 ctio->timeout = __constant_cpu_to_le16(QLA_TGT_TIMEOUT);
1154 ctio->vp_index = vha->vp_idx;
1155 ctio->initiator_id[0] = entry->fcp_hdr_le.d_id[0];
1156 ctio->initiator_id[1] = entry->fcp_hdr_le.d_id[1];
1157 ctio->initiator_id[2] = entry->fcp_hdr_le.d_id[2];
1158 ctio->exchange_addr = entry->exchange_addr_to_abort;
1159 ctio->u.status1.flags =
1160 __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1 |
1161 CTIO7_FLAGS_TERMINATE);
33a5fcee 1162 ctio->u.status1.ox_id = cpu_to_le16(entry->fcp_hdr_le.ox_id);
2d70c103 1163
63163e06
HM		 1164 /* Memory Barrier */
1165 wmb();
2d70c103
NB		 1166 qla2x00_start_iocbs(vha, vha->req);
1167
1168 qlt_24xx_send_abts_resp(vha, (struct abts_recv_from_24xx *)entry,
1169 FCP_TMF_CMPL, true);
1170}
1171
1172/* ha->hardware_lock supposed to be held on entry */
1173static int __qlt_24xx_handle_abts(struct scsi_qla_host *vha,
1174 struct abts_recv_from_24xx *abts, struct qla_tgt_sess *sess)
1175{
1176 struct qla_hw_data *ha = vha->hw;
06e97b48 1177 struct se_session *se_sess = sess->se_sess;
2d70c103 1178 struct qla_tgt_mgmt_cmd *mcmd;
06e97b48
SH		 1179 struct se_cmd *se_cmd;
1180 u32 lun = 0;
2d70c103 1181 int rc;
06e97b48
SH		 1182 bool found_lun = false;
1183
1184 spin_lock(&se_sess->sess_cmd_lock);
1185 list_for_each_entry(se_cmd, &se_sess->sess_cmd_list, se_cmd_list) {
1186 struct qla_tgt_cmd *cmd =
1187 container_of(se_cmd, struct qla_tgt_cmd, se_cmd);
649ee054 1188 if (se_cmd->tag == abts->exchange_addr_to_abort) {
06e97b48
SH		 1189 lun = cmd->unpacked_lun;
1190 found_lun = true;
1191 break;
1192 }
1193 }
1194 spin_unlock(&se_sess->sess_cmd_lock);
1195
1196 if (!found_lun)
1197 return -ENOENT;
2d70c103
NB		 1198
1199 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf00f,
1200 "qla_target(%d): task abort (tag=%d)\n",
1201 vha->vp_idx, abts->exchange_addr_to_abort);
1202
1203 mcmd = mempool_alloc(qla_tgt_mgmt_cmd_mempool, GFP_ATOMIC);
1204 if (mcmd == NULL) {
1205 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf051,
1206 "qla_target(%d): %s: Allocation of ABORT cmd failed",
1207 vha->vp_idx, __func__);
1208 return -ENOMEM;
1209 }
1210 memset(mcmd, 0, sizeof(*mcmd));
1211
1212 mcmd->sess = sess;
1213 memcpy(&mcmd->orig_iocb.abts, abts, sizeof(mcmd->orig_iocb.abts));
80187f8e 1214 mcmd->reset_count = vha->hw->chip_reset;
2d70c103 1215
06e97b48 1216 rc = ha->tgt.tgt_ops->handle_tmr(mcmd, lun, TMR_ABORT_TASK,
2d70c103
NB		 1217 abts->exchange_addr_to_abort);
1218 if (rc != 0) {
1219 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf052,
1220 "qla_target(%d): tgt_ops->handle_tmr()"
1221 " failed: %d", vha->vp_idx, rc);
1222 mempool_free(mcmd, qla_tgt_mgmt_cmd_mempool);
1223 return -EFAULT;
1224 }
1225
1226 return 0;
1227}
1228
1229/*
1230 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
1231 */
1232static void qlt_24xx_handle_abts(struct scsi_qla_host *vha,
1233 struct abts_recv_from_24xx *abts)
1234{
1235 struct qla_hw_data *ha = vha->hw;
1236 struct qla_tgt_sess *sess;
1237 uint32_t tag = abts->exchange_addr_to_abort;
1238 uint8_t s_id[3];
1239 int rc;
1240
1241 if (le32_to_cpu(abts->fcp_hdr_le.parameter) & ABTS_PARAM_ABORT_SEQ) {
1242 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf053,
1243 "qla_target(%d): ABTS: Abort Sequence not "
1244 "supported\n", vha->vp_idx);
1245 qlt_24xx_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false);
1246 return;
1247 }
1248
1249 if (tag == ATIO_EXCHANGE_ADDRESS_UNKNOWN) {
1250 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf010,
1251 "qla_target(%d): ABTS: Unknown Exchange "
1252 "Address received\n", vha->vp_idx);
1253 qlt_24xx_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false);
1254 return;
1255 }
1256
1257 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf011,
1258 "qla_target(%d): task abort (s_id=%x:%x:%x, "
1259 "tag=%d, param=%x)\n", vha->vp_idx, abts->fcp_hdr_le.s_id[2],
1260 abts->fcp_hdr_le.s_id[1], abts->fcp_hdr_le.s_id[0], tag,
1261 le32_to_cpu(abts->fcp_hdr_le.parameter));
1262
1263 s_id[0] = abts->fcp_hdr_le.s_id[2];
1264 s_id[1] = abts->fcp_hdr_le.s_id[1];
1265 s_id[2] = abts->fcp_hdr_le.s_id[0];
1266
1267 sess = ha->tgt.tgt_ops->find_sess_by_s_id(vha, s_id);
1268 if (!sess) {
1269 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf012,
1270 "qla_target(%d): task abort for non-existant session\n",
1271 vha->vp_idx);
0e8cd71c 1272 rc = qlt_sched_sess_work(vha->vha_tgt.qla_tgt,
2d70c103
NB		 1273 QLA_TGT_SESS_WORK_ABORT, abts, sizeof(*abts));
1274 if (rc != 0) {
1275 qlt_24xx_send_abts_resp(vha, abts, FCP_TMF_REJECTED,
1276 false);
1277 }
1278 return;
1279 }
1280
1281 rc = __qlt_24xx_handle_abts(vha, abts, sess);
1282 if (rc != 0) {
1283 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf054,
1284 "qla_target(%d): __qlt_24xx_handle_abts() failed: %d\n",
1285 vha->vp_idx, rc);
1286 qlt_24xx_send_abts_resp(vha, abts, FCP_TMF_REJECTED, false);
1287 return;
1288 }
1289}
1290
1291/*
1292 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
1293 */
1294static void qlt_24xx_send_task_mgmt_ctio(struct scsi_qla_host *ha,
1295 struct qla_tgt_mgmt_cmd *mcmd, uint32_t resp_code)
1296{
1297 struct atio_from_isp *atio = &mcmd->orig_iocb.atio;
1298 struct ctio7_to_24xx *ctio;
33a5fcee 1299 uint16_t temp;
2d70c103
NB		 1300
1301 ql_dbg(ql_dbg_tgt, ha, 0xe008,
1302 "Sending task mgmt CTIO7 (ha=%p, atio=%p, resp_code=%x\n",
1303 ha, atio, resp_code);
1304
1305 /* Send marker if required */
1306 if (qlt_issue_marker(ha, 1) != QLA_SUCCESS)
1307 return;
1308
1309 ctio = (struct ctio7_to_24xx *)qla2x00_alloc_iocbs(ha, NULL);
1310 if (ctio == NULL) {
1311 ql_dbg(ql_dbg_tgt, ha, 0xe04c,
1312 "qla_target(%d): %s failed: unable to allocate "
1313 "request packet\n", ha->vp_idx, __func__);
1314 return;
1315 }
1316
1317 ctio->entry_type = CTIO_TYPE7;
1318 ctio->entry_count = 1;
1319 ctio->handle = QLA_TGT_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK;
1320 ctio->nport_handle = mcmd->sess->loop_id;
1321 ctio->timeout = __constant_cpu_to_le16(QLA_TGT_TIMEOUT);
1322 ctio->vp_index = ha->vp_idx;
1323 ctio->initiator_id[0] = atio->u.isp24.fcp_hdr.s_id[2];
1324 ctio->initiator_id[1] = atio->u.isp24.fcp_hdr.s_id[1];
1325 ctio->initiator_id[2] = atio->u.isp24.fcp_hdr.s_id[0];
1326 ctio->exchange_addr = atio->u.isp24.exchange_addr;
1327 ctio->u.status1.flags = (atio->u.isp24.attr << 9) |
1328 __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1 |
1329 CTIO7_FLAGS_SEND_STATUS);
33a5fcee
QT		 1330 temp = be16_to_cpu(atio->u.isp24.fcp_hdr.ox_id);
1331 ctio->u.status1.ox_id = cpu_to_le16(temp);
2d70c103
NB		 1332 ctio->u.status1.scsi_status =
1333 __constant_cpu_to_le16(SS_RESPONSE_INFO_LEN_VALID);
1334 ctio->u.status1.response_len = __constant_cpu_to_le16(8);
e4b11b89 1335 ctio->u.status1.sense_data[0] = resp_code;
2d70c103 1336
63163e06
HM		 1337 /* Memory Barrier */
1338 wmb();
2d70c103
NB		 1339 qla2x00_start_iocbs(ha, ha->req);
1340}
1341
1342void qlt_free_mcmd(struct qla_tgt_mgmt_cmd *mcmd)
1343{
1344 mempool_free(mcmd, qla_tgt_mgmt_cmd_mempool);
1345}
1346EXPORT_SYMBOL(qlt_free_mcmd);
1347
1348/* callback from target fabric module code */
1349void qlt_xmit_tm_rsp(struct qla_tgt_mgmt_cmd *mcmd)
1350{
1351 struct scsi_qla_host *vha = mcmd->sess->vha;
1352 struct qla_hw_data *ha = vha->hw;
1353 unsigned long flags;
1354
1355 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf013,
1356 "TM response mcmd (%p) status %#x state %#x",
1357 mcmd, mcmd->fc_tm_rsp, mcmd->flags);
1358
1359 spin_lock_irqsave(&ha->hardware_lock, flags);
b6a029e1
AE		 1360
1361 if (qla2x00_reset_active(vha) || mcmd->reset_count != ha->chip_reset) {
1362 /*
1363 * Either a chip reset is active or this request was from
1364 * previous life, just abort the processing.
1365 */
1366 ql_dbg(ql_dbg_async, vha, 0xe100,
1367 "RESET-TMR active/old-count/new-count = %d/%d/%d.\n",
1368 qla2x00_reset_active(vha), mcmd->reset_count,
1369 ha->chip_reset);
1370 ha->tgt.tgt_ops->free_mcmd(mcmd);
1371 spin_unlock_irqrestore(&ha->hardware_lock, flags);
1372 return;
1373 }
1374
2d70c103
NB		 1375 if (mcmd->flags == QLA24XX_MGMT_SEND_NACK)
1376 qlt_send_notify_ack(vha, &mcmd->orig_iocb.imm_ntfy,
1377 0, 0, 0, 0, 0, 0);
1378 else {
1379 if (mcmd->se_cmd.se_tmr_req->function == TMR_ABORT_TASK)
1380 qlt_24xx_send_abts_resp(vha, &mcmd->orig_iocb.abts,
1381 mcmd->fc_tm_rsp, false);
1382 else
1383 qlt_24xx_send_task_mgmt_ctio(vha, mcmd,
1384 mcmd->fc_tm_rsp);
1385 }
1386 /*
1387 * Make the callback for ->free_mcmd() to queue_work() and invoke
1388 * target_put_sess_cmd() to drop cmd_kref to 1. The final
1389 * target_put_sess_cmd() call will be made from TFO->check_stop_free()
1390 * -> tcm_qla2xxx_check_stop_free() to release the TMR associated se_cmd
1391 * descriptor after TFO->queue_tm_rsp() -> tcm_qla2xxx_queue_tm_rsp() ->
1392 * qlt_xmit_tm_rsp() returns here..
1393 */
1394 ha->tgt.tgt_ops->free_mcmd(mcmd);
1395 spin_unlock_irqrestore(&ha->hardware_lock, flags);
1396}
1397EXPORT_SYMBOL(qlt_xmit_tm_rsp);
1398
1399/* No locks */
1400static int qlt_pci_map_calc_cnt(struct qla_tgt_prm *prm)
1401{
1402 struct qla_tgt_cmd *cmd = prm->cmd;
1403
1404 BUG_ON(cmd->sg_cnt == 0);
1405
1406 prm->sg = (struct scatterlist *)cmd->sg;
1407 prm->seg_cnt = pci_map_sg(prm->tgt->ha->pdev, cmd->sg,
1408 cmd->sg_cnt, cmd->dma_data_direction);
1409 if (unlikely(prm->seg_cnt == 0))
1410 goto out_err;
1411
1412 prm->cmd->sg_mapped = 1;
1413
f83adb61
QT		 1414 if (cmd->se_cmd.prot_op == TARGET_PROT_NORMAL) {
1415 /*
1416 * If greater than four sg entries then we need to allocate
1417 * the continuation entries
1418 */
1419 if (prm->seg_cnt > prm->tgt->datasegs_per_cmd)
1420 prm->req_cnt += DIV_ROUND_UP(prm->seg_cnt -
1421 prm->tgt->datasegs_per_cmd,
1422 prm->tgt->datasegs_per_cont);
1423 } else {
1424 /* DIF */
1425 if ((cmd->se_cmd.prot_op == TARGET_PROT_DIN_INSERT) ||
1426 (cmd->se_cmd.prot_op == TARGET_PROT_DOUT_STRIP)) {
1427 prm->seg_cnt = DIV_ROUND_UP(cmd->bufflen, cmd->blk_sz);
1428 prm->tot_dsds = prm->seg_cnt;
1429 } else
1430 prm->tot_dsds = prm->seg_cnt;
1431
1432 if (cmd->prot_sg_cnt) {
1433 prm->prot_sg = cmd->prot_sg;
1434 prm->prot_seg_cnt = pci_map_sg(prm->tgt->ha->pdev,
1435 cmd->prot_sg, cmd->prot_sg_cnt,
1436 cmd->dma_data_direction);
1437 if (unlikely(prm->prot_seg_cnt == 0))
1438 goto out_err;
1439
1440 if ((cmd->se_cmd.prot_op == TARGET_PROT_DIN_INSERT) ||
1441 (cmd->se_cmd.prot_op == TARGET_PROT_DOUT_STRIP)) {
1442 /* Dif Bundling not support here */
1443 prm->prot_seg_cnt = DIV_ROUND_UP(cmd->bufflen,
1444 cmd->blk_sz);
1445 prm->tot_dsds += prm->prot_seg_cnt;
1446 } else
1447 prm->tot_dsds += prm->prot_seg_cnt;
1448 }
1449 }
2d70c103 1450
2d70c103
NB		 1451 return 0;
1452
1453out_err:
1454 ql_dbg(ql_dbg_tgt, prm->cmd->vha, 0xe04d,
1455 "qla_target(%d): PCI mapping failed: sg_cnt=%d",
1456 0, prm->cmd->sg_cnt);
1457 return -1;
1458}
1459
f9b6721a 1460static void qlt_unmap_sg(struct scsi_qla_host *vha, struct qla_tgt_cmd *cmd)
2d70c103
NB		 1461{
1462 struct qla_hw_data *ha = vha->hw;
1463
f9b6721a
JE		 1464 if (!cmd->sg_mapped)
1465 return;
1466
2d70c103
NB		 1467 pci_unmap_sg(ha->pdev, cmd->sg, cmd->sg_cnt, cmd->dma_data_direction);
1468 cmd->sg_mapped = 0;
f83adb61
QT		 1469
1470 if (cmd->prot_sg_cnt)
1471 pci_unmap_sg(ha->pdev, cmd->prot_sg, cmd->prot_sg_cnt,
1472 cmd->dma_data_direction);
1473
1474 if (cmd->ctx_dsd_alloced)
1475 qla2x00_clean_dsd_pool(ha, NULL, cmd);
1476
1477 if (cmd->ctx)
1478 dma_pool_free(ha->dl_dma_pool, cmd->ctx, cmd->ctx->crc_ctx_dma);
2d70c103
NB		 1479}
1480
1481static int qlt_check_reserve_free_req(struct scsi_qla_host *vha,
1482 uint32_t req_cnt)
1483{
d29fb736 1484 uint32_t cnt, cnt_in;
2d70c103
NB		 1485
1486 if (vha->req->cnt < (req_cnt + 2)) {
75554b68 1487 cnt = (uint16_t)RD_REG_DWORD(vha->req->req_q_out);
d29fb736 1488 cnt_in = (uint16_t)RD_REG_DWORD(vha->req->req_q_in);
2d70c103 1489
2d70c103
NB		 1490 if (vha->req->ring_index < cnt)
1491 vha->req->cnt = cnt - vha->req->ring_index;
1492 else
1493 vha->req->cnt = vha->req->length -
1494 (vha->req->ring_index - cnt);
1495 }
1496
1497 if (unlikely(vha->req->cnt < (req_cnt + 2))) {
667024a3 1498 ql_dbg(ql_dbg_io, vha, 0x305a,
d29fb736
SK		 1499 "qla_target(%d): There is no room in the request ring: vha->req->ring_index=%d, vha->req->cnt=%d, req_cnt=%d Req-out=%d Req-in=%d Req-Length=%d\n",
1500 vha->vp_idx, vha->req->ring_index,
1501 vha->req->cnt, req_cnt, cnt, cnt_in, vha->req->length);
2d70c103
NB		 1502 return -EAGAIN;
1503 }
1504 vha->req->cnt -= req_cnt;
1505
1506 return 0;
1507}
1508
1509/*
1510 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
1511 */
1512static inline void *qlt_get_req_pkt(struct scsi_qla_host *vha)
1513{
1514 /* Adjust ring index. */
1515 vha->req->ring_index++;
1516 if (vha->req->ring_index == vha->req->length) {
1517 vha->req->ring_index = 0;
1518 vha->req->ring_ptr = vha->req->ring;
1519 } else {
1520 vha->req->ring_ptr++;
1521 }
1522 return (cont_entry_t *)vha->req->ring_ptr;
1523}
1524
1525/* ha->hardware_lock supposed to be held on entry */
1526static inline uint32_t qlt_make_handle(struct scsi_qla_host *vha)
1527{
1528 struct qla_hw_data *ha = vha->hw;
1529 uint32_t h;
1530
1531 h = ha->tgt.current_handle;
1532 /* always increment cmd handle */
1533 do {
1534 ++h;
8d93f550 1535 if (h > DEFAULT_OUTSTANDING_COMMANDS)
2d70c103
NB		 1536 h = 1; /* 0 is QLA_TGT_NULL_HANDLE */
1537 if (h == ha->tgt.current_handle) {
667024a3 1538 ql_dbg(ql_dbg_io, vha, 0x305b,
2d70c103
NB		 1539 "qla_target(%d): Ran out of "
1540 "empty cmd slots in ha %p\n", vha->vp_idx, ha);
1541 h = QLA_TGT_NULL_HANDLE;
1542 break;
1543 }
1544 } while ((h == QLA_TGT_NULL_HANDLE) ||
1545 (h == QLA_TGT_SKIP_HANDLE) ||
1546 (ha->tgt.cmds[h-1] != NULL));
1547
1548 if (h != QLA_TGT_NULL_HANDLE)
1549 ha->tgt.current_handle = h;
1550
1551 return h;
1552}
1553
1554/* ha->hardware_lock supposed to be held on entry */
1555static int qlt_24xx_build_ctio_pkt(struct qla_tgt_prm *prm,
1556 struct scsi_qla_host *vha)
1557{
1558 uint32_t h;
1559 struct ctio7_to_24xx *pkt;
1560 struct qla_hw_data *ha = vha->hw;
1561 struct atio_from_isp *atio = &prm->cmd->atio;
33a5fcee 1562 uint16_t temp;
2d70c103
NB		 1563
1564 pkt = (struct ctio7_to_24xx *)vha->req->ring_ptr;
1565 prm->pkt = pkt;
1566 memset(pkt, 0, sizeof(*pkt));
1567
1568 pkt->entry_type = CTIO_TYPE7;
1569 pkt->entry_count = (uint8_t)prm->req_cnt;
1570 pkt->vp_index = vha->vp_idx;
1571
1572 h = qlt_make_handle(vha);
1573 if (unlikely(h == QLA_TGT_NULL_HANDLE)) {
1574 /*
1575 * CTIO type 7 from the firmware doesn't provide a way to
1576 * know the initiator's LOOP ID, hence we can't find
1577 * the session and, so, the command.
1578 */
1579 return -EAGAIN;
1580 } else
1581 ha->tgt.cmds[h-1] = prm->cmd;
1582
1583 pkt->handle = h | CTIO_COMPLETION_HANDLE_MARK;
1584 pkt->nport_handle = prm->cmd->loop_id;
1585 pkt->timeout = __constant_cpu_to_le16(QLA_TGT_TIMEOUT);
1586 pkt->initiator_id[0] = atio->u.isp24.fcp_hdr.s_id[2];
1587 pkt->initiator_id[1] = atio->u.isp24.fcp_hdr.s_id[1];
1588 pkt->initiator_id[2] = atio->u.isp24.fcp_hdr.s_id[0];
1589 pkt->exchange_addr = atio->u.isp24.exchange_addr;
1590 pkt->u.status0.flags |= (atio->u.isp24.attr << 9);
33a5fcee
QT		 1591 temp = be16_to_cpu(atio->u.isp24.fcp_hdr.ox_id);
1592 pkt->u.status0.ox_id = cpu_to_le16(temp);
2d70c103
NB		 1593 pkt->u.status0.relative_offset = cpu_to_le32(prm->cmd->offset);
1594
2d70c103
NB		 1595 return 0;
1596}
1597
1598/*
1599 * ha->hardware_lock supposed to be held on entry. We have already made sure
1600 * that there is sufficient amount of request entries to not drop it.
1601 */
1602static void qlt_load_cont_data_segments(struct qla_tgt_prm *prm,
1603 struct scsi_qla_host *vha)
1604{
1605 int cnt;
1606 uint32_t *dword_ptr;
1607 int enable_64bit_addressing = prm->tgt->tgt_enable_64bit_addr;
1608
1609 /* Build continuation packets */
1610 while (prm->seg_cnt > 0) {
1611 cont_a64_entry_t *cont_pkt64 =
1612 (cont_a64_entry_t *)qlt_get_req_pkt(vha);
1613
1614 /*
1615 * Make sure that from cont_pkt64 none of
1616 * 64-bit specific fields used for 32-bit
1617 * addressing. Cast to (cont_entry_t *) for
1618 * that.
1619 */
1620
1621 memset(cont_pkt64, 0, sizeof(*cont_pkt64));
1622
1623 cont_pkt64->entry_count = 1;
1624 cont_pkt64->sys_define = 0;
1625
1626 if (enable_64bit_addressing) {
1627 cont_pkt64->entry_type = CONTINUE_A64_TYPE;
1628 dword_ptr =
1629 (uint32_t *)&cont_pkt64->dseg_0_address;
1630 } else {
1631 cont_pkt64->entry_type = CONTINUE_TYPE;
1632 dword_ptr =
1633 (uint32_t *)&((cont_entry_t *)
1634 cont_pkt64)->dseg_0_address;
1635 }
1636
1637 /* Load continuation entry data segments */
1638 for (cnt = 0;
1639 cnt < prm->tgt->datasegs_per_cont && prm->seg_cnt;
1640 cnt++, prm->seg_cnt--) {
1641 *dword_ptr++ =
1642 cpu_to_le32(pci_dma_lo32
1643 (sg_dma_address(prm->sg)));
1644 if (enable_64bit_addressing) {
1645 *dword_ptr++ =
1646 cpu_to_le32(pci_dma_hi32
1647 (sg_dma_address
1648 (prm->sg)));
1649 }
1650 *dword_ptr++ = cpu_to_le32(sg_dma_len(prm->sg));
1651
2d70c103
NB		 1652 prm->sg = sg_next(prm->sg);
1653 }
1654 }
1655}
1656
1657/*
1658 * ha->hardware_lock supposed to be held on entry. We have already made sure
1659 * that there is sufficient amount of request entries to not drop it.
1660 */
1661static void qlt_load_data_segments(struct qla_tgt_prm *prm,
1662 struct scsi_qla_host *vha)
1663{
1664 int cnt;
1665 uint32_t *dword_ptr;
1666 int enable_64bit_addressing = prm->tgt->tgt_enable_64bit_addr;
1667 struct ctio7_to_24xx *pkt24 = (struct ctio7_to_24xx *)prm->pkt;
1668
2d70c103
NB		 1669 pkt24->u.status0.transfer_length = cpu_to_le32(prm->cmd->bufflen);
1670
1671 /* Setup packet address segment pointer */
1672 dword_ptr = pkt24->u.status0.dseg_0_address;
1673
1674 /* Set total data segment count */
1675 if (prm->seg_cnt)
1676 pkt24->dseg_count = cpu_to_le16(prm->seg_cnt);
1677
1678 if (prm->seg_cnt == 0) {
1679 /* No data transfer */
1680 *dword_ptr++ = 0;
1681 *dword_ptr = 0;
1682 return;
1683 }
1684
1685 /* If scatter gather */
2d70c103
NB		 1686
1687 /* Load command entry data segments */
1688 for (cnt = 0;
1689 (cnt < prm->tgt->datasegs_per_cmd) && prm->seg_cnt;
1690 cnt++, prm->seg_cnt--) {
1691 *dword_ptr++ =
1692 cpu_to_le32(pci_dma_lo32(sg_dma_address(prm->sg)));
1693 if (enable_64bit_addressing) {
1694 *dword_ptr++ =
1695 cpu_to_le32(pci_dma_hi32(
1696 sg_dma_address(prm->sg)));
1697 }
1698 *dword_ptr++ = cpu_to_le32(sg_dma_len(prm->sg));
1699
2d70c103
NB		 1700 prm->sg = sg_next(prm->sg);
1701 }
1702
1703 qlt_load_cont_data_segments(prm, vha);
1704}
1705
1706static inline int qlt_has_data(struct qla_tgt_cmd *cmd)
1707{
1708 return cmd->bufflen > 0;
1709}
1710
1711/*
1712 * Called without ha->hardware_lock held
1713 */
1714static int qlt_pre_xmit_response(struct qla_tgt_cmd *cmd,
1715 struct qla_tgt_prm *prm, int xmit_type, uint8_t scsi_status,
1716 uint32_t *full_req_cnt)
1717{
1718 struct qla_tgt *tgt = cmd->tgt;
1719 struct scsi_qla_host *vha = tgt->vha;
1720 struct qla_hw_data *ha = vha->hw;
1721 struct se_cmd *se_cmd = &cmd->se_cmd;
1722
1723 if (unlikely(cmd->aborted)) {
1724 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf014,
649ee054
BVA		 1725 "qla_target(%d): terminating exchange for aborted cmd=%p (se_cmd=%p, tag=%lld)",
1726 vha->vp_idx, cmd, se_cmd, se_cmd->tag);
2d70c103
NB		 1727
1728 cmd->state = QLA_TGT_STATE_ABORTED;
e07f8f65 1729 cmd->cmd_flags |= BIT_6;
2d70c103
NB		 1730
1731 qlt_send_term_exchange(vha, cmd, &cmd->atio, 0);
1732
1733 /* !! At this point cmd could be already freed !! */
1734 return QLA_TGT_PRE_XMIT_RESP_CMD_ABORTED;
1735 }
1736
2d70c103
NB		 1737 prm->cmd = cmd;
1738 prm->tgt = tgt;
1739 prm->rq_result = scsi_status;
1740 prm->sense_buffer = &cmd->sense_buffer[0];
1741 prm->sense_buffer_len = TRANSPORT_SENSE_BUFFER;
1742 prm->sg = NULL;
1743 prm->seg_cnt = -1;
1744 prm->req_cnt = 1;
1745 prm->add_status_pkt = 0;
1746
2d70c103
NB		 1747 /* Send marker if required */
1748 if (qlt_issue_marker(vha, 0) != QLA_SUCCESS)
1749 return -EFAULT;
1750
2d70c103
NB		 1751 if ((xmit_type & QLA_TGT_XMIT_DATA) && qlt_has_data(cmd)) {
1752 if (qlt_pci_map_calc_cnt(prm) != 0)
1753 return -EAGAIN;
1754 }
1755
1756 *full_req_cnt = prm->req_cnt;
1757
1758 if (se_cmd->se_cmd_flags & SCF_UNDERFLOW_BIT) {
1759 prm->residual = se_cmd->residual_count;
667024a3 1760 ql_dbg(ql_dbg_io + ql_dbg_verbose, vha, 0x305c,
649ee054
BVA		 1761 "Residual underflow: %d (tag %lld, op %x, bufflen %d, rq_result %x)\n",
1762 prm->residual, se_cmd->tag,
1763 se_cmd->t_task_cdb ? se_cmd->t_task_cdb[0] : 0,
1764 cmd->bufflen, prm->rq_result);
2d70c103
NB		 1765 prm->rq_result |= SS_RESIDUAL_UNDER;
1766 } else if (se_cmd->se_cmd_flags & SCF_OVERFLOW_BIT) {
1767 prm->residual = se_cmd->residual_count;
667024a3 1768 ql_dbg(ql_dbg_io, vha, 0x305d,
649ee054
BVA		 1769 "Residual overflow: %d (tag %lld, op %x, bufflen %d, rq_result %x)\n",
1770 prm->residual, se_cmd->tag, se_cmd->t_task_cdb ?
1771 se_cmd->t_task_cdb[0] : 0, cmd->bufflen, prm->rq_result);
2d70c103
NB		 1772 prm->rq_result |= SS_RESIDUAL_OVER;
1773 }
1774
1775 if (xmit_type & QLA_TGT_XMIT_STATUS) {
1776 /*
1777 * If QLA_TGT_XMIT_DATA is not set, add_status_pkt will be
1778 * ignored in *xmit_response() below
1779 */
1780 if (qlt_has_data(cmd)) {
1781 if (QLA_TGT_SENSE_VALID(prm->sense_buffer) ||
1782 (IS_FWI2_CAPABLE(ha) &&
1783 (prm->rq_result != 0))) {
1784 prm->add_status_pkt = 1;
1785 (*full_req_cnt)++;
1786 }
1787 }
1788 }
1789
2d70c103
NB		 1790 return 0;
1791}
1792
1793static inline int qlt_need_explicit_conf(struct qla_hw_data *ha,
1794 struct qla_tgt_cmd *cmd, int sending_sense)
1795{
1796 if (ha->tgt.enable_class_2)
1797 return 0;
1798
1799 if (sending_sense)
1800 return cmd->conf_compl_supported;
1801 else
1802 return ha->tgt.enable_explicit_conf &&
1803 cmd->conf_compl_supported;
1804}
1805
1806#ifdef CONFIG_QLA_TGT_DEBUG_SRR
1807/*
1808 * Original taken from the XFS code
1809 */
1810static unsigned long qlt_srr_random(void)
1811{
1812 static int Inited;
1813 static unsigned long RandomValue;
1814 static DEFINE_SPINLOCK(lock);
1815 /* cycles pseudo-randomly through all values between 1 and 2^31 - 2 */
1816 register long rv;
1817 register long lo;
1818 register long hi;
1819 unsigned long flags;
1820
1821 spin_lock_irqsave(&lock, flags);
1822 if (!Inited) {
1823 RandomValue = jiffies;
1824 Inited = 1;
1825 }
1826 rv = RandomValue;
1827 hi = rv / 127773;
1828 lo = rv % 127773;
1829 rv = 16807 * lo - 2836 * hi;
1830 if (rv <= 0)
1831 rv += 2147483647;
1832 RandomValue = rv;
1833 spin_unlock_irqrestore(&lock, flags);
1834 return rv;
1835}
1836
1837static void qlt_check_srr_debug(struct qla_tgt_cmd *cmd, int *xmit_type)
1838{
1839#if 0 /* This is not a real status packets lost, so it won't lead to SRR */
1840 if ((*xmit_type & QLA_TGT_XMIT_STATUS) && (qlt_srr_random() % 200)
1841 == 50) {
1842 *xmit_type &= ~QLA_TGT_XMIT_STATUS;
1843 ql_dbg(ql_dbg_tgt_mgt, cmd->vha, 0xf015,
649ee054 1844 "Dropping cmd %p (tag %d) status", cmd, se_cmd->tag);
2d70c103
NB		 1845 }
1846#endif
1847 /*
1848 * It's currently not possible to simulate SRRs for FCP_WRITE without
1849 * a physical link layer failure, so don't even try here..
1850 */
1851 if (cmd->dma_data_direction != DMA_FROM_DEVICE)
1852 return;
1853
1854 if (qlt_has_data(cmd) && (cmd->sg_cnt > 1) &&
1855 ((qlt_srr_random() % 100) == 20)) {
1856 int i, leave = 0;
1857 unsigned int tot_len = 0;
1858
1859 while (leave == 0)
1860 leave = qlt_srr_random() % cmd->sg_cnt;
1861
1862 for (i = 0; i < leave; i++)
1863 tot_len += cmd->sg[i].length;
1864
1865 ql_dbg(ql_dbg_tgt_mgt, cmd->vha, 0xf016,
1866 "Cutting cmd %p (tag %d) buffer"
1867 " tail to len %d, sg_cnt %d (cmd->bufflen %d,"
649ee054 1868 " cmd->sg_cnt %d)", cmd, se_cmd->tag, tot_len, leave,
2d70c103
NB		 1869 cmd->bufflen, cmd->sg_cnt);
1870
1871 cmd->bufflen = tot_len;
1872 cmd->sg_cnt = leave;
1873 }
1874
1875 if (qlt_has_data(cmd) && ((qlt_srr_random() % 100) == 70)) {
1876 unsigned int offset = qlt_srr_random() % cmd->bufflen;
1877
1878 ql_dbg(ql_dbg_tgt_mgt, cmd->vha, 0xf017,
1879 "Cutting cmd %p (tag %d) buffer head "
649ee054 1880 "to offset %d (cmd->bufflen %d)", cmd, se_cmd->tag, offset,
2d70c103
NB		 1881 cmd->bufflen);
1882 if (offset == 0)
1883 *xmit_type &= ~QLA_TGT_XMIT_DATA;
1884 else if (qlt_set_data_offset(cmd, offset)) {
1885 ql_dbg(ql_dbg_tgt_mgt, cmd->vha, 0xf018,
649ee054 1886 "qlt_set_data_offset() failed (tag %d)", se_cmd->tag);
2d70c103
NB		 1887 }
1888 }
1889}
1890#else
1891static inline void qlt_check_srr_debug(struct qla_tgt_cmd *cmd, int *xmit_type)
1892{}
1893#endif
1894
1895static void qlt_24xx_init_ctio_to_isp(struct ctio7_to_24xx *ctio,
1896 struct qla_tgt_prm *prm)
1897{
1898 prm->sense_buffer_len = min_t(uint32_t, prm->sense_buffer_len,
1899 (uint32_t)sizeof(ctio->u.status1.sense_data));
1900 ctio->u.status0.flags |=
1901 __constant_cpu_to_le16(CTIO7_FLAGS_SEND_STATUS);
1902 if (qlt_need_explicit_conf(prm->tgt->ha, prm->cmd, 0)) {
1903 ctio->u.status0.flags |= __constant_cpu_to_le16(
1904 CTIO7_FLAGS_EXPLICIT_CONFORM |
1905 CTIO7_FLAGS_CONFORM_REQ);
1906 }
1907 ctio->u.status0.residual = cpu_to_le32(prm->residual);
1908 ctio->u.status0.scsi_status = cpu_to_le16(prm->rq_result);
1909 if (QLA_TGT_SENSE_VALID(prm->sense_buffer)) {
1910 int i;
1911
1912 if (qlt_need_explicit_conf(prm->tgt->ha, prm->cmd, 1)) {
1913 if (prm->cmd->se_cmd.scsi_status != 0) {
1914 ql_dbg(ql_dbg_tgt, prm->cmd->vha, 0xe017,
1915 "Skipping EXPLICIT_CONFORM and "
1916 "CTIO7_FLAGS_CONFORM_REQ for FCP READ w/ "
1917 "non GOOD status\n");
1918 goto skip_explict_conf;
1919 }
1920 ctio->u.status1.flags |= __constant_cpu_to_le16(
1921 CTIO7_FLAGS_EXPLICIT_CONFORM |
1922 CTIO7_FLAGS_CONFORM_REQ);
1923 }
1924skip_explict_conf:
1925 ctio->u.status1.flags &=
1926 ~__constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_0);
1927 ctio->u.status1.flags |=
1928 __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1);
1929 ctio->u.status1.scsi_status |=
1930 __constant_cpu_to_le16(SS_SENSE_LEN_VALID);
1931 ctio->u.status1.sense_length =
1932 cpu_to_le16(prm->sense_buffer_len);
1933 for (i = 0; i < prm->sense_buffer_len/4; i++)
1934 ((uint32_t *)ctio->u.status1.sense_data)[i] =
1935 cpu_to_be32(((uint32_t *)prm->sense_buffer)[i]);
1936#if 0
1937 if (unlikely((prm->sense_buffer_len % 4) != 0)) {
1938 static int q;
1939 if (q < 10) {
1940 ql_dbg(ql_dbg_tgt, vha, 0xe04f,
1941 "qla_target(%d): %d bytes of sense "
1942 "lost", prm->tgt->ha->vp_idx,
1943 prm->sense_buffer_len % 4);
1944 q++;
1945 }
1946 }
1947#endif
1948 } else {
1949 ctio->u.status1.flags &=
1950 ~__constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_0);
1951 ctio->u.status1.flags |=
1952 __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1);
1953 ctio->u.status1.sense_length = 0;
1954 memset(ctio->u.status1.sense_data, 0,
1955 sizeof(ctio->u.status1.sense_data));
1956 }
1957
1958 /* Sense with len > 24, is it possible ??? */
1959}
1960
f83adb61
QT		 1961
1962
1963/* diff */
1964static inline int
1965qlt_hba_err_chk_enabled(struct se_cmd *se_cmd)
1966{
1967 /*
1968 * Uncomment when corresponding SCSI changes are done.
1969 *
1970 if (!sp->cmd->prot_chk)
1971 return 0;
1972 *
1973 */
1974 switch (se_cmd->prot_op) {
1975 case TARGET_PROT_DOUT_INSERT:
1976 case TARGET_PROT_DIN_STRIP:
1977 if (ql2xenablehba_err_chk >= 1)
1978 return 1;
1979 break;
1980 case TARGET_PROT_DOUT_PASS:
1981 case TARGET_PROT_DIN_PASS:
1982 if (ql2xenablehba_err_chk >= 2)
1983 return 1;
1984 break;
1985 case TARGET_PROT_DIN_INSERT:
1986 case TARGET_PROT_DOUT_STRIP:
1987 return 1;
1988 default:
1989 break;
1990 }
1991 return 0;
1992}
1993
1994/*
1995 * qla24xx_set_t10dif_tags_from_cmd - Extract Ref and App tags from SCSI command
1996 *
1997 */
1998static inline void
1999qlt_set_t10dif_tags(struct se_cmd *se_cmd, struct crc_context *ctx)
2000{
2001 uint32_t lba = 0xffffffff & se_cmd->t_task_lba;
2002
2003 /* wait til Mode Sense/Select cmd, modepage Ah, subpage 2
2004 * have been immplemented by TCM, before AppTag is avail.
2005 * Look for modesense_handlers[]
2006 */
c7ee3bd4 2007 ctx->app_tag = 0;
f83adb61
QT		 2008 ctx->app_tag_mask[0] = 0x0;
2009 ctx->app_tag_mask[1] = 0x0;
2010
2011 switch (se_cmd->prot_type) {
2012 case TARGET_DIF_TYPE0_PROT:
2013 /*
2014 * No check for ql2xenablehba_err_chk, as it would be an
2015 * I/O error if hba tag generation is not done.
2016 */
2017 ctx->ref_tag = cpu_to_le32(lba);
2018
2019 if (!qlt_hba_err_chk_enabled(se_cmd))
2020 break;
2021
2022 /* enable ALL bytes of the ref tag */
2023 ctx->ref_tag_mask[0] = 0xff;
2024 ctx->ref_tag_mask[1] = 0xff;
2025 ctx->ref_tag_mask[2] = 0xff;
2026 ctx->ref_tag_mask[3] = 0xff;
2027 break;
2028 /*
2029 * For TYpe 1 protection: 16 bit GUARD tag, 32 bit REF tag, and
2030 * 16 bit app tag.
2031 */
2032 case TARGET_DIF_TYPE1_PROT:
2033 ctx->ref_tag = cpu_to_le32(lba);
2034
2035 if (!qlt_hba_err_chk_enabled(se_cmd))
2036 break;
2037
2038 /* enable ALL bytes of the ref tag */
2039 ctx->ref_tag_mask[0] = 0xff;
2040 ctx->ref_tag_mask[1] = 0xff;
2041 ctx->ref_tag_mask[2] = 0xff;
2042 ctx->ref_tag_mask[3] = 0xff;
2043 break;
2044 /*
2045 * For TYPE 2 protection: 16 bit GUARD + 32 bit REF tag has to
2046 * match LBA in CDB + N
2047 */
2048 case TARGET_DIF_TYPE2_PROT:
2049 ctx->ref_tag = cpu_to_le32(lba);
2050
2051 if (!qlt_hba_err_chk_enabled(se_cmd))
2052 break;
2053
2054 /* enable ALL bytes of the ref tag */
2055 ctx->ref_tag_mask[0] = 0xff;
2056 ctx->ref_tag_mask[1] = 0xff;
2057 ctx->ref_tag_mask[2] = 0xff;
2058 ctx->ref_tag_mask[3] = 0xff;
2059 break;
2060
2061 /* For Type 3 protection: 16 bit GUARD only */
2062 case TARGET_DIF_TYPE3_PROT:
2063 ctx->ref_tag_mask[0] = ctx->ref_tag_mask[1] =
2064 ctx->ref_tag_mask[2] = ctx->ref_tag_mask[3] = 0x00;
2065 break;
2066 }
2067}
2068
2069
2070static inline int
2071qlt_build_ctio_crc2_pkt(struct qla_tgt_prm *prm, scsi_qla_host_t *vha)
2072{
2073 uint32_t *cur_dsd;
2074 int sgc;
2075 uint32_t transfer_length = 0;
2076 uint32_t data_bytes;
2077 uint32_t dif_bytes;
2078 uint8_t bundling = 1;
2079 uint8_t *clr_ptr;
2080 struct crc_context *crc_ctx_pkt = NULL;
2081 struct qla_hw_data *ha;
2082 struct ctio_crc2_to_fw *pkt;
2083 dma_addr_t crc_ctx_dma;
2084 uint16_t fw_prot_opts = 0;
2085 struct qla_tgt_cmd *cmd = prm->cmd;
2086 struct se_cmd *se_cmd = &cmd->se_cmd;
2087 uint32_t h;
2088 struct atio_from_isp *atio = &prm->cmd->atio;
c7ee3bd4 2089 uint16_t t16;
f83adb61
QT		 2090
2091 sgc = 0;
2092 ha = vha->hw;
2093
2094 pkt = (struct ctio_crc2_to_fw *)vha->req->ring_ptr;
2095 prm->pkt = pkt;
2096 memset(pkt, 0, sizeof(*pkt));
2097
2098 ql_dbg(ql_dbg_tgt, vha, 0xe071,
2099 "qla_target(%d):%s: se_cmd[%p] CRC2 prot_op[0x%x] cmd prot sg:cnt[%p:%x] lba[%llu]\n",
2100 vha->vp_idx, __func__, se_cmd, se_cmd->prot_op,
2101 prm->prot_sg, prm->prot_seg_cnt, se_cmd->t_task_lba);
2102
2103 if ((se_cmd->prot_op == TARGET_PROT_DIN_INSERT) ||
2104 (se_cmd->prot_op == TARGET_PROT_DOUT_STRIP))
2105 bundling = 0;
2106
2107 /* Compute dif len and adjust data len to incude protection */
2108 data_bytes = cmd->bufflen;
2109 dif_bytes = (data_bytes / cmd->blk_sz) * 8;
2110
2111 switch (se_cmd->prot_op) {
2112 case TARGET_PROT_DIN_INSERT:
2113 case TARGET_PROT_DOUT_STRIP:
2114 transfer_length = data_bytes;
2115 data_bytes += dif_bytes;
2116 break;
2117
2118 case TARGET_PROT_DIN_STRIP:
2119 case TARGET_PROT_DOUT_INSERT:
2120 case TARGET_PROT_DIN_PASS:
2121 case TARGET_PROT_DOUT_PASS:
2122 transfer_length = data_bytes + dif_bytes;
2123 break;
2124
2125 default:
2126 BUG();
2127 break;
2128 }
2129
2130 if (!qlt_hba_err_chk_enabled(se_cmd))
2131 fw_prot_opts |= 0x10; /* Disable Guard tag checking */
2132 /* HBA error checking enabled */
2133 else if (IS_PI_UNINIT_CAPABLE(ha)) {
2134 if ((se_cmd->prot_type == TARGET_DIF_TYPE1_PROT) ||
2135 (se_cmd->prot_type == TARGET_DIF_TYPE2_PROT))
2136 fw_prot_opts |= PO_DIS_VALD_APP_ESC;
2137 else if (se_cmd->prot_type == TARGET_DIF_TYPE3_PROT)
2138 fw_prot_opts |= PO_DIS_VALD_APP_REF_ESC;
2139 }
2140
2141 switch (se_cmd->prot_op) {
2142 case TARGET_PROT_DIN_INSERT:
2143 case TARGET_PROT_DOUT_INSERT:
2144 fw_prot_opts |= PO_MODE_DIF_INSERT;
2145 break;
2146 case TARGET_PROT_DIN_STRIP:
2147 case TARGET_PROT_DOUT_STRIP:
2148 fw_prot_opts |= PO_MODE_DIF_REMOVE;
2149 break;
2150 case TARGET_PROT_DIN_PASS:
2151 case TARGET_PROT_DOUT_PASS:
2152 fw_prot_opts |= PO_MODE_DIF_PASS;
2153 /* FUTURE: does tcm require T10CRC<->IPCKSUM conversion? */
2154 break;
2155 default:/* Normal Request */
2156 fw_prot_opts |= PO_MODE_DIF_PASS;
2157 break;
2158 }
2159
2160
2161 /* ---- PKT ---- */
2162 /* Update entry type to indicate Command Type CRC_2 IOCB */
2163 pkt->entry_type = CTIO_CRC2;
2164 pkt->entry_count = 1;
2165 pkt->vp_index = vha->vp_idx;
2166
2167 h = qlt_make_handle(vha);
2168 if (unlikely(h == QLA_TGT_NULL_HANDLE)) {
2169 /*
2170 * CTIO type 7 from the firmware doesn't provide a way to
2171 * know the initiator's LOOP ID, hence we can't find
2172 * the session and, so, the command.
2173 */
2174 return -EAGAIN;
2175 } else
2176 ha->tgt.cmds[h-1] = prm->cmd;
2177
2178
2179 pkt->handle = h | CTIO_COMPLETION_HANDLE_MARK;
2180 pkt->nport_handle = prm->cmd->loop_id;
2181 pkt->timeout = __constant_cpu_to_le16(QLA_TGT_TIMEOUT);
2182 pkt->initiator_id[0] = atio->u.isp24.fcp_hdr.s_id[2];
2183 pkt->initiator_id[1] = atio->u.isp24.fcp_hdr.s_id[1];
2184 pkt->initiator_id[2] = atio->u.isp24.fcp_hdr.s_id[0];
2185 pkt->exchange_addr = atio->u.isp24.exchange_addr;
c7ee3bd4
QT		 2186
2187 /* silence compile warning */
2188 t16 = be16_to_cpu(atio->u.isp24.fcp_hdr.ox_id);
2189 pkt->ox_id = cpu_to_le16(t16);
2190
2191 t16 = (atio->u.isp24.attr << 9);
2192 pkt->flags |= cpu_to_le16(t16);
f83adb61
QT		 2193 pkt->relative_offset = cpu_to_le32(prm->cmd->offset);
2194
2195 /* Set transfer direction */
2196 if (cmd->dma_data_direction == DMA_TO_DEVICE)
2197 pkt->flags = __constant_cpu_to_le16(CTIO7_FLAGS_DATA_IN);
2198 else if (cmd->dma_data_direction == DMA_FROM_DEVICE)
2199 pkt->flags = __constant_cpu_to_le16(CTIO7_FLAGS_DATA_OUT);
2200
2201
2202 pkt->dseg_count = prm->tot_dsds;
2203 /* Fibre channel byte count */
2204 pkt->transfer_length = cpu_to_le32(transfer_length);
2205
2206
2207 /* ----- CRC context -------- */
2208
2209 /* Allocate CRC context from global pool */
2210 crc_ctx_pkt = cmd->ctx =
2211 dma_pool_alloc(ha->dl_dma_pool, GFP_ATOMIC, &crc_ctx_dma);
2212
2213 if (!crc_ctx_pkt)
2214 goto crc_queuing_error;
2215
2216 /* Zero out CTX area. */
2217 clr_ptr = (uint8_t *)crc_ctx_pkt;
2218 memset(clr_ptr, 0, sizeof(*crc_ctx_pkt));
2219
2220 crc_ctx_pkt->crc_ctx_dma = crc_ctx_dma;
2221 INIT_LIST_HEAD(&crc_ctx_pkt->dsd_list);
2222
2223 /* Set handle */
2224 crc_ctx_pkt->handle = pkt->handle;
2225
2226 qlt_set_t10dif_tags(se_cmd, crc_ctx_pkt);
2227
2228 pkt->crc_context_address[0] = cpu_to_le32(LSD(crc_ctx_dma));
2229 pkt->crc_context_address[1] = cpu_to_le32(MSD(crc_ctx_dma));
2230 pkt->crc_context_len = CRC_CONTEXT_LEN_FW;
2231
2232
2233 if (!bundling) {
2234 cur_dsd = (uint32_t *) &crc_ctx_pkt->u.nobundling.data_address;
2235 } else {
2236 /*
2237 * Configure Bundling if we need to fetch interlaving
2238 * protection PCI accesses
2239 */
2240 fw_prot_opts |= PO_ENABLE_DIF_BUNDLING;
2241 crc_ctx_pkt->u.bundling.dif_byte_count = cpu_to_le32(dif_bytes);
2242 crc_ctx_pkt->u.bundling.dseg_count =
2243 cpu_to_le16(prm->tot_dsds - prm->prot_seg_cnt);
2244 cur_dsd = (uint32_t *) &crc_ctx_pkt->u.bundling.data_address;
2245 }
2246
2247 /* Finish the common fields of CRC pkt */
2248 crc_ctx_pkt->blk_size = cpu_to_le16(cmd->blk_sz);
2249 crc_ctx_pkt->prot_opts = cpu_to_le16(fw_prot_opts);
2250 crc_ctx_pkt->byte_count = cpu_to_le32(data_bytes);
2251 crc_ctx_pkt->guard_seed = __constant_cpu_to_le16(0);
2252
2253
2254 /* Walks data segments */
2255 pkt->flags |= __constant_cpu_to_le16(CTIO7_FLAGS_DSD_PTR);
2256
2257 if (!bundling && prm->prot_seg_cnt) {
2258 if (qla24xx_walk_and_build_sglist_no_difb(ha, NULL, cur_dsd,
2259 prm->tot_dsds, cmd))
2260 goto crc_queuing_error;
2261 } else if (qla24xx_walk_and_build_sglist(ha, NULL, cur_dsd,
2262 (prm->tot_dsds - prm->prot_seg_cnt), cmd))
2263 goto crc_queuing_error;
2264
2265 if (bundling && prm->prot_seg_cnt) {
2266 /* Walks dif segments */
c7ee3bd4 2267 pkt->add_flags |= CTIO_CRC2_AF_DIF_DSD_ENA;
f83adb61
QT		 2268
2269 cur_dsd = (uint32_t *) &crc_ctx_pkt->u.bundling.dif_address;
2270 if (qla24xx_walk_and_build_prot_sglist(ha, NULL, cur_dsd,
2271 prm->prot_seg_cnt, cmd))
2272 goto crc_queuing_error;
2273 }
2274 return QLA_SUCCESS;
2275
2276crc_queuing_error:
2277 /* Cleanup will be performed by the caller */
2278
2279 return QLA_FUNCTION_FAILED;
2280}
2281
2282
2d70c103
NB		 2283/*
2284 * Callback to setup response of xmit_type of QLA_TGT_XMIT_DATA and *
2285 * QLA_TGT_XMIT_STATUS for >= 24xx silicon
2286 */
2287int qlt_xmit_response(struct qla_tgt_cmd *cmd, int xmit_type,
2288 uint8_t scsi_status)
2289{
2290 struct scsi_qla_host *vha = cmd->vha;
2291 struct qla_hw_data *ha = vha->hw;
2292 struct ctio7_to_24xx *pkt;
2293 struct qla_tgt_prm prm;
2294 uint32_t full_req_cnt = 0;
2295 unsigned long flags = 0;
2296 int res;
2297
2298 memset(&prm, 0, sizeof(prm));
2299 qlt_check_srr_debug(cmd, &xmit_type);
2300
2301 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe018,
f83adb61
QT		 2302 "is_send_status=%d, cmd->bufflen=%d, cmd->sg_cnt=%d, cmd->dma_data_direction=%d se_cmd[%p]\n",
2303 (xmit_type & QLA_TGT_XMIT_STATUS) ?
2304 1 : 0, cmd->bufflen, cmd->sg_cnt, cmd->dma_data_direction,
2305 &cmd->se_cmd);
2d70c103
NB		 2306
2307 res = qlt_pre_xmit_response(cmd, &prm, xmit_type, scsi_status,
2308 &full_req_cnt);
2309 if (unlikely(res != 0)) {
2310 if (res == QLA_TGT_PRE_XMIT_RESP_CMD_ABORTED)
2311 return 0;
2312
2313 return res;
2314 }
2315
2316 spin_lock_irqsave(&ha->hardware_lock, flags);
2317
b6a029e1
AE		 2318 if (qla2x00_reset_active(vha) || cmd->reset_count != ha->chip_reset) {
2319 /*
2320 * Either a chip reset is active or this request was from
2321 * previous life, just abort the processing.
2322 */
2323 cmd->state = QLA_TGT_STATE_PROCESSED;
2324 qlt_abort_cmd_on_host_reset(cmd->vha, cmd);
2325 ql_dbg(ql_dbg_async, vha, 0xe101,
2326 "RESET-RSP active/old-count/new-count = %d/%d/%d.\n",
2327 qla2x00_reset_active(vha), cmd->reset_count,
2328 ha->chip_reset);
2329 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2330 return 0;
2331 }
2332
2d70c103
NB		 2333 /* Does F/W have an IOCBs for this request */
2334 res = qlt_check_reserve_free_req(vha, full_req_cnt);
2335 if (unlikely(res))
2336 goto out_unmap_unlock;
2337
f83adb61
QT		 2338 if (cmd->se_cmd.prot_op && (xmit_type & QLA_TGT_XMIT_DATA))
2339 res = qlt_build_ctio_crc2_pkt(&prm, vha);
2340 else
2341 res = qlt_24xx_build_ctio_pkt(&prm, vha);
2d70c103
NB		 2342 if (unlikely(res != 0))
2343 goto out_unmap_unlock;
2344
2345
2346 pkt = (struct ctio7_to_24xx *)prm.pkt;
2347
2348 if (qlt_has_data(cmd) && (xmit_type & QLA_TGT_XMIT_DATA)) {
2349 pkt->u.status0.flags |=
2350 __constant_cpu_to_le16(CTIO7_FLAGS_DATA_IN |
2351 CTIO7_FLAGS_STATUS_MODE_0);
2352
f83adb61
QT		 2353 if (cmd->se_cmd.prot_op == TARGET_PROT_NORMAL)
2354 qlt_load_data_segments(&prm, vha);
2d70c103
NB		 2355
2356 if (prm.add_status_pkt == 0) {
2357 if (xmit_type & QLA_TGT_XMIT_STATUS) {
2358 pkt->u.status0.scsi_status =
2359 cpu_to_le16(prm.rq_result);
2360 pkt->u.status0.residual =
2361 cpu_to_le32(prm.residual);
2362 pkt->u.status0.flags |= __constant_cpu_to_le16(
2363 CTIO7_FLAGS_SEND_STATUS);
2364 if (qlt_need_explicit_conf(ha, cmd, 0)) {
2365 pkt->u.status0.flags |=
2366 __constant_cpu_to_le16(
2367 CTIO7_FLAGS_EXPLICIT_CONFORM |
2368 CTIO7_FLAGS_CONFORM_REQ);
2369 }
2370 }
2371
2372 } else {
2373 /*
2374 * We have already made sure that there is sufficient
2375 * amount of request entries to not drop HW lock in
2376 * req_pkt().
2377 */
2378 struct ctio7_to_24xx *ctio =
2379 (struct ctio7_to_24xx *)qlt_get_req_pkt(vha);
2380
667024a3
AE		 2381 ql_dbg(ql_dbg_io, vha, 0x305e,
2382 "Building additional status packet 0x%p.\n",
2383 ctio);
2d70c103 2384
f83adb61
QT		 2385 /*
2386 * T10Dif: ctio_crc2_to_fw overlay ontop of
2387 * ctio7_to_24xx
2388 */
2d70c103 2389 memcpy(ctio, pkt, sizeof(*ctio));
f83adb61 2390 /* reset back to CTIO7 */
2d70c103 2391 ctio->entry_count = 1;
f83adb61 2392 ctio->entry_type = CTIO_TYPE7;
2d70c103
NB		 2393 ctio->dseg_count = 0;
2394 ctio->u.status1.flags &= ~__constant_cpu_to_le16(
2395 CTIO7_FLAGS_DATA_IN);
2396
2397 /* Real finish is ctio_m1's finish */
2398 pkt->handle |= CTIO_INTERMEDIATE_HANDLE_MARK;
2399 pkt->u.status0.flags |= __constant_cpu_to_le16(
2400 CTIO7_FLAGS_DONT_RET_CTIO);
f83adb61
QT		 2401
2402 /* qlt_24xx_init_ctio_to_isp will correct
2403 * all neccessary fields that's part of CTIO7.
2404 * There should be no residual of CTIO-CRC2 data.
2405 */
2d70c103
NB		 2406 qlt_24xx_init_ctio_to_isp((struct ctio7_to_24xx *)ctio,
2407 &prm);
2408 pr_debug("Status CTIO7: %p\n", ctio);
2409 }
2410 } else
2411 qlt_24xx_init_ctio_to_isp(pkt, &prm);
2412
2413
2414 cmd->state = QLA_TGT_STATE_PROCESSED; /* Mid-level is done processing */
d564a372 2415 cmd->cmd_sent_to_fw = 1;
2d70c103 2416
63163e06
HM		 2417 /* Memory Barrier */
2418 wmb();
2d70c103
NB		 2419 qla2x00_start_iocbs(vha, vha->req);
2420 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2421
2422 return 0;
2423
2424out_unmap_unlock:
f9b6721a 2425 qlt_unmap_sg(vha, cmd);
2d70c103
NB		 2426 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2427
2428 return res;
2429}
2430EXPORT_SYMBOL(qlt_xmit_response);
2431
2432int qlt_rdy_to_xfer(struct qla_tgt_cmd *cmd)
2433{
2434 struct ctio7_to_24xx *pkt;
2435 struct scsi_qla_host *vha = cmd->vha;
2436 struct qla_hw_data *ha = vha->hw;
2437 struct qla_tgt *tgt = cmd->tgt;
2438 struct qla_tgt_prm prm;
2439 unsigned long flags;
2440 int res = 0;
2441
2442 memset(&prm, 0, sizeof(prm));
2443 prm.cmd = cmd;
2444 prm.tgt = tgt;
2445 prm.sg = NULL;
2446 prm.req_cnt = 1;
2447
2448 /* Send marker if required */
2449 if (qlt_issue_marker(vha, 0) != QLA_SUCCESS)
2450 return -EIO;
2451
2d70c103
NB		 2452 /* Calculate number of entries and segments required */
2453 if (qlt_pci_map_calc_cnt(&prm) != 0)
2454 return -EAGAIN;
2455
2456 spin_lock_irqsave(&ha->hardware_lock, flags);
2457
b6a029e1
AE		 2458 if (qla2x00_reset_active(vha) || cmd->reset_count != ha->chip_reset) {
2459 /*
2460 * Either a chip reset is active or this request was from
2461 * previous life, just abort the processing.
2462 */
2463 cmd->state = QLA_TGT_STATE_NEED_DATA;
2464 qlt_abort_cmd_on_host_reset(cmd->vha, cmd);
2465 ql_dbg(ql_dbg_async, vha, 0xe102,
2466 "RESET-XFR active/old-count/new-count = %d/%d/%d.\n",
2467 qla2x00_reset_active(vha), cmd->reset_count,
2468 ha->chip_reset);
2469 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2470 return 0;
2471 }
2472
2d70c103
NB		 2473 /* Does F/W have an IOCBs for this request */
2474 res = qlt_check_reserve_free_req(vha, prm.req_cnt);
2475 if (res != 0)
2476 goto out_unlock_free_unmap;
f83adb61
QT		 2477 if (cmd->se_cmd.prot_op)
2478 res = qlt_build_ctio_crc2_pkt(&prm, vha);
2479 else
2480 res = qlt_24xx_build_ctio_pkt(&prm, vha);
2d70c103 2481
2d70c103
NB		 2482 if (unlikely(res != 0))
2483 goto out_unlock_free_unmap;
2484 pkt = (struct ctio7_to_24xx *)prm.pkt;
2485 pkt->u.status0.flags |= __constant_cpu_to_le16(CTIO7_FLAGS_DATA_OUT |
2486 CTIO7_FLAGS_STATUS_MODE_0);
f83adb61
QT		 2487
2488 if (cmd->se_cmd.prot_op == TARGET_PROT_NORMAL)
2489 qlt_load_data_segments(&prm, vha);
2d70c103
NB		 2490
2491 cmd->state = QLA_TGT_STATE_NEED_DATA;
d564a372 2492 cmd->cmd_sent_to_fw = 1;
2d70c103 2493
63163e06
HM		 2494 /* Memory Barrier */
2495 wmb();
2d70c103
NB		 2496 qla2x00_start_iocbs(vha, vha->req);
2497 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2498
2499 return res;
2500
2501out_unlock_free_unmap:
f9b6721a 2502 qlt_unmap_sg(vha, cmd);
2d70c103
NB		 2503 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2504
2505 return res;
2506}
2507EXPORT_SYMBOL(qlt_rdy_to_xfer);
2508
f83adb61
QT		 2509
2510/*
2511 * Checks the guard or meta-data for the type of error
2512 * detected by the HBA.
2513 */
2514static inline int
2515qlt_handle_dif_error(struct scsi_qla_host *vha, struct qla_tgt_cmd *cmd,
2516 struct ctio_crc_from_fw *sts)
2517{
2518 uint8_t *ap = &sts->actual_dif[0];
2519 uint8_t *ep = &sts->expected_dif[0];
2520 uint32_t e_ref_tag, a_ref_tag;
2521 uint16_t e_app_tag, a_app_tag;
2522 uint16_t e_guard, a_guard;
2523 uint64_t lba = cmd->se_cmd.t_task_lba;
2524
2525 a_guard = be16_to_cpu(*(uint16_t *)(ap + 0));
2526 a_app_tag = be16_to_cpu(*(uint16_t *)(ap + 2));
2527 a_ref_tag = be32_to_cpu(*(uint32_t *)(ap + 4));
2528
2529 e_guard = be16_to_cpu(*(uint16_t *)(ep + 0));
2530 e_app_tag = be16_to_cpu(*(uint16_t *)(ep + 2));
2531 e_ref_tag = be32_to_cpu(*(uint32_t *)(ep + 4));
2532
2533 ql_dbg(ql_dbg_tgt, vha, 0xe075,
2534 "iocb(s) %p Returned STATUS.\n", sts);
2535
2536 ql_dbg(ql_dbg_tgt, vha, 0xf075,
fc385045 2537 "dif check TGT cdb 0x%x lba 0x%llx: [Actual|Expected] Ref Tag[0x%x|0x%x], App Tag [0x%x|0x%x], Guard [0x%x|0x%x]\n",
f83adb61
QT		 2538 cmd->atio.u.isp24.fcp_cmnd.cdb[0], lba,
2539 a_ref_tag, e_ref_tag, a_app_tag, e_app_tag, a_guard, e_guard);
2540
2541 /*
2542 * Ignore sector if:
2543 * For type 3: ref & app tag is all 'f's
2544 * For type 0,1,2: app tag is all 'f's
2545 */
2546 if ((a_app_tag == 0xffff) &&
2547 ((cmd->se_cmd.prot_type != TARGET_DIF_TYPE3_PROT) ||
2548 (a_ref_tag == 0xffffffff))) {
2549 uint32_t blocks_done;
2550
2551 /* 2TB boundary case covered automatically with this */
2552 blocks_done = e_ref_tag - (uint32_t)lba + 1;
2553 cmd->se_cmd.bad_sector = e_ref_tag;
2554 cmd->se_cmd.pi_err = 0;
2555 ql_dbg(ql_dbg_tgt, vha, 0xf074,
2556 "need to return scsi good\n");
2557
2558 /* Update protection tag */
2559 if (cmd->prot_sg_cnt) {
2560 uint32_t i, j = 0, k = 0, num_ent;
2561 struct scatterlist *sg, *sgl;
2562
2563
2564 sgl = cmd->prot_sg;
2565
2566 /* Patch the corresponding protection tags */
2567 for_each_sg(sgl, sg, cmd->prot_sg_cnt, i) {
2568 num_ent = sg_dma_len(sg) / 8;
2569 if (k + num_ent < blocks_done) {
2570 k += num_ent;
2571 continue;
2572 }
2573 j = blocks_done - k - 1;
2574 k = blocks_done;
2575 break;
2576 }
2577
2578 if (k != blocks_done) {
2579 ql_log(ql_log_warn, vha, 0xf076,
2580 "unexpected tag values tag:lba=%u:%llu)\n",
2581 e_ref_tag, (unsigned long long)lba);
2582 goto out;
2583 }
2584
2585#if 0
2586 struct sd_dif_tuple *spt;
2587 /* TODO:
2588 * This section came from initiator. Is it valid here?
2589 * should ulp be override with actual val???
2590 */
2591 spt = page_address(sg_page(sg)) + sg->offset;
2592 spt += j;
2593
2594 spt->app_tag = 0xffff;
2595 if (cmd->se_cmd.prot_type == SCSI_PROT_DIF_TYPE3)
2596 spt->ref_tag = 0xffffffff;
2597#endif
2598 }
2599
2600 return 0;
2601 }
2602
2603 /* check guard */
2604 if (e_guard != a_guard) {
2605 cmd->se_cmd.pi_err = TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED;
2606 cmd->se_cmd.bad_sector = cmd->se_cmd.t_task_lba;
2607
2608 ql_log(ql_log_warn, vha, 0xe076,
2609 "Guard ERR: cdb 0x%x lba 0x%llx: [Actual|Expected] Ref Tag[0x%x|0x%x], App Tag [0x%x|0x%x], Guard [0x%x|0x%x] cmd=%p\n",
2610 cmd->atio.u.isp24.fcp_cmnd.cdb[0], lba,
2611 a_ref_tag, e_ref_tag, a_app_tag, e_app_tag,
2612 a_guard, e_guard, cmd);
2613 goto out;
2614 }
2615
2616 /* check ref tag */
2617 if (e_ref_tag != a_ref_tag) {
2618 cmd->se_cmd.pi_err = TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
2619 cmd->se_cmd.bad_sector = e_ref_tag;
2620
2621 ql_log(ql_log_warn, vha, 0xe077,
2622 "Ref Tag ERR: cdb 0x%x lba 0x%llx: [Actual|Expected] Ref Tag[0x%x|0x%x], App Tag [0x%x|0x%x], Guard [0x%x|0x%x] cmd=%p\n",
2623 cmd->atio.u.isp24.fcp_cmnd.cdb[0], lba,
2624 a_ref_tag, e_ref_tag, a_app_tag, e_app_tag,
2625 a_guard, e_guard, cmd);
2626 goto out;
2627 }
2628
2629 /* check appl tag */
2630 if (e_app_tag != a_app_tag) {
2631 cmd->se_cmd.pi_err = TCM_LOGICAL_BLOCK_APP_TAG_CHECK_FAILED;
2632 cmd->se_cmd.bad_sector = cmd->se_cmd.t_task_lba;
2633
2634 ql_log(ql_log_warn, vha, 0xe078,
2635 "App Tag ERR: cdb 0x%x lba 0x%llx: [Actual|Expected] Ref Tag[0x%x|0x%x], App Tag [0x%x|0x%x], Guard [0x%x|0x%x] cmd=%p\n",
2636 cmd->atio.u.isp24.fcp_cmnd.cdb[0], lba,
2637 a_ref_tag, e_ref_tag, a_app_tag, e_app_tag,
2638 a_guard, e_guard, cmd);
2639 goto out;
2640 }
2641out:
2642 return 1;
2643}
2644
2645
2d70c103
NB		 2646/* If hardware_lock held on entry, might drop it, then reaquire */
2647/* This function sends the appropriate CTIO to ISP 2xxx or 24xx */
2648static int __qlt_send_term_exchange(struct scsi_qla_host *vha,
2649 struct qla_tgt_cmd *cmd,
2650 struct atio_from_isp *atio)
2651{
2652 struct ctio7_to_24xx *ctio24;
2653 struct qla_hw_data *ha = vha->hw;
2654 request_t *pkt;
2655 int ret = 0;
33a5fcee 2656 uint16_t temp;
2d70c103
NB		 2657
2658 ql_dbg(ql_dbg_tgt, vha, 0xe01c, "Sending TERM EXCH CTIO (ha=%p)\n", ha);
2659
b6a029e1 2660 pkt = (request_t *)qla2x00_alloc_iocbs_ready(vha, NULL);
2d70c103
NB		 2661 if (pkt == NULL) {
2662 ql_dbg(ql_dbg_tgt, vha, 0xe050,
2663 "qla_target(%d): %s failed: unable to allocate "
2664 "request packet\n", vha->vp_idx, __func__);
2665 return -ENOMEM;
2666 }
2667
2668 if (cmd != NULL) {
2669 if (cmd->state < QLA_TGT_STATE_PROCESSED) {
2670 ql_dbg(ql_dbg_tgt, vha, 0xe051,
2671 "qla_target(%d): Terminating cmd %p with "
2672 "incorrect state %d\n", vha->vp_idx, cmd,
2673 cmd->state);
2674 } else
2675 ret = 1;
2676 }
2677
2678 pkt->entry_count = 1;
2679 pkt->handle = QLA_TGT_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK;
2680
2681 ctio24 = (struct ctio7_to_24xx *)pkt;
2682 ctio24->entry_type = CTIO_TYPE7;
2683 ctio24->nport_handle = cmd ? cmd->loop_id : CTIO7_NHANDLE_UNRECOGNIZED;
2684 ctio24->timeout = __constant_cpu_to_le16(QLA_TGT_TIMEOUT);
2685 ctio24->vp_index = vha->vp_idx;
2686 ctio24->initiator_id[0] = atio->u.isp24.fcp_hdr.s_id[2];
2687 ctio24->initiator_id[1] = atio->u.isp24.fcp_hdr.s_id[1];
2688 ctio24->initiator_id[2] = atio->u.isp24.fcp_hdr.s_id[0];
2689 ctio24->exchange_addr = atio->u.isp24.exchange_addr;
2690 ctio24->u.status1.flags = (atio->u.isp24.attr << 9) |
2691 __constant_cpu_to_le16(CTIO7_FLAGS_STATUS_MODE_1 |
2692 CTIO7_FLAGS_TERMINATE);
33a5fcee
QT		 2693 temp = be16_to_cpu(atio->u.isp24.fcp_hdr.ox_id);
2694 ctio24->u.status1.ox_id = cpu_to_le16(temp);
2d70c103
NB		 2695
2696 /* Most likely, it isn't needed */
2697 ctio24->u.status1.residual = get_unaligned((uint32_t *)
2698 &atio->u.isp24.fcp_cmnd.add_cdb[
2699 atio->u.isp24.fcp_cmnd.add_cdb_len]);
2700 if (ctio24->u.status1.residual != 0)
2701 ctio24->u.status1.scsi_status |= SS_RESIDUAL_UNDER;
2702
63163e06
HM		 2703 /* Memory Barrier */
2704 wmb();
2d70c103
NB		 2705 qla2x00_start_iocbs(vha, vha->req);
2706 return ret;
2707}
2708
2709static void qlt_send_term_exchange(struct scsi_qla_host *vha,
2710 struct qla_tgt_cmd *cmd, struct atio_from_isp *atio, int ha_locked)
2711{
2712 unsigned long flags;
2713 int rc;
2714
2715 if (qlt_issue_marker(vha, ha_locked) < 0)
2716 return;
2717
2718 if (ha_locked) {
2719 rc = __qlt_send_term_exchange(vha, cmd, atio);
33e79977
QT		 2720 if (rc == -ENOMEM)
2721 qlt_alloc_qfull_cmd(vha, atio, 0, 0);
2d70c103
NB		 2722 goto done;
2723 }
2724 spin_lock_irqsave(&vha->hw->hardware_lock, flags);
2725 rc = __qlt_send_term_exchange(vha, cmd, atio);
33e79977
QT		 2726 if (rc == -ENOMEM)
2727 qlt_alloc_qfull_cmd(vha, atio, 0, 0);
2d70c103 2728 spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
d564a372 2729
2d70c103 2730done:
d564a372
QT		 2731 if (cmd && ((cmd->state != QLA_TGT_STATE_ABORTED) ||
2732 !cmd->cmd_sent_to_fw)) {
2d70c103
NB		 2733 if (!ha_locked && !in_interrupt())
2734 msleep(250); /* just in case */
2735
f9b6721a 2736 qlt_unmap_sg(vha, cmd);
2d70c103
NB		 2737 vha->hw->tgt.tgt_ops->free_cmd(cmd);
2738 }
7b898542 2739 return;
2d70c103
NB		 2740}
2741
33e79977
QT		 2742static void qlt_init_term_exchange(struct scsi_qla_host *vha)
2743{
2744 struct list_head free_list;
2745 struct qla_tgt_cmd *cmd, *tcmd;
2746
2747 vha->hw->tgt.leak_exchg_thresh_hold =
2748 (vha->hw->fw_xcb_count/100) * LEAK_EXCHG_THRESH_HOLD_PERCENT;
2749
2750 cmd = tcmd = NULL;
2751 if (!list_empty(&vha->hw->tgt.q_full_list)) {
2752 INIT_LIST_HEAD(&free_list);
2753 list_splice_init(&vha->hw->tgt.q_full_list, &free_list);
2754
2755 list_for_each_entry_safe(cmd, tcmd, &free_list, cmd_list) {
2756 list_del(&cmd->cmd_list);
2757 /* This cmd was never sent to TCM. There is no need
2758 * to schedule free or call free_cmd
2759 */
2760 qlt_free_cmd(cmd);
2761 vha->hw->tgt.num_qfull_cmds_alloc--;
2762 }
2763 }
2764 vha->hw->tgt.num_qfull_cmds_dropped = 0;
2765}
2766
2767static void qlt_chk_exch_leak_thresh_hold(struct scsi_qla_host *vha)
2768{
2769 uint32_t total_leaked;
2770
2771 total_leaked = vha->hw->tgt.num_qfull_cmds_dropped;
2772
2773 if (vha->hw->tgt.leak_exchg_thresh_hold &&
2774 (total_leaked > vha->hw->tgt.leak_exchg_thresh_hold)) {
2775
2776 ql_dbg(ql_dbg_tgt, vha, 0xe079,
2777 "Chip reset due to exchange starvation: %d/%d.\n",
2778 total_leaked, vha->hw->fw_xcb_count);
2779
2780 if (IS_P3P_TYPE(vha->hw))
2781 set_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags);
2782 else
2783 set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
2784 qla2xxx_wake_dpc(vha);
2785 }
2786
2787}
2788
2d70c103
NB		 2789void qlt_free_cmd(struct qla_tgt_cmd *cmd)
2790{
51a07f84
NB		 2791 struct qla_tgt_sess *sess = cmd->sess;
2792
f83adb61
QT		 2793 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe074,
2794 "%s: se_cmd[%p] ox_id %04x\n",
2795 __func__, &cmd->se_cmd,
2796 be16_to_cpu(cmd->atio.u.isp24.fcp_hdr.ox_id));
2d70c103 2797
e07f8f65
SK		 2798 BUG_ON(cmd->cmd_in_wq);
2799
33e79977
QT		 2800 if (!cmd->q_full)
2801 qlt_decr_num_pend_cmds(cmd->vha);
2802
f83adb61 2803 BUG_ON(cmd->sg_mapped);
e07f8f65 2804 cmd->jiffies_at_free = get_jiffies_64();
2d70c103
NB		 2805 if (unlikely(cmd->free_sg))
2806 kfree(cmd->sg);
51a07f84
NB		 2807
2808 if (!sess || !sess->se_sess) {
2809 WARN_ON(1);
2810 return;
2811 }
e07f8f65 2812 cmd->jiffies_at_free = get_jiffies_64();
51a07f84 2813 percpu_ida_free(&sess->se_sess->sess_tag_pool, cmd->se_cmd.map_tag);
2d70c103
NB		 2814}
2815EXPORT_SYMBOL(qlt_free_cmd);
2816
2817/* ha->hardware_lock supposed to be held on entry */
2818static int qlt_prepare_srr_ctio(struct scsi_qla_host *vha,
2819 struct qla_tgt_cmd *cmd, void *ctio)
2820{
2821 struct qla_tgt_srr_ctio *sc;
0e8cd71c 2822 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 2823 struct qla_tgt_srr_imm *imm;
2824
2825 tgt->ctio_srr_id++;
e07f8f65 2826 cmd->cmd_flags |= BIT_15;
2d70c103
NB		 2827
2828 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf019,
2829 "qla_target(%d): CTIO with SRR status received\n", vha->vp_idx);
2830
2831 if (!ctio) {
2832 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf055,
2833 "qla_target(%d): SRR CTIO, but ctio is NULL\n",
2834 vha->vp_idx);
2835 return -EINVAL;
2836 }
2837
2838 sc = kzalloc(sizeof(*sc), GFP_ATOMIC);
2839 if (sc != NULL) {
2840 sc->cmd = cmd;
2841 /* IRQ is already OFF */
2842 spin_lock(&tgt->srr_lock);
2843 sc->srr_id = tgt->ctio_srr_id;
2844 list_add_tail(&sc->srr_list_entry,
2845 &tgt->srr_ctio_list);
2846 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf01a,
2847 "CTIO SRR %p added (id %d)\n", sc, sc->srr_id);
2848 if (tgt->imm_srr_id == tgt->ctio_srr_id) {
2849 int found = 0;
2850 list_for_each_entry(imm, &tgt->srr_imm_list,
2851 srr_list_entry) {
2852 if (imm->srr_id == sc->srr_id) {
2853 found = 1;
2854 break;
2855 }
2856 }
2857 if (found) {
2858 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf01b,
2859 "Scheduling srr work\n");
2860 schedule_work(&tgt->srr_work);
2861 } else {
2862 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf056,
2863 "qla_target(%d): imm_srr_id "
2864 "== ctio_srr_id (%d), but there is no "
2865 "corresponding SRR IMM, deleting CTIO "
2866 "SRR %p\n", vha->vp_idx,
2867 tgt->ctio_srr_id, sc);
2868 list_del(&sc->srr_list_entry);
2869 spin_unlock(&tgt->srr_lock);
2870
2871 kfree(sc);
2872 return -EINVAL;
2873 }
2874 }
2875 spin_unlock(&tgt->srr_lock);
2876 } else {
2877 struct qla_tgt_srr_imm *ti;
2878
2879 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf057,
2880 "qla_target(%d): Unable to allocate SRR CTIO entry\n",
2881 vha->vp_idx);
2882 spin_lock(&tgt->srr_lock);
2883 list_for_each_entry_safe(imm, ti, &tgt->srr_imm_list,
2884 srr_list_entry) {
2885 if (imm->srr_id == tgt->ctio_srr_id) {
2886 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf01c,
2887 "IMM SRR %p deleted (id %d)\n",
2888 imm, imm->srr_id);
2889 list_del(&imm->srr_list_entry);
2890 qlt_reject_free_srr_imm(vha, imm, 1);
2891 }
2892 }
2893 spin_unlock(&tgt->srr_lock);
2894
2895 return -ENOMEM;
2896 }
2897
2898 return 0;
2899}
2900
2901/*
2902 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
2903 */
2904static int qlt_term_ctio_exchange(struct scsi_qla_host *vha, void *ctio,
2905 struct qla_tgt_cmd *cmd, uint32_t status)
2906{
2907 int term = 0;
2908
2909 if (ctio != NULL) {
2910 struct ctio7_from_24xx *c = (struct ctio7_from_24xx *)ctio;
2911 term = !(c->flags &
2912 __constant_cpu_to_le16(OF_TERM_EXCH));
2913 } else
2914 term = 1;
2915
2916 if (term)
2917 qlt_send_term_exchange(vha, cmd, &cmd->atio, 1);
2918
2919 return term;
2920}
2921
2922/* ha->hardware_lock supposed to be held on entry */
2923static inline struct qla_tgt_cmd *qlt_get_cmd(struct scsi_qla_host *vha,
2924 uint32_t handle)
2925{
2926 struct qla_hw_data *ha = vha->hw;
2927
2928 handle--;
2929 if (ha->tgt.cmds[handle] != NULL) {
2930 struct qla_tgt_cmd *cmd = ha->tgt.cmds[handle];
2931 ha->tgt.cmds[handle] = NULL;
2932 return cmd;
2933 } else
2934 return NULL;
2935}
2936
2937/* ha->hardware_lock supposed to be held on entry */
2938static struct qla_tgt_cmd *qlt_ctio_to_cmd(struct scsi_qla_host *vha,
2939 uint32_t handle, void *ctio)
2940{
2941 struct qla_tgt_cmd *cmd = NULL;
2942
2943 /* Clear out internal marks */
2944 handle &= ~(CTIO_COMPLETION_HANDLE_MARK |
2945 CTIO_INTERMEDIATE_HANDLE_MARK);
2946
2947 if (handle != QLA_TGT_NULL_HANDLE) {
667024a3 2948 if (unlikely(handle == QLA_TGT_SKIP_HANDLE))
2d70c103 2949 return NULL;
667024a3 2950
2d70c103 2951 /* handle-1 is actually used */
8d93f550 2952 if (unlikely(handle > DEFAULT_OUTSTANDING_COMMANDS)) {
2d70c103
NB		 2953 ql_dbg(ql_dbg_tgt, vha, 0xe052,
2954 "qla_target(%d): Wrong handle %x received\n",
2955 vha->vp_idx, handle);
2956 return NULL;
2957 }
2958 cmd = qlt_get_cmd(vha, handle);
2959 if (unlikely(cmd == NULL)) {
2960 ql_dbg(ql_dbg_tgt, vha, 0xe053,
2961 "qla_target(%d): Suspicious: unable to "
2962 "find the command with handle %x\n", vha->vp_idx,
2963 handle);
2964 return NULL;
2965 }
2966 } else if (ctio != NULL) {
2967 /* We can't get loop ID from CTIO7 */
2968 ql_dbg(ql_dbg_tgt, vha, 0xe054,
2969 "qla_target(%d): Wrong CTIO received: QLA24xx doesn't "
2970 "support NULL handles\n", vha->vp_idx);
2971 return NULL;
2972 }
2973
2974 return cmd;
2975}
2976
c0cb4496
AE		 2977/* hardware_lock should be held by caller. */
2978static void
2979qlt_abort_cmd_on_host_reset(struct scsi_qla_host *vha, struct qla_tgt_cmd *cmd)
2980{
2981 struct qla_hw_data *ha = vha->hw;
2982 uint32_t handle;
2983
2984 if (cmd->sg_mapped)
2985 qlt_unmap_sg(vha, cmd);
2986
2987 handle = qlt_make_handle(vha);
2988
2989 /* TODO: fix debug message type and ids. */
2990 if (cmd->state == QLA_TGT_STATE_PROCESSED) {
2991 ql_dbg(ql_dbg_io, vha, 0xff00,
2992 "HOST-ABORT: handle=%d, state=PROCESSED.\n", handle);
2993 } else if (cmd->state == QLA_TGT_STATE_NEED_DATA) {
2994 cmd->write_data_transferred = 0;
2995 cmd->state = QLA_TGT_STATE_DATA_IN;
2996
2997 ql_dbg(ql_dbg_io, vha, 0xff01,
2998 "HOST-ABORT: handle=%d, state=DATA_IN.\n", handle);
2999
3000 ha->tgt.tgt_ops->handle_data(cmd);
3001 return;
3002 } else if (cmd->state == QLA_TGT_STATE_ABORTED) {
3003 ql_dbg(ql_dbg_io, vha, 0xff02,
3004 "HOST-ABORT: handle=%d, state=ABORTED.\n", handle);
3005 } else {
3006 ql_dbg(ql_dbg_io, vha, 0xff03,
3007 "HOST-ABORT: handle=%d, state=BAD(%d).\n", handle,
3008 cmd->state);
3009 dump_stack();
3010 }
3011
e07f8f65 3012 cmd->cmd_flags |= BIT_12;
c0cb4496
AE		 3013 ha->tgt.tgt_ops->free_cmd(cmd);
3014}
3015
3016void
3017qlt_host_reset_handler(struct qla_hw_data *ha)
3018{
3019 struct qla_tgt_cmd *cmd;
3020 unsigned long flags;
3021 scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);
3022 scsi_qla_host_t *vha = NULL;
3023 struct qla_tgt *tgt = base_vha->vha_tgt.qla_tgt;
3024 uint32_t i;
3025
3026 if (!base_vha->hw->tgt.tgt_ops)
3027 return;
3028
3029 if (!tgt || qla_ini_mode_enabled(base_vha)) {
3030 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf003,
3031 "Target mode disabled\n");
3032 return;
3033 }
3034
3035 ql_dbg(ql_dbg_tgt_mgt, vha, 0xff10,
3036 "HOST-ABORT-HNDLR: base_vha->dpc_flags=%lx.\n",
3037 base_vha->dpc_flags);
3038
3039 spin_lock_irqsave(&ha->hardware_lock, flags);
3040 for (i = 1; i < DEFAULT_OUTSTANDING_COMMANDS + 1; i++) {
3041 cmd = qlt_get_cmd(base_vha, i);
3042 if (!cmd)
3043 continue;
3044 /* ha->tgt.cmds entry is cleared by qlt_get_cmd. */
3045 vha = cmd->vha;
3046 qlt_abort_cmd_on_host_reset(vha, cmd);
3047 }
3048 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3049}
3050
3051
2d70c103
NB		 3052/*
3053 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
3054 */
3055static void qlt_do_ctio_completion(struct scsi_qla_host *vha, uint32_t handle,
3056 uint32_t status, void *ctio)
3057{
3058 struct qla_hw_data *ha = vha->hw;
3059 struct se_cmd *se_cmd;
9ac8928e 3060 const struct target_core_fabric_ops *tfo;
2d70c103
NB		 3061 struct qla_tgt_cmd *cmd;
3062
2d70c103
NB		 3063 if (handle & CTIO_INTERMEDIATE_HANDLE_MARK) {
3064 /* That could happen only in case of an error/reset/abort */
3065 if (status != CTIO_SUCCESS) {
3066 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf01d,
3067 "Intermediate CTIO received"
3068 " (status %x)\n", status);
3069 }
3070 return;
3071 }
3072
3073 cmd = qlt_ctio_to_cmd(vha, handle, ctio);
092e1dc3 3074 if (cmd == NULL)
2d70c103 3075 return;
092e1dc3 3076
2d70c103
NB		 3077 se_cmd = &cmd->se_cmd;
3078 tfo = se_cmd->se_tfo;
d564a372 3079 cmd->cmd_sent_to_fw = 0;
2d70c103 3080
f9b6721a 3081 qlt_unmap_sg(vha, cmd);
2d70c103
NB		 3082
3083 if (unlikely(status != CTIO_SUCCESS)) {
3084 switch (status & 0xFFFF) {
3085 case CTIO_LIP_RESET:
3086 case CTIO_TARGET_RESET:
3087 case CTIO_ABORTED:
7b898542 3088 /* driver request abort via Terminate exchange */
2d70c103
NB		 3089 case CTIO_TIMEOUT:
3090 case CTIO_INVALID_RX_ID:
3091 /* They are OK */
3092 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf058,
3093 "qla_target(%d): CTIO with "
3094 "status %#x received, state %x, se_cmd %p, "
3095 "(LIP_RESET=e, ABORTED=2, TARGET_RESET=17, "
3096 "TIMEOUT=b, INVALID_RX_ID=8)\n", vha->vp_idx,
3097 status, cmd->state, se_cmd);
3098 break;
3099
3100 case CTIO_PORT_LOGGED_OUT:
3101 case CTIO_PORT_UNAVAILABLE:
3102 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf059,
3103 "qla_target(%d): CTIO with PORT LOGGED "
3104 "OUT (29) or PORT UNAVAILABLE (28) status %x "
3105 "received (state %x, se_cmd %p)\n", vha->vp_idx,
3106 status, cmd->state, se_cmd);
3107 break;
3108
3109 case CTIO_SRR_RECEIVED:
3110 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf05a,
3111 "qla_target(%d): CTIO with SRR_RECEIVED"
3112 " status %x received (state %x, se_cmd %p)\n",
3113 vha->vp_idx, status, cmd->state, se_cmd);
3114 if (qlt_prepare_srr_ctio(vha, cmd, ctio) != 0)
3115 break;
3116 else
3117 return;
3118
f83adb61
QT		 3119 case CTIO_DIF_ERROR: {
3120 struct ctio_crc_from_fw *crc =
3121 (struct ctio_crc_from_fw *)ctio;
3122 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf073,
3123 "qla_target(%d): CTIO with DIF_ERROR status %x received (state %x, se_cmd %p) actual_dif[0x%llx] expect_dif[0x%llx]\n",
3124 vha->vp_idx, status, cmd->state, se_cmd,
3125 *((u64 *)&crc->actual_dif[0]),
3126 *((u64 *)&crc->expected_dif[0]));
3127
3128 if (qlt_handle_dif_error(vha, cmd, ctio)) {
3129 if (cmd->state == QLA_TGT_STATE_NEED_DATA) {
3130 /* scsi Write/xfer rdy complete */
3131 goto skip_term;
3132 } else {
3133 /* scsi read/xmit respond complete
3134 * call handle dif to send scsi status
3135 * rather than terminate exchange.
3136 */
3137 cmd->state = QLA_TGT_STATE_PROCESSED;
3138 ha->tgt.tgt_ops->handle_dif_err(cmd);
3139 return;
3140 }
3141 } else {
3142 /* Need to generate a SCSI good completion.
3143 * because FW did not send scsi status.
3144 */
3145 status = 0;
3146 goto skip_term;
3147 }
3148 break;
3149 }
2d70c103
NB		 3150 default:
3151 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf05b,
f83adb61 3152 "qla_target(%d): CTIO with error status 0x%x received (state %x, se_cmd %p\n",
2d70c103
NB		 3153 vha->vp_idx, status, cmd->state, se_cmd);
3154 break;
3155 }
3156
7b898542
QT		 3157
3158 /* "cmd->state == QLA_TGT_STATE_ABORTED" means
3159 * cmd is already aborted/terminated, we don't
3160 * need to terminate again. The exchange is already
3161 * cleaned up/freed at FW level. Just cleanup at driver
3162 * level.
3163 */
3164 if ((cmd->state != QLA_TGT_STATE_NEED_DATA) &&
33e79977 3165 (cmd->state != QLA_TGT_STATE_ABORTED)) {
e07f8f65 3166 cmd->cmd_flags |= BIT_13;
2d70c103
NB		 3167 if (qlt_term_ctio_exchange(vha, ctio, cmd, status))
3168 return;
7b898542 3169 }
2d70c103 3170 }
f83adb61 3171skip_term:
2d70c103
NB		 3172
3173 if (cmd->state == QLA_TGT_STATE_PROCESSED) {
667024a3 3174 ;
2d70c103
NB		 3175 } else if (cmd->state == QLA_TGT_STATE_NEED_DATA) {
3176 int rx_status = 0;
3177
3178 cmd->state = QLA_TGT_STATE_DATA_IN;
3179
3180 if (unlikely(status != CTIO_SUCCESS))
3181 rx_status = -EIO;
3182 else
3183 cmd->write_data_transferred = 1;
3184
2d70c103
NB		 3185 ha->tgt.tgt_ops->handle_data(cmd);
3186 return;
3187 } else if (cmd->state == QLA_TGT_STATE_ABORTED) {
3188 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf01e,
649ee054 3189 "Aborted command %p (tag %lld) finished\n", cmd, se_cmd->tag);
2d70c103
NB		 3190 } else {
3191 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf05c,
3192 "qla_target(%d): A command in state (%d) should "
3193 "not return a CTIO complete\n", vha->vp_idx, cmd->state);
3194 }
3195
7b898542
QT		 3196 if (unlikely(status != CTIO_SUCCESS) &&
3197 (cmd->state != QLA_TGT_STATE_ABORTED)) {
2d70c103
NB		 3198 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf01f, "Finishing failed CTIO\n");
3199 dump_stack();
3200 }
3201
33e79977 3202
2d70c103
NB		 3203 ha->tgt.tgt_ops->free_cmd(cmd);
3204}
3205
2d70c103
NB		 3206static inline int qlt_get_fcp_task_attr(struct scsi_qla_host *vha,
3207 uint8_t task_codes)
3208{
3209 int fcp_task_attr;
3210
3211 switch (task_codes) {
3212 case ATIO_SIMPLE_QUEUE:
68d81f40 3213 fcp_task_attr = TCM_SIMPLE_TAG;
2d70c103
NB		 3214 break;
3215 case ATIO_HEAD_OF_QUEUE:
68d81f40 3216 fcp_task_attr = TCM_HEAD_TAG;
2d70c103
NB		 3217 break;
3218 case ATIO_ORDERED_QUEUE:
68d81f40 3219 fcp_task_attr = TCM_ORDERED_TAG;
2d70c103
NB		 3220 break;
3221 case ATIO_ACA_QUEUE:
68d81f40 3222 fcp_task_attr = TCM_ACA_TAG;
2d70c103
NB		 3223 break;
3224 case ATIO_UNTAGGED:
68d81f40 3225 fcp_task_attr = TCM_SIMPLE_TAG;
2d70c103
NB		 3226 break;
3227 default:
3228 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf05d,
3229 "qla_target: unknown task code %x, use ORDERED instead\n",
3230 task_codes);
68d81f40 3231 fcp_task_attr = TCM_ORDERED_TAG;
2d70c103
NB		 3232 break;
3233 }
3234
3235 return fcp_task_attr;
3236}
3237
3238static struct qla_tgt_sess *qlt_make_local_sess(struct scsi_qla_host *,
3239 uint8_t *);
3240/*
3241 * Process context for I/O path into tcm_qla2xxx code
3242 */
51a07f84 3243static void __qlt_do_work(struct qla_tgt_cmd *cmd)
2d70c103 3244{
2d70c103
NB		 3245 scsi_qla_host_t *vha = cmd->vha;
3246 struct qla_hw_data *ha = vha->hw;
0e8cd71c 3247 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
51a07f84 3248 struct qla_tgt_sess *sess = cmd->sess;
2d70c103
NB		 3249 struct atio_from_isp *atio = &cmd->atio;
3250 unsigned char *cdb;
3251 unsigned long flags;
3252 uint32_t data_length;
3253 int ret, fcp_task_attr, data_dir, bidi = 0;
3254
e07f8f65
SK		 3255 cmd->cmd_in_wq = 0;
3256 cmd->cmd_flags |= BIT_1;
2d70c103
NB		 3257 if (tgt->tgt_stop)
3258 goto out_term;
3259
2d70c103 3260 cdb = &atio->u.isp24.fcp_cmnd.cdb[0];
649ee054 3261 cmd->se_cmd.tag = atio->u.isp24.exchange_addr;
2d70c103
NB		 3262 cmd->unpacked_lun = scsilun_to_int(
3263 (struct scsi_lun *)&atio->u.isp24.fcp_cmnd.lun);
3264
3265 if (atio->u.isp24.fcp_cmnd.rddata &&
3266 atio->u.isp24.fcp_cmnd.wrdata) {
3267 bidi = 1;
3268 data_dir = DMA_TO_DEVICE;
3269 } else if (atio->u.isp24.fcp_cmnd.rddata)
3270 data_dir = DMA_FROM_DEVICE;
3271 else if (atio->u.isp24.fcp_cmnd.wrdata)
3272 data_dir = DMA_TO_DEVICE;
3273 else
3274 data_dir = DMA_NONE;
3275
3276 fcp_task_attr = qlt_get_fcp_task_attr(vha,
3277 atio->u.isp24.fcp_cmnd.task_attr);
3278 data_length = be32_to_cpu(get_unaligned((uint32_t *)
3279 &atio->u.isp24.fcp_cmnd.add_cdb[
3280 atio->u.isp24.fcp_cmnd.add_cdb_len]));
3281
51a07f84
NB		 3282 ret = ha->tgt.tgt_ops->handle_cmd(vha, cmd, cdb, data_length,
3283 fcp_task_attr, data_dir, bidi);
2d70c103
NB		 3284 if (ret != 0)
3285 goto out_term;
3286 /*
3287 * Drop extra session reference from qla_tgt_handle_cmd_for_atio*(
3288 */
08234e3a 3289 spin_lock_irqsave(&ha->hardware_lock, flags);
2d70c103 3290 ha->tgt.tgt_ops->put_sess(sess);
08234e3a 3291 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2d70c103
NB		 3292 return;
3293
3294out_term:
667024a3 3295 ql_dbg(ql_dbg_io, vha, 0x3060, "Terminating work cmd %p", cmd);
2d70c103 3296 /*
fae9eaf8
RD		 3297 * cmd has not sent to target yet, so pass NULL as the second
3298 * argument to qlt_send_term_exchange() and free the memory here.
2d70c103 3299 */
e07f8f65 3300 cmd->cmd_flags |= BIT_2;
2d70c103
NB		 3301 spin_lock_irqsave(&ha->hardware_lock, flags);
3302 qlt_send_term_exchange(vha, NULL, &cmd->atio, 1);
33e79977
QT		 3303
3304 qlt_decr_num_pend_cmds(vha);
51a07f84
NB		 3305 percpu_ida_free(&sess->se_sess->sess_tag_pool, cmd->se_cmd.map_tag);
3306 ha->tgt.tgt_ops->put_sess(sess);
3307 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3308}
3309
3310static void qlt_do_work(struct work_struct *work)
3311{
3312 struct qla_tgt_cmd *cmd = container_of(work, struct qla_tgt_cmd, work);
3313
3314 __qlt_do_work(cmd);
3315}
3316
3317static struct qla_tgt_cmd *qlt_get_tag(scsi_qla_host_t *vha,
3318 struct qla_tgt_sess *sess,
3319 struct atio_from_isp *atio)
3320{
3321 struct se_session *se_sess = sess->se_sess;
3322 struct qla_tgt_cmd *cmd;
3323 int tag;
3324
3325 tag = percpu_ida_alloc(&se_sess->sess_tag_pool, TASK_RUNNING);
3326 if (tag < 0)
3327 return NULL;
3328
3329 cmd = &((struct qla_tgt_cmd *)se_sess->sess_cmd_map)[tag];
3330 memset(cmd, 0, sizeof(struct qla_tgt_cmd));
3331
3332 memcpy(&cmd->atio, atio, sizeof(*atio));
3333 cmd->state = QLA_TGT_STATE_NEW;
3334 cmd->tgt = vha->vha_tgt.qla_tgt;
33e79977 3335 qlt_incr_num_pend_cmds(vha);
51a07f84
NB		 3336 cmd->vha = vha;
3337 cmd->se_cmd.map_tag = tag;
3338 cmd->sess = sess;
3339 cmd->loop_id = sess->loop_id;
3340 cmd->conf_compl_supported = sess->conf_compl_supported;
3341
3342 return cmd;
3343}
3344
3345static void qlt_send_busy(struct scsi_qla_host *, struct atio_from_isp *,
3346 uint16_t);
3347
3348static void qlt_create_sess_from_atio(struct work_struct *work)
3349{
3350 struct qla_tgt_sess_op *op = container_of(work,
3351 struct qla_tgt_sess_op, work);
3352 scsi_qla_host_t *vha = op->vha;
3353 struct qla_hw_data *ha = vha->hw;
3354 struct qla_tgt_sess *sess;
3355 struct qla_tgt_cmd *cmd;
3356 unsigned long flags;
3357 uint8_t *s_id = op->atio.u.isp24.fcp_hdr.s_id;
3358
3359 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf022,
3360 "qla_target(%d): Unable to find wwn login"
3361 " (s_id %x:%x:%x), trying to create it manually\n",
3362 vha->vp_idx, s_id[0], s_id[1], s_id[2]);
3363
3364 if (op->atio.u.raw.entry_count > 1) {
3365 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf023,
3366 "Dropping multy entry atio %p\n", &op->atio);
3367 goto out_term;
3368 }
3369
3370 mutex_lock(&vha->vha_tgt.tgt_mutex);
3371 sess = qlt_make_local_sess(vha, s_id);
3372 /* sess has an extra creation ref. */
3373 mutex_unlock(&vha->vha_tgt.tgt_mutex);
3374
3375 if (!sess)
3376 goto out_term;
3377 /*
3378 * Now obtain a pre-allocated session tag using the original op->atio
3379 * packet header, and dispatch into __qlt_do_work() using the existing
3380 * process context.
3381 */
3382 cmd = qlt_get_tag(vha, sess, &op->atio);
3383 if (!cmd) {
3384 spin_lock_irqsave(&ha->hardware_lock, flags);
3385 qlt_send_busy(vha, &op->atio, SAM_STAT_BUSY);
2d70c103 3386 ha->tgt.tgt_ops->put_sess(sess);
51a07f84
NB		 3387 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3388 kfree(op);
3389 return;
3390 }
3391 /*
3392 * __qlt_do_work() will call ha->tgt.tgt_ops->put_sess() to release
3393 * the extra reference taken above by qlt_make_local_sess()
3394 */
3395 __qlt_do_work(cmd);
3396 kfree(op);
3397 return;
3398
3399out_term:
3400 spin_lock_irqsave(&ha->hardware_lock, flags);
3401 qlt_send_term_exchange(vha, NULL, &op->atio, 1);
08234e3a 3402 spin_unlock_irqrestore(&ha->hardware_lock, flags);
51a07f84
NB		 3403 kfree(op);
3404
2d70c103
NB		 3405}
3406
3407/* ha->hardware_lock supposed to be held on entry */
3408static int qlt_handle_cmd_for_atio(struct scsi_qla_host *vha,
3409 struct atio_from_isp *atio)
3410{
51a07f84 3411 struct qla_hw_data *ha = vha->hw;
0e8cd71c 3412 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
51a07f84 3413 struct qla_tgt_sess *sess;
2d70c103
NB		 3414 struct qla_tgt_cmd *cmd;
3415
3416 if (unlikely(tgt->tgt_stop)) {
667024a3 3417 ql_dbg(ql_dbg_io, vha, 0x3061,
2d70c103
NB		 3418 "New command while device %p is shutting down\n", tgt);
3419 return -EFAULT;
3420 }
3421
51a07f84
NB		 3422 sess = ha->tgt.tgt_ops->find_sess_by_s_id(vha, atio->u.isp24.fcp_hdr.s_id);
3423 if (unlikely(!sess)) {
3424 struct qla_tgt_sess_op *op = kzalloc(sizeof(struct qla_tgt_sess_op),
3425 GFP_ATOMIC);
3426 if (!op)
3427 return -ENOMEM;
3428
3429 memcpy(&op->atio, atio, sizeof(*atio));
78c2106a 3430 op->vha = vha;
51a07f84
NB		 3431 INIT_WORK(&op->work, qlt_create_sess_from_atio);
3432 queue_work(qla_tgt_wq, &op->work);
3433 return 0;
3434 }
3435 /*
3436 * Do kref_get() before returning + dropping qla_hw_data->hardware_lock.
3437 */
3438 kref_get(&sess->se_sess->sess_kref);
3439
3440 cmd = qlt_get_tag(vha, sess, atio);
2d70c103 3441 if (!cmd) {
667024a3 3442 ql_dbg(ql_dbg_io, vha, 0x3062,
2d70c103 3443 "qla_target(%d): Allocation of cmd failed\n", vha->vp_idx);
51a07f84 3444 ha->tgt.tgt_ops->put_sess(sess);
2d70c103
NB		 3445 return -ENOMEM;
3446 }
3447
e07f8f65
SK		 3448 cmd->cmd_flags = 0;
3449 cmd->jiffies_at_alloc = get_jiffies_64();
3450
b6a029e1
AE		 3451 cmd->reset_count = vha->hw->chip_reset;
3452
e07f8f65
SK		 3453 cmd->cmd_in_wq = 1;
3454 cmd->cmd_flags |= BIT_0;
2d70c103
NB		 3455 INIT_WORK(&cmd->work, qlt_do_work);
3456 queue_work(qla_tgt_wq, &cmd->work);
3457 return 0;
3458
3459}
3460
3461/* ha->hardware_lock supposed to be held on entry */
3462static int qlt_issue_task_mgmt(struct qla_tgt_sess *sess, uint32_t lun,
3463 int fn, void *iocb, int flags)
3464{
3465 struct scsi_qla_host *vha = sess->vha;
3466 struct qla_hw_data *ha = vha->hw;
3467 struct qla_tgt_mgmt_cmd *mcmd;
3468 int res;
3469 uint8_t tmr_func;
3470
3471 mcmd = mempool_alloc(qla_tgt_mgmt_cmd_mempool, GFP_ATOMIC);
3472 if (!mcmd) {
3473 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10009,
3474 "qla_target(%d): Allocation of management "
3475 "command failed, some commands and their data could "
3476 "leak\n", vha->vp_idx);
3477 return -ENOMEM;
3478 }
3479 memset(mcmd, 0, sizeof(*mcmd));
3480 mcmd->sess = sess;
3481
3482 if (iocb) {
3483 memcpy(&mcmd->orig_iocb.imm_ntfy, iocb,
3484 sizeof(mcmd->orig_iocb.imm_ntfy));
3485 }
3486 mcmd->tmr_func = fn;
3487 mcmd->flags = flags;
b6a029e1 3488 mcmd->reset_count = vha->hw->chip_reset;
2d70c103
NB		 3489
3490 switch (fn) {
3491 case QLA_TGT_CLEAR_ACA:
3492 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10000,
3493 "qla_target(%d): CLEAR_ACA received\n", sess->vha->vp_idx);
3494 tmr_func = TMR_CLEAR_ACA;
3495 break;
3496
3497 case QLA_TGT_TARGET_RESET:
3498 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10001,
3499 "qla_target(%d): TARGET_RESET received\n",
3500 sess->vha->vp_idx);
3501 tmr_func = TMR_TARGET_WARM_RESET;
3502 break;
3503
3504 case QLA_TGT_LUN_RESET:
3505 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10002,
3506 "qla_target(%d): LUN_RESET received\n", sess->vha->vp_idx);
3507 tmr_func = TMR_LUN_RESET;
3508 break;
3509
3510 case QLA_TGT_CLEAR_TS:
3511 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10003,
3512 "qla_target(%d): CLEAR_TS received\n", sess->vha->vp_idx);
3513 tmr_func = TMR_CLEAR_TASK_SET;
3514 break;
3515
3516 case QLA_TGT_ABORT_TS:
3517 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10004,
3518 "qla_target(%d): ABORT_TS received\n", sess->vha->vp_idx);
3519 tmr_func = TMR_ABORT_TASK_SET;
3520 break;
3521#if 0
3522 case QLA_TGT_ABORT_ALL:
3523 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10005,
3524 "qla_target(%d): Doing ABORT_ALL_TASKS\n",
3525 sess->vha->vp_idx);
3526 tmr_func = 0;
3527 break;
3528
3529 case QLA_TGT_ABORT_ALL_SESS:
3530 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10006,
3531 "qla_target(%d): Doing ABORT_ALL_TASKS_SESS\n",
3532 sess->vha->vp_idx);
3533 tmr_func = 0;
3534 break;
3535
3536 case QLA_TGT_NEXUS_LOSS_SESS:
3537 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10007,
3538 "qla_target(%d): Doing NEXUS_LOSS_SESS\n",
3539 sess->vha->vp_idx);
3540 tmr_func = 0;
3541 break;
3542
3543 case QLA_TGT_NEXUS_LOSS:
3544 ql_dbg(ql_dbg_tgt_tmr, vha, 0x10008,
3545 "qla_target(%d): Doing NEXUS_LOSS\n", sess->vha->vp_idx);
3546 tmr_func = 0;
3547 break;
3548#endif
3549 default:
3550 ql_dbg(ql_dbg_tgt_tmr, vha, 0x1000a,
3551 "qla_target(%d): Unknown task mgmt fn 0x%x\n",
3552 sess->vha->vp_idx, fn);
3553 mempool_free(mcmd, qla_tgt_mgmt_cmd_mempool);
3554 return -ENOSYS;
3555 }
3556
3557 res = ha->tgt.tgt_ops->handle_tmr(mcmd, lun, tmr_func, 0);
3558 if (res != 0) {
3559 ql_dbg(ql_dbg_tgt_tmr, vha, 0x1000b,
3560 "qla_target(%d): tgt.tgt_ops->handle_tmr() failed: %d\n",
3561 sess->vha->vp_idx, res);
3562 mempool_free(mcmd, qla_tgt_mgmt_cmd_mempool);
3563 return -EFAULT;
3564 }
3565
3566 return 0;
3567}
3568
3569/* ha->hardware_lock supposed to be held on entry */
3570static int qlt_handle_task_mgmt(struct scsi_qla_host *vha, void *iocb)
3571{
3572 struct atio_from_isp *a = (struct atio_from_isp *)iocb;
3573 struct qla_hw_data *ha = vha->hw;
3574 struct qla_tgt *tgt;
3575 struct qla_tgt_sess *sess;
3576 uint32_t lun, unpacked_lun;
3577 int lun_size, fn;
3578
0e8cd71c 3579 tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 3580
3581 lun = a->u.isp24.fcp_cmnd.lun;
3582 lun_size = sizeof(a->u.isp24.fcp_cmnd.lun);
3583 fn = a->u.isp24.fcp_cmnd.task_mgmt_flags;
3584 sess = ha->tgt.tgt_ops->find_sess_by_s_id(vha,
3585 a->u.isp24.fcp_hdr.s_id);
3586 unpacked_lun = scsilun_to_int((struct scsi_lun *)&lun);
3587
3588 if (!sess) {
3589 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf024,
3590 "qla_target(%d): task mgmt fn 0x%x for "
3591 "non-existant session\n", vha->vp_idx, fn);
3592 return qlt_sched_sess_work(tgt, QLA_TGT_SESS_WORK_TM, iocb,
3593 sizeof(struct atio_from_isp));
3594 }
3595
3596 return qlt_issue_task_mgmt(sess, unpacked_lun, fn, iocb, 0);
3597}
3598
3599/* ha->hardware_lock supposed to be held on entry */
3600static int __qlt_abort_task(struct scsi_qla_host *vha,
3601 struct imm_ntfy_from_isp *iocb, struct qla_tgt_sess *sess)
3602{
3603 struct atio_from_isp *a = (struct atio_from_isp *)iocb;
3604 struct qla_hw_data *ha = vha->hw;
3605 struct qla_tgt_mgmt_cmd *mcmd;
3606 uint32_t lun, unpacked_lun;
3607 int rc;
3608
3609 mcmd = mempool_alloc(qla_tgt_mgmt_cmd_mempool, GFP_ATOMIC);
3610 if (mcmd == NULL) {
3611 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf05f,
3612 "qla_target(%d): %s: Allocation of ABORT cmd failed\n",
3613 vha->vp_idx, __func__);
3614 return -ENOMEM;
3615 }
3616 memset(mcmd, 0, sizeof(*mcmd));
3617
3618 mcmd->sess = sess;
3619 memcpy(&mcmd->orig_iocb.imm_ntfy, iocb,
3620 sizeof(mcmd->orig_iocb.imm_ntfy));
3621
3622 lun = a->u.isp24.fcp_cmnd.lun;
3623 unpacked_lun = scsilun_to_int((struct scsi_lun *)&lun);
80187f8e 3624 mcmd->reset_count = vha->hw->chip_reset;
2d70c103
NB		 3625
3626 rc = ha->tgt.tgt_ops->handle_tmr(mcmd, unpacked_lun, TMR_ABORT_TASK,
3627 le16_to_cpu(iocb->u.isp2x.seq_id));
3628 if (rc != 0) {
3629 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf060,
3630 "qla_target(%d): tgt_ops->handle_tmr() failed: %d\n",
3631 vha->vp_idx, rc);
3632 mempool_free(mcmd, qla_tgt_mgmt_cmd_mempool);
3633 return -EFAULT;
3634 }
3635
3636 return 0;
3637}
3638
3639/* ha->hardware_lock supposed to be held on entry */
3640static int qlt_abort_task(struct scsi_qla_host *vha,
3641 struct imm_ntfy_from_isp *iocb)
3642{
3643 struct qla_hw_data *ha = vha->hw;
3644 struct qla_tgt_sess *sess;
3645 int loop_id;
3646
3647 loop_id = GET_TARGET_ID(ha, (struct atio_from_isp *)iocb);
3648
3649 sess = ha->tgt.tgt_ops->find_sess_by_loop_id(vha, loop_id);
3650 if (sess == NULL) {
3651 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf025,
3652 "qla_target(%d): task abort for unexisting "
3653 "session\n", vha->vp_idx);
0e8cd71c 3654 return qlt_sched_sess_work(vha->vha_tgt.qla_tgt,
2d70c103
NB		 3655 QLA_TGT_SESS_WORK_ABORT, iocb, sizeof(*iocb));
3656 }
3657
3658 return __qlt_abort_task(vha, iocb, sess);
3659}
3660
3661/*
3662 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
3663 */
3664static int qlt_24xx_handle_els(struct scsi_qla_host *vha,
3665 struct imm_ntfy_from_isp *iocb)
3666{
2d70c103
NB		 3667 int res = 0;
3668
3669 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf026,
7b833558
OK		 3670 "qla_target(%d): Port ID: 0x%3phC ELS opcode: 0x%02x\n",
3671 vha->vp_idx, iocb->u.isp24.port_id, iocb->u.isp24.status_subcode);
2d70c103
NB		 3672
3673 switch (iocb->u.isp24.status_subcode) {
3674 case ELS_PLOGI:
3675 case ELS_FLOGI:
3676 case ELS_PRLI:
3677 case ELS_LOGO:
3678 case ELS_PRLO:
3679 res = qlt_reset(vha, iocb, QLA_TGT_NEXUS_LOSS_SESS);
3680 break;
3681 case ELS_PDISC:
3682 case ELS_ADISC:
3683 {
0e8cd71c 3684 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 3685 if (tgt->link_reinit_iocb_pending) {
3686 qlt_send_notify_ack(vha, &tgt->link_reinit_iocb,
3687 0, 0, 0, 0, 0, 0);
3688 tgt->link_reinit_iocb_pending = 0;
3689 }
3690 res = 1; /* send notify ack */
3691 break;
3692 }
3693
3694 default:
3695 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf061,
3696 "qla_target(%d): Unsupported ELS command %x "
3697 "received\n", vha->vp_idx, iocb->u.isp24.status_subcode);
3698 res = qlt_reset(vha, iocb, QLA_TGT_NEXUS_LOSS_SESS);
3699 break;
3700 }
3701
3702 return res;
3703}
3704
3705static int qlt_set_data_offset(struct qla_tgt_cmd *cmd, uint32_t offset)
3706{
5897cb2f
BVA		 3707#if 1
3708 /*
3709 * FIXME: Reject non zero SRR relative offset until we can test
3710 * this code properly.
3711 */
3712 pr_debug("Rejecting non zero SRR rel_offs: %u\n", offset);
3713 return -1;
3714#else
2d70c103
NB		 3715 struct scatterlist *sg, *sgp, *sg_srr, *sg_srr_start = NULL;
3716 size_t first_offset = 0, rem_offset = offset, tmp = 0;
3717 int i, sg_srr_cnt, bufflen = 0;
3718
3719 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe023,
3720 "Entering qla_tgt_set_data_offset: cmd: %p, cmd->sg: %p, "
3721 "cmd->sg_cnt: %u, direction: %d\n",
3722 cmd, cmd->sg, cmd->sg_cnt, cmd->dma_data_direction);
3723
2d70c103
NB		 3724 if (!cmd->sg || !cmd->sg_cnt) {
3725 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe055,
3726 "Missing cmd->sg or zero cmd->sg_cnt in"
3727 " qla_tgt_set_data_offset\n");
3728 return -EINVAL;
3729 }
3730 /*
3731 * Walk the current cmd->sg list until we locate the new sg_srr_start
3732 */
3733 for_each_sg(cmd->sg, sg, cmd->sg_cnt, i) {
3734 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe024,
3735 "sg[%d]: %p page: %p, length: %d, offset: %d\n",
3736 i, sg, sg_page(sg), sg->length, sg->offset);
3737
3738 if ((sg->length + tmp) > offset) {
3739 first_offset = rem_offset;
3740 sg_srr_start = sg;
3741 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe025,
3742 "Found matching sg[%d], using %p as sg_srr_start, "
3743 "and using first_offset: %zu\n", i, sg,
3744 first_offset);
3745 break;
3746 }
3747 tmp += sg->length;
3748 rem_offset -= sg->length;
3749 }
3750
3751 if (!sg_srr_start) {
3752 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe056,
3753 "Unable to locate sg_srr_start for offset: %u\n", offset);
3754 return -EINVAL;
3755 }
3756 sg_srr_cnt = (cmd->sg_cnt - i);
3757
3758 sg_srr = kzalloc(sizeof(struct scatterlist) * sg_srr_cnt, GFP_KERNEL);
3759 if (!sg_srr) {
3760 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe057,
3761 "Unable to allocate sgp\n");
3762 return -ENOMEM;
3763 }
3764 sg_init_table(sg_srr, sg_srr_cnt);
3765 sgp = &sg_srr[0];
3766 /*
3767 * Walk the remaining list for sg_srr_start, mapping to the newly
3768 * allocated sg_srr taking first_offset into account.
3769 */
3770 for_each_sg(sg_srr_start, sg, sg_srr_cnt, i) {
3771 if (first_offset) {
3772 sg_set_page(sgp, sg_page(sg),
3773 (sg->length - first_offset), first_offset);
3774 first_offset = 0;
3775 } else {
3776 sg_set_page(sgp, sg_page(sg), sg->length, 0);
3777 }
3778 bufflen += sgp->length;
3779
3780 sgp = sg_next(sgp);
3781 if (!sgp)
3782 break;
3783 }
3784
3785 cmd->sg = sg_srr;
3786 cmd->sg_cnt = sg_srr_cnt;
3787 cmd->bufflen = bufflen;
3788 cmd->offset += offset;
3789 cmd->free_sg = 1;
3790
3791 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe026, "New cmd->sg: %p\n", cmd->sg);
3792 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe027, "New cmd->sg_cnt: %u\n",
3793 cmd->sg_cnt);
3794 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe028, "New cmd->bufflen: %u\n",
3795 cmd->bufflen);
3796 ql_dbg(ql_dbg_tgt, cmd->vha, 0xe029, "New cmd->offset: %u\n",
3797 cmd->offset);
3798
3799 if (cmd->sg_cnt < 0)
3800 BUG();
3801
3802 if (cmd->bufflen < 0)
3803 BUG();
3804
3805 return 0;
5897cb2f 3806#endif
2d70c103
NB		 3807}
3808
3809static inline int qlt_srr_adjust_data(struct qla_tgt_cmd *cmd,
3810 uint32_t srr_rel_offs, int *xmit_type)
3811{
3812 int res = 0, rel_offs;
3813
3814 rel_offs = srr_rel_offs - cmd->offset;
3815 ql_dbg(ql_dbg_tgt_mgt, cmd->vha, 0xf027, "srr_rel_offs=%d, rel_offs=%d",
3816 srr_rel_offs, rel_offs);
3817
3818 *xmit_type = QLA_TGT_XMIT_ALL;
3819
3820 if (rel_offs < 0) {
3821 ql_dbg(ql_dbg_tgt_mgt, cmd->vha, 0xf062,
3822 "qla_target(%d): SRR rel_offs (%d) < 0",
3823 cmd->vha->vp_idx, rel_offs);
3824 res = -1;
3825 } else if (rel_offs == cmd->bufflen)
3826 *xmit_type = QLA_TGT_XMIT_STATUS;
3827 else if (rel_offs > 0)
3828 res = qlt_set_data_offset(cmd, rel_offs);
3829
3830 return res;
3831}
3832
3833/* No locks, thread context */
3834static void qlt_handle_srr(struct scsi_qla_host *vha,
3835 struct qla_tgt_srr_ctio *sctio, struct qla_tgt_srr_imm *imm)
3836{
3837 struct imm_ntfy_from_isp *ntfy =
3838 (struct imm_ntfy_from_isp *)&imm->imm_ntfy;
3839 struct qla_hw_data *ha = vha->hw;
3840 struct qla_tgt_cmd *cmd = sctio->cmd;
3841 struct se_cmd *se_cmd = &cmd->se_cmd;
3842 unsigned long flags;
3843 int xmit_type = 0, resp = 0;
3844 uint32_t offset;
3845 uint16_t srr_ui;
3846
3847 offset = le32_to_cpu(ntfy->u.isp24.srr_rel_offs);
3848 srr_ui = ntfy->u.isp24.srr_ui;
3849
3850 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf028, "SRR cmd %p, srr_ui %x\n",
3851 cmd, srr_ui);
3852
3853 switch (srr_ui) {
3854 case SRR_IU_STATUS:
3855 spin_lock_irqsave(&ha->hardware_lock, flags);
3856 qlt_send_notify_ack(vha, ntfy,
3857 0, 0, 0, NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0);
3858 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3859 xmit_type = QLA_TGT_XMIT_STATUS;
3860 resp = 1;
3861 break;
3862 case SRR_IU_DATA_IN:
3863 if (!cmd->sg || !cmd->sg_cnt) {
3864 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf063,
3865 "Unable to process SRR_IU_DATA_IN due to"
3866 " missing cmd->sg, state: %d\n", cmd->state);
3867 dump_stack();
3868 goto out_reject;
3869 }
3870 if (se_cmd->scsi_status != 0) {
3871 ql_dbg(ql_dbg_tgt, vha, 0xe02a,
3872 "Rejecting SRR_IU_DATA_IN with non GOOD "
3873 "scsi_status\n");
3874 goto out_reject;
3875 }
3876 cmd->bufflen = se_cmd->data_length;
3877
3878 if (qlt_has_data(cmd)) {
3879 if (qlt_srr_adjust_data(cmd, offset, &xmit_type) != 0)
3880 goto out_reject;
3881 spin_lock_irqsave(&ha->hardware_lock, flags);
3882 qlt_send_notify_ack(vha, ntfy,
3883 0, 0, 0, NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0);
3884 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3885 resp = 1;
3886 } else {
3887 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf064,
649ee054
BVA		 3888 "qla_target(%d): SRR for in data for cmd without them (tag %lld, SCSI status %d), reject",
3889 vha->vp_idx, se_cmd->tag,
2d70c103
NB		 3890 cmd->se_cmd.scsi_status);
3891 goto out_reject;
3892 }
3893 break;
3894 case SRR_IU_DATA_OUT:
3895 if (!cmd->sg || !cmd->sg_cnt) {
3896 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf065,
3897 "Unable to process SRR_IU_DATA_OUT due to"
3898 " missing cmd->sg\n");
3899 dump_stack();
3900 goto out_reject;
3901 }
3902 if (se_cmd->scsi_status != 0) {
3903 ql_dbg(ql_dbg_tgt, vha, 0xe02b,
3904 "Rejecting SRR_IU_DATA_OUT"
3905 " with non GOOD scsi_status\n");
3906 goto out_reject;
3907 }
3908 cmd->bufflen = se_cmd->data_length;
3909
3910 if (qlt_has_data(cmd)) {
3911 if (qlt_srr_adjust_data(cmd, offset, &xmit_type) != 0)
3912 goto out_reject;
3913 spin_lock_irqsave(&ha->hardware_lock, flags);
3914 qlt_send_notify_ack(vha, ntfy,
3915 0, 0, 0, NOTIFY_ACK_SRR_FLAGS_ACCEPT, 0, 0);
3916 spin_unlock_irqrestore(&ha->hardware_lock, flags);
e07f8f65
SK		 3917 if (xmit_type & QLA_TGT_XMIT_DATA) {
3918 cmd->cmd_flags |= BIT_8;
2d70c103 3919 qlt_rdy_to_xfer(cmd);
e07f8f65 3920 }
2d70c103
NB		 3921 } else {
3922 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf066,
649ee054
BVA		 3923 "qla_target(%d): SRR for out data for cmd without them (tag %lld, SCSI status %d), reject",
3924 vha->vp_idx, se_cmd->tag, cmd->se_cmd.scsi_status);
2d70c103
NB		 3925 goto out_reject;
3926 }
3927 break;
3928 default:
3929 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf067,
3930 "qla_target(%d): Unknown srr_ui value %x",
3931 vha->vp_idx, srr_ui);
3932 goto out_reject;
3933 }
3934
3935 /* Transmit response in case of status and data-in cases */
e07f8f65
SK		 3936 if (resp) {
3937 cmd->cmd_flags |= BIT_7;
2d70c103 3938 qlt_xmit_response(cmd, xmit_type, se_cmd->scsi_status);
e07f8f65 3939 }
2d70c103
NB		 3940
3941 return;
3942
3943out_reject:
3944 spin_lock_irqsave(&ha->hardware_lock, flags);
3945 qlt_send_notify_ack(vha, ntfy, 0, 0, 0,
3946 NOTIFY_ACK_SRR_FLAGS_REJECT,
3947 NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM,
3948 NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL);
3949 if (cmd->state == QLA_TGT_STATE_NEED_DATA) {
3950 cmd->state = QLA_TGT_STATE_DATA_IN;
3951 dump_stack();
e07f8f65
SK		 3952 } else {
3953 cmd->cmd_flags |= BIT_9;
2d70c103 3954 qlt_send_term_exchange(vha, cmd, &cmd->atio, 1);
e07f8f65 3955 }
2d70c103
NB		 3956 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3957}
3958
3959static void qlt_reject_free_srr_imm(struct scsi_qla_host *vha,
3960 struct qla_tgt_srr_imm *imm, int ha_locked)
3961{
3962 struct qla_hw_data *ha = vha->hw;
3963 unsigned long flags = 0;
3964
3965 if (!ha_locked)
3966 spin_lock_irqsave(&ha->hardware_lock, flags);
3967
3968 qlt_send_notify_ack(vha, (void *)&imm->imm_ntfy, 0, 0, 0,
3969 NOTIFY_ACK_SRR_FLAGS_REJECT,
3970 NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM,
3971 NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL);
3972
3973 if (!ha_locked)
3974 spin_unlock_irqrestore(&ha->hardware_lock, flags);
3975
3976 kfree(imm);
3977}
3978
3979static void qlt_handle_srr_work(struct work_struct *work)
3980{
3981 struct qla_tgt *tgt = container_of(work, struct qla_tgt, srr_work);
3982 struct scsi_qla_host *vha = tgt->vha;
3983 struct qla_tgt_srr_ctio *sctio;
3984 unsigned long flags;
3985
3986 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf029, "Entering SRR work (tgt %p)\n",
3987 tgt);
3988
3989restart:
3990 spin_lock_irqsave(&tgt->srr_lock, flags);
3991 list_for_each_entry(sctio, &tgt->srr_ctio_list, srr_list_entry) {
3992 struct qla_tgt_srr_imm *imm, *i, *ti;
3993 struct qla_tgt_cmd *cmd;
3994 struct se_cmd *se_cmd;
3995
3996 imm = NULL;
3997 list_for_each_entry_safe(i, ti, &tgt->srr_imm_list,
3998 srr_list_entry) {
3999 if (i->srr_id == sctio->srr_id) {
4000 list_del(&i->srr_list_entry);
4001 if (imm) {
4002 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf068,
4003 "qla_target(%d): There must be "
4004 "only one IMM SRR per CTIO SRR "
4005 "(IMM SRR %p, id %d, CTIO %p\n",
4006 vha->vp_idx, i, i->srr_id, sctio);
4007 qlt_reject_free_srr_imm(tgt->vha, i, 0);
4008 } else
4009 imm = i;
4010 }
4011 }
4012
4013 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf02a,
4014 "IMM SRR %p, CTIO SRR %p (id %d)\n", imm, sctio,
4015 sctio->srr_id);
4016
4017 if (imm == NULL) {
4018 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf02b,
4019 "Not found matching IMM for SRR CTIO (id %d)\n",
4020 sctio->srr_id);
4021 continue;
4022 } else
4023 list_del(&sctio->srr_list_entry);
4024
4025 spin_unlock_irqrestore(&tgt->srr_lock, flags);
4026
4027 cmd = sctio->cmd;
4028 /*
4029 * Reset qla_tgt_cmd SRR values and SGL pointer+count to follow
4030 * tcm_qla2xxx_write_pending() and tcm_qla2xxx_queue_data_in()
4031 * logic..
4032 */
4033 cmd->offset = 0;
4034 if (cmd->free_sg) {
4035 kfree(cmd->sg);
4036 cmd->sg = NULL;
4037 cmd->free_sg = 0;
4038 }
4039 se_cmd = &cmd->se_cmd;
4040
4041 cmd->sg_cnt = se_cmd->t_data_nents;
4042 cmd->sg = se_cmd->t_data_sg;
4043
4044 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf02c,
649ee054
BVA		 4045 "SRR cmd %p (se_cmd %p, tag %lld, op %x), sg_cnt=%d, offset=%d",
4046 cmd, &cmd->se_cmd, se_cmd->tag, se_cmd->t_task_cdb ?
4047 se_cmd->t_task_cdb[0] : 0, cmd->sg_cnt, cmd->offset);
2d70c103
NB		 4048
4049 qlt_handle_srr(vha, sctio, imm);
4050
4051 kfree(imm);
4052 kfree(sctio);
4053 goto restart;
4054 }
4055 spin_unlock_irqrestore(&tgt->srr_lock, flags);
4056}
4057
4058/* ha->hardware_lock supposed to be held on entry */
4059static void qlt_prepare_srr_imm(struct scsi_qla_host *vha,
4060 struct imm_ntfy_from_isp *iocb)
4061{
4062 struct qla_tgt_srr_imm *imm;
0e8cd71c 4063 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 4064 struct qla_tgt_srr_ctio *sctio;
4065
4066 tgt->imm_srr_id++;
4067
e07f8f65 4068 ql_log(ql_log_warn, vha, 0xf02d, "qla_target(%d): SRR received\n",
2d70c103
NB		 4069 vha->vp_idx);
4070
4071 imm = kzalloc(sizeof(*imm), GFP_ATOMIC);
4072 if (imm != NULL) {
4073 memcpy(&imm->imm_ntfy, iocb, sizeof(imm->imm_ntfy));
4074
4075 /* IRQ is already OFF */
4076 spin_lock(&tgt->srr_lock);
4077 imm->srr_id = tgt->imm_srr_id;
4078 list_add_tail(&imm->srr_list_entry,
4079 &tgt->srr_imm_list);
4080 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf02e,
4081 "IMM NTFY SRR %p added (id %d, ui %x)\n",
4082 imm, imm->srr_id, iocb->u.isp24.srr_ui);
4083 if (tgt->imm_srr_id == tgt->ctio_srr_id) {
4084 int found = 0;
4085 list_for_each_entry(sctio, &tgt->srr_ctio_list,
4086 srr_list_entry) {
4087 if (sctio->srr_id == imm->srr_id) {
4088 found = 1;
4089 break;
4090 }
4091 }
4092 if (found) {
4093 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf02f, "%s",
4094 "Scheduling srr work\n");
4095 schedule_work(&tgt->srr_work);
4096 } else {
4097 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf030,
4098 "qla_target(%d): imm_srr_id "
4099 "== ctio_srr_id (%d), but there is no "
4100 "corresponding SRR CTIO, deleting IMM "
4101 "SRR %p\n", vha->vp_idx, tgt->ctio_srr_id,
4102 imm);
4103 list_del(&imm->srr_list_entry);
4104
4105 kfree(imm);
4106
4107 spin_unlock(&tgt->srr_lock);
4108 goto out_reject;
4109 }
4110 }
4111 spin_unlock(&tgt->srr_lock);
4112 } else {
4113 struct qla_tgt_srr_ctio *ts;
4114
4115 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf069,
4116 "qla_target(%d): Unable to allocate SRR IMM "
4117 "entry, SRR request will be rejected\n", vha->vp_idx);
4118
4119 /* IRQ is already OFF */
4120 spin_lock(&tgt->srr_lock);
4121 list_for_each_entry_safe(sctio, ts, &tgt->srr_ctio_list,
4122 srr_list_entry) {
4123 if (sctio->srr_id == tgt->imm_srr_id) {
4124 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf031,
4125 "CTIO SRR %p deleted (id %d)\n",
4126 sctio, sctio->srr_id);
4127 list_del(&sctio->srr_list_entry);
4128 qlt_send_term_exchange(vha, sctio->cmd,
4129 &sctio->cmd->atio, 1);
4130 kfree(sctio);
4131 }
4132 }
4133 spin_unlock(&tgt->srr_lock);
4134 goto out_reject;
4135 }
4136
4137 return;
4138
4139out_reject:
4140 qlt_send_notify_ack(vha, iocb, 0, 0, 0,
4141 NOTIFY_ACK_SRR_FLAGS_REJECT,
4142 NOTIFY_ACK_SRR_REJECT_REASON_UNABLE_TO_PERFORM,
4143 NOTIFY_ACK_SRR_FLAGS_REJECT_EXPL_NO_EXPL);
4144}
4145
4146/*
4147 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
4148 */
4149static void qlt_handle_imm_notify(struct scsi_qla_host *vha,
4150 struct imm_ntfy_from_isp *iocb)
4151{
4152 struct qla_hw_data *ha = vha->hw;
4153 uint32_t add_flags = 0;
4154 int send_notify_ack = 1;
4155 uint16_t status;
4156
4157 status = le16_to_cpu(iocb->u.isp2x.status);
4158 switch (status) {
4159 case IMM_NTFY_LIP_RESET:
4160 {
4161 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf032,
4162 "qla_target(%d): LIP reset (loop %#x), subcode %x\n",
4163 vha->vp_idx, le16_to_cpu(iocb->u.isp24.nport_handle),
4164 iocb->u.isp24.status_subcode);
4165
4166 if (qlt_reset(vha, iocb, QLA_TGT_ABORT_ALL) == 0)
4167 send_notify_ack = 0;
4168 break;
4169 }
4170
4171 case IMM_NTFY_LIP_LINK_REINIT:
4172 {
0e8cd71c 4173 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 4174 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf033,
4175 "qla_target(%d): LINK REINIT (loop %#x, "
4176 "subcode %x)\n", vha->vp_idx,
4177 le16_to_cpu(iocb->u.isp24.nport_handle),
4178 iocb->u.isp24.status_subcode);
4179 if (tgt->link_reinit_iocb_pending) {
4180 qlt_send_notify_ack(vha, &tgt->link_reinit_iocb,
4181 0, 0, 0, 0, 0, 0);
4182 }
4183 memcpy(&tgt->link_reinit_iocb, iocb, sizeof(*iocb));
4184 tgt->link_reinit_iocb_pending = 1;
4185 /*
4186 * QLogic requires to wait after LINK REINIT for possible
4187 * PDISC or ADISC ELS commands
4188 */
4189 send_notify_ack = 0;
4190 break;
4191 }
4192
4193 case IMM_NTFY_PORT_LOGOUT:
4194 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf034,
4195 "qla_target(%d): Port logout (loop "
4196 "%#x, subcode %x)\n", vha->vp_idx,
4197 le16_to_cpu(iocb->u.isp24.nport_handle),
4198 iocb->u.isp24.status_subcode);
4199
4200 if (qlt_reset(vha, iocb, QLA_TGT_NEXUS_LOSS_SESS) == 0)
4201 send_notify_ack = 0;
4202 /* The sessions will be cleared in the callback, if needed */
4203 break;
4204
4205 case IMM_NTFY_GLBL_TPRLO:
4206 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf035,
4207 "qla_target(%d): Global TPRLO (%x)\n", vha->vp_idx, status);
4208 if (qlt_reset(vha, iocb, QLA_TGT_NEXUS_LOSS) == 0)
4209 send_notify_ack = 0;
4210 /* The sessions will be cleared in the callback, if needed */
4211 break;
4212
4213 case IMM_NTFY_PORT_CONFIG:
4214 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf036,
4215 "qla_target(%d): Port config changed (%x)\n", vha->vp_idx,
4216 status);
4217 if (qlt_reset(vha, iocb, QLA_TGT_ABORT_ALL) == 0)
4218 send_notify_ack = 0;
4219 /* The sessions will be cleared in the callback, if needed */
4220 break;
4221
4222 case IMM_NTFY_GLBL_LOGO:
4223 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf06a,
4224 "qla_target(%d): Link failure detected\n",
4225 vha->vp_idx);
4226 /* I_T nexus loss */
4227 if (qlt_reset(vha, iocb, QLA_TGT_NEXUS_LOSS) == 0)
4228 send_notify_ack = 0;
4229 break;
4230
4231 case IMM_NTFY_IOCB_OVERFLOW:
4232 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf06b,
4233 "qla_target(%d): Cannot provide requested "
4234 "capability (IOCB overflowed the immediate notify "
4235 "resource count)\n", vha->vp_idx);
4236 break;
4237
4238 case IMM_NTFY_ABORT_TASK:
4239 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf037,
4240 "qla_target(%d): Abort Task (S %08x I %#x -> "
4241 "L %#x)\n", vha->vp_idx,
4242 le16_to_cpu(iocb->u.isp2x.seq_id),
4243 GET_TARGET_ID(ha, (struct atio_from_isp *)iocb),
4244 le16_to_cpu(iocb->u.isp2x.lun));
4245 if (qlt_abort_task(vha, iocb) == 0)
4246 send_notify_ack = 0;
4247 break;
4248
4249 case IMM_NTFY_RESOURCE:
4250 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf06c,
4251 "qla_target(%d): Out of resources, host %ld\n",
4252 vha->vp_idx, vha->host_no);
4253 break;
4254
4255 case IMM_NTFY_MSG_RX:
4256 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf038,
4257 "qla_target(%d): Immediate notify task %x\n",
4258 vha->vp_idx, iocb->u.isp2x.task_flags);
4259 if (qlt_handle_task_mgmt(vha, iocb) == 0)
4260 send_notify_ack = 0;
4261 break;
4262
4263 case IMM_NTFY_ELS:
4264 if (qlt_24xx_handle_els(vha, iocb) == 0)
4265 send_notify_ack = 0;
4266 break;
4267
4268 case IMM_NTFY_SRR:
4269 qlt_prepare_srr_imm(vha, iocb);
4270 send_notify_ack = 0;
4271 break;
4272
4273 default:
4274 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf06d,
4275 "qla_target(%d): Received unknown immediate "
4276 "notify status %x\n", vha->vp_idx, status);
4277 break;
4278 }
4279
4280 if (send_notify_ack)
4281 qlt_send_notify_ack(vha, iocb, add_flags, 0, 0, 0, 0, 0);
4282}
4283
4284/*
4285 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
4286 * This function sends busy to ISP 2xxx or 24xx.
4287 */
33e79977 4288static int __qlt_send_busy(struct scsi_qla_host *vha,
2d70c103
NB		 4289 struct atio_from_isp *atio, uint16_t status)
4290{
4291 struct ctio7_to_24xx *ctio24;
4292 struct qla_hw_data *ha = vha->hw;
4293 request_t *pkt;
4294 struct qla_tgt_sess *sess = NULL;
4295
4296 sess = ha->tgt.tgt_ops->find_sess_by_s_id(vha,
4297 atio->u.isp24.fcp_hdr.s_id);
4298 if (!sess) {
4299 qlt_send_term_exchange(vha, NULL, atio, 1);
33e79977 4300 return 0;
2d70c103
NB		 4301 }
4302 /* Sending marker isn't necessary, since we called from ISR */
4303
4304 pkt = (request_t *)qla2x00_alloc_iocbs(vha, NULL);
4305 if (!pkt) {
667024a3 4306 ql_dbg(ql_dbg_io, vha, 0x3063,
2d70c103
NB		 4307 "qla_target(%d): %s failed: unable to allocate "
4308 "request packet", vha->vp_idx, __func__);
33e79977 4309 return -ENOMEM;
2d70c103
NB		 4310 }
4311
4312 pkt->entry_count = 1;
4313 pkt->handle = QLA_TGT_SKIP_HANDLE | CTIO_COMPLETION_HANDLE_MARK;
4314
4315 ctio24 = (struct ctio7_to_24xx *)pkt;
4316 ctio24->entry_type = CTIO_TYPE7;
4317 ctio24->nport_handle = sess->loop_id;
4318 ctio24->timeout = __constant_cpu_to_le16(QLA_TGT_TIMEOUT);
4319 ctio24->vp_index = vha->vp_idx;
4320 ctio24->initiator_id[0] = atio->u.isp24.fcp_hdr.s_id[2];
4321 ctio24->initiator_id[1] = atio->u.isp24.fcp_hdr.s_id[1];
4322 ctio24->initiator_id[2] = atio->u.isp24.fcp_hdr.s_id[0];
4323 ctio24->exchange_addr = atio->u.isp24.exchange_addr;
4324 ctio24->u.status1.flags = (atio->u.isp24.attr << 9) |
4325 __constant_cpu_to_le16(
4326 CTIO7_FLAGS_STATUS_MODE_1 | CTIO7_FLAGS_SEND_STATUS |
4327 CTIO7_FLAGS_DONT_RET_CTIO);
4328 /*
4329 * CTIO from fw w/o se_cmd doesn't provide enough info to retry it,
4330 * if the explicit conformation is used.
4331 */
4332 ctio24->u.status1.ox_id = swab16(atio->u.isp24.fcp_hdr.ox_id);
4333 ctio24->u.status1.scsi_status = cpu_to_le16(status);
63163e06
HM		 4334 /* Memory Barrier */
4335 wmb();
2d70c103 4336 qla2x00_start_iocbs(vha, vha->req);
33e79977
QT		 4337 return 0;
4338}
4339
4340/*
4341 * This routine is used to allocate a command for either a QFull condition
4342 * (ie reply SAM_STAT_BUSY) or to terminate an exchange that did not go
4343 * out previously.
4344 */
4345static void
4346qlt_alloc_qfull_cmd(struct scsi_qla_host *vha,
4347 struct atio_from_isp *atio, uint16_t status, int qfull)
4348{
4349 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
4350 struct qla_hw_data *ha = vha->hw;
4351 struct qla_tgt_sess *sess;
4352 struct se_session *se_sess;
4353 struct qla_tgt_cmd *cmd;
4354 int tag;
4355
4356 if (unlikely(tgt->tgt_stop)) {
4357 ql_dbg(ql_dbg_io, vha, 0x300a,
4358 "New command while device %p is shutting down\n", tgt);
4359 return;
4360 }
4361
4362 if ((vha->hw->tgt.num_qfull_cmds_alloc + 1) > MAX_QFULL_CMDS_ALLOC) {
4363 vha->hw->tgt.num_qfull_cmds_dropped++;
4364 if (vha->hw->tgt.num_qfull_cmds_dropped >
4365 vha->hw->qla_stats.stat_max_qfull_cmds_dropped)
4366 vha->hw->qla_stats.stat_max_qfull_cmds_dropped =
4367 vha->hw->tgt.num_qfull_cmds_dropped;
4368
4369 ql_dbg(ql_dbg_io, vha, 0x3068,
4370 "qla_target(%d): %s: QFull CMD dropped[%d]\n",
4371 vha->vp_idx, __func__,
4372 vha->hw->tgt.num_qfull_cmds_dropped);
4373
4374 qlt_chk_exch_leak_thresh_hold(vha);
4375 return;
4376 }
4377
4378 sess = ha->tgt.tgt_ops->find_sess_by_s_id
4379 (vha, atio->u.isp24.fcp_hdr.s_id);
4380 if (!sess)
4381 return;
4382
4383 se_sess = sess->se_sess;
4384
4385 tag = percpu_ida_alloc(&se_sess->sess_tag_pool, TASK_RUNNING);
4386 if (tag < 0)
4387 return;
4388
4389 cmd = &((struct qla_tgt_cmd *)se_sess->sess_cmd_map)[tag];
4390 if (!cmd) {
4391 ql_dbg(ql_dbg_io, vha, 0x3009,
4392 "qla_target(%d): %s: Allocation of cmd failed\n",
4393 vha->vp_idx, __func__);
4394
4395 vha->hw->tgt.num_qfull_cmds_dropped++;
4396 if (vha->hw->tgt.num_qfull_cmds_dropped >
4397 vha->hw->qla_stats.stat_max_qfull_cmds_dropped)
4398 vha->hw->qla_stats.stat_max_qfull_cmds_dropped =
4399 vha->hw->tgt.num_qfull_cmds_dropped;
4400
4401 qlt_chk_exch_leak_thresh_hold(vha);
4402 return;
4403 }
4404
4405 memset(cmd, 0, sizeof(struct qla_tgt_cmd));
4406
4407 qlt_incr_num_pend_cmds(vha);
4408 INIT_LIST_HEAD(&cmd->cmd_list);
4409 memcpy(&cmd->atio, atio, sizeof(*atio));
4410
4411 cmd->tgt = vha->vha_tgt.qla_tgt;
4412 cmd->vha = vha;
4413 cmd->reset_count = vha->hw->chip_reset;
4414 cmd->q_full = 1;
4415
4416 if (qfull) {
4417 cmd->q_full = 1;
4418 /* NOTE: borrowing the state field to carry the status */
4419 cmd->state = status;
4420 } else
4421 cmd->term_exchg = 1;
4422
4423 list_add_tail(&cmd->cmd_list, &vha->hw->tgt.q_full_list);
4424
4425 vha->hw->tgt.num_qfull_cmds_alloc++;
4426 if (vha->hw->tgt.num_qfull_cmds_alloc >
4427 vha->hw->qla_stats.stat_max_qfull_cmds_alloc)
4428 vha->hw->qla_stats.stat_max_qfull_cmds_alloc =
4429 vha->hw->tgt.num_qfull_cmds_alloc;
4430}
4431
4432int
4433qlt_free_qfull_cmds(struct scsi_qla_host *vha)
4434{
4435 struct qla_hw_data *ha = vha->hw;
4436 unsigned long flags;
4437 struct qla_tgt_cmd *cmd, *tcmd;
4438 struct list_head free_list;
4439 int rc = 0;
4440
4441 if (list_empty(&ha->tgt.q_full_list))
4442 return 0;
4443
4444 INIT_LIST_HEAD(&free_list);
4445
4446 spin_lock_irqsave(&vha->hw->hardware_lock, flags);
4447
4448 if (list_empty(&ha->tgt.q_full_list)) {
4449 spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
4450 return 0;
4451 }
4452
4453 list_for_each_entry_safe(cmd, tcmd, &ha->tgt.q_full_list, cmd_list) {
4454 if (cmd->q_full)
4455 /* cmd->state is a borrowed field to hold status */
4456 rc = __qlt_send_busy(vha, &cmd->atio, cmd->state);
4457 else if (cmd->term_exchg)
4458 rc = __qlt_send_term_exchange(vha, NULL, &cmd->atio);
4459
4460 if (rc == -ENOMEM)
4461 break;
4462
4463 if (cmd->q_full)
4464 ql_dbg(ql_dbg_io, vha, 0x3006,
4465 "%s: busy sent for ox_id[%04x]\n", __func__,
4466 be16_to_cpu(cmd->atio.u.isp24.fcp_hdr.ox_id));
4467 else if (cmd->term_exchg)
4468 ql_dbg(ql_dbg_io, vha, 0x3007,
4469 "%s: Term exchg sent for ox_id[%04x]\n", __func__,
4470 be16_to_cpu(cmd->atio.u.isp24.fcp_hdr.ox_id));
4471 else
4472 ql_dbg(ql_dbg_io, vha, 0x3008,
4473 "%s: Unexpected cmd in QFull list %p\n", __func__,
4474 cmd);
4475
4476 list_del(&cmd->cmd_list);
4477 list_add_tail(&cmd->cmd_list, &free_list);
4478
4479 /* piggy back on hardware_lock for protection */
4480 vha->hw->tgt.num_qfull_cmds_alloc--;
4481 }
4482 spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
4483
4484 cmd = NULL;
4485
4486 list_for_each_entry_safe(cmd, tcmd, &free_list, cmd_list) {
4487 list_del(&cmd->cmd_list);
4488 /* This cmd was never sent to TCM. There is no need
4489 * to schedule free or call free_cmd
4490 */
4491 qlt_free_cmd(cmd);
4492 }
4493 return rc;
4494}
4495
4496static void
4497qlt_send_busy(struct scsi_qla_host *vha,
4498 struct atio_from_isp *atio, uint16_t status)
4499{
4500 int rc = 0;
4501
4502 rc = __qlt_send_busy(vha, atio, status);
4503 if (rc == -ENOMEM)
4504 qlt_alloc_qfull_cmd(vha, atio, status, 1);
4505}
4506
4507static int
4508qlt_chk_qfull_thresh_hold(struct scsi_qla_host *vha,
4509 struct atio_from_isp *atio)
4510{
4511 struct qla_hw_data *ha = vha->hw;
4512 uint16_t status;
4513
4514 if (ha->tgt.num_pend_cmds < Q_FULL_THRESH_HOLD(ha))
4515 return 0;
4516
4517 status = temp_sam_status;
4518 qlt_send_busy(vha, atio, status);
4519 return 1;
2d70c103
NB		 4520}
4521
4522/* ha->hardware_lock supposed to be held on entry */
4523/* called via callback from qla2xxx */
4524static void qlt_24xx_atio_pkt(struct scsi_qla_host *vha,
4525 struct atio_from_isp *atio)
4526{
4527 struct qla_hw_data *ha = vha->hw;
0e8cd71c 4528 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 4529 int rc;
4530
4531 if (unlikely(tgt == NULL)) {
667024a3 4532 ql_dbg(ql_dbg_io, vha, 0x3064,
2d70c103
NB		 4533 "ATIO pkt, but no tgt (ha %p)", ha);
4534 return;
4535 }
2d70c103
NB		 4536 /*
4537 * In tgt_stop mode we also should allow all requests to pass.
4538 * Otherwise, some commands can stuck.
4539 */
4540
4541 tgt->irq_cmd_count++;
4542
4543 switch (atio->u.raw.entry_type) {
4544 case ATIO_TYPE7:
2d70c103
NB		 4545 if (unlikely(atio->u.isp24.exchange_addr ==
4546 ATIO_EXCHANGE_ADDRESS_UNKNOWN)) {
667024a3 4547 ql_dbg(ql_dbg_io, vha, 0x3065,
2d70c103
NB		 4548 "qla_target(%d): ATIO_TYPE7 "
4549 "received with UNKNOWN exchange address, "
4550 "sending QUEUE_FULL\n", vha->vp_idx);
4551 qlt_send_busy(vha, atio, SAM_STAT_TASK_SET_FULL);
4552 break;
4553 }
33e79977
QT		 4554
4555
4556
4557 if (likely(atio->u.isp24.fcp_cmnd.task_mgmt_flags == 0)) {
4558 rc = qlt_chk_qfull_thresh_hold(vha, atio);
4559 if (rc != 0) {
4560 tgt->irq_cmd_count--;
4561 return;
4562 }
2d70c103 4563 rc = qlt_handle_cmd_for_atio(vha, atio);
33e79977 4564 } else {
2d70c103 4565 rc = qlt_handle_task_mgmt(vha, atio);
33e79977 4566 }
2d70c103
NB		 4567 if (unlikely(rc != 0)) {
4568 if (rc == -ESRCH) {
4569#if 1 /* With TERM EXCHANGE some FC cards refuse to boot */
4570 qlt_send_busy(vha, atio, SAM_STAT_BUSY);
4571#else
4572 qlt_send_term_exchange(vha, NULL, atio, 1);
4573#endif
4574 } else {
4575 if (tgt->tgt_stop) {
4576 ql_dbg(ql_dbg_tgt, vha, 0xe059,
4577 "qla_target: Unable to send "
4578 "command to target for req, "
4579 "ignoring.\n");
4580 } else {
4581 ql_dbg(ql_dbg_tgt, vha, 0xe05a,
4582 "qla_target(%d): Unable to send "
4583 "command to target, sending BUSY "
4584 "status.\n", vha->vp_idx);
4585 qlt_send_busy(vha, atio, SAM_STAT_BUSY);
4586 }
4587 }
4588 }
4589 break;
4590
4591 case IMMED_NOTIFY_TYPE:
4592 {
4593 if (unlikely(atio->u.isp2x.entry_status != 0)) {
4594 ql_dbg(ql_dbg_tgt, vha, 0xe05b,
4595 "qla_target(%d): Received ATIO packet %x "
4596 "with error status %x\n", vha->vp_idx,
4597 atio->u.raw.entry_type,
4598 atio->u.isp2x.entry_status);
4599 break;
4600 }
4601 ql_dbg(ql_dbg_tgt, vha, 0xe02e, "%s", "IMMED_NOTIFY ATIO");
4602 qlt_handle_imm_notify(vha, (struct imm_ntfy_from_isp *)atio);
4603 break;
4604 }
4605
4606 default:
4607 ql_dbg(ql_dbg_tgt, vha, 0xe05c,
4608 "qla_target(%d): Received unknown ATIO atio "
4609 "type %x\n", vha->vp_idx, atio->u.raw.entry_type);
4610 break;
4611 }
4612
4613 tgt->irq_cmd_count--;
4614}
4615
4616/* ha->hardware_lock supposed to be held on entry */
4617/* called via callback from qla2xxx */
4618static void qlt_response_pkt(struct scsi_qla_host *vha, response_t *pkt)
4619{
4620 struct qla_hw_data *ha = vha->hw;
0e8cd71c 4621 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 4622
4623 if (unlikely(tgt == NULL)) {
4624 ql_dbg(ql_dbg_tgt, vha, 0xe05d,
4625 "qla_target(%d): Response pkt %x received, but no "
4626 "tgt (ha %p)\n", vha->vp_idx, pkt->entry_type, ha);
4627 return;
4628 }
4629
2d70c103
NB		 4630 /*
4631 * In tgt_stop mode we also should allow all requests to pass.
4632 * Otherwise, some commands can stuck.
4633 */
4634
4635 tgt->irq_cmd_count++;
4636
4637 switch (pkt->entry_type) {
f83adb61 4638 case CTIO_CRC2:
2d70c103
NB		 4639 case CTIO_TYPE7:
4640 {
4641 struct ctio7_from_24xx *entry = (struct ctio7_from_24xx *)pkt;
2d70c103
NB		 4642 qlt_do_ctio_completion(vha, entry->handle,
4643 le16_to_cpu(entry->status)|(pkt->entry_status << 16),
4644 entry);
4645 break;
4646 }
4647
4648 case ACCEPT_TGT_IO_TYPE:
4649 {
4650 struct atio_from_isp *atio = (struct atio_from_isp *)pkt;
4651 int rc;
2d70c103
NB		 4652 if (atio->u.isp2x.status !=
4653 __constant_cpu_to_le16(ATIO_CDB_VALID)) {
4654 ql_dbg(ql_dbg_tgt, vha, 0xe05e,
4655 "qla_target(%d): ATIO with error "
4656 "status %x received\n", vha->vp_idx,
4657 le16_to_cpu(atio->u.isp2x.status));
4658 break;
4659 }
2d70c103 4660
33e79977
QT		 4661 rc = qlt_chk_qfull_thresh_hold(vha, atio);
4662 if (rc != 0) {
4663 tgt->irq_cmd_count--;
4664 return;
4665 }
4666
2d70c103
NB		 4667 rc = qlt_handle_cmd_for_atio(vha, atio);
4668 if (unlikely(rc != 0)) {
4669 if (rc == -ESRCH) {
4670#if 1 /* With TERM EXCHANGE some FC cards refuse to boot */
4671 qlt_send_busy(vha, atio, 0);
4672#else
4673 qlt_send_term_exchange(vha, NULL, atio, 1);
4674#endif
4675 } else {
4676 if (tgt->tgt_stop) {
4677 ql_dbg(ql_dbg_tgt, vha, 0xe05f,
4678 "qla_target: Unable to send "
4679 "command to target, sending TERM "
4680 "EXCHANGE for rsp\n");
4681 qlt_send_term_exchange(vha, NULL,
4682 atio, 1);
4683 } else {
4684 ql_dbg(ql_dbg_tgt, vha, 0xe060,
4685 "qla_target(%d): Unable to send "
4686 "command to target, sending BUSY "
4687 "status\n", vha->vp_idx);
4688 qlt_send_busy(vha, atio, 0);
4689 }
4690 }
4691 }
4692 }
4693 break;
4694
4695 case CONTINUE_TGT_IO_TYPE:
4696 {
4697 struct ctio_to_2xxx *entry = (struct ctio_to_2xxx *)pkt;
2d70c103
NB		 4698 qlt_do_ctio_completion(vha, entry->handle,
4699 le16_to_cpu(entry->status)|(pkt->entry_status << 16),
4700 entry);
4701 break;
4702 }
4703
4704 case CTIO_A64_TYPE:
4705 {
4706 struct ctio_to_2xxx *entry = (struct ctio_to_2xxx *)pkt;
2d70c103
NB		 4707 qlt_do_ctio_completion(vha, entry->handle,
4708 le16_to_cpu(entry->status)|(pkt->entry_status << 16),
4709 entry);
4710 break;
4711 }
4712
4713 case IMMED_NOTIFY_TYPE:
4714 ql_dbg(ql_dbg_tgt, vha, 0xe035, "%s", "IMMED_NOTIFY\n");
4715 qlt_handle_imm_notify(vha, (struct imm_ntfy_from_isp *)pkt);
4716 break;
4717
4718 case NOTIFY_ACK_TYPE:
4719 if (tgt->notify_ack_expected > 0) {
4720 struct nack_to_isp *entry = (struct nack_to_isp *)pkt;
4721 ql_dbg(ql_dbg_tgt, vha, 0xe036,
4722 "NOTIFY_ACK seq %08x status %x\n",
4723 le16_to_cpu(entry->u.isp2x.seq_id),
4724 le16_to_cpu(entry->u.isp2x.status));
4725 tgt->notify_ack_expected--;
4726 if (entry->u.isp2x.status !=
4727 __constant_cpu_to_le16(NOTIFY_ACK_SUCCESS)) {
4728 ql_dbg(ql_dbg_tgt, vha, 0xe061,
4729 "qla_target(%d): NOTIFY_ACK "
4730 "failed %x\n", vha->vp_idx,
4731 le16_to_cpu(entry->u.isp2x.status));
4732 }
4733 } else {
4734 ql_dbg(ql_dbg_tgt, vha, 0xe062,
4735 "qla_target(%d): Unexpected NOTIFY_ACK received\n",
4736 vha->vp_idx);
4737 }
4738 break;
4739
4740 case ABTS_RECV_24XX:
4741 ql_dbg(ql_dbg_tgt, vha, 0xe037,
4742 "ABTS_RECV_24XX: instance %d\n", vha->vp_idx);
4743 qlt_24xx_handle_abts(vha, (struct abts_recv_from_24xx *)pkt);
4744 break;
4745
4746 case ABTS_RESP_24XX:
4747 if (tgt->abts_resp_expected > 0) {
4748 struct abts_resp_from_24xx_fw *entry =
4749 (struct abts_resp_from_24xx_fw *)pkt;
4750 ql_dbg(ql_dbg_tgt, vha, 0xe038,
4751 "ABTS_RESP_24XX: compl_status %x\n",
4752 entry->compl_status);
4753 tgt->abts_resp_expected--;
4754 if (le16_to_cpu(entry->compl_status) !=
4755 ABTS_RESP_COMPL_SUCCESS) {
4756 if ((entry->error_subcode1 == 0x1E) &&
4757 (entry->error_subcode2 == 0)) {
4758 /*
4759 * We've got a race here: aborted
4760 * exchange not terminated, i.e.
4761 * response for the aborted command was
4762 * sent between the abort request was
4763 * received and processed.
4764 * Unfortunately, the firmware has a
4765 * silly requirement that all aborted
4766 * exchanges must be explicitely
4767 * terminated, otherwise it refuses to
4768 * send responses for the abort
4769 * requests. So, we have to
4770 * (re)terminate the exchange and retry
4771 * the abort response.
4772 */
4773 qlt_24xx_retry_term_exchange(vha,
4774 entry);
4775 } else
4776 ql_dbg(ql_dbg_tgt, vha, 0xe063,
4777 "qla_target(%d): ABTS_RESP_24XX "
4778 "failed %x (subcode %x:%x)",
4779 vha->vp_idx, entry->compl_status,
4780 entry->error_subcode1,
4781 entry->error_subcode2);
4782 }
4783 } else {
4784 ql_dbg(ql_dbg_tgt, vha, 0xe064,
4785 "qla_target(%d): Unexpected ABTS_RESP_24XX "
4786 "received\n", vha->vp_idx);
4787 }
4788 break;
4789
4790 default:
4791 ql_dbg(ql_dbg_tgt, vha, 0xe065,
4792 "qla_target(%d): Received unknown response pkt "
4793 "type %x\n", vha->vp_idx, pkt->entry_type);
4794 break;
4795 }
4796
4797 tgt->irq_cmd_count--;
4798}
4799
4800/*
4801 * ha->hardware_lock supposed to be held on entry. Might drop it, then reaquire
4802 */
4803void qlt_async_event(uint16_t code, struct scsi_qla_host *vha,
4804 uint16_t *mailbox)
4805{
4806 struct qla_hw_data *ha = vha->hw;
0e8cd71c 4807 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
4f1d0f19 4808 int login_code;
2d70c103 4809
2d70c103
NB		 4810 if (!ha->tgt.tgt_ops)
4811 return;
4812
4813 if (unlikely(tgt == NULL)) {
4814 ql_dbg(ql_dbg_tgt, vha, 0xe03a,
4815 "ASYNC EVENT %#x, but no tgt (ha %p)\n", code, ha);
4816 return;
4817 }
4818
4819 if (((code == MBA_POINT_TO_POINT) || (code == MBA_CHG_IN_CONNECTION)) &&
4820 IS_QLA2100(ha))
4821 return;
4822 /*
4823 * In tgt_stop mode we also should allow all requests to pass.
4824 * Otherwise, some commands can stuck.
4825 */
4826
4827 tgt->irq_cmd_count++;
4828
4829 switch (code) {
4830 case MBA_RESET: /* Reset */
4831 case MBA_SYSTEM_ERR: /* System Error */
4832 case MBA_REQ_TRANSFER_ERR: /* Request Transfer Error */
4833 case MBA_RSP_TRANSFER_ERR: /* Response Transfer Error */
4834 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf03a,
4835 "qla_target(%d): System error async event %#x "
6efb3c0a 4836 "occurred", vha->vp_idx, code);
2d70c103
NB		 4837 break;
4838 case MBA_WAKEUP_THRES: /* Request Queue Wake-up. */
4839 set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
4840 break;
4841
4842 case MBA_LOOP_UP:
4843 {
4844 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf03b,
6efb3c0a 4845 "qla_target(%d): Async LOOP_UP occurred "
4f1d0f19
AC		 4846 "(m[0]=%x, m[1]=%x, m[2]=%x, m[3]=%x)", vha->vp_idx,
4847 le16_to_cpu(mailbox[0]), le16_to_cpu(mailbox[1]),
4848 le16_to_cpu(mailbox[2]), le16_to_cpu(mailbox[3]));
2d70c103
NB		 4849 if (tgt->link_reinit_iocb_pending) {
4850 qlt_send_notify_ack(vha, (void *)&tgt->link_reinit_iocb,
4851 0, 0, 0, 0, 0, 0);
4852 tgt->link_reinit_iocb_pending = 0;
4853 }
4854 break;
4855 }
4856
4857 case MBA_LIP_OCCURRED:
4858 case MBA_LOOP_DOWN:
4859 case MBA_LIP_RESET:
4860 case MBA_RSCN_UPDATE:
4861 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf03c,
6efb3c0a 4862 "qla_target(%d): Async event %#x occurred "
4f1d0f19
AC		 4863 "(m[0]=%x, m[1]=%x, m[2]=%x, m[3]=%x)", vha->vp_idx, code,
4864 le16_to_cpu(mailbox[0]), le16_to_cpu(mailbox[1]),
4865 le16_to_cpu(mailbox[2]), le16_to_cpu(mailbox[3]));
2d70c103
NB		 4866 break;
4867
4868 case MBA_PORT_UPDATE:
4869 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf03d,
4870 "qla_target(%d): Port update async event %#x "
6efb3c0a 4871 "occurred: updating the ports database (m[0]=%x, m[1]=%x, "
4f1d0f19
AC		 4872 "m[2]=%x, m[3]=%x)", vha->vp_idx, code,
4873 le16_to_cpu(mailbox[0]), le16_to_cpu(mailbox[1]),
4874 le16_to_cpu(mailbox[2]), le16_to_cpu(mailbox[3]));
4875
4876 login_code = le16_to_cpu(mailbox[2]);
4877 if (login_code == 0x4)
2d70c103
NB		 4878 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf03e,
4879 "Async MB 2: Got PLOGI Complete\n");
4f1d0f19 4880 else if (login_code == 0x7)
2d70c103
NB		 4881 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf03f,
4882 "Async MB 2: Port Logged Out\n");
4883 break;
4884
4885 default:
2d70c103
NB		 4886 break;
4887 }
4888
4889 tgt->irq_cmd_count--;
4890}
4891
4892static fc_port_t *qlt_get_port_database(struct scsi_qla_host *vha,
4893 uint16_t loop_id)
4894{
4895 fc_port_t *fcport;
4896 int rc;
4897
4898 fcport = kzalloc(sizeof(*fcport), GFP_KERNEL);
4899 if (!fcport) {
4900 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf06f,
4901 "qla_target(%d): Allocation of tmp FC port failed",
4902 vha->vp_idx);
4903 return NULL;
4904 }
4905
2d70c103
NB		 4906 fcport->loop_id = loop_id;
4907
4908 rc = qla2x00_get_port_database(vha, fcport, 0);
4909 if (rc != QLA_SUCCESS) {
4910 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf070,
4911 "qla_target(%d): Failed to retrieve fcport "
4912 "information -- get_port_database() returned %x "
4913 "(loop_id=0x%04x)", vha->vp_idx, rc, loop_id);
4914 kfree(fcport);
4915 return NULL;
4916 }
4917
4918 return fcport;
4919}
4920
4921/* Must be called under tgt_mutex */
4922static struct qla_tgt_sess *qlt_make_local_sess(struct scsi_qla_host *vha,
4923 uint8_t *s_id)
4924{
2d70c103
NB		 4925 struct qla_tgt_sess *sess = NULL;
4926 fc_port_t *fcport = NULL;
4927 int rc, global_resets;
4928 uint16_t loop_id = 0;
4929
4930retry:
0e8cd71c
SK		 4931 global_resets =
4932 atomic_read(&vha->vha_tgt.qla_tgt->tgt_global_resets_count);
2d70c103
NB		 4933
4934 rc = qla24xx_get_loop_id(vha, s_id, &loop_id);
4935 if (rc != 0) {
4936 if ((s_id[0] == 0xFF) &&
4937 (s_id[1] == 0xFC)) {
4938 /*
4939 * This is Domain Controller, so it should be
4940 * OK to drop SCSI commands from it.
4941 */
4942 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf042,
4943 "Unable to find initiator with S_ID %x:%x:%x",
4944 s_id[0], s_id[1], s_id[2]);
4945 } else
4946 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf071,
4947 "qla_target(%d): Unable to find "
4948 "initiator with S_ID %x:%x:%x",
4949 vha->vp_idx, s_id[0], s_id[1],
4950 s_id[2]);
4951 return NULL;
4952 }
4953
4954 fcport = qlt_get_port_database(vha, loop_id);
4955 if (!fcport)
4956 return NULL;
4957
4958 if (global_resets !=
0e8cd71c 4959 atomic_read(&vha->vha_tgt.qla_tgt->tgt_global_resets_count)) {
2d70c103
NB		 4960 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf043,
4961 "qla_target(%d): global reset during session discovery "
4962 "(counter was %d, new %d), retrying", vha->vp_idx,
4963 global_resets,
0e8cd71c
SK		 4964 atomic_read(&vha->vha_tgt.
4965 qla_tgt->tgt_global_resets_count));
2d70c103
NB		 4966 goto retry;
4967 }
4968
4969 sess = qlt_create_sess(vha, fcport, true);
4970
4971 kfree(fcport);
4972 return sess;
4973}
4974
4975static void qlt_abort_work(struct qla_tgt *tgt,
4976 struct qla_tgt_sess_work_param *prm)
4977{
4978 struct scsi_qla_host *vha = tgt->vha;
4979 struct qla_hw_data *ha = vha->hw;
4980 struct qla_tgt_sess *sess = NULL;
4981 unsigned long flags;
4982 uint32_t be_s_id;
4983 uint8_t s_id[3];
4984 int rc;
4985
4986 spin_lock_irqsave(&ha->hardware_lock, flags);
4987
4988 if (tgt->tgt_stop)
4989 goto out_term;
4990
4991 s_id[0] = prm->abts.fcp_hdr_le.s_id[2];
4992 s_id[1] = prm->abts.fcp_hdr_le.s_id[1];
4993 s_id[2] = prm->abts.fcp_hdr_le.s_id[0];
4994
4995 sess = ha->tgt.tgt_ops->find_sess_by_s_id(vha,
4996 (unsigned char *)&be_s_id);
4997 if (!sess) {
4998 spin_unlock_irqrestore(&ha->hardware_lock, flags);
4999
0e8cd71c 5000 mutex_lock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 5001 sess = qlt_make_local_sess(vha, s_id);
5002 /* sess has got an extra creation ref */
0e8cd71c 5003 mutex_unlock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 5004
5005 spin_lock_irqsave(&ha->hardware_lock, flags);
5006 if (!sess)
5007 goto out_term;
5008 } else {
5009 kref_get(&sess->se_sess->sess_kref);
5010 }
5011
5012 if (tgt->tgt_stop)
5013 goto out_term;
5014
5015 rc = __qlt_24xx_handle_abts(vha, &prm->abts, sess);
5016 if (rc != 0)
5017 goto out_term;
2d70c103
NB		 5018
5019 ha->tgt.tgt_ops->put_sess(sess);
08234e3a 5020 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2d70c103
NB		 5021 return;
5022
5023out_term:
5024 qlt_24xx_send_abts_resp(vha, &prm->abts, FCP_TMF_REJECTED, false);
2d70c103
NB		 5025 if (sess)
5026 ha->tgt.tgt_ops->put_sess(sess);
08234e3a 5027 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2d70c103
NB		 5028}
5029
5030static void qlt_tmr_work(struct qla_tgt *tgt,
5031 struct qla_tgt_sess_work_param *prm)
5032{
5033 struct atio_from_isp *a = &prm->tm_iocb2;
5034 struct scsi_qla_host *vha = tgt->vha;
5035 struct qla_hw_data *ha = vha->hw;
5036 struct qla_tgt_sess *sess = NULL;
5037 unsigned long flags;
5038 uint8_t *s_id = NULL; /* to hide compiler warnings */
5039 int rc;
5040 uint32_t lun, unpacked_lun;
5041 int lun_size, fn;
5042 void *iocb;
5043
5044 spin_lock_irqsave(&ha->hardware_lock, flags);
5045
5046 if (tgt->tgt_stop)
5047 goto out_term;
5048
5049 s_id = prm->tm_iocb2.u.isp24.fcp_hdr.s_id;
5050 sess = ha->tgt.tgt_ops->find_sess_by_s_id(vha, s_id);
5051 if (!sess) {
5052 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5053
0e8cd71c 5054 mutex_lock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 5055 sess = qlt_make_local_sess(vha, s_id);
5056 /* sess has got an extra creation ref */
0e8cd71c 5057 mutex_unlock(&vha->vha_tgt.tgt_mutex);
2d70c103
NB		 5058
5059 spin_lock_irqsave(&ha->hardware_lock, flags);
5060 if (!sess)
5061 goto out_term;
5062 } else {
5063 kref_get(&sess->se_sess->sess_kref);
5064 }
5065
5066 iocb = a;
5067 lun = a->u.isp24.fcp_cmnd.lun;
5068 lun_size = sizeof(lun);
5069 fn = a->u.isp24.fcp_cmnd.task_mgmt_flags;
5070 unpacked_lun = scsilun_to_int((struct scsi_lun *)&lun);
5071
5072 rc = qlt_issue_task_mgmt(sess, unpacked_lun, fn, iocb, 0);
5073 if (rc != 0)
5074 goto out_term;
2d70c103
NB		 5075
5076 ha->tgt.tgt_ops->put_sess(sess);
08234e3a 5077 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2d70c103
NB		 5078 return;
5079
5080out_term:
5081 qlt_send_term_exchange(vha, NULL, &prm->tm_iocb2, 1);
2d70c103
NB		 5082 if (sess)
5083 ha->tgt.tgt_ops->put_sess(sess);
08234e3a 5084 spin_unlock_irqrestore(&ha->hardware_lock, flags);
2d70c103
NB		 5085}
5086
5087static void qlt_sess_work_fn(struct work_struct *work)
5088{
5089 struct qla_tgt *tgt = container_of(work, struct qla_tgt, sess_work);
5090 struct scsi_qla_host *vha = tgt->vha;
5091 unsigned long flags;
5092
5093 ql_dbg(ql_dbg_tgt_mgt, vha, 0xf000, "Sess work (tgt %p)", tgt);
5094
5095 spin_lock_irqsave(&tgt->sess_work_lock, flags);
5096 while (!list_empty(&tgt->sess_works_list)) {
5097 struct qla_tgt_sess_work_param *prm = list_entry(
5098 tgt->sess_works_list.next, typeof(*prm),
5099 sess_works_list_entry);
5100
5101 /*
5102 * This work can be scheduled on several CPUs at time, so we
5103 * must delete the entry to eliminate double processing
5104 */
5105 list_del(&prm->sess_works_list_entry);
5106
5107 spin_unlock_irqrestore(&tgt->sess_work_lock, flags);
5108
5109 switch (prm->type) {
5110 case QLA_TGT_SESS_WORK_ABORT:
5111 qlt_abort_work(tgt, prm);
5112 break;
5113 case QLA_TGT_SESS_WORK_TM:
5114 qlt_tmr_work(tgt, prm);
5115 break;
5116 default:
5117 BUG_ON(1);
5118 break;
5119 }
5120
5121 spin_lock_irqsave(&tgt->sess_work_lock, flags);
5122
5123 kfree(prm);
5124 }
5125 spin_unlock_irqrestore(&tgt->sess_work_lock, flags);
5126}
5127
5128/* Must be called under tgt_host_action_mutex */
5129int qlt_add_target(struct qla_hw_data *ha, struct scsi_qla_host *base_vha)
5130{
5131 struct qla_tgt *tgt;
5132
5133 if (!QLA_TGT_MODE_ENABLED())
5134 return 0;
5135
33c36c0a
AE		 5136 if (!IS_TGT_MODE_CAPABLE(ha)) {
5137 ql_log(ql_log_warn, base_vha, 0xe070,
5138 "This adapter does not support target mode.\n");
5139 return 0;
5140 }
5141
2d70c103 5142 ql_dbg(ql_dbg_tgt, base_vha, 0xe03b,
0e8cd71c 5143 "Registering target for host %ld(%p).\n", base_vha->host_no, ha);
2d70c103 5144
0e8cd71c 5145 BUG_ON(base_vha->vha_tgt.qla_tgt != NULL);
2d70c103
NB		 5146
5147 tgt = kzalloc(sizeof(struct qla_tgt), GFP_KERNEL);
5148 if (!tgt) {
5149 ql_dbg(ql_dbg_tgt, base_vha, 0xe066,
5150 "Unable to allocate struct qla_tgt\n");
5151 return -ENOMEM;
5152 }
5153
5154 if (!(base_vha->host->hostt->supported_mode & MODE_TARGET))
5155 base_vha->host->hostt->supported_mode |= MODE_TARGET;
5156
5157 tgt->ha = ha;
5158 tgt->vha = base_vha;
5159 init_waitqueue_head(&tgt->waitQ);
5160 INIT_LIST_HEAD(&tgt->sess_list);
5161 INIT_LIST_HEAD(&tgt->del_sess_list);
5162 INIT_DELAYED_WORK(&tgt->sess_del_work,
5163 (void (*)(struct work_struct *))qlt_del_sess_work_fn);
5164 spin_lock_init(&tgt->sess_work_lock);
5165 INIT_WORK(&tgt->sess_work, qlt_sess_work_fn);
5166 INIT_LIST_HEAD(&tgt->sess_works_list);
5167 spin_lock_init(&tgt->srr_lock);
5168 INIT_LIST_HEAD(&tgt->srr_ctio_list);
5169 INIT_LIST_HEAD(&tgt->srr_imm_list);
5170 INIT_WORK(&tgt->srr_work, qlt_handle_srr_work);
5171 atomic_set(&tgt->tgt_global_resets_count, 0);
5172
0e8cd71c 5173 base_vha->vha_tgt.qla_tgt = tgt;
2d70c103
NB		 5174
5175 ql_dbg(ql_dbg_tgt, base_vha, 0xe067,
5176 "qla_target(%d): using 64 Bit PCI addressing",
5177 base_vha->vp_idx);
5178 tgt->tgt_enable_64bit_addr = 1;
5179 /* 3 is reserved */
5180 tgt->sg_tablesize = QLA_TGT_MAX_SG_24XX(base_vha->req->length - 3);
5181 tgt->datasegs_per_cmd = QLA_TGT_DATASEGS_PER_CMD_24XX;
5182 tgt->datasegs_per_cont = QLA_TGT_DATASEGS_PER_CONT_24XX;
5183
ddb95145
NB		 5184 if (base_vha->fc_vport)
5185 return 0;
5186
2d70c103
NB		 5187 mutex_lock(&qla_tgt_mutex);
5188 list_add_tail(&tgt->tgt_list_entry, &qla_tgt_glist);
5189 mutex_unlock(&qla_tgt_mutex);
5190
5191 return 0;
5192}
5193
5194/* Must be called under tgt_host_action_mutex */
5195int qlt_remove_target(struct qla_hw_data *ha, struct scsi_qla_host *vha)
5196{
0e8cd71c 5197 if (!vha->vha_tgt.qla_tgt)
2d70c103
NB		 5198 return 0;
5199
ddb95145
NB		 5200 if (vha->fc_vport) {
5201 qlt_release(vha->vha_tgt.qla_tgt);
5202 return 0;
5203 }
33e79977
QT		 5204
5205 /* free left over qfull cmds */
5206 qlt_init_term_exchange(vha);
5207
2d70c103 5208 mutex_lock(&qla_tgt_mutex);
0e8cd71c 5209 list_del(&vha->vha_tgt.qla_tgt->tgt_list_entry);
2d70c103
NB		 5210 mutex_unlock(&qla_tgt_mutex);
5211
5212 ql_dbg(ql_dbg_tgt, vha, 0xe03c, "Unregistering target for host %ld(%p)",
5213 vha->host_no, ha);
0e8cd71c 5214 qlt_release(vha->vha_tgt.qla_tgt);
2d70c103
NB		 5215
5216 return 0;
5217}
5218
5219static void qlt_lport_dump(struct scsi_qla_host *vha, u64 wwpn,
5220 unsigned char *b)
5221{
5222 int i;
5223
5224 pr_debug("qla2xxx HW vha->node_name: ");
5225 for (i = 0; i < WWN_SIZE; i++)
5226 pr_debug("%02x ", vha->node_name[i]);
5227 pr_debug("\n");
5228 pr_debug("qla2xxx HW vha->port_name: ");
5229 for (i = 0; i < WWN_SIZE; i++)
5230 pr_debug("%02x ", vha->port_name[i]);
5231 pr_debug("\n");
5232
5233 pr_debug("qla2xxx passed configfs WWPN: ");
5234 put_unaligned_be64(wwpn, b);
5235 for (i = 0; i < WWN_SIZE; i++)
5236 pr_debug("%02x ", b[i]);
5237 pr_debug("\n");
5238}
5239
5240/**
5241 * qla_tgt_lport_register - register lport with external module
5242 *
5243 * @qla_tgt_ops: Pointer for tcm_qla2xxx qla_tgt_ops
5244 * @wwpn: Passwd FC target WWPN
5245 * @callback: lport initialization callback for tcm_qla2xxx code
5246 * @target_lport_ptr: pointer for tcm_qla2xxx specific lport data
5247 */
49a47f2c
NB		 5248int qlt_lport_register(void *target_lport_ptr, u64 phys_wwpn,
5249 u64 npiv_wwpn, u64 npiv_wwnn,
5250 int (*callback)(struct scsi_qla_host *, void *, u64, u64))
2d70c103
NB		 5251{
5252 struct qla_tgt *tgt;
5253 struct scsi_qla_host *vha;
5254 struct qla_hw_data *ha;
5255 struct Scsi_Host *host;
5256 unsigned long flags;
5257 int rc;
5258 u8 b[WWN_SIZE];
5259
5260 mutex_lock(&qla_tgt_mutex);
5261 list_for_each_entry(tgt, &qla_tgt_glist, tgt_list_entry) {
5262 vha = tgt->vha;
5263 ha = vha->hw;
5264
5265 host = vha->host;
5266 if (!host)
5267 continue;
5268
2d70c103
NB		 5269 if (!(host->hostt->supported_mode & MODE_TARGET))
5270 continue;
5271
5272 spin_lock_irqsave(&ha->hardware_lock, flags);
49a47f2c 5273 if ((!npiv_wwpn || !npiv_wwnn) && host->active_mode & MODE_TARGET) {
2d70c103
NB		 5274 pr_debug("MODE_TARGET already active on qla2xxx(%d)\n",
5275 host->host_no);
5276 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5277 continue;
5278 }
ddb95145
NB		 5279 if (tgt->tgt_stop) {
5280 pr_debug("MODE_TARGET in shutdown on qla2xxx(%d)\n",
5281 host->host_no);
5282 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5283 continue;
5284 }
2d70c103
NB		 5285 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5286
5287 if (!scsi_host_get(host)) {
5288 ql_dbg(ql_dbg_tgt, vha, 0xe068,
5289 "Unable to scsi_host_get() for"
5290 " qla2xxx scsi_host\n");
5291 continue;
5292 }
49a47f2c 5293 qlt_lport_dump(vha, phys_wwpn, b);
2d70c103
NB		 5294
5295 if (memcmp(vha->port_name, b, WWN_SIZE)) {
5296 scsi_host_put(host);
5297 continue;
5298 }
49a47f2c
NB		 5299 rc = (*callback)(vha, target_lport_ptr, npiv_wwpn, npiv_wwnn);
5300 if (rc != 0)
5301 scsi_host_put(host);
5302
ddb95145 5303 mutex_unlock(&qla_tgt_mutex);
2d70c103
NB		 5304 return rc;
5305 }
5306 mutex_unlock(&qla_tgt_mutex);
5307
5308 return -ENODEV;
5309}
5310EXPORT_SYMBOL(qlt_lport_register);
5311
5312/**
5313 * qla_tgt_lport_deregister - Degister lport
5314 *
5315 * @vha: Registered scsi_qla_host pointer
5316 */
5317void qlt_lport_deregister(struct scsi_qla_host *vha)
5318{
5319 struct qla_hw_data *ha = vha->hw;
5320 struct Scsi_Host *sh = vha->host;
5321 /*
5322 * Clear the target_lport_ptr qla_target_template pointer in qla_hw_data
5323 */
0e8cd71c 5324 vha->vha_tgt.target_lport_ptr = NULL;
2d70c103
NB		 5325 ha->tgt.tgt_ops = NULL;
5326 /*
5327 * Release the Scsi_Host reference for the underlying qla2xxx host
5328 */
5329 scsi_host_put(sh);
5330}
5331EXPORT_SYMBOL(qlt_lport_deregister);
5332
5333/* Must be called under HW lock */
55a9066f 5334static void qlt_set_mode(struct scsi_qla_host *vha)
2d70c103
NB		 5335{
5336 struct qla_hw_data *ha = vha->hw;
5337
5338 switch (ql2x_ini_mode) {
5339 case QLA2XXX_INI_MODE_DISABLED:
5340 case QLA2XXX_INI_MODE_EXCLUSIVE:
5341 vha->host->active_mode = MODE_TARGET;
5342 break;
5343 case QLA2XXX_INI_MODE_ENABLED:
5344 vha->host->active_mode |= MODE_TARGET;
5345 break;
5346 default:
5347 break;
5348 }
5349
5350 if (ha->tgt.ini_mode_force_reverse)
5351 qla_reverse_ini_mode(vha);
5352}
5353
5354/* Must be called under HW lock */
55a9066f 5355static void qlt_clear_mode(struct scsi_qla_host *vha)
2d70c103
NB		 5356{
5357 struct qla_hw_data *ha = vha->hw;
5358
5359 switch (ql2x_ini_mode) {
5360 case QLA2XXX_INI_MODE_DISABLED:
5361 vha->host->active_mode = MODE_UNKNOWN;
5362 break;
5363 case QLA2XXX_INI_MODE_EXCLUSIVE:
5364 vha->host->active_mode = MODE_INITIATOR;
5365 break;
5366 case QLA2XXX_INI_MODE_ENABLED:
5367 vha->host->active_mode &= ~MODE_TARGET;
5368 break;
5369 default:
5370 break;
5371 }
5372
5373 if (ha->tgt.ini_mode_force_reverse)
5374 qla_reverse_ini_mode(vha);
5375}
5376
5377/*
5378 * qla_tgt_enable_vha - NO LOCK HELD
5379 *
5380 * host_reset, bring up w/ Target Mode Enabled
5381 */
5382void
5383qlt_enable_vha(struct scsi_qla_host *vha)
5384{
5385 struct qla_hw_data *ha = vha->hw;
0e8cd71c 5386 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103 5387 unsigned long flags;
0e8cd71c 5388 scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);
2d70c103
NB		 5389
5390 if (!tgt) {
5391 ql_dbg(ql_dbg_tgt, vha, 0xe069,
5392 "Unable to locate qla_tgt pointer from"
5393 " struct qla_hw_data\n");
5394 dump_stack();
5395 return;
5396 }
5397
5398 spin_lock_irqsave(&ha->hardware_lock, flags);
5399 tgt->tgt_stopped = 0;
5400 qlt_set_mode(vha);
5401 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5402
0e8cd71c
SK		 5403 if (vha->vp_idx) {
5404 qla24xx_disable_vp(vha);
5405 qla24xx_enable_vp(vha);
5406 } else {
5407 set_bit(ISP_ABORT_NEEDED, &base_vha->dpc_flags);
5408 qla2xxx_wake_dpc(base_vha);
5409 qla2x00_wait_for_hba_online(base_vha);
5410 }
2d70c103
NB		 5411}
5412EXPORT_SYMBOL(qlt_enable_vha);
5413
5414/*
5415 * qla_tgt_disable_vha - NO LOCK HELD
5416 *
5417 * Disable Target Mode and reset the adapter
5418 */
55a9066f 5419static void qlt_disable_vha(struct scsi_qla_host *vha)
2d70c103
NB		 5420{
5421 struct qla_hw_data *ha = vha->hw;
0e8cd71c 5422 struct qla_tgt *tgt = vha->vha_tgt.qla_tgt;
2d70c103
NB		 5423 unsigned long flags;
5424
5425 if (!tgt) {
5426 ql_dbg(ql_dbg_tgt, vha, 0xe06a,
5427 "Unable to locate qla_tgt pointer from"
5428 " struct qla_hw_data\n");
5429 dump_stack();
5430 return;
5431 }
5432
5433 spin_lock_irqsave(&ha->hardware_lock, flags);
5434 qlt_clear_mode(vha);
5435 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5436
5437 set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
5438 qla2xxx_wake_dpc(vha);
5439 qla2x00_wait_for_hba_online(vha);
5440}
5441
5442/*
5443 * Called from qla_init.c:qla24xx_vport_create() contex to setup
5444 * the target mode specific struct scsi_qla_host and struct qla_hw_data
5445 * members.
5446 */
5447void
5448qlt_vport_create(struct scsi_qla_host *vha, struct qla_hw_data *ha)
5449{
5450 if (!qla_tgt_mode_enabled(vha))
5451 return;
5452
0e8cd71c
SK		 5453 vha->vha_tgt.qla_tgt = NULL;
5454
5455 mutex_init(&vha->vha_tgt.tgt_mutex);
5456 mutex_init(&vha->vha_tgt.tgt_host_action_mutex);
2d70c103
NB		 5457
5458 qlt_clear_mode(vha);
5459
5460 /*
5461 * NOTE: Currently the value is kept the same for <24xx and
5462 * >=24xx ISPs. If it is necessary to change it,
5463 * the check should be added for specific ISPs,
5464 * assigning the value appropriately.
5465 */
5466 ha->tgt.atio_q_length = ATIO_ENTRY_CNT_24XX;
0e8cd71c
SK		 5467
5468 qlt_add_target(ha, vha);
2d70c103
NB		 5469}
5470
5471void
5472qlt_rff_id(struct scsi_qla_host *vha, struct ct_sns_req *ct_req)
5473{
5474 /*
5475 * FC-4 Feature bit 0 indicates target functionality to the name server.
5476 */
5477 if (qla_tgt_mode_enabled(vha)) {
5478 if (qla_ini_mode_enabled(vha))
5479 ct_req->req.rff_id.fc4_feature = BIT_0 | BIT_1;
5480 else
5481 ct_req->req.rff_id.fc4_feature = BIT_0;
5482 } else if (qla_ini_mode_enabled(vha)) {
5483 ct_req->req.rff_id.fc4_feature = BIT_1;
5484 }
5485}
5486
5487/*
5488 * qlt_init_atio_q_entries() - Initializes ATIO queue entries.
5489 * @ha: HA context
5490 *
5491 * Beginning of ATIO ring has initialization control block already built
5492 * by nvram config routine.
5493 *
5494 * Returns 0 on success.
5495 */
5496void
5497qlt_init_atio_q_entries(struct scsi_qla_host *vha)
5498{
5499 struct qla_hw_data *ha = vha->hw;
5500 uint16_t cnt;
5501 struct atio_from_isp *pkt = (struct atio_from_isp *)ha->tgt.atio_ring;
5502
5503 if (!qla_tgt_mode_enabled(vha))
5504 return;
5505
5506 for (cnt = 0; cnt < ha->tgt.atio_q_length; cnt++) {
5507 pkt->u.raw.signature = ATIO_PROCESSED;
5508 pkt++;
5509 }
5510
5511}
5512
5513/*
5514 * qlt_24xx_process_atio_queue() - Process ATIO queue entries.
5515 * @ha: SCSI driver HA context
5516 */
5517void
5518qlt_24xx_process_atio_queue(struct scsi_qla_host *vha)
5519{
5520 struct qla_hw_data *ha = vha->hw;
2d70c103
NB		 5521 struct atio_from_isp *pkt;
5522 int cnt, i;
5523
5524 if (!vha->flags.online)
5525 return;
5526
5527 while (ha->tgt.atio_ring_ptr->signature != ATIO_PROCESSED) {
5528 pkt = (struct atio_from_isp *)ha->tgt.atio_ring_ptr;
5529 cnt = pkt->u.raw.entry_count;
5530
5531 qlt_24xx_atio_pkt_all_vps(vha, (struct atio_from_isp *)pkt);
5532
5533 for (i = 0; i < cnt; i++) {
5534 ha->tgt.atio_ring_index++;
5535 if (ha->tgt.atio_ring_index == ha->tgt.atio_q_length) {
5536 ha->tgt.atio_ring_index = 0;
5537 ha->tgt.atio_ring_ptr = ha->tgt.atio_ring;
5538 } else
5539 ha->tgt.atio_ring_ptr++;
5540
5541 pkt->u.raw.signature = ATIO_PROCESSED;
5542 pkt = (struct atio_from_isp *)ha->tgt.atio_ring_ptr;
5543 }
5544 wmb();
5545 }
5546
5547 /* Adjust ring index */
aa230bc5 5548 WRT_REG_DWORD(ISP_ATIO_Q_OUT(vha), ha->tgt.atio_ring_index);
2d70c103
NB		 5549}
5550
5551void
aa230bc5 5552qlt_24xx_config_rings(struct scsi_qla_host *vha)
2d70c103
NB		 5553{
5554 struct qla_hw_data *ha = vha->hw;
aa230bc5
AE		 5555 if (!QLA_TGT_MODE_ENABLED())
5556 return;
2d70c103 5557
aa230bc5
AE		 5558 WRT_REG_DWORD(ISP_ATIO_Q_IN(vha), 0);
5559 WRT_REG_DWORD(ISP_ATIO_Q_OUT(vha), 0);
5560 RD_REG_DWORD(ISP_ATIO_Q_OUT(vha));
5561
5562 if (IS_ATIO_MSIX_CAPABLE(ha)) {
5563 struct qla_msix_entry *msix = &ha->msix_entries[2];
5564 struct init_cb_24xx *icb = (struct init_cb_24xx *)ha->init_cb;
5565
5566 icb->msix_atio = cpu_to_le16(msix->entry);
5567 ql_dbg(ql_dbg_init, vha, 0xf072,
5568 "Registering ICB vector 0x%x for atio que.\n",
5569 msix->entry);
2d70c103
NB		 5570 }
5571}
5572
5573void
5574qlt_24xx_config_nvram_stage1(struct scsi_qla_host *vha, struct nvram_24xx *nv)
5575{
5576 struct qla_hw_data *ha = vha->hw;
5577
5578 if (qla_tgt_mode_enabled(vha)) {
5579 if (!ha->tgt.saved_set) {
5580 /* We save only once */
5581 ha->tgt.saved_exchange_count = nv->exchange_count;
5582 ha->tgt.saved_firmware_options_1 =
5583 nv->firmware_options_1;
5584 ha->tgt.saved_firmware_options_2 =
5585 nv->firmware_options_2;
5586 ha->tgt.saved_firmware_options_3 =
5587 nv->firmware_options_3;
5588 ha->tgt.saved_set = 1;
5589 }
5590
5591 nv->exchange_count = __constant_cpu_to_le16(0xFFFF);
5592
5593 /* Enable target mode */
5594 nv->firmware_options_1 |= __constant_cpu_to_le32(BIT_4);
5595
5596 /* Disable ini mode, if requested */
5597 if (!qla_ini_mode_enabled(vha))
5598 nv->firmware_options_1 |= __constant_cpu_to_le32(BIT_5);
5599
5600 /* Disable Full Login after LIP */
5601 nv->firmware_options_1 &= __constant_cpu_to_le32(~BIT_13);
5602 /* Enable initial LIP */
5603 nv->firmware_options_1 &= __constant_cpu_to_le32(~BIT_9);
d154f350
AE		 5604 if (ql2xtgt_tape_enable)
5605 /* Enable FC Tape support */
5606 nv->firmware_options_2 |= cpu_to_le32(BIT_12);
5607 else
5608 /* Disable FC Tape support */
5609 nv->firmware_options_2 &= cpu_to_le32(~BIT_12);
5610
2d70c103
NB		 5611 /* Disable Full Login after LIP */
5612 nv->host_p &= __constant_cpu_to_le32(~BIT_10);
5613 /* Enable target PRLI control */
5614 nv->firmware_options_2 |= __constant_cpu_to_le32(BIT_14);
5615 } else {
5616 if (ha->tgt.saved_set) {
5617 nv->exchange_count = ha->tgt.saved_exchange_count;
5618 nv->firmware_options_1 =
5619 ha->tgt.saved_firmware_options_1;
5620 nv->firmware_options_2 =
5621 ha->tgt.saved_firmware_options_2;
5622 nv->firmware_options_3 =
5623 ha->tgt.saved_firmware_options_3;
5624 }
5625 return;
5626 }
5627
5628 /* out-of-order frames reassembly */
5629 nv->firmware_options_3 |= BIT_6|BIT_9;
5630
5631 if (ha->tgt.enable_class_2) {
5632 if (vha->flags.init_done)
5633 fc_host_supported_classes(vha->host) =
5634 FC_COS_CLASS2 | FC_COS_CLASS3;
5635
5636 nv->firmware_options_2 |= __constant_cpu_to_le32(BIT_8);
5637 } else {
5638 if (vha->flags.init_done)
5639 fc_host_supported_classes(vha->host) = FC_COS_CLASS3;
5640
5641 nv->firmware_options_2 &= ~__constant_cpu_to_le32(BIT_8);
5642 }
5643}
5644
5645void
5646qlt_24xx_config_nvram_stage2(struct scsi_qla_host *vha,
5647 struct init_cb_24xx *icb)
5648{
5649 struct qla_hw_data *ha = vha->hw;
5650
5651 if (ha->tgt.node_name_set) {
5652 memcpy(icb->node_name, ha->tgt.tgt_node_name, WWN_SIZE);
5653 icb->firmware_options_1 |= __constant_cpu_to_le32(BIT_14);
5654 }
5655}
5656
aa230bc5
AE		 5657void
5658qlt_81xx_config_nvram_stage1(struct scsi_qla_host *vha, struct nvram_81xx *nv)
5659{
5660 struct qla_hw_data *ha = vha->hw;
5661
5662 if (!QLA_TGT_MODE_ENABLED())
5663 return;
5664
5665 if (qla_tgt_mode_enabled(vha)) {
5666 if (!ha->tgt.saved_set) {
5667 /* We save only once */
5668 ha->tgt.saved_exchange_count = nv->exchange_count;
5669 ha->tgt.saved_firmware_options_1 =
5670 nv->firmware_options_1;
5671 ha->tgt.saved_firmware_options_2 =
5672 nv->firmware_options_2;
5673 ha->tgt.saved_firmware_options_3 =
5674 nv->firmware_options_3;
5675 ha->tgt.saved_set = 1;
5676 }
5677
5678 nv->exchange_count = __constant_cpu_to_le16(0xFFFF);
5679
5680 /* Enable target mode */
5681 nv->firmware_options_1 |= __constant_cpu_to_le32(BIT_4);
5682
5683 /* Disable ini mode, if requested */
5684 if (!qla_ini_mode_enabled(vha))
5685 nv->firmware_options_1 |=
5686 __constant_cpu_to_le32(BIT_5);
5687
5688 /* Disable Full Login after LIP */
5689 nv->firmware_options_1 &= __constant_cpu_to_le32(~BIT_13);
5690 /* Enable initial LIP */
5691 nv->firmware_options_1 &= __constant_cpu_to_le32(~BIT_9);
d154f350
AE		 5692 if (ql2xtgt_tape_enable)
5693 /* Enable FC tape support */
5694 nv->firmware_options_2 |= cpu_to_le32(BIT_12);
5695 else
5696 /* Disable FC tape support */
5697 nv->firmware_options_2 &= cpu_to_le32(~BIT_12);
5698
aa230bc5
AE		 5699 /* Disable Full Login after LIP */
5700 nv->host_p &= __constant_cpu_to_le32(~BIT_10);
5701 /* Enable target PRLI control */
5702 nv->firmware_options_2 |= __constant_cpu_to_le32(BIT_14);
5703 } else {
5704 if (ha->tgt.saved_set) {
5705 nv->exchange_count = ha->tgt.saved_exchange_count;
5706 nv->firmware_options_1 =
5707 ha->tgt.saved_firmware_options_1;
5708 nv->firmware_options_2 =
5709 ha->tgt.saved_firmware_options_2;
5710 nv->firmware_options_3 =
5711 ha->tgt.saved_firmware_options_3;
5712 }
5713 return;
5714 }
5715
5716 /* out-of-order frames reassembly */
5717 nv->firmware_options_3 |= BIT_6|BIT_9;
5718
5719 if (ha->tgt.enable_class_2) {
5720 if (vha->flags.init_done)
5721 fc_host_supported_classes(vha->host) =
5722 FC_COS_CLASS2 | FC_COS_CLASS3;
5723
5724 nv->firmware_options_2 |= __constant_cpu_to_le32(BIT_8);
5725 } else {
5726 if (vha->flags.init_done)
5727 fc_host_supported_classes(vha->host) = FC_COS_CLASS3;
5728
5729 nv->firmware_options_2 &= ~__constant_cpu_to_le32(BIT_8);
5730 }
5731}
5732
5733void
5734qlt_81xx_config_nvram_stage2(struct scsi_qla_host *vha,
5735 struct init_cb_81xx *icb)
5736{
5737 struct qla_hw_data *ha = vha->hw;
5738
5739 if (!QLA_TGT_MODE_ENABLED())
5740 return;
5741
5742 if (ha->tgt.node_name_set) {
5743 memcpy(icb->node_name, ha->tgt.tgt_node_name, WWN_SIZE);
5744 icb->firmware_options_1 |= __constant_cpu_to_le32(BIT_14);
5745 }
5746}
5747
5748void
5749qlt_83xx_iospace_config(struct qla_hw_data *ha)
5750{
5751 if (!QLA_TGT_MODE_ENABLED())
5752 return;
5753
5754 ha->msix_count += 1; /* For ATIO Q */
5755}
5756
2d70c103
NB		 5757int
5758qlt_24xx_process_response_error(struct scsi_qla_host *vha,
5759 struct sts_entry_24xx *pkt)
5760{
5761 switch (pkt->entry_type) {
5762 case ABTS_RECV_24XX:
5763 case ABTS_RESP_24XX:
5764 case CTIO_TYPE7:
5765 case NOTIFY_ACK_TYPE:
f83adb61 5766 case CTIO_CRC2:
2d70c103
NB		 5767 return 1;
5768 default:
5769 return 0;
5770 }
5771}
5772
5773void
5774qlt_modify_vp_config(struct scsi_qla_host *vha,
5775 struct vp_config_entry_24xx *vpmod)
5776{
5777 if (qla_tgt_mode_enabled(vha))
5778 vpmod->options_idx1 &= ~BIT_5;
5779 /* Disable ini mode, if requested */
5780 if (!qla_ini_mode_enabled(vha))
5781 vpmod->options_idx1 &= ~BIT_4;
5782}
5783
5784void
5785qlt_probe_one_stage1(struct scsi_qla_host *base_vha, struct qla_hw_data *ha)
5786{
5787 if (!QLA_TGT_MODE_ENABLED())
5788 return;
5789
b20f02e1 5790 if (ha->mqenable || IS_QLA83XX(ha) || IS_QLA27XX(ha)) {
aa230bc5
AE		 5791 ISP_ATIO_Q_IN(base_vha) = &ha->mqiobase->isp25mq.atio_q_in;
5792 ISP_ATIO_Q_OUT(base_vha) = &ha->mqiobase->isp25mq.atio_q_out;
5793 } else {
5794 ISP_ATIO_Q_IN(base_vha) = &ha->iobase->isp24.atio_q_in;
5795 ISP_ATIO_Q_OUT(base_vha) = &ha->iobase->isp24.atio_q_out;
5796 }
5797
0e8cd71c
SK		 5798 mutex_init(&base_vha->vha_tgt.tgt_mutex);
5799 mutex_init(&base_vha->vha_tgt.tgt_host_action_mutex);
2d70c103
NB		 5800 qlt_clear_mode(base_vha);
5801}
5802
aa230bc5
AE		 5803irqreturn_t
5804qla83xx_msix_atio_q(int irq, void *dev_id)
5805{
5806 struct rsp_que *rsp;
5807 scsi_qla_host_t *vha;
5808 struct qla_hw_data *ha;
5809 unsigned long flags;
5810
5811 rsp = (struct rsp_que *) dev_id;
5812 ha = rsp->hw;
5813 vha = pci_get_drvdata(ha->pdev);
5814
5815 spin_lock_irqsave(&ha->hardware_lock, flags);
5816
5817 qlt_24xx_process_atio_queue(vha);
5818 qla24xx_process_response_queue(vha, rsp);
5819
5820 spin_unlock_irqrestore(&ha->hardware_lock, flags);
5821
5822 return IRQ_HANDLED;
5823}
5824
2d70c103
NB		 5825int
5826qlt_mem_alloc(struct qla_hw_data *ha)
5827{
5828 if (!QLA_TGT_MODE_ENABLED())
5829 return 0;
5830
5831 ha->tgt.tgt_vp_map = kzalloc(sizeof(struct qla_tgt_vp_map) *
5832 MAX_MULTI_ID_FABRIC, GFP_KERNEL);
5833 if (!ha->tgt.tgt_vp_map)
5834 return -ENOMEM;
5835
5836 ha->tgt.atio_ring = dma_alloc_coherent(&ha->pdev->dev,
5837 (ha->tgt.atio_q_length + 1) * sizeof(struct atio_from_isp),
5838 &ha->tgt.atio_dma, GFP_KERNEL);
5839 if (!ha->tgt.atio_ring) {
5840 kfree(ha->tgt.tgt_vp_map);
5841 return -ENOMEM;
5842 }
5843 return 0;
5844}
5845
5846void
5847qlt_mem_free(struct qla_hw_data *ha)
5848{
5849 if (!QLA_TGT_MODE_ENABLED())
5850 return;
5851
5852 if (ha->tgt.atio_ring) {
5853 dma_free_coherent(&ha->pdev->dev, (ha->tgt.atio_q_length + 1) *
5854 sizeof(struct atio_from_isp), ha->tgt.atio_ring,
5855 ha->tgt.atio_dma);
5856 }
5857 kfree(ha->tgt.tgt_vp_map);
5858}
5859
5860/* vport_slock to be held by the caller */
5861void
5862qlt_update_vp_map(struct scsi_qla_host *vha, int cmd)
5863{
5864 if (!QLA_TGT_MODE_ENABLED())
5865 return;
5866
5867 switch (cmd) {
5868 case SET_VP_IDX:
5869 vha->hw->tgt.tgt_vp_map[vha->vp_idx].vha = vha;
5870 break;
5871 case SET_AL_PA:
5872 vha->hw->tgt.tgt_vp_map[vha->d_id.b.al_pa].idx = vha->vp_idx;
5873 break;
5874 case RESET_VP_IDX:
5875 vha->hw->tgt.tgt_vp_map[vha->vp_idx].vha = NULL;
5876 break;
5877 case RESET_AL_PA:
5878 vha->hw->tgt.tgt_vp_map[vha->d_id.b.al_pa].idx = 0;
5879 break;
5880 }
5881}
5882
5883static int __init qlt_parse_ini_mode(void)
5884{
5885 if (strcasecmp(qlini_mode, QLA2XXX_INI_MODE_STR_EXCLUSIVE) == 0)
5886 ql2x_ini_mode = QLA2XXX_INI_MODE_EXCLUSIVE;
5887 else if (strcasecmp(qlini_mode, QLA2XXX_INI_MODE_STR_DISABLED) == 0)
5888 ql2x_ini_mode = QLA2XXX_INI_MODE_DISABLED;
5889 else if (strcasecmp(qlini_mode, QLA2XXX_INI_MODE_STR_ENABLED) == 0)
5890 ql2x_ini_mode = QLA2XXX_INI_MODE_ENABLED;
5891 else
5892 return false;
5893
5894 return true;
5895}
5896
5897int __init qlt_init(void)
5898{
5899 int ret;
5900
5901 if (!qlt_parse_ini_mode()) {
5902 ql_log(ql_log_fatal, NULL, 0xe06b,
5903 "qlt_parse_ini_mode() failed\n");
5904 return -EINVAL;
5905 }
5906
5907 if (!QLA_TGT_MODE_ENABLED())
5908 return 0;
5909
2d70c103
NB		 5910 qla_tgt_mgmt_cmd_cachep = kmem_cache_create("qla_tgt_mgmt_cmd_cachep",
5911 sizeof(struct qla_tgt_mgmt_cmd), __alignof__(struct
5912 qla_tgt_mgmt_cmd), 0, NULL);
5913 if (!qla_tgt_mgmt_cmd_cachep) {
5914 ql_log(ql_log_fatal, NULL, 0xe06d,
5915 "kmem_cache_create for qla_tgt_mgmt_cmd_cachep failed\n");
51a07f84 5916 return -ENOMEM;
2d70c103
NB		 5917 }
5918
5919 qla_tgt_mgmt_cmd_mempool = mempool_create(25, mempool_alloc_slab,
5920 mempool_free_slab, qla_tgt_mgmt_cmd_cachep);
5921 if (!qla_tgt_mgmt_cmd_mempool) {
5922 ql_log(ql_log_fatal, NULL, 0xe06e,
5923 "mempool_create for qla_tgt_mgmt_cmd_mempool failed\n");
5924 ret = -ENOMEM;
5925 goto out_mgmt_cmd_cachep;
5926 }
5927
5928 qla_tgt_wq = alloc_workqueue("qla_tgt_wq", 0, 0);
5929 if (!qla_tgt_wq) {
5930 ql_log(ql_log_fatal, NULL, 0xe06f,
5931 "alloc_workqueue for qla_tgt_wq failed\n");
5932 ret = -ENOMEM;
5933 goto out_cmd_mempool;
5934 }
5935 /*
5936 * Return 1 to signal that initiator-mode is being disabled
5937 */
5938 return (ql2x_ini_mode == QLA2XXX_INI_MODE_DISABLED) ? 1 : 0;
5939
5940out_cmd_mempool:
5941 mempool_destroy(qla_tgt_mgmt_cmd_mempool);
5942out_mgmt_cmd_cachep:
5943 kmem_cache_destroy(qla_tgt_mgmt_cmd_cachep);
2d70c103
NB		 5944 return ret;
5945}
5946
5947void qlt_exit(void)
5948{
5949 if (!QLA_TGT_MODE_ENABLED())
5950 return;
5951
5952 destroy_workqueue(qla_tgt_wq);
5953 mempool_destroy(qla_tgt_mgmt_cmd_mempool);
5954 kmem_cache_destroy(qla_tgt_mgmt_cmd_cachep);
2d70c103 5955}
Ubuntu Artful kernel mirror