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