Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    3)  * QLogic iSCSI Offload Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    4)  * Copyright (c) 2016 Cavium Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    5)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    7) #include <linux/blkdev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    8) #include <scsi/scsi_tcq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300    9) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   11) #include "qedi.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   12) #include "qedi_iscsi.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   13) #include "qedi_gbl.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   14) #include "qedi_fw_iscsi.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   15) #include "qedi_fw_scsi.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   17) static int qedi_send_iscsi_tmf(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   18) 			       struct iscsi_task *mtask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   20) void qedi_iscsi_unmap_sg_list(struct qedi_cmd *cmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   21) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   22) 	struct scsi_cmnd *sc = cmd->scsi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   23) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   24) 	if (cmd->io_tbl.sge_valid && sc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   25) 		cmd->io_tbl.sge_valid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   26) 		scsi_dma_unmap(sc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   27) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   28) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   30) static void qedi_process_logout_resp(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   31) 				     union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   32) 				     struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   33) 				     struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   35) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   36) 	struct iscsi_logout_rsp *resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   37) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   38) 	struct iscsi_logout_response_hdr *cqe_logout_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   39) 	struct qedi_cmd *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   41) 	cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   42) 	cqe_logout_response = &cqe->cqe_common.iscsi_hdr.logout_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   43) 	spin_lock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   44) 	resp_hdr = (struct iscsi_logout_rsp *)&qedi_conn->gen_pdu.resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   45) 	memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   46) 	resp_hdr->opcode = cqe_logout_response->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   47) 	resp_hdr->flags = cqe_logout_response->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   48) 	resp_hdr->hlength = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   50) 	resp_hdr->itt = build_itt(cqe->cqe_solicited.itid, conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   51) 	resp_hdr->statsn = cpu_to_be32(cqe_logout_response->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   52) 	resp_hdr->exp_cmdsn = cpu_to_be32(cqe_logout_response->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   53) 	resp_hdr->max_cmdsn = cpu_to_be32(cqe_logout_response->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   55) 	resp_hdr->t2wait = cpu_to_be32(cqe_logout_response->time_2_wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   56) 	resp_hdr->t2retain = cpu_to_be32(cqe_logout_response->time_2_retain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   58) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_TID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   59) 		  "Freeing tid=0x%x for cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   60) 		  cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   62) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   63) 	if (likely(cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   64) 		cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   65) 		list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   66) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   67) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   68) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   69) 			  "Active cmd list node already deleted, tid=0x%x, cid=0x%x, io_cmd_node=%p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   70) 			  cmd->task_id, qedi_conn->iscsi_conn_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   71) 			  &cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   72) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   73) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   75) 	cmd->state = RESPONSE_RECEIVED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   76) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   78) 	spin_unlock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   81) static void qedi_process_text_resp(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   82) 				   union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   83) 				   struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   84) 				   struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   86) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   87) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   88) 	struct e4_iscsi_task_context *task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   89) 	struct iscsi_text_rsp *resp_hdr_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   90) 	struct iscsi_text_response_hdr *cqe_text_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   91) 	struct qedi_cmd *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   92) 	int pld_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   93) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   94) 	cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   95) 	task_ctx = qedi_get_task_mem(&qedi->tasks, cmd->task_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   97) 	cqe_text_response = &cqe->cqe_common.iscsi_hdr.text_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   98) 	spin_lock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   99) 	resp_hdr_ptr =  (struct iscsi_text_rsp *)&qedi_conn->gen_pdu.resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  100) 	memset(resp_hdr_ptr, 0, sizeof(struct iscsi_hdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  101) 	resp_hdr_ptr->opcode = cqe_text_response->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  102) 	resp_hdr_ptr->flags = cqe_text_response->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  103) 	resp_hdr_ptr->hlength = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  105) 	hton24(resp_hdr_ptr->dlength,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  106) 	       (cqe_text_response->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  107) 		ISCSI_TEXT_RESPONSE_HDR_DATA_SEG_LEN_MASK));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  109) 	resp_hdr_ptr->itt = build_itt(cqe->cqe_solicited.itid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  110) 				      conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  111) 	resp_hdr_ptr->ttt = cqe_text_response->ttt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  112) 	resp_hdr_ptr->statsn = cpu_to_be32(cqe_text_response->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  113) 	resp_hdr_ptr->exp_cmdsn = cpu_to_be32(cqe_text_response->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  114) 	resp_hdr_ptr->max_cmdsn = cpu_to_be32(cqe_text_response->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  116) 	pld_len = cqe_text_response->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  117) 		  ISCSI_TEXT_RESPONSE_HDR_DATA_SEG_LEN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  118) 	qedi_conn->gen_pdu.resp_wr_ptr = qedi_conn->gen_pdu.resp_buf + pld_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  120) 	memset(task_ctx, '\0', sizeof(*task_ctx));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  122) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_TID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  123) 		  "Freeing tid=0x%x for cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  124) 		  cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  125) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  126) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  127) 	if (likely(cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  128) 		cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  129) 		list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  130) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  131) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  132) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  133) 			  "Active cmd list node already deleted, tid=0x%x, cid=0x%x, io_cmd_node=%p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  134) 			  cmd->task_id, qedi_conn->iscsi_conn_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  135) 			  &cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  136) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  137) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  138) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  139) 	cmd->state = RESPONSE_RECEIVED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  140) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  141) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr_ptr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  142) 			     qedi_conn->gen_pdu.resp_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  143) 			     (qedi_conn->gen_pdu.resp_wr_ptr -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  144) 			      qedi_conn->gen_pdu.resp_buf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  145) 	spin_unlock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  148) static void qedi_tmf_resp_work(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  149) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  150) 	struct qedi_cmd *qedi_cmd =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  151) 				container_of(work, struct qedi_cmd, tmf_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  152) 	struct qedi_conn *qedi_conn = qedi_cmd->conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  153) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  154) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  155) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  156) 	struct iscsi_tm_rsp *resp_hdr_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  157) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  158) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  159) 	set_bit(QEDI_CONN_FW_CLEANUP, &qedi_conn->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  160) 	resp_hdr_ptr =  (struct iscsi_tm_rsp *)qedi_cmd->tmf_resp_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  162) 	rval = qedi_cleanup_all_io(qedi, qedi_conn, qedi_cmd->task, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  163) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  164) 		goto exit_tmf_resp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  166) 	spin_lock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  167) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr_ptr, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  168) 	spin_unlock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  169) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  170) exit_tmf_resp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  171) 	kfree(resp_hdr_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  172) 	clear_bit(QEDI_CONN_FW_CLEANUP, &qedi_conn->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  175) static void qedi_process_tmf_resp(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  176) 				  union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  177) 				  struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  178) 				  struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  179) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  180) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  181) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  182) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  183) 	struct iscsi_tmf_response_hdr *cqe_tmp_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  184) 	struct iscsi_tm_rsp *resp_hdr_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  185) 	struct iscsi_tm *tmf_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  186) 	struct qedi_cmd *qedi_cmd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  187) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  188) 	cqe_tmp_response = &cqe->cqe_common.iscsi_hdr.tmf_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  189) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  190) 	qedi_cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  191) 	qedi_cmd->tmf_resp_buf = kzalloc(sizeof(*resp_hdr_ptr), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  192) 	if (!qedi_cmd->tmf_resp_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  193) 		QEDI_ERR(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  194) 			 "Failed to allocate resp buf, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  195) 			  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  196) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  197) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  198) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  199) 	spin_lock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  200) 	resp_hdr_ptr =  (struct iscsi_tm_rsp *)qedi_cmd->tmf_resp_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  201) 	memset(resp_hdr_ptr, 0, sizeof(struct iscsi_tm_rsp));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  203) 	/* Fill up the header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  204) 	resp_hdr_ptr->opcode = cqe_tmp_response->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  205) 	resp_hdr_ptr->flags = cqe_tmp_response->hdr_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  206) 	resp_hdr_ptr->response = cqe_tmp_response->hdr_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  207) 	resp_hdr_ptr->hlength = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  209) 	hton24(resp_hdr_ptr->dlength,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  210) 	       (cqe_tmp_response->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  211) 		ISCSI_TMF_RESPONSE_HDR_DATA_SEG_LEN_MASK));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  212) 	resp_hdr_ptr->itt = build_itt(cqe->cqe_solicited.itid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  213) 				      conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  214) 	resp_hdr_ptr->statsn = cpu_to_be32(cqe_tmp_response->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  215) 	resp_hdr_ptr->exp_cmdsn  = cpu_to_be32(cqe_tmp_response->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  216) 	resp_hdr_ptr->max_cmdsn = cpu_to_be32(cqe_tmp_response->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  218) 	tmf_hdr = (struct iscsi_tm *)qedi_cmd->task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  220) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  221) 	if (likely(qedi_cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  222) 		qedi_cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  223) 		list_del_init(&qedi_cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  224) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  225) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  226) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  227) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  228) 	if (((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  229) 	      ISCSI_TM_FUNC_LOGICAL_UNIT_RESET) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  230) 	    ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  231) 	      ISCSI_TM_FUNC_TARGET_WARM_RESET) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  232) 	    ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  233) 	      ISCSI_TM_FUNC_TARGET_COLD_RESET)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  234) 		INIT_WORK(&qedi_cmd->tmf_work, qedi_tmf_resp_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  235) 		queue_work(qedi->tmf_thread, &qedi_cmd->tmf_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  236) 		goto unblock_sess;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  237) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  238) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  239) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr_ptr, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  240) 	kfree(resp_hdr_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  241) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  242) unblock_sess:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  243) 	spin_unlock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  244) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  245) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  246) static void qedi_process_login_resp(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  247) 				    union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  248) 				    struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  249) 				    struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  250) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  251) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  252) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  253) 	struct e4_iscsi_task_context *task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  254) 	struct iscsi_login_rsp *resp_hdr_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  255) 	struct iscsi_login_response_hdr *cqe_login_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  256) 	struct qedi_cmd *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  257) 	int pld_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  258) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  259) 	cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  260) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  261) 	cqe_login_response = &cqe->cqe_common.iscsi_hdr.login_response;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  262) 	task_ctx = qedi_get_task_mem(&qedi->tasks, cmd->task_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  263) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  264) 	spin_lock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  265) 	resp_hdr_ptr =  (struct iscsi_login_rsp *)&qedi_conn->gen_pdu.resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  266) 	memset(resp_hdr_ptr, 0, sizeof(struct iscsi_login_rsp));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  267) 	resp_hdr_ptr->opcode = cqe_login_response->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  268) 	resp_hdr_ptr->flags = cqe_login_response->flags_attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  269) 	resp_hdr_ptr->hlength = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  270) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  271) 	hton24(resp_hdr_ptr->dlength,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  272) 	       (cqe_login_response->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  273) 		ISCSI_LOGIN_RESPONSE_HDR_DATA_SEG_LEN_MASK));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  274) 	resp_hdr_ptr->itt = build_itt(cqe->cqe_solicited.itid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  275) 				      conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  276) 	resp_hdr_ptr->tsih = cqe_login_response->tsih;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  277) 	resp_hdr_ptr->statsn = cpu_to_be32(cqe_login_response->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  278) 	resp_hdr_ptr->exp_cmdsn = cpu_to_be32(cqe_login_response->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  279) 	resp_hdr_ptr->max_cmdsn = cpu_to_be32(cqe_login_response->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  280) 	resp_hdr_ptr->status_class = cqe_login_response->status_class;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  281) 	resp_hdr_ptr->status_detail = cqe_login_response->status_detail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  282) 	pld_len = cqe_login_response->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  283) 		  ISCSI_LOGIN_RESPONSE_HDR_DATA_SEG_LEN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  284) 	qedi_conn->gen_pdu.resp_wr_ptr = qedi_conn->gen_pdu.resp_buf + pld_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  285) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  286) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  287) 	if (likely(cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  288) 		cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  289) 		list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  290) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  291) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  292) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  293) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  294) 	memset(task_ctx, '\0', sizeof(*task_ctx));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  295) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  296) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr_ptr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  297) 			     qedi_conn->gen_pdu.resp_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  298) 			     (qedi_conn->gen_pdu.resp_wr_ptr -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  299) 			     qedi_conn->gen_pdu.resp_buf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  300) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  301) 	spin_unlock(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  302) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_TID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  303) 		  "Freeing tid=0x%x for cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  304) 		  cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  305) 	cmd->state = RESPONSE_RECEIVED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  307) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  308) static void qedi_get_rq_bdq_buf(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  309) 				struct iscsi_cqe_unsolicited *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  310) 				char *ptr, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  311) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  312) 	u16 idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  313) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  314) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  315) 		  "pld_len [%d], bdq_prod_idx [%d], idx [%d]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  316) 		  len, qedi->bdq_prod_idx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  317) 		  (qedi->bdq_prod_idx % qedi->rq_num_entries));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  318) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  319) 	/* Obtain buffer address from rqe_opaque */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  320) 	idx = cqe->rqe_opaque;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  321) 	if (idx > (QEDI_BDQ_NUM - 1)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  322) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  323) 			  "wrong idx %d returned by FW, dropping the unsolicited pkt\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  324) 			  idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  325) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  326) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  327) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  328) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  329) 		  "rqe_opaque [0x%p], idx [%d]\n", cqe->rqe_opaque, idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  330) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  331) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  332) 		  "unsol_cqe_type = %d\n", cqe->unsol_cqe_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  333) 	switch (cqe->unsol_cqe_type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  334) 	case ISCSI_CQE_UNSOLICITED_SINGLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  335) 	case ISCSI_CQE_UNSOLICITED_FIRST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  336) 		if (len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  337) 			memcpy(ptr, (void *)qedi->bdq[idx].buf_addr, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  338) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  339) 	case ISCSI_CQE_UNSOLICITED_MIDDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  340) 	case ISCSI_CQE_UNSOLICITED_LAST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  341) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  342) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  343) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  344) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  345) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  346) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  347) static void qedi_put_rq_bdq_buf(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  348) 				struct iscsi_cqe_unsolicited *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  349) 				int count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  350) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  351) 	u16 idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  352) 	struct scsi_bd *pbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  353) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  354) 	/* Obtain buffer address from rqe_opaque */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  355) 	idx = cqe->rqe_opaque;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  356) 	if (idx > (QEDI_BDQ_NUM - 1)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  357) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  358) 			  "wrong idx %d returned by FW, dropping the unsolicited pkt\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  359) 			  idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  360) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  361) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  362) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  363) 	pbl = (struct scsi_bd *)qedi->bdq_pbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  364) 	pbl += (qedi->bdq_prod_idx % qedi->rq_num_entries);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  365) 	pbl->address.hi = cpu_to_le32(QEDI_U64_HI(qedi->bdq[idx].buf_dma));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  366) 	pbl->address.lo = cpu_to_le32(QEDI_U64_LO(qedi->bdq[idx].buf_dma));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  367) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  368) 		  "pbl [0x%p] pbl->address hi [0x%llx] lo [0x%llx] idx [%d]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  369) 		  pbl, pbl->address.hi, pbl->address.lo, idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  370) 	pbl->opaque.iscsi_opaque.reserved_zero[0] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  371) 	pbl->opaque.iscsi_opaque.reserved_zero[1] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  372) 	pbl->opaque.iscsi_opaque.reserved_zero[2] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  373) 	pbl->opaque.iscsi_opaque.opaque = cpu_to_le32(idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  374) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  375) 	/* Increment producer to let f/w know we've handled the frame */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  376) 	qedi->bdq_prod_idx += count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  377) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  378) 	writew(qedi->bdq_prod_idx, qedi->bdq_primary_prod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  379) 	readw(qedi->bdq_primary_prod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  380) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  381) 	writew(qedi->bdq_prod_idx, qedi->bdq_secondary_prod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  382) 	readw(qedi->bdq_secondary_prod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  384) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  385) static void qedi_unsol_pdu_adjust_bdq(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  386) 				      struct iscsi_cqe_unsolicited *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  387) 				      u32 pdu_len, u32 num_bdqs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  388) 				      char *bdq_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  389) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  390) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  391) 		  "num_bdqs [%d]\n", num_bdqs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  392) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  393) 	qedi_get_rq_bdq_buf(qedi, cqe, bdq_data, pdu_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  394) 	qedi_put_rq_bdq_buf(qedi, cqe, (num_bdqs + 1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  395) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  396) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  397) static int qedi_process_nopin_mesg(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  398) 				   union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  399) 				   struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  400) 				   struct qedi_conn *qedi_conn, u16 que_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  401) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  402) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  403) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  404) 	struct iscsi_nop_in_hdr *cqe_nop_in;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  405) 	struct iscsi_nopin *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  406) 	struct qedi_cmd *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  407) 	int tgt_async_nop = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  408) 	u32 lun[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  409) 	u32 pdu_len, num_bdqs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  410) 	char bdq_data[QEDI_BDQ_BUF_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  411) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  412) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  413) 	spin_lock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  414) 	cqe_nop_in = &cqe->cqe_common.iscsi_hdr.nop_in;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  415) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  416) 	pdu_len = cqe_nop_in->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  417) 		  ISCSI_NOP_IN_HDR_DATA_SEG_LEN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  418) 	num_bdqs = pdu_len / QEDI_BDQ_BUF_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  419) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  420) 	hdr = (struct iscsi_nopin *)&qedi_conn->gen_pdu.resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  421) 	memset(hdr, 0, sizeof(struct iscsi_hdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  422) 	hdr->opcode = cqe_nop_in->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  423) 	hdr->max_cmdsn = cpu_to_be32(cqe_nop_in->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  424) 	hdr->exp_cmdsn = cpu_to_be32(cqe_nop_in->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  425) 	hdr->statsn = cpu_to_be32(cqe_nop_in->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  426) 	hdr->ttt = cpu_to_be32(cqe_nop_in->ttt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  427) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  428) 	if (cqe->cqe_common.cqe_type == ISCSI_CQE_TYPE_UNSOLICITED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  429) 		spin_lock_irqsave(&qedi->hba_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  430) 		qedi_unsol_pdu_adjust_bdq(qedi, &cqe->cqe_unsolicited,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  431) 					  pdu_len, num_bdqs, bdq_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  432) 		hdr->itt = RESERVED_ITT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  433) 		tgt_async_nop = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  434) 		spin_unlock_irqrestore(&qedi->hba_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  435) 		goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  436) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  437) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  438) 	/* Response to one of our nop-outs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  439) 	if (task) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  440) 		cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  441) 		hdr->flags = ISCSI_FLAG_CMD_FINAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  442) 		hdr->itt = build_itt(cqe->cqe_solicited.itid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  443) 				     conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  444) 		lun[0] = 0xffffffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  445) 		lun[1] = 0xffffffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  446) 		memcpy(&hdr->lun, lun, sizeof(struct scsi_lun));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  447) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_TID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  448) 			  "Freeing tid=0x%x for cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  449) 			  cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  450) 		cmd->state = RESPONSE_RECEIVED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  451) 		spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  452) 		if (likely(cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  453) 			cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  454) 			list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  455) 			qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  456) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  457) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  458) 		spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  459) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  460) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  461) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  462) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr, bdq_data, pdu_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  463) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  464) 	spin_unlock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  465) 	return tgt_async_nop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  466) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  467) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  468) static void qedi_process_async_mesg(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  469) 				    union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  470) 				    struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  471) 				    struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  472) 				    u16 que_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  473) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  474) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  475) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  476) 	struct iscsi_async_msg_hdr *cqe_async_msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  477) 	struct iscsi_async *resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  478) 	u32 lun[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  479) 	u32 pdu_len, num_bdqs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  480) 	char bdq_data[QEDI_BDQ_BUF_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  481) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  482) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  483) 	spin_lock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  484) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  485) 	cqe_async_msg = &cqe->cqe_common.iscsi_hdr.async_msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  486) 	pdu_len = cqe_async_msg->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  487) 		ISCSI_ASYNC_MSG_HDR_DATA_SEG_LEN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  488) 	num_bdqs = pdu_len / QEDI_BDQ_BUF_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  489) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  490) 	if (cqe->cqe_common.cqe_type == ISCSI_CQE_TYPE_UNSOLICITED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  491) 		spin_lock_irqsave(&qedi->hba_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  492) 		qedi_unsol_pdu_adjust_bdq(qedi, &cqe->cqe_unsolicited,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  493) 					  pdu_len, num_bdqs, bdq_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  494) 		spin_unlock_irqrestore(&qedi->hba_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  495) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  496) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  497) 	resp_hdr = (struct iscsi_async *)&qedi_conn->gen_pdu.resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  498) 	memset(resp_hdr, 0, sizeof(struct iscsi_hdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  499) 	resp_hdr->opcode = cqe_async_msg->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  500) 	resp_hdr->flags = 0x80;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  501) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  502) 	lun[0] = cpu_to_be32(cqe_async_msg->lun.lo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  503) 	lun[1] = cpu_to_be32(cqe_async_msg->lun.hi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  504) 	memcpy(&resp_hdr->lun, lun, sizeof(struct scsi_lun));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  505) 	resp_hdr->exp_cmdsn = cpu_to_be32(cqe_async_msg->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  506) 	resp_hdr->max_cmdsn = cpu_to_be32(cqe_async_msg->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  507) 	resp_hdr->statsn = cpu_to_be32(cqe_async_msg->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  508) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  509) 	resp_hdr->async_event = cqe_async_msg->async_event;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  510) 	resp_hdr->async_vcode = cqe_async_msg->async_vcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  511) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  512) 	resp_hdr->param1 = cpu_to_be16(cqe_async_msg->param1_rsrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  513) 	resp_hdr->param2 = cpu_to_be16(cqe_async_msg->param2_rsrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  514) 	resp_hdr->param3 = cpu_to_be16(cqe_async_msg->param3_rsrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  515) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  516) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)resp_hdr, bdq_data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  517) 			     pdu_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  518) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  519) 	spin_unlock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  520) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  521) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  522) static void qedi_process_reject_mesg(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  523) 				     union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  524) 				     struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  525) 				     struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  526) 				     uint16_t que_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  527) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  528) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  529) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  530) 	struct iscsi_reject_hdr *cqe_reject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  531) 	struct iscsi_reject *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  532) 	u32 pld_len, num_bdqs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  533) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  534) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  535) 	spin_lock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  536) 	cqe_reject = &cqe->cqe_common.iscsi_hdr.reject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  537) 	pld_len = cqe_reject->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  538) 		  ISCSI_REJECT_HDR_DATA_SEG_LEN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  539) 	num_bdqs = pld_len / QEDI_BDQ_BUF_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  540) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  541) 	if (cqe->cqe_common.cqe_type == ISCSI_CQE_TYPE_UNSOLICITED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  542) 		spin_lock_irqsave(&qedi->hba_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  543) 		qedi_unsol_pdu_adjust_bdq(qedi, &cqe->cqe_unsolicited,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  544) 					  pld_len, num_bdqs, conn->data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  545) 		spin_unlock_irqrestore(&qedi->hba_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  546) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  547) 	hdr = (struct iscsi_reject *)&qedi_conn->gen_pdu.resp_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  548) 	memset(hdr, 0, sizeof(struct iscsi_hdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  549) 	hdr->opcode = cqe_reject->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  550) 	hdr->reason = cqe_reject->hdr_reason;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  551) 	hdr->flags = cqe_reject->hdr_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  552) 	hton24(hdr->dlength, (cqe_reject->hdr_second_dword &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  553) 			      ISCSI_REJECT_HDR_DATA_SEG_LEN_MASK));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  554) 	hdr->max_cmdsn = cpu_to_be32(cqe_reject->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  555) 	hdr->exp_cmdsn = cpu_to_be32(cqe_reject->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  556) 	hdr->statsn = cpu_to_be32(cqe_reject->stat_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  557) 	hdr->ffffffff = cpu_to_be32(0xffffffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  558) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  559) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  560) 			     conn->data, pld_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  561) 	spin_unlock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  562) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  563) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  564) static void qedi_scsi_completion(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  565) 				 union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  566) 				 struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  567) 				 struct iscsi_conn *conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  568) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  569) 	struct scsi_cmnd *sc_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  570) 	struct qedi_cmd *cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  571) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  572) 	struct iscsi_scsi_rsp *hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  573) 	struct iscsi_data_in_hdr *cqe_data_in;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  574) 	int datalen = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  575) 	struct qedi_conn *qedi_conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  576) 	u32 iscsi_cid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  577) 	u8 cqe_err_bits = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  578) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  579) 	iscsi_cid  = cqe->cqe_common.conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  580) 	qedi_conn = qedi->cid_que.conn_cid_tbl[iscsi_cid];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  581) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  582) 	cqe_data_in = &cqe->cqe_common.iscsi_hdr.data_in;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  583) 	cqe_err_bits =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  584) 		cqe->cqe_common.error_bitmap.error_bits.cqe_error_status_bits;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  585) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  586) 	spin_lock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  587) 	/* get the scsi command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  588) 	sc_cmd = cmd->scsi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  589) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  590) 	if (!sc_cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  591) 		QEDI_WARN(&qedi->dbg_ctx, "sc_cmd is NULL!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  592) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  593) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  594) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  595) 	if (!sc_cmd->SCp.ptr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  596) 		QEDI_WARN(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  597) 			  "SCp.ptr is NULL, returned in another context.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  598) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  599) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  600) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  601) 	if (!sc_cmd->request) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  602) 		QEDI_WARN(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  603) 			  "sc_cmd->request is NULL, sc_cmd=%p.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  604) 			  sc_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  605) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  606) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  607) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  608) 	if (!sc_cmd->request->q) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  609) 		QEDI_WARN(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  610) 			  "request->q is NULL so request is not valid, sc_cmd=%p.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  611) 			  sc_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  612) 		goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  613) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  614) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  615) 	qedi_iscsi_unmap_sg_list(cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  616) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  617) 	hdr = (struct iscsi_scsi_rsp *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  618) 	hdr->opcode = cqe_data_in->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  619) 	hdr->max_cmdsn = cpu_to_be32(cqe_data_in->max_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  620) 	hdr->exp_cmdsn = cpu_to_be32(cqe_data_in->exp_cmd_sn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  621) 	hdr->itt = build_itt(cqe->cqe_solicited.itid, conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  622) 	hdr->response = cqe_data_in->reserved1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  623) 	hdr->cmd_status = cqe_data_in->status_rsvd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  624) 	hdr->flags = cqe_data_in->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  625) 	hdr->residual_count = cpu_to_be32(cqe_data_in->residual_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  626) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  627) 	if (hdr->cmd_status == SAM_STAT_CHECK_CONDITION) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  628) 		datalen = cqe_data_in->reserved2 &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  629) 			  ISCSI_COMMON_HDR_DATA_SEG_LEN_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  630) 		memcpy((char *)conn->data, (char *)cmd->sense_buffer, datalen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  631) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  632) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  633) 	/* If f/w reports data underrun err then set residual to IO transfer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  634) 	 * length, set Underrun flag and clear Overrun flag explicitly
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  635) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  636) 	if (unlikely(cqe_err_bits &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  637) 		     GET_FIELD(cqe_err_bits, CQE_ERROR_BITMAP_UNDER_RUN_ERR))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  638) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  639) 			  "Under flow itt=0x%x proto flags=0x%x tid=0x%x cid 0x%x fw resid 0x%x sc dlen 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  640) 			  hdr->itt, cqe_data_in->flags, cmd->task_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  641) 			  qedi_conn->iscsi_conn_id, hdr->residual_count,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  642) 			  scsi_bufflen(sc_cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  643) 		hdr->residual_count = cpu_to_be32(scsi_bufflen(sc_cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  644) 		hdr->flags |= ISCSI_FLAG_CMD_UNDERFLOW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  645) 		hdr->flags &= (~ISCSI_FLAG_CMD_OVERFLOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  646) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  647) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  648) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  649) 	if (likely(cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  650) 		cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  651) 		list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  652) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  653) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  654) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  655) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  656) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_TID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  657) 		  "Freeing tid=0x%x for cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  658) 		  cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  659) 	cmd->state = RESPONSE_RECEIVED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  660) 	if (qedi_io_tracing)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  661) 		qedi_trace_io(qedi, task, cmd->task_id, QEDI_IO_TRACE_RSP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  662) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  663) 	__iscsi_complete_pdu(conn, (struct iscsi_hdr *)hdr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  664) 			     conn->data, datalen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  665) error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  666) 	spin_unlock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  667) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  668) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  669) static void qedi_mtask_completion(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  670) 				  union iscsi_cqe *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  671) 				  struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  672) 				  struct qedi_conn *conn, uint16_t que_idx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  673) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  674) 	struct iscsi_conn *iscsi_conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  675) 	u32 hdr_opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  676) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  677) 	hdr_opcode = cqe->cqe_common.iscsi_hdr.common.hdr_first_byte;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  678) 	iscsi_conn = conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  679) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  680) 	switch (hdr_opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  681) 	case ISCSI_OPCODE_SCSI_RESPONSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  682) 	case ISCSI_OPCODE_DATA_IN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  683) 		qedi_scsi_completion(qedi, cqe, task, iscsi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  684) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  685) 	case ISCSI_OPCODE_LOGIN_RESPONSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  686) 		qedi_process_login_resp(qedi, cqe, task, conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  687) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  688) 	case ISCSI_OPCODE_TMF_RESPONSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  689) 		qedi_process_tmf_resp(qedi, cqe, task, conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  690) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  691) 	case ISCSI_OPCODE_TEXT_RESPONSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  692) 		qedi_process_text_resp(qedi, cqe, task, conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  693) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  694) 	case ISCSI_OPCODE_LOGOUT_RESPONSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  695) 		qedi_process_logout_resp(qedi, cqe, task, conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  696) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  697) 	case ISCSI_OPCODE_NOP_IN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  698) 		qedi_process_nopin_mesg(qedi, cqe, task, conn, que_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  699) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  700) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  701) 		QEDI_ERR(&qedi->dbg_ctx, "unknown opcode\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  702) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  703) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  704) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  705) static void qedi_process_nopin_local_cmpl(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  706) 					  struct iscsi_cqe_solicited *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  707) 					  struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  708) 					  struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  709) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  710) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  711) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  712) 	struct qedi_cmd *cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  713) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  714) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_UNSOL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  715) 		  "itid=0x%x, cmd task id=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  716) 		  cqe->itid, cmd->task_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  717) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  718) 	cmd->state = RESPONSE_RECEIVED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  719) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  720) 	spin_lock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  721) 	__iscsi_put_task(task);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  722) 	spin_unlock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  723) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  724) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  725) static void qedi_process_cmd_cleanup_resp(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  726) 					  struct iscsi_cqe_solicited *cqe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  727) 					  struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  728) 					  struct iscsi_conn *conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  729) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  730) 	struct qedi_work_map *work, *work_tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  731) 	u32 proto_itt = cqe->itid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  732) 	u32 ptmp_itt = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  733) 	itt_t protoitt = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  734) 	int found = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  735) 	struct qedi_cmd *qedi_cmd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  736) 	u32 iscsi_cid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  737) 	struct qedi_conn *qedi_conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  738) 	struct qedi_cmd *dbg_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  739) 	struct iscsi_task *mtask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  740) 	struct iscsi_tm *tmf_hdr = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  741) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  742) 	iscsi_cid = cqe->conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  743) 	qedi_conn = qedi->cid_que.conn_cid_tbl[iscsi_cid];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  744) 	if (!qedi_conn) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  745) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  746) 			  "icid not found 0x%x\n", cqe->conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  747) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  748) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  749) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  750) 	/* Based on this itt get the corresponding qedi_cmd */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  751) 	spin_lock_bh(&qedi_conn->tmf_work_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  752) 	list_for_each_entry_safe(work, work_tmp, &qedi_conn->tmf_work_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  753) 				 list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  754) 		if (work->rtid == proto_itt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  755) 			/* We found the command */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  756) 			qedi_cmd = work->qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  757) 			if (!qedi_cmd->list_tmf_work) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  758) 				QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  759) 					  "TMF work not found, cqe->tid=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  760) 					  proto_itt, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  761) 				WARN_ON(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  762) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  763) 			found = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  764) 			mtask = qedi_cmd->task;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  765) 			tmf_hdr = (struct iscsi_tm *)mtask->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  766) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  767) 			list_del_init(&work->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  768) 			kfree(work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  769) 			qedi_cmd->list_tmf_work = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  770) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  771) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  772) 	spin_unlock_bh(&qedi_conn->tmf_work_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  773) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  774) 	if (found) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  775) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  776) 			  "TMF work, cqe->tid=0x%x, tmf flags=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  777) 			  proto_itt, tmf_hdr->flags, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  778) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  779) 		if ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  780) 		    ISCSI_TM_FUNC_ABORT_TASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  781) 			spin_lock_bh(&conn->session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  782) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  783) 			protoitt = build_itt(get_itt(tmf_hdr->rtt),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  784) 					     conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  785) 			task = iscsi_itt_to_task(conn, protoitt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  786) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  787) 			spin_unlock_bh(&conn->session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  788) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  789) 			if (!task) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  790) 				QEDI_NOTICE(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  791) 					    "IO task completed, tmf rtt=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  792) 					    get_itt(tmf_hdr->rtt),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  793) 					    qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  794) 				return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  795) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  796) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  797) 			dbg_cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  798) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  799) 			QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  800) 				  "Abort tmf rtt=0x%x, i/o itt=0x%x, i/o tid=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  801) 				  get_itt(tmf_hdr->rtt), get_itt(task->itt),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  802) 				  dbg_cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  803) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  804) 			if (qedi_cmd->state == CLEANUP_WAIT_FAILED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  805) 				qedi_cmd->state = CLEANUP_RECV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  806) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  807) 			spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  808) 			if (likely(dbg_cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  809) 				dbg_cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  810) 				list_del_init(&dbg_cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  811) 				qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  812) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  813) 			spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  814) 			qedi_cmd->state = CLEANUP_RECV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  815) 			wake_up_interruptible(&qedi_conn->wait_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  816) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  817) 	} else if (qedi_conn->cmd_cleanup_req > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  818) 		spin_lock_bh(&conn->session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  819) 		qedi_get_proto_itt(qedi, cqe->itid, &ptmp_itt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  820) 		protoitt = build_itt(ptmp_itt, conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  821) 		task = iscsi_itt_to_task(conn, protoitt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  822) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  823) 			  "cleanup io itid=0x%x, protoitt=0x%x, cmd_cleanup_cmpl=%d, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  824) 			  cqe->itid, protoitt, qedi_conn->cmd_cleanup_cmpl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  825) 			  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  826) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  827) 		spin_unlock_bh(&conn->session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  828) 		if (!task) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  829) 			QEDI_NOTICE(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  830) 				    "task is null, itid=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  831) 				    cqe->itid, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  832) 			return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  833) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  834) 		qedi_conn->cmd_cleanup_cmpl++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  835) 		wake_up(&qedi_conn->wait_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  836) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  837) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_TID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  838) 			  "Freeing tid=0x%x for cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  839) 			  cqe->itid, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  840) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  841) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  842) 		qedi_get_proto_itt(qedi, cqe->itid, &ptmp_itt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  843) 		protoitt = build_itt(ptmp_itt, conn->session->age);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  844) 		task = iscsi_itt_to_task(conn, protoitt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  845) 		QEDI_ERR(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  846) 			 "Delayed or untracked cleanup response, itt=0x%x, tid=0x%x, cid=0x%x, task=%p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  847) 			 protoitt, cqe->itid, qedi_conn->iscsi_conn_id, task);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  848) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  849) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  850) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  851) void qedi_fp_process_cqes(struct qedi_work *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  852) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  853) 	struct qedi_ctx *qedi = work->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  854) 	union iscsi_cqe *cqe = &work->cqe;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  855) 	struct iscsi_task *task = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  856) 	struct iscsi_nopout *nopout_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  857) 	struct qedi_conn *q_conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  858) 	struct iscsi_conn *conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  859) 	struct qedi_cmd *qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  860) 	u32 comp_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  861) 	u32 iscsi_cid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  862) 	u32 hdr_opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  863) 	u16 que_idx = work->que_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  864) 	u8 cqe_err_bits = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  865) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  866) 	comp_type = cqe->cqe_common.cqe_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  867) 	hdr_opcode = cqe->cqe_common.iscsi_hdr.common.hdr_first_byte;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  868) 	cqe_err_bits =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  869) 		cqe->cqe_common.error_bitmap.error_bits.cqe_error_status_bits;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  870) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  871) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_CONN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  872) 		  "fw_cid=0x%x, cqe type=0x%x, opcode=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  873) 		  cqe->cqe_common.conn_id, comp_type, hdr_opcode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  874) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  875) 	if (comp_type >= MAX_ISCSI_CQES_TYPE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  876) 		QEDI_WARN(&qedi->dbg_ctx, "Invalid CqE type\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  877) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  878) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  879) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  880) 	iscsi_cid  = cqe->cqe_common.conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  881) 	q_conn = qedi->cid_que.conn_cid_tbl[iscsi_cid];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  882) 	if (!q_conn) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  883) 		QEDI_WARN(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  884) 			  "Session no longer exists for cid=0x%x!!\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  885) 			  iscsi_cid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  886) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  887) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  888) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  889) 	conn = q_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  890) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  891) 	if (unlikely(cqe_err_bits &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  892) 		     GET_FIELD(cqe_err_bits,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  893) 			       CQE_ERROR_BITMAP_DATA_DIGEST_ERR))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  894) 		iscsi_conn_failure(conn, ISCSI_ERR_DATA_DGST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  895) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  896) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  897) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  898) 	switch (comp_type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  899) 	case ISCSI_CQE_TYPE_SOLICITED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  900) 	case ISCSI_CQE_TYPE_SOLICITED_WITH_SENSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  901) 		qedi_cmd = container_of(work, struct qedi_cmd, cqe_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  902) 		task = qedi_cmd->task;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  903) 		if (!task) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  904) 			QEDI_WARN(&qedi->dbg_ctx, "task is NULL\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  905) 			return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  906) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  907) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  908) 		/* Process NOPIN local completion */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  909) 		nopout_hdr = (struct iscsi_nopout *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  910) 		if ((nopout_hdr->itt == RESERVED_ITT) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  911) 		    (cqe->cqe_solicited.itid != (u16)RESERVED_ITT)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  912) 			qedi_process_nopin_local_cmpl(qedi, &cqe->cqe_solicited,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  913) 						      task, q_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  914) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  915) 			cqe->cqe_solicited.itid =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  916) 					       qedi_get_itt(cqe->cqe_solicited);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  917) 			/* Process other solicited responses */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  918) 			qedi_mtask_completion(qedi, cqe, task, q_conn, que_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  919) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  920) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  921) 	case ISCSI_CQE_TYPE_UNSOLICITED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  922) 		switch (hdr_opcode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  923) 		case ISCSI_OPCODE_NOP_IN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  924) 			qedi_process_nopin_mesg(qedi, cqe, task, q_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  925) 						que_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  926) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  927) 		case ISCSI_OPCODE_ASYNC_MSG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  928) 			qedi_process_async_mesg(qedi, cqe, task, q_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  929) 						que_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  930) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  931) 		case ISCSI_OPCODE_REJECT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  932) 			qedi_process_reject_mesg(qedi, cqe, task, q_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  933) 						 que_idx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  934) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  935) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  936) 		goto exit_fp_process;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  937) 	case ISCSI_CQE_TYPE_DUMMY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  938) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM, "Dummy CqE\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  939) 		goto exit_fp_process;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  940) 	case ISCSI_CQE_TYPE_TASK_CLEANUP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  941) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM, "CleanUp CqE\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  942) 		qedi_process_cmd_cleanup_resp(qedi, &cqe->cqe_solicited, task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  943) 					      conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  944) 		goto exit_fp_process;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  945) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  946) 		QEDI_ERR(&qedi->dbg_ctx, "Error cqe.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  947) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  948) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  949) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  950) exit_fp_process:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  951) 	return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  952) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  953) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  954) static void qedi_ring_doorbell(struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  955) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  956) 	struct iscsi_db_data dbell = { 0 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  957) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  958) 	dbell.agg_flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  959) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  960) 	dbell.params |= DB_DEST_XCM << ISCSI_DB_DATA_DEST_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  961) 	dbell.params |= DB_AGG_CMD_SET << ISCSI_DB_DATA_AGG_CMD_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  962) 	dbell.params |=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  963) 		   DQ_XCM_ISCSI_SQ_PROD_CMD << ISCSI_DB_DATA_AGG_VAL_SEL_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  964) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  965) 	dbell.sq_prod = qedi_conn->ep->fw_sq_prod_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  966) 	writel(*(u32 *)&dbell, qedi_conn->ep->p_doorbell);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  967) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  968) 	/* Make sure fw write idx is coherent, and include both memory barriers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  969) 	 * as a failsafe as for some architectures the call is the same but on
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  970) 	 * others they are two different assembly operations.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  971) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  972) 	wmb();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  973) 	QEDI_INFO(&qedi_conn->qedi->dbg_ctx, QEDI_LOG_MP_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  974) 		  "prod_idx=0x%x, fw_prod_idx=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  975) 		  qedi_conn->ep->sq_prod_idx, qedi_conn->ep->fw_sq_prod_idx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  976) 		  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  977) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  978) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  979) static u16 qedi_get_wqe_idx(struct qedi_conn *qedi_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  980) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  981) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  982) 	u16 rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  983) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  984) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  985) 	rval = ep->sq_prod_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  986) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  987) 	/* Increament SQ index */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  988) 	ep->sq_prod_idx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  989) 	ep->fw_sq_prod_idx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  990) 	if (ep->sq_prod_idx == QEDI_SQ_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  991) 		ep->sq_prod_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  992) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  993) 	return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  994) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  995) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  996) int qedi_send_iscsi_login(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  997) 			  struct iscsi_task *task)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  998) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  999) 	struct iscsi_login_req_hdr login_req_pdu_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) 	struct scsi_sgl_task_params tx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001) 	struct scsi_sgl_task_params rx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) 	struct e4_iscsi_task_context *fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) 	struct iscsi_login_req *login_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) 	struct scsi_sge *resp_sge = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007) 	struct qedi_cmd *qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) 	resp_sge = (struct scsi_sge *)qedi_conn->gen_pdu.resp_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) 	qedi_cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) 	login_hdr = (struct iscsi_login_req *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) 	if (tid == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) 	fw_task_ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023) 	     (struct e4_iscsi_task_context *)qedi_get_task_mem(&qedi->tasks,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) 							       tid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) 	memset(fw_task_ctx, 0, sizeof(struct e4_iscsi_task_context));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) 	qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) 	memset(&login_req_pdu_header, 0, sizeof(login_req_pdu_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031) 	memset(&tx_sgl_task_params, 0, sizeof(tx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032) 	memset(&rx_sgl_task_params, 0, sizeof(rx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) 	/* Update header info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) 	login_req_pdu_header.opcode = login_hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) 	login_req_pdu_header.version_min = login_hdr->min_version;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) 	login_req_pdu_header.version_max = login_hdr->max_version;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037) 	login_req_pdu_header.flags_attr = login_hdr->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) 	login_req_pdu_header.isid_tabc = swab32p((u32 *)login_hdr->isid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) 	login_req_pdu_header.isid_d = swab16p((u16 *)&login_hdr->isid[4]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) 	login_req_pdu_header.tsih = login_hdr->tsih;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) 	login_req_pdu_header.hdr_second_dword = ntoh24(login_hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044) 	qedi_update_itt_map(qedi, tid, task->itt, qedi_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045) 	login_req_pdu_header.itt = qedi_set_itt(tid, get_itt(task->itt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) 	login_req_pdu_header.cid = qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) 	login_req_pdu_header.cmd_sn = be32_to_cpu(login_hdr->cmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) 	login_req_pdu_header.exp_stat_sn = be32_to_cpu(login_hdr->exp_statsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049) 	login_req_pdu_header.exp_stat_sn = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) 	/* Fill tx AHS and rx buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052) 	tx_sgl_task_params.sgl =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) 			       (struct scsi_sge *)qedi_conn->gen_pdu.req_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054) 	tx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055) 					 (u32)(qedi_conn->gen_pdu.req_dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) 	tx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) 			      (u32)((u64)qedi_conn->gen_pdu.req_dma_addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) 	tx_sgl_task_params.total_buffer_size = ntoh24(login_hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059) 	tx_sgl_task_params.num_sges = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061) 	rx_sgl_task_params.sgl =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) 			      (struct scsi_sge *)qedi_conn->gen_pdu.resp_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) 	rx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064) 					(u32)(qedi_conn->gen_pdu.resp_dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) 	rx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) 			     (u32)((u64)qedi_conn->gen_pdu.resp_dma_addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) 	rx_sgl_task_params.total_buffer_size = resp_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068) 	rx_sgl_task_params.num_sges = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) 	/* Fill fw input params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071) 	task_params.context = fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072) 	task_params.conn_icid = (u16)qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) 	task_params.itid = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074) 	task_params.cq_rss_number = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075) 	task_params.tx_io_size = ntoh24(login_hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076) 	task_params.rx_io_size = resp_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082) 	rval = init_initiator_login_request_task(&task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083) 						 &login_req_pdu_header,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) 						 &tx_sgl_task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085) 						 &rx_sgl_task_params);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090) 	list_add_tail(&qedi_cmd->io_cmd, &qedi_conn->active_cmd_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) 	qedi_cmd->io_cmd_in_list = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) 	qedi_conn->active_cmd_count++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) int qedi_send_iscsi_logout(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100) 			   struct iscsi_task *task)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) 	struct iscsi_logout_req_hdr logout_pdu_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) 	struct scsi_sgl_task_params tx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104) 	struct scsi_sgl_task_params rx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) 	struct e4_iscsi_task_context *fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107) 	struct iscsi_logout *logout_hdr = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) 	struct qedi_cmd *qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) 	qedi_cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) 	logout_hdr = (struct iscsi_logout *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) 	if (tid == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) 	fw_task_ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) 	     (struct e4_iscsi_task_context *)qedi_get_task_mem(&qedi->tasks,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) 							       tid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) 	memset(fw_task_ctx, 0, sizeof(struct e4_iscsi_task_context));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128) 	qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) 	memset(&logout_pdu_header, 0, sizeof(logout_pdu_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) 	memset(&tx_sgl_task_params, 0, sizeof(tx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133) 	memset(&rx_sgl_task_params, 0, sizeof(rx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) 	/* Update header info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) 	logout_pdu_header.opcode = logout_hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137) 	logout_pdu_header.reason_code = 0x80 | logout_hdr->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138) 	qedi_update_itt_map(qedi, tid, task->itt, qedi_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139) 	logout_pdu_header.itt = qedi_set_itt(tid, get_itt(task->itt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) 	logout_pdu_header.exp_stat_sn = be32_to_cpu(logout_hdr->exp_statsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) 	logout_pdu_header.cmd_sn = be32_to_cpu(logout_hdr->cmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) 	logout_pdu_header.cid = qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) 	/* Fill fw input params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) 	task_params.context = fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) 	task_params.conn_icid = (u16)qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) 	task_params.itid = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) 	task_params.cq_rss_number = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) 	task_params.tx_io_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150) 	task_params.rx_io_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) 	rval = init_initiator_logout_request_task(&task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) 						  &logout_pdu_header,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) 						  NULL, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) 	list_add_tail(&qedi_cmd->io_cmd, &qedi_conn->active_cmd_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164) 	qedi_cmd->io_cmd_in_list = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) 	qedi_conn->active_cmd_count++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172) int qedi_cleanup_all_io(struct qedi_ctx *qedi, struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173) 			struct iscsi_task *task, bool in_recovery)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) 	int rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) 	struct iscsi_task *ctask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) 	struct qedi_cmd *cmd, *cmd_tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) 	struct iscsi_tm *tmf_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) 	unsigned int lun = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) 	bool lun_reset = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184) 	/* From recovery, task is NULL or from tmf resp valid task */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) 	if (task) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186) 		tmf_hdr = (struct iscsi_tm *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) 		if ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) 			ISCSI_TM_FUNC_LOGICAL_UNIT_RESET) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) 			lun_reset = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) 			lun = scsilun_to_int(&tmf_hdr->lun);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) 	qedi_conn->cmd_cleanup_req = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) 	qedi_conn->cmd_cleanup_cmpl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199) 		  "active_cmd_count=%d, cid=0x%x, in_recovery=%d, lun_reset=%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200) 		  qedi_conn->active_cmd_count, qedi_conn->iscsi_conn_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) 		  in_recovery, lun_reset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) 	if (lun_reset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) 		spin_lock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) 	list_for_each_entry_safe(cmd, cmd_tmp, &qedi_conn->active_cmd_list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) 				 io_cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) 		ctask = cmd->task;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) 		if (ctask == task)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) 		if (lun_reset) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) 			if (cmd->scsi_cmd && cmd->scsi_cmd->device) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) 				QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217) 					  "tid=0x%x itt=0x%x scsi_cmd_ptr=%p device=%p task_state=%d cmd_state=0%x cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) 					  cmd->task_id, get_itt(ctask->itt),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) 					  cmd->scsi_cmd, cmd->scsi_cmd->device,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) 					  ctask->state, cmd->state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) 					  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) 				if (cmd->scsi_cmd->device->lun != lun)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) 					continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226) 		qedi_conn->cmd_cleanup_req++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227) 		qedi_iscsi_cleanup_task(ctask, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) 		cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) 		list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232) 		QEDI_WARN(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) 			  "Deleted active cmd list node io_cmd=%p, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) 			  &cmd->io_cmd, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) 	if (lun_reset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) 		spin_unlock_bh(&session->back_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) 		  "cmd_cleanup_req=%d, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) 		  qedi_conn->cmd_cleanup_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) 		  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247) 	rval  = wait_event_interruptible_timeout(qedi_conn->wait_queue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) 						 ((qedi_conn->cmd_cleanup_req ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) 						 qedi_conn->cmd_cleanup_cmpl) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250) 						 test_bit(QEDI_IN_RECOVERY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) 							  &qedi->flags)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) 						 5 * HZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) 	if (rval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) 			  "i/o cmd_cleanup_req=%d, equal to cmd_cleanup_cmpl=%d, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256) 			  qedi_conn->cmd_cleanup_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) 			  qedi_conn->cmd_cleanup_cmpl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) 			  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) 		  "i/o cmd_cleanup_req=%d, not equal to cmd_cleanup_cmpl=%d, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265) 		  qedi_conn->cmd_cleanup_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) 		  qedi_conn->cmd_cleanup_cmpl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267) 		  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) 	iscsi_host_for_each_session(qedi->shost,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270) 				    qedi_mark_device_missing);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) 	qedi_ops->common->drain(qedi->cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) 	/* Enable IOs for all other sessions except current.*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) 	if (!wait_event_interruptible_timeout(qedi_conn->wait_queue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) 					      (qedi_conn->cmd_cleanup_req ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276) 					       qedi_conn->cmd_cleanup_cmpl) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) 					       test_bit(QEDI_IN_RECOVERY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) 							&qedi->flags),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279) 					      5 * HZ)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) 		iscsi_host_for_each_session(qedi->shost,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) 					    qedi_mark_device_available);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) 	iscsi_host_for_each_session(qedi->shost,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) 				    qedi_mark_device_available);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291) void qedi_clearsq(struct qedi_ctx *qedi, struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292) 		  struct iscsi_task *task)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294) 	struct qedi_endpoint *qedi_ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) 	int rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) 	qedi_ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298) 	qedi_conn->cmd_cleanup_req = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) 	qedi_conn->cmd_cleanup_cmpl = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1301) 	if (!qedi_ep) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1302) 		QEDI_WARN(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1303) 			  "Cannot proceed, ep already disconnected, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1304) 			  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1305) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1306) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1307) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1308) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1309) 		  "Clearing SQ for cid=0x%x, conn=%p, ep=%p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1310) 		  qedi_conn->iscsi_conn_id, qedi_conn, qedi_ep);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1311) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1312) 	qedi_ops->clear_sq(qedi->cdev, qedi_ep->handle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1313) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1314) 	rval = qedi_cleanup_all_io(qedi, qedi_conn, task, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1315) 	if (rval) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1316) 		QEDI_ERR(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1317) 			 "fatal error, need hard reset, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1318) 			 qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1319) 		WARN_ON(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1320) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1321) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1323) static int qedi_wait_for_cleanup_request(struct qedi_ctx *qedi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1324) 					 struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1325) 					 struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1326) 					 struct qedi_cmd *qedi_cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1327) 					 struct qedi_work_map *list_work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1328) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1329) 	struct qedi_cmd *cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1330) 	int wait;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1331) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1332) 	wait  = wait_event_interruptible_timeout(qedi_conn->wait_queue,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1333) 						 ((qedi_cmd->state ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1334) 						   CLEANUP_RECV) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1335) 						 ((qedi_cmd->type == TYPEIO) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1336) 						  (cmd->state ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1337) 						   RESPONSE_RECEIVED))),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1338) 						 5 * HZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1339) 	if (!wait) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1340) 		qedi_cmd->state = CLEANUP_WAIT_FAILED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1341) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1342) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1343) 			  "Cleanup timedout tid=0x%x, issue connection recovery, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1344) 			  cmd->task_id, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1345) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1346) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1347) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1348) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1349) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1350) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1351) static void qedi_tmf_work(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1352) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1353) 	struct qedi_cmd *qedi_cmd =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1354) 		container_of(work, struct qedi_cmd, tmf_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1355) 	struct qedi_conn *qedi_conn = qedi_cmd->conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1356) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1357) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1358) 	struct qedi_work_map *list_work = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1359) 	struct iscsi_task *mtask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1360) 	struct qedi_cmd *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1361) 	struct iscsi_task *ctask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1362) 	struct iscsi_tm *tmf_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1363) 	s16 rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1364) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1365) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1366) 	mtask = qedi_cmd->task;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1367) 	tmf_hdr = (struct iscsi_tm *)mtask->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1368) 	set_bit(QEDI_CONN_FW_CLEANUP, &qedi_conn->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1369) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1370) 	ctask = iscsi_itt_to_task(conn, tmf_hdr->rtt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1371) 	if (!ctask || !ctask->sc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1372) 		QEDI_ERR(&qedi->dbg_ctx, "Task already completed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1373) 		goto abort_ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1374) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1375) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1376) 	cmd = (struct qedi_cmd *)ctask->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1377) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1378) 		  "Abort tmf rtt=0x%x, cmd itt=0x%x, cmd tid=0x%x, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1379) 		  get_itt(tmf_hdr->rtt), get_itt(ctask->itt), cmd->task_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1380) 		  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1381) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1382) 	if (qedi_do_not_recover) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1383) 		QEDI_ERR(&qedi->dbg_ctx, "DONT SEND CLEANUP/ABORT %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1384) 			 qedi_do_not_recover);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1385) 		goto abort_ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1386) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1387) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1388) 	list_work = kzalloc(sizeof(*list_work), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1389) 	if (!list_work) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1390) 		QEDI_ERR(&qedi->dbg_ctx, "Memory allocation failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1391) 		goto abort_ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1392) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1393) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1394) 	qedi_cmd->type = TYPEIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1395) 	list_work->qedi_cmd = qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1396) 	list_work->rtid = cmd->task_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1397) 	list_work->state = QEDI_WORK_SCHEDULED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1398) 	qedi_cmd->list_tmf_work = list_work;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1399) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1400) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1401) 		  "Queue tmf work=%p, list node=%p, cid=0x%x, tmf flags=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1402) 		  list_work->ptr_tmf_work, list_work, qedi_conn->iscsi_conn_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1403) 		  tmf_hdr->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1404) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1405) 	spin_lock_bh(&qedi_conn->tmf_work_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1406) 	list_add_tail(&list_work->list, &qedi_conn->tmf_work_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1407) 	spin_unlock_bh(&qedi_conn->tmf_work_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1408) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1409) 	qedi_iscsi_cleanup_task(ctask, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1410) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1411) 	rval = qedi_wait_for_cleanup_request(qedi, qedi_conn, ctask, qedi_cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1412) 					     list_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1413) 	if (rval == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1414) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_INFO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1415) 			  "FW cleanup got escalated, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1416) 			  qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1417) 		goto ldel_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1418) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1419) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1420) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1421) 	if (tid == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1422) 		QEDI_ERR(&qedi->dbg_ctx, "Invalid tid, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1423) 			 qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1424) 		goto ldel_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1425) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1426) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1427) 	qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1428) 	qedi_send_iscsi_tmf(qedi_conn, qedi_cmd->task);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1429) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1430) abort_ret:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1431) 	clear_bit(QEDI_CONN_FW_CLEANUP, &qedi_conn->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1432) 	return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1433) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1434) ldel_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1435) 	spin_lock_bh(&qedi_conn->tmf_work_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1436) 	if (qedi_cmd->list_tmf_work) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1437) 		list_del_init(&list_work->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1438) 		qedi_cmd->list_tmf_work = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1439) 		kfree(list_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1440) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1441) 	spin_unlock_bh(&qedi_conn->tmf_work_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1442) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1443) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1444) 	if (likely(cmd->io_cmd_in_list)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1445) 		cmd->io_cmd_in_list = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1446) 		list_del_init(&cmd->io_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1447) 		qedi_conn->active_cmd_count--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1448) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1449) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1450) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1451) 	clear_bit(QEDI_CONN_FW_CLEANUP, &qedi_conn->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1452) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1453) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1454) static int qedi_send_iscsi_tmf(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1455) 			       struct iscsi_task *mtask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1456) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1457) 	struct iscsi_tmf_request_hdr tmf_pdu_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1458) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1459) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1460) 	struct e4_iscsi_task_context *fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1461) 	struct iscsi_conn *conn = qedi_conn->cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1462) 	struct iscsi_task *ctask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1463) 	struct iscsi_tm *tmf_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1464) 	struct qedi_cmd *qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1465) 	struct qedi_cmd *cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1466) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1467) 	u32 scsi_lun[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1468) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1469) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1470) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1471) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1472) 	tmf_hdr = (struct iscsi_tm *)mtask->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1473) 	qedi_cmd = (struct qedi_cmd *)mtask->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1474) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1475) 	if (!ep)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1476) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1477) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1478) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1479) 	if (tid == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1480) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1481) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1482) 	fw_task_ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1483) 	     (struct e4_iscsi_task_context *)qedi_get_task_mem(&qedi->tasks,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1484) 							       tid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1485) 	memset(fw_task_ctx, 0, sizeof(struct e4_iscsi_task_context));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1486) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1487) 	qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1488) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1489) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1490) 	memset(&tmf_pdu_header, 0, sizeof(tmf_pdu_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1491) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1492) 	/* Update header info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1493) 	qedi_update_itt_map(qedi, tid, mtask->itt, qedi_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1494) 	tmf_pdu_header.itt = qedi_set_itt(tid, get_itt(mtask->itt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1495) 	tmf_pdu_header.cmd_sn = be32_to_cpu(tmf_hdr->cmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1496) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1497) 	memcpy(scsi_lun, &tmf_hdr->lun, sizeof(struct scsi_lun));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1498) 	tmf_pdu_header.lun.lo = be32_to_cpu(scsi_lun[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1499) 	tmf_pdu_header.lun.hi = be32_to_cpu(scsi_lun[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1500) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1501) 	if ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1502) 	     ISCSI_TM_FUNC_ABORT_TASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1503) 		ctask = iscsi_itt_to_task(conn, tmf_hdr->rtt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1504) 		if (!ctask || !ctask->sc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1505) 			QEDI_ERR(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1506) 				 "Could not get reference task\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1507) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1508) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1509) 		cmd = (struct qedi_cmd *)ctask->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1510) 		tmf_pdu_header.rtt =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1511) 				qedi_set_itt(cmd->task_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1512) 					     get_itt(tmf_hdr->rtt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1513) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1514) 		tmf_pdu_header.rtt = ISCSI_RESERVED_TAG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1515) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1516) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1517) 	tmf_pdu_header.opcode = tmf_hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1518) 	tmf_pdu_header.function = tmf_hdr->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1519) 	tmf_pdu_header.hdr_second_dword = ntoh24(tmf_hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1520) 	tmf_pdu_header.ref_cmd_sn = be32_to_cpu(tmf_hdr->refcmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1521) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1522) 	/* Fill fw input params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1523) 	task_params.context = fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1524) 	task_params.conn_icid = (u16)qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1525) 	task_params.itid = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1526) 	task_params.cq_rss_number = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1527) 	task_params.tx_io_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1528) 	task_params.rx_io_size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1529) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1530) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1531) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1532) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1533) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1534) 	rval = init_initiator_tmf_request_task(&task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1535) 					       &tmf_pdu_header);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1536) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1537) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1538) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1539) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1540) 	list_add_tail(&qedi_cmd->io_cmd, &qedi_conn->active_cmd_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1541) 	qedi_cmd->io_cmd_in_list = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1542) 	qedi_conn->active_cmd_count++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1543) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1544) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1545) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1546) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1547) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1548) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1549) int qedi_iscsi_abort_work(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1550) 			  struct iscsi_task *mtask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1551) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1552) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1553) 	struct iscsi_tm *tmf_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1554) 	struct qedi_cmd *qedi_cmd = (struct qedi_cmd *)mtask->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1555) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1556) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1557) 	tmf_hdr = (struct iscsi_tm *)mtask->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1558) 	qedi_cmd->task = mtask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1559) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1560) 	/* If abort task then schedule the work and return */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1561) 	if ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1562) 	    ISCSI_TM_FUNC_ABORT_TASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1563) 		qedi_cmd->state = CLEANUP_WAIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1564) 		INIT_WORK(&qedi_cmd->tmf_work, qedi_tmf_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1565) 		queue_work(qedi->tmf_thread, &qedi_cmd->tmf_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1566) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1567) 	} else if (((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1568) 		    ISCSI_TM_FUNC_LOGICAL_UNIT_RESET) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1569) 		   ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1570) 		    ISCSI_TM_FUNC_TARGET_WARM_RESET) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1571) 		   ((tmf_hdr->flags & ISCSI_FLAG_TM_FUNC_MASK) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1572) 		    ISCSI_TM_FUNC_TARGET_COLD_RESET)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1573) 		tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1574) 		if (tid == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1575) 			QEDI_ERR(&qedi->dbg_ctx, "Invalid tid, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1576) 				 qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1577) 			return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1578) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1579) 		qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1580) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1581) 		qedi_send_iscsi_tmf(qedi_conn, qedi_cmd->task);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1582) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1583) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1584) 		QEDI_ERR(&qedi->dbg_ctx, "Invalid tmf, cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1585) 			 qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1586) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1587) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1588) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1589) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1590) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1591) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1592) int qedi_send_iscsi_text(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1593) 			 struct iscsi_task *task)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1594) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1595) 	struct iscsi_text_request_hdr text_request_pdu_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1596) 	struct scsi_sgl_task_params tx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1597) 	struct scsi_sgl_task_params rx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1598) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1599) 	struct e4_iscsi_task_context *fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1600) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1601) 	struct iscsi_text *text_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1602) 	struct scsi_sge *req_sge = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1603) 	struct scsi_sge *resp_sge = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1604) 	struct qedi_cmd *qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1605) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1606) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1607) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1608) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1609) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1610) 	req_sge = (struct scsi_sge *)qedi_conn->gen_pdu.req_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1611) 	resp_sge = (struct scsi_sge *)qedi_conn->gen_pdu.resp_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1612) 	qedi_cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1613) 	text_hdr = (struct iscsi_text *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1614) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1615) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1616) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1617) 	if (tid == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1618) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1619) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1620) 	fw_task_ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1621) 	     (struct e4_iscsi_task_context *)qedi_get_task_mem(&qedi->tasks,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1622) 							       tid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1623) 	memset(fw_task_ctx, 0, sizeof(struct e4_iscsi_task_context));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1624) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1625) 	qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1626) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1627) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1628) 	memset(&text_request_pdu_header, 0, sizeof(text_request_pdu_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1629) 	memset(&tx_sgl_task_params, 0, sizeof(tx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1630) 	memset(&rx_sgl_task_params, 0, sizeof(rx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1631) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1632) 	/* Update header info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1633) 	text_request_pdu_header.opcode = text_hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1634) 	text_request_pdu_header.flags_attr = text_hdr->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1635) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1636) 	qedi_update_itt_map(qedi, tid, task->itt, qedi_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1637) 	text_request_pdu_header.itt = qedi_set_itt(tid, get_itt(task->itt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1638) 	text_request_pdu_header.ttt = text_hdr->ttt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1639) 	text_request_pdu_header.cmd_sn = be32_to_cpu(text_hdr->cmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1640) 	text_request_pdu_header.exp_stat_sn = be32_to_cpu(text_hdr->exp_statsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1641) 	text_request_pdu_header.hdr_second_dword = ntoh24(text_hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1642) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1643) 	/* Fill tx AHS and rx buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1644) 	tx_sgl_task_params.sgl =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1645) 			       (struct scsi_sge *)qedi_conn->gen_pdu.req_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1646) 	tx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1647) 					 (u32)(qedi_conn->gen_pdu.req_dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1648) 	tx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1649) 			      (u32)((u64)qedi_conn->gen_pdu.req_dma_addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1650) 	tx_sgl_task_params.total_buffer_size = req_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1651) 	tx_sgl_task_params.num_sges = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1652) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1653) 	rx_sgl_task_params.sgl =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1654) 			      (struct scsi_sge *)qedi_conn->gen_pdu.resp_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1655) 	rx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1656) 					(u32)(qedi_conn->gen_pdu.resp_dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1657) 	rx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1658) 			     (u32)((u64)qedi_conn->gen_pdu.resp_dma_addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1659) 	rx_sgl_task_params.total_buffer_size = resp_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1660) 	rx_sgl_task_params.num_sges = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1661) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1662) 	/* Fill fw input params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1663) 	task_params.context = fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1664) 	task_params.conn_icid = (u16)qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1665) 	task_params.itid = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1666) 	task_params.cq_rss_number = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1667) 	task_params.tx_io_size = ntoh24(text_hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1668) 	task_params.rx_io_size = resp_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1669) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1670) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1671) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1672) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1673) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1674) 	rval = init_initiator_text_request_task(&task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1675) 						&text_request_pdu_header,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1676) 						&tx_sgl_task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1677) 						&rx_sgl_task_params);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1678) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1679) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1680) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1681) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1682) 	list_add_tail(&qedi_cmd->io_cmd, &qedi_conn->active_cmd_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1683) 	qedi_cmd->io_cmd_in_list = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1684) 	qedi_conn->active_cmd_count++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1685) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1686) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1687) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1688) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1689) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1690) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1691) int qedi_send_iscsi_nopout(struct qedi_conn *qedi_conn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1692) 			   struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1693) 			   char *datap, int data_len, int unsol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1694) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1695) 	struct iscsi_nop_out_hdr nop_out_pdu_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1696) 	struct scsi_sgl_task_params tx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1697) 	struct scsi_sgl_task_params rx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1698) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1699) 	struct qedi_ctx *qedi = qedi_conn->qedi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1700) 	struct e4_iscsi_task_context *fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1701) 	struct iscsi_nopout *nopout_hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1702) 	struct scsi_sge *resp_sge = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1703) 	struct qedi_cmd *qedi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1704) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1705) 	u32 scsi_lun[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1706) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1707) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1708) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1709) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1710) 	resp_sge = (struct scsi_sge *)qedi_conn->gen_pdu.resp_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1711) 	qedi_cmd = (struct qedi_cmd *)task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1712) 	nopout_hdr = (struct iscsi_nopout *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1713) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1714) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1715) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1716) 	if (tid == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1717) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1718) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1719) 	fw_task_ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1720) 	     (struct e4_iscsi_task_context *)qedi_get_task_mem(&qedi->tasks,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1721) 							       tid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1722) 	memset(fw_task_ctx, 0, sizeof(struct e4_iscsi_task_context));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1723) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1724) 	qedi_cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1725) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1726) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1727) 	memset(&nop_out_pdu_header, 0, sizeof(nop_out_pdu_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1728) 	memset(&tx_sgl_task_params, 0, sizeof(tx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1729) 	memset(&rx_sgl_task_params, 0, sizeof(rx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1730) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1731) 	/* Update header info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1732) 	nop_out_pdu_header.opcode = nopout_hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1733) 	SET_FIELD(nop_out_pdu_header.flags_attr, ISCSI_NOP_OUT_HDR_CONST1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1734) 	SET_FIELD(nop_out_pdu_header.flags_attr, ISCSI_NOP_OUT_HDR_RSRV, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1735) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1736) 	memcpy(scsi_lun, &nopout_hdr->lun, sizeof(struct scsi_lun));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1737) 	nop_out_pdu_header.lun.lo = be32_to_cpu(scsi_lun[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1738) 	nop_out_pdu_header.lun.hi = be32_to_cpu(scsi_lun[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1739) 	nop_out_pdu_header.cmd_sn = be32_to_cpu(nopout_hdr->cmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1740) 	nop_out_pdu_header.exp_stat_sn = be32_to_cpu(nopout_hdr->exp_statsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1741) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1742) 	qedi_update_itt_map(qedi, tid, task->itt, qedi_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1743) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1744) 	if (nopout_hdr->ttt != ISCSI_TTT_ALL_ONES) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1745) 		nop_out_pdu_header.itt = be32_to_cpu(nopout_hdr->itt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1746) 		nop_out_pdu_header.ttt = be32_to_cpu(nopout_hdr->ttt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1747) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1748) 		nop_out_pdu_header.itt = qedi_set_itt(tid, get_itt(task->itt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1749) 		nop_out_pdu_header.ttt = ISCSI_TTT_ALL_ONES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1750) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1751) 		spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1752) 		list_add_tail(&qedi_cmd->io_cmd, &qedi_conn->active_cmd_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1753) 		qedi_cmd->io_cmd_in_list = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1754) 		qedi_conn->active_cmd_count++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1755) 		spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1756) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1757) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1758) 	/* Fill tx AHS and rx buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1759) 	if (data_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1760) 		tx_sgl_task_params.sgl =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1761) 			       (struct scsi_sge *)qedi_conn->gen_pdu.req_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1762) 		tx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1763) 					 (u32)(qedi_conn->gen_pdu.req_dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1764) 		tx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1765) 			      (u32)((u64)qedi_conn->gen_pdu.req_dma_addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1766) 		tx_sgl_task_params.total_buffer_size = data_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1767) 		tx_sgl_task_params.num_sges = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1768) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1769) 		rx_sgl_task_params.sgl =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1770) 			      (struct scsi_sge *)qedi_conn->gen_pdu.resp_bd_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1771) 		rx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1772) 					(u32)(qedi_conn->gen_pdu.resp_dma_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1773) 		rx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1774) 			     (u32)((u64)qedi_conn->gen_pdu.resp_dma_addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1775) 		rx_sgl_task_params.total_buffer_size = resp_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1776) 		rx_sgl_task_params.num_sges = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1777) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1778) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1779) 	/* Fill fw input params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1780) 	task_params.context = fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1781) 	task_params.conn_icid = (u16)qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1782) 	task_params.itid = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1783) 	task_params.cq_rss_number = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1784) 	task_params.tx_io_size = data_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1785) 	task_params.rx_io_size = resp_sge->sge_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1786) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1787) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1788) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1789) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1790) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1791) 	rval = init_initiator_nop_out_task(&task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1792) 					   &nop_out_pdu_header,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1793) 					   &tx_sgl_task_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1794) 					   &rx_sgl_task_params);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1795) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1796) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1797) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1798) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1799) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1800) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1801) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1802) static int qedi_split_bd(struct qedi_cmd *cmd, u64 addr, int sg_len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1803) 			 int bd_index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1804) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1805) 	struct scsi_sge *bd = cmd->io_tbl.sge_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1806) 	int frag_size, sg_frags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1807) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1808) 	sg_frags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1809) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1810) 	while (sg_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1811) 		if (addr % QEDI_PAGE_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1812) 			frag_size =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1813) 				   (QEDI_PAGE_SIZE - (addr % QEDI_PAGE_SIZE));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1814) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1815) 			frag_size = (sg_len > QEDI_BD_SPLIT_SZ) ? 0 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1816) 				    (sg_len % QEDI_BD_SPLIT_SZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1817) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1818) 		if (frag_size == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1819) 			frag_size = QEDI_BD_SPLIT_SZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1820) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1821) 		bd[bd_index + sg_frags].sge_addr.lo = (addr & 0xffffffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1822) 		bd[bd_index + sg_frags].sge_addr.hi = (addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1823) 		bd[bd_index + sg_frags].sge_len = (u16)frag_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1824) 		QEDI_INFO(&cmd->conn->qedi->dbg_ctx, QEDI_LOG_IO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1825) 			  "split sge %d: addr=%llx, len=%x",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1826) 			  (bd_index + sg_frags), addr, frag_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1827) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1828) 		addr += (u64)frag_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1829) 		sg_frags++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1830) 		sg_len -= frag_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1831) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1832) 	return sg_frags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1833) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1834) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1835) static int qedi_map_scsi_sg(struct qedi_ctx *qedi, struct qedi_cmd *cmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1836) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1837) 	struct scsi_cmnd *sc = cmd->scsi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1838) 	struct scsi_sge *bd = cmd->io_tbl.sge_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1839) 	struct scatterlist *sg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1840) 	int byte_count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1841) 	int bd_count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1842) 	int sg_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1843) 	int sg_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1844) 	int sg_frags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1845) 	u64 addr, end_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1846) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1847) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1848) 	WARN_ON(scsi_sg_count(sc) > QEDI_ISCSI_MAX_BDS_PER_CMD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1849) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1850) 	sg_count = dma_map_sg(&qedi->pdev->dev, scsi_sglist(sc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1851) 			      scsi_sg_count(sc), sc->sc_data_direction);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1852) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1853) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1854) 	 * New condition to send single SGE as cached-SGL.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1855) 	 * Single SGE with length less than 64K.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1856) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1857) 	sg = scsi_sglist(sc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1858) 	if ((sg_count == 1) && (sg_dma_len(sg) <= MAX_SGLEN_FOR_CACHESGL)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1859) 		sg_len = sg_dma_len(sg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1860) 		addr = (u64)sg_dma_address(sg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1861) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1862) 		bd[bd_count].sge_addr.lo = (addr & 0xffffffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1863) 		bd[bd_count].sge_addr.hi = (addr >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1864) 		bd[bd_count].sge_len = (u16)sg_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1865) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1866) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_IO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1867) 			  "single-cached-sgl: bd_count:%d addr=%llx, len=%x",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1868) 			  sg_count, addr, sg_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1869) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1870) 		return ++bd_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1871) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1872) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1873) 	scsi_for_each_sg(sc, sg, sg_count, i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1874) 		sg_len = sg_dma_len(sg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1875) 		addr = (u64)sg_dma_address(sg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1876) 		end_addr = (addr + sg_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1877) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1878) 		/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1879) 		 * first sg elem in the 'list',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1880) 		 * check if end addr is page-aligned.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1881) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1882) 		if ((i == 0) && (sg_count > 1) && (end_addr % QEDI_PAGE_SIZE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1883) 			cmd->use_slowpath = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1884) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1885) 		/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1886) 		 * last sg elem in the 'list',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1887) 		 * check if start addr is page-aligned.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1888) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1889) 		else if ((i == (sg_count - 1)) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1890) 			 (sg_count > 1) && (addr % QEDI_PAGE_SIZE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1891) 			cmd->use_slowpath = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1892) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1893) 		/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1894) 		 * middle sg elements in list,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1895) 		 * check if start and end addr is page-aligned
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1896) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1897) 		else if ((i != 0) && (i != (sg_count - 1)) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1898) 			 ((addr % QEDI_PAGE_SIZE) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1899) 			 (end_addr % QEDI_PAGE_SIZE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1900) 			cmd->use_slowpath = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1901) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1902) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_IO, "sg[%d] size=0x%x",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1903) 			  i, sg_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1904) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1905) 		if (sg_len > QEDI_BD_SPLIT_SZ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1906) 			sg_frags = qedi_split_bd(cmd, addr, sg_len, bd_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1907) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1908) 			sg_frags = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1909) 			bd[bd_count].sge_addr.lo = addr & 0xffffffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1910) 			bd[bd_count].sge_addr.hi = addr >> 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1911) 			bd[bd_count].sge_len = sg_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1912) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1913) 		byte_count += sg_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1914) 		bd_count += sg_frags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1915) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1916) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1917) 	if (byte_count != scsi_bufflen(sc))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1918) 		QEDI_ERR(&qedi->dbg_ctx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1919) 			 "byte_count = %d != scsi_bufflen = %d\n", byte_count,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1920) 			 scsi_bufflen(sc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1921) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1922) 		QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_IO, "byte_count = %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1923) 			  byte_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1924) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1925) 	WARN_ON(byte_count != scsi_bufflen(sc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1926) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1927) 	return bd_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1928) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1929) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1930) static void qedi_iscsi_map_sg_list(struct qedi_cmd *cmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1931) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1932) 	int bd_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1933) 	struct scsi_cmnd *sc = cmd->scsi_cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1934) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1935) 	if (scsi_sg_count(sc)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1936) 		bd_count  = qedi_map_scsi_sg(cmd->conn->qedi, cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1937) 		if (bd_count == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1938) 			return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1939) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1940) 		struct scsi_sge *bd = cmd->io_tbl.sge_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1941) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1942) 		bd[0].sge_addr.lo = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1943) 		bd[0].sge_addr.hi = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1944) 		bd[0].sge_len = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1945) 		bd_count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1946) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1947) 	cmd->io_tbl.sge_valid = bd_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1948) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1949) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1950) static void qedi_cpy_scsi_cdb(struct scsi_cmnd *sc, u32 *dstp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1951) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1952) 	u32 dword;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1953) 	int lpcnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1954) 	u8 *srcp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1955) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1956) 	lpcnt = sc->cmd_len / sizeof(dword);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1957) 	srcp = (u8 *)sc->cmnd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1958) 	while (lpcnt--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1959) 		memcpy(&dword, (const void *)srcp, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1960) 		*dstp = cpu_to_be32(dword);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1961) 		srcp += 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1962) 		dstp++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1963) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1964) 	if (sc->cmd_len & 0x3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1965) 		dword = (u32)srcp[0] | ((u32)srcp[1] << 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1966) 		*dstp = cpu_to_be32(dword);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1967) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1968) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1969) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1970) void qedi_trace_io(struct qedi_ctx *qedi, struct iscsi_task *task,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1971) 		   u16 tid, int8_t direction)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1972) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1973) 	struct qedi_io_log *io_log;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1974) 	struct iscsi_conn *conn = task->conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1975) 	struct qedi_conn *qedi_conn = conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1976) 	struct scsi_cmnd *sc_cmd = task->sc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1977) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1978) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1979) 	spin_lock_irqsave(&qedi->io_trace_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1980) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1981) 	io_log = &qedi->io_trace_buf[qedi->io_trace_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1982) 	io_log->direction = direction;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1983) 	io_log->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1984) 	io_log->cid = qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1985) 	io_log->lun = sc_cmd->device->lun;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1986) 	io_log->op = sc_cmd->cmnd[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1987) 	io_log->lba[0] = sc_cmd->cmnd[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1988) 	io_log->lba[1] = sc_cmd->cmnd[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1989) 	io_log->lba[2] = sc_cmd->cmnd[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1990) 	io_log->lba[3] = sc_cmd->cmnd[5];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1991) 	io_log->bufflen = scsi_bufflen(sc_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1992) 	io_log->sg_count = scsi_sg_count(sc_cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1993) 	io_log->fast_sgs = qedi->fast_sgls;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1994) 	io_log->cached_sgs = qedi->cached_sgls;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1995) 	io_log->slow_sgs = qedi->slow_sgls;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1996) 	io_log->cached_sge = qedi->use_cached_sge;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1997) 	io_log->slow_sge = qedi->use_slow_sge;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1998) 	io_log->fast_sge = qedi->use_fast_sge;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1999) 	io_log->result = sc_cmd->result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2000) 	io_log->jiffies = jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2001) 	io_log->blk_req_cpu = smp_processor_id();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2002) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2003) 	if (direction == QEDI_IO_TRACE_REQ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2004) 		/* For requests we only care about the submission CPU */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2005) 		io_log->req_cpu = smp_processor_id() % qedi->num_queues;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2006) 		io_log->intr_cpu = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2007) 		io_log->blk_rsp_cpu = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2008) 	} else if (direction == QEDI_IO_TRACE_RSP) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2009) 		io_log->req_cpu = smp_processor_id() % qedi->num_queues;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2010) 		io_log->intr_cpu = qedi->intr_cpu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2011) 		io_log->blk_rsp_cpu = smp_processor_id();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2012) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2013) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2014) 	qedi->io_trace_idx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2015) 	if (qedi->io_trace_idx == QEDI_IO_TRACE_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2016) 		qedi->io_trace_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2017) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2018) 	qedi->use_cached_sge = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2019) 	qedi->use_slow_sge = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2020) 	qedi->use_fast_sge = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2021) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2022) 	spin_unlock_irqrestore(&qedi->io_trace_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2023) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2024) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2025) int qedi_iscsi_send_ioreq(struct iscsi_task *task)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2026) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2027) 	struct iscsi_conn *conn = task->conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2028) 	struct iscsi_session *session = conn->session;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2029) 	struct Scsi_Host *shost = iscsi_session_to_shost(session->cls_session);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2030) 	struct qedi_ctx *qedi = iscsi_host_priv(shost);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2031) 	struct qedi_conn *qedi_conn = conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2032) 	struct qedi_cmd *cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2033) 	struct scsi_cmnd *sc = task->sc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2034) 	struct iscsi_cmd_hdr cmd_pdu_header;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2035) 	struct scsi_sgl_task_params tx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2036) 	struct scsi_sgl_task_params rx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2037) 	struct scsi_sgl_task_params *prx_sgl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2038) 	struct scsi_sgl_task_params *ptx_sgl = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2039) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2040) 	struct iscsi_conn_params conn_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2041) 	struct scsi_initiator_cmd_params cmd_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2042) 	struct e4_iscsi_task_context *fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2043) 	struct iscsi_cls_conn *cls_conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2044) 	struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)task->hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2045) 	enum iscsi_task_type task_type = MAX_ISCSI_TASK_TYPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2046) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2047) 	u32 scsi_lun[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2048) 	s16 tid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2049) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2050) 	u16 cq_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2051) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2052) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2053) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2054) 	cls_conn = qedi_conn->cls_conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2055) 	conn = cls_conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2056) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2057) 	qedi_iscsi_map_sg_list(cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2058) 	int_to_scsilun(sc->device->lun, (struct scsi_lun *)scsi_lun);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2059) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2060) 	tid = qedi_get_task_idx(qedi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2061) 	if (tid == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2062) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2063) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2064) 	fw_task_ctx =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2065) 	     (struct e4_iscsi_task_context *)qedi_get_task_mem(&qedi->tasks,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2066) 							       tid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2067) 	memset(fw_task_ctx, 0, sizeof(struct e4_iscsi_task_context));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2068) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2069) 	cmd->task_id = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2070) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2071) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2072) 	memset(&cmd_pdu_header, 0, sizeof(cmd_pdu_header));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2073) 	memset(&tx_sgl_task_params, 0, sizeof(tx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2074) 	memset(&rx_sgl_task_params, 0, sizeof(rx_sgl_task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2075) 	memset(&conn_params, 0, sizeof(conn_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2076) 	memset(&cmd_params, 0, sizeof(cmd_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2077) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2078) 	cq_idx = smp_processor_id() % qedi->num_queues;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2079) 	/* Update header info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2080) 	SET_FIELD(cmd_pdu_header.flags_attr, ISCSI_CMD_HDR_ATTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2081) 		  ISCSI_ATTR_SIMPLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2082) 	if (hdr->cdb[0] != TEST_UNIT_READY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2083) 		if (sc->sc_data_direction == DMA_TO_DEVICE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2084) 			SET_FIELD(cmd_pdu_header.flags_attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2085) 				  ISCSI_CMD_HDR_WRITE, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2086) 			task_type = ISCSI_TASK_TYPE_INITIATOR_WRITE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2087) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2088) 			SET_FIELD(cmd_pdu_header.flags_attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2089) 				  ISCSI_CMD_HDR_READ, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2090) 			task_type = ISCSI_TASK_TYPE_INITIATOR_READ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2091) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2092) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2093) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2094) 	cmd_pdu_header.lun.lo = be32_to_cpu(scsi_lun[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2095) 	cmd_pdu_header.lun.hi = be32_to_cpu(scsi_lun[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2096) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2097) 	qedi_update_itt_map(qedi, tid, task->itt, cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2098) 	cmd_pdu_header.itt = qedi_set_itt(tid, get_itt(task->itt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2099) 	cmd_pdu_header.expected_transfer_length = cpu_to_be32(hdr->data_length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2100) 	cmd_pdu_header.hdr_second_dword = ntoh24(hdr->dlength);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2101) 	cmd_pdu_header.cmd_sn = be32_to_cpu(hdr->cmdsn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2102) 	cmd_pdu_header.hdr_first_byte = hdr->opcode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2103) 	qedi_cpy_scsi_cdb(sc, (u32 *)cmd_pdu_header.cdb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2105) 	/* Fill tx AHS and rx buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2106) 	if (task_type == ISCSI_TASK_TYPE_INITIATOR_WRITE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2107) 		tx_sgl_task_params.sgl = cmd->io_tbl.sge_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2108) 		tx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2109) 						 (u32)(cmd->io_tbl.sge_tbl_dma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2110) 		tx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2111) 				      (u32)((u64)cmd->io_tbl.sge_tbl_dma >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2112) 		tx_sgl_task_params.total_buffer_size = scsi_bufflen(sc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2113) 		tx_sgl_task_params.num_sges = cmd->io_tbl.sge_valid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2114) 		if (cmd->use_slowpath)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2115) 			tx_sgl_task_params.small_mid_sge = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2116) 	} else if (task_type == ISCSI_TASK_TYPE_INITIATOR_READ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2117) 		rx_sgl_task_params.sgl = cmd->io_tbl.sge_tbl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2118) 		rx_sgl_task_params.sgl_phys_addr.lo =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2119) 						 (u32)(cmd->io_tbl.sge_tbl_dma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2120) 		rx_sgl_task_params.sgl_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2121) 				      (u32)((u64)cmd->io_tbl.sge_tbl_dma >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2122) 		rx_sgl_task_params.total_buffer_size = scsi_bufflen(sc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2123) 		rx_sgl_task_params.num_sges = cmd->io_tbl.sge_valid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2124) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2125) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2126) 	/* Add conn param */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2127) 	conn_params.first_burst_length = conn->session->first_burst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2128) 	conn_params.max_send_pdu_length = conn->max_xmit_dlength;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2129) 	conn_params.max_burst_length = conn->session->max_burst;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2130) 	if (conn->session->initial_r2t_en)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2131) 		conn_params.initial_r2t = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2132) 	if (conn->session->imm_data_en)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2133) 		conn_params.immediate_data = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2135) 	/* Add cmd params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2136) 	cmd_params.sense_data_buffer_phys_addr.lo = (u32)cmd->sense_buffer_dma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2137) 	cmd_params.sense_data_buffer_phys_addr.hi =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2138) 					(u32)((u64)cmd->sense_buffer_dma >> 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2139) 	/* Fill fw input params */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2140) 	task_params.context = fw_task_ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2141) 	task_params.conn_icid = (u16)qedi_conn->iscsi_conn_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2142) 	task_params.itid = tid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2143) 	task_params.cq_rss_number = cq_idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2144) 	if (task_type == ISCSI_TASK_TYPE_INITIATOR_WRITE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2145) 		task_params.tx_io_size = scsi_bufflen(sc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2146) 	else if (task_type == ISCSI_TASK_TYPE_INITIATOR_READ)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2147) 		task_params.rx_io_size = scsi_bufflen(sc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2149) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2150) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2152) 	QEDI_INFO(&qedi->dbg_ctx, QEDI_LOG_IO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2153) 		  "%s: %s-SGL: sg_len=0x%x num_sges=0x%x first-sge-lo=0x%x first-sge-hi=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2154) 		  (task_type == ISCSI_TASK_TYPE_INITIATOR_WRITE) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2155) 		  "Write " : "Read ", (cmd->io_tbl.sge_valid == 1) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2156) 		  "Single" : (cmd->use_slowpath ? "SLOW" : "FAST"),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2157) 		  (u16)cmd->io_tbl.sge_valid, scsi_bufflen(sc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2158) 		  (u32)(cmd->io_tbl.sge_tbl_dma),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2159) 		  (u32)((u64)cmd->io_tbl.sge_tbl_dma >> 32));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2161) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2162) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2163) 	if (task_params.tx_io_size != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2164) 		ptx_sgl = &tx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2165) 	if (task_params.rx_io_size != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2166) 		prx_sgl = &rx_sgl_task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2168) 	rval = init_initiator_rw_iscsi_task(&task_params, &conn_params,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2169) 					    &cmd_params, &cmd_pdu_header,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2170) 					    ptx_sgl, prx_sgl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2171) 					    NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2172) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2173) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2175) 	spin_lock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2176) 	list_add_tail(&cmd->io_cmd, &qedi_conn->active_cmd_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2177) 	cmd->io_cmd_in_list = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2178) 	qedi_conn->active_cmd_count++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2179) 	spin_unlock(&qedi_conn->list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2180) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2181) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2182) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2184) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2185) int qedi_iscsi_cleanup_task(struct iscsi_task *task, bool mark_cmd_node_deleted)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2186) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2187) 	struct iscsi_task_params task_params;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2188) 	struct qedi_endpoint *ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2189) 	struct iscsi_conn *conn = task->conn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2190) 	struct qedi_conn *qedi_conn = conn->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2191) 	struct qedi_cmd *cmd = task->dd_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2192) 	u16 sq_idx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2193) 	int rval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2195) 	QEDI_INFO(&qedi_conn->qedi->dbg_ctx, QEDI_LOG_SCSI_TM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2196) 		  "issue cleanup tid=0x%x itt=0x%x task_state=%d cmd_state=0%x cid=0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2197) 		  cmd->task_id, get_itt(task->itt), task->state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2198) 		  cmd->state, qedi_conn->iscsi_conn_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2200) 	memset(&task_params, 0, sizeof(task_params));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2201) 	ep = qedi_conn->ep;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2203) 	sq_idx = qedi_get_wqe_idx(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2204) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2205) 	task_params.sqe = &ep->sq[sq_idx];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2206) 	memset(task_params.sqe, 0, sizeof(struct iscsi_wqe));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2207) 	task_params.itid = cmd->task_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2209) 	rval = init_cleanup_task(&task_params);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2210) 	if (rval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2211) 		return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2212) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2213) 	qedi_ring_doorbell(qedi_conn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2214) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2215) }