• Home
  • Raw
  • Download

Lines Matching full:queue

57 	struct nvmet_tcp_queue		*queue;  member
159 static inline u16 nvmet_tcp_cmd_tag(struct nvmet_tcp_queue *queue, in nvmet_tcp_cmd_tag() argument
162 if (unlikely(!queue->nr_cmds)) { in nvmet_tcp_cmd_tag()
167 return cmd - queue->cmds; in nvmet_tcp_cmd_tag()
195 nvmet_tcp_get_cmd(struct nvmet_tcp_queue *queue) in nvmet_tcp_get_cmd() argument
199 cmd = list_first_entry_or_null(&queue->free_list, in nvmet_tcp_get_cmd()
215 if (unlikely(cmd == &cmd->queue->connect)) in nvmet_tcp_put_cmd()
218 list_add_tail(&cmd->entry, &cmd->queue->free_list); in nvmet_tcp_put_cmd()
221 static inline int queue_cpu(struct nvmet_tcp_queue *queue) in queue_cpu() argument
223 return queue->sock->sk->sk_incoming_cpu; in queue_cpu()
226 static inline u8 nvmet_tcp_hdgst_len(struct nvmet_tcp_queue *queue) in nvmet_tcp_hdgst_len() argument
228 return queue->hdr_digest ? NVME_TCP_DIGEST_LENGTH : 0; in nvmet_tcp_hdgst_len()
231 static inline u8 nvmet_tcp_ddgst_len(struct nvmet_tcp_queue *queue) in nvmet_tcp_ddgst_len() argument
233 return queue->data_digest ? NVME_TCP_DIGEST_LENGTH : 0; in nvmet_tcp_ddgst_len()
246 static int nvmet_tcp_verify_hdgst(struct nvmet_tcp_queue *queue, in nvmet_tcp_verify_hdgst() argument
254 pr_err("queue %d: header digest enabled but no header digest\n", in nvmet_tcp_verify_hdgst()
255 queue->idx); in nvmet_tcp_verify_hdgst()
260 nvmet_tcp_hdgst(queue->rcv_hash, pdu, len); in nvmet_tcp_verify_hdgst()
263 pr_err("queue %d: header digest error: recv %#x expected %#x\n", in nvmet_tcp_verify_hdgst()
264 queue->idx, le32_to_cpu(recv_digest), in nvmet_tcp_verify_hdgst()
272 static int nvmet_tcp_check_ddgst(struct nvmet_tcp_queue *queue, void *pdu) in nvmet_tcp_check_ddgst() argument
275 u8 digest_len = nvmet_tcp_hdgst_len(queue); in nvmet_tcp_check_ddgst()
282 pr_err("queue %d: data digest flag is cleared\n", queue->idx); in nvmet_tcp_check_ddgst()
329 static void nvmet_tcp_fatal_error(struct nvmet_tcp_queue *queue) in nvmet_tcp_fatal_error() argument
331 queue->rcv_state = NVMET_TCP_RECV_ERR; in nvmet_tcp_fatal_error()
332 if (queue->nvme_sq.ctrl) in nvmet_tcp_fatal_error()
333 nvmet_ctrl_fatal_error(queue->nvme_sq.ctrl); in nvmet_tcp_fatal_error()
335 kernel_sock_shutdown(queue->sock, SHUT_RDWR); in nvmet_tcp_fatal_error()
338 static void nvmet_tcp_socket_error(struct nvmet_tcp_queue *queue, int status) in nvmet_tcp_socket_error() argument
340 queue->rcv_state = NVMET_TCP_RECV_ERR; in nvmet_tcp_socket_error()
342 kernel_sock_shutdown(queue->sock, SHUT_RDWR); in nvmet_tcp_socket_error()
344 nvmet_tcp_fatal_error(queue); in nvmet_tcp_socket_error()
412 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_setup_c2h_data_pdu() local
413 u8 hdgst = nvmet_tcp_hdgst_len(cmd->queue); in nvmet_setup_c2h_data_pdu()
414 u8 ddgst = nvmet_tcp_ddgst_len(cmd->queue); in nvmet_setup_c2h_data_pdu()
420 pdu->hdr.flags = NVME_TCP_F_DATA_LAST | (queue->nvme_sq.sqhd_disabled ? in nvmet_setup_c2h_data_pdu()
431 if (queue->data_digest) { in nvmet_setup_c2h_data_pdu()
433 nvmet_tcp_send_ddgst(queue->snd_hash, cmd); in nvmet_setup_c2h_data_pdu()
436 if (cmd->queue->hdr_digest) { in nvmet_setup_c2h_data_pdu()
438 nvmet_tcp_hdgst(queue->snd_hash, pdu, sizeof(*pdu)); in nvmet_setup_c2h_data_pdu()
445 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_setup_r2t_pdu() local
446 u8 hdgst = nvmet_tcp_hdgst_len(cmd->queue); in nvmet_setup_r2t_pdu()
458 pdu->ttag = nvmet_tcp_cmd_tag(cmd->queue, cmd); in nvmet_setup_r2t_pdu()
461 if (cmd->queue->hdr_digest) { in nvmet_setup_r2t_pdu()
463 nvmet_tcp_hdgst(queue->snd_hash, pdu, sizeof(*pdu)); in nvmet_setup_r2t_pdu()
470 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_setup_response_pdu() local
471 u8 hdgst = nvmet_tcp_hdgst_len(cmd->queue); in nvmet_setup_response_pdu()
481 if (cmd->queue->hdr_digest) { in nvmet_setup_response_pdu()
483 nvmet_tcp_hdgst(queue->snd_hash, pdu, sizeof(*pdu)); in nvmet_setup_response_pdu()
487 static void nvmet_tcp_process_resp_list(struct nvmet_tcp_queue *queue) in nvmet_tcp_process_resp_list() argument
492 for (node = llist_del_all(&queue->resp_list); node; node = node->next) { in nvmet_tcp_process_resp_list()
494 list_add(&cmd->entry, &queue->resp_send_list); in nvmet_tcp_process_resp_list()
495 queue->send_list_len++; in nvmet_tcp_process_resp_list()
499 static struct nvmet_tcp_cmd *nvmet_tcp_fetch_cmd(struct nvmet_tcp_queue *queue) in nvmet_tcp_fetch_cmd() argument
501 queue->snd_cmd = list_first_entry_or_null(&queue->resp_send_list, in nvmet_tcp_fetch_cmd()
503 if (!queue->snd_cmd) { in nvmet_tcp_fetch_cmd()
504 nvmet_tcp_process_resp_list(queue); in nvmet_tcp_fetch_cmd()
505 queue->snd_cmd = in nvmet_tcp_fetch_cmd()
506 list_first_entry_or_null(&queue->resp_send_list, in nvmet_tcp_fetch_cmd()
508 if (unlikely(!queue->snd_cmd)) in nvmet_tcp_fetch_cmd()
512 list_del_init(&queue->snd_cmd->entry); in nvmet_tcp_fetch_cmd()
513 queue->send_list_len--; in nvmet_tcp_fetch_cmd()
515 if (nvmet_tcp_need_data_out(queue->snd_cmd)) in nvmet_tcp_fetch_cmd()
516 nvmet_setup_c2h_data_pdu(queue->snd_cmd); in nvmet_tcp_fetch_cmd()
517 else if (nvmet_tcp_need_data_in(queue->snd_cmd)) in nvmet_tcp_fetch_cmd()
518 nvmet_setup_r2t_pdu(queue->snd_cmd); in nvmet_tcp_fetch_cmd()
520 nvmet_setup_response_pdu(queue->snd_cmd); in nvmet_tcp_fetch_cmd()
522 return queue->snd_cmd; in nvmet_tcp_fetch_cmd()
529 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_tcp_queue_response() local
533 if (unlikely(cmd == queue->cmd)) { in nvmet_tcp_queue_response()
542 if (queue->rcv_state == NVMET_TCP_RECV_PDU && in nvmet_tcp_queue_response()
548 llist_add(&cmd->lentry, &queue->resp_list); in nvmet_tcp_queue_response()
549 queue_work_on(queue_cpu(queue), nvmet_tcp_wq, &cmd->queue->io_work); in nvmet_tcp_queue_response()
562 u8 hdgst = nvmet_tcp_hdgst_len(cmd->queue); in nvmet_try_send_data_pdu()
566 ret = kernel_sendpage(cmd->queue->sock, virt_to_page(cmd->data_pdu), in nvmet_try_send_data_pdu()
585 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_try_send_data() local
593 if ((!last_in_batch && cmd->queue->send_list_len) || in nvmet_try_send_data()
595 queue->data_digest || !queue->nvme_sq.sqhd_disabled) in nvmet_try_send_data()
598 ret = kernel_sendpage(cmd->queue->sock, page, cmd->offset, in nvmet_try_send_data()
613 if (queue->data_digest) { in nvmet_try_send_data()
617 if (queue->nvme_sq.sqhd_disabled) { in nvmet_try_send_data()
618 cmd->queue->snd_cmd = NULL; in nvmet_try_send_data()
625 if (queue->nvme_sq.sqhd_disabled) { in nvmet_try_send_data()
637 u8 hdgst = nvmet_tcp_hdgst_len(cmd->queue); in nvmet_try_send_response()
642 if (!last_in_batch && cmd->queue->send_list_len) in nvmet_try_send_response()
647 ret = kernel_sendpage(cmd->queue->sock, virt_to_page(cmd->rsp_pdu), in nvmet_try_send_response()
659 cmd->queue->snd_cmd = NULL; in nvmet_try_send_response()
666 u8 hdgst = nvmet_tcp_hdgst_len(cmd->queue); in nvmet_try_send_r2t()
671 if (!last_in_batch && cmd->queue->send_list_len) in nvmet_try_send_r2t()
676 ret = kernel_sendpage(cmd->queue->sock, virt_to_page(cmd->r2t_pdu), in nvmet_try_send_r2t()
686 cmd->queue->snd_cmd = NULL; in nvmet_try_send_r2t()
692 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_try_send_ddgst() local
701 if (!last_in_batch && cmd->queue->send_list_len) in nvmet_try_send_ddgst()
706 ret = kernel_sendmsg(queue->sock, &msg, &iov, 1, iov.iov_len); in nvmet_try_send_ddgst()
716 if (queue->nvme_sq.sqhd_disabled) { in nvmet_try_send_ddgst()
717 cmd->queue->snd_cmd = NULL; in nvmet_try_send_ddgst()
725 static int nvmet_tcp_try_send_one(struct nvmet_tcp_queue *queue, in nvmet_tcp_try_send_one() argument
728 struct nvmet_tcp_cmd *cmd = queue->snd_cmd; in nvmet_tcp_try_send_one()
731 if (!cmd || queue->state == NVMET_TCP_Q_DISCONNECTING) { in nvmet_tcp_try_send_one()
732 cmd = nvmet_tcp_fetch_cmd(queue); in nvmet_tcp_try_send_one()
774 static int nvmet_tcp_try_send(struct nvmet_tcp_queue *queue, in nvmet_tcp_try_send() argument
780 ret = nvmet_tcp_try_send_one(queue, i == budget - 1); in nvmet_tcp_try_send()
782 nvmet_tcp_socket_error(queue, ret); in nvmet_tcp_try_send()
793 static void nvmet_prepare_receive_pdu(struct nvmet_tcp_queue *queue) in nvmet_prepare_receive_pdu() argument
795 queue->offset = 0; in nvmet_prepare_receive_pdu()
796 queue->left = sizeof(struct nvme_tcp_hdr); in nvmet_prepare_receive_pdu()
797 queue->cmd = NULL; in nvmet_prepare_receive_pdu()
798 queue->rcv_state = NVMET_TCP_RECV_PDU; in nvmet_prepare_receive_pdu()
801 static void nvmet_tcp_free_crypto(struct nvmet_tcp_queue *queue) in nvmet_tcp_free_crypto() argument
803 struct crypto_ahash *tfm = crypto_ahash_reqtfm(queue->rcv_hash); in nvmet_tcp_free_crypto()
805 ahash_request_free(queue->rcv_hash); in nvmet_tcp_free_crypto()
806 ahash_request_free(queue->snd_hash); in nvmet_tcp_free_crypto()
810 static int nvmet_tcp_alloc_crypto(struct nvmet_tcp_queue *queue) in nvmet_tcp_alloc_crypto() argument
818 queue->snd_hash = ahash_request_alloc(tfm, GFP_KERNEL); in nvmet_tcp_alloc_crypto()
819 if (!queue->snd_hash) in nvmet_tcp_alloc_crypto()
821 ahash_request_set_callback(queue->snd_hash, 0, NULL, NULL); in nvmet_tcp_alloc_crypto()
823 queue->rcv_hash = ahash_request_alloc(tfm, GFP_KERNEL); in nvmet_tcp_alloc_crypto()
824 if (!queue->rcv_hash) in nvmet_tcp_alloc_crypto()
826 ahash_request_set_callback(queue->rcv_hash, 0, NULL, NULL); in nvmet_tcp_alloc_crypto()
830 ahash_request_free(queue->snd_hash); in nvmet_tcp_alloc_crypto()
837 static int nvmet_tcp_handle_icreq(struct nvmet_tcp_queue *queue) in nvmet_tcp_handle_icreq() argument
839 struct nvme_tcp_icreq_pdu *icreq = &queue->pdu.icreq; in nvmet_tcp_handle_icreq()
840 struct nvme_tcp_icresp_pdu *icresp = &queue->pdu.icresp; in nvmet_tcp_handle_icreq()
848 nvmet_tcp_fatal_error(queue); in nvmet_tcp_handle_icreq()
852 pr_err("queue %d: bad pfv %d\n", queue->idx, icreq->pfv); in nvmet_tcp_handle_icreq()
857 pr_err("queue %d: unsupported hpda %d\n", queue->idx, in nvmet_tcp_handle_icreq()
862 queue->hdr_digest = !!(icreq->digest & NVME_TCP_HDR_DIGEST_ENABLE); in nvmet_tcp_handle_icreq()
863 queue->data_digest = !!(icreq->digest & NVME_TCP_DATA_DIGEST_ENABLE); in nvmet_tcp_handle_icreq()
864 if (queue->hdr_digest || queue->data_digest) { in nvmet_tcp_handle_icreq()
865 ret = nvmet_tcp_alloc_crypto(queue); in nvmet_tcp_handle_icreq()
878 if (queue->hdr_digest) in nvmet_tcp_handle_icreq()
880 if (queue->data_digest) in nvmet_tcp_handle_icreq()
885 ret = kernel_sendmsg(queue->sock, &msg, &iov, 1, iov.iov_len); in nvmet_tcp_handle_icreq()
887 return ret; /* queue removal will cleanup */ in nvmet_tcp_handle_icreq()
889 queue->state = NVMET_TCP_Q_LIVE; in nvmet_tcp_handle_icreq()
890 nvmet_prepare_receive_pdu(queue); in nvmet_tcp_handle_icreq()
894 static void nvmet_tcp_handle_req_failure(struct nvmet_tcp_queue *queue, in nvmet_tcp_handle_req_failure() argument
902 nvmet_prepare_receive_pdu(queue); in nvmet_tcp_handle_req_failure()
908 pr_err("queue %d: failed to map data\n", queue->idx); in nvmet_tcp_handle_req_failure()
909 nvmet_tcp_fatal_error(queue); in nvmet_tcp_handle_req_failure()
913 queue->rcv_state = NVMET_TCP_RECV_DATA; in nvmet_tcp_handle_req_failure()
918 static int nvmet_tcp_handle_h2c_data_pdu(struct nvmet_tcp_queue *queue) in nvmet_tcp_handle_h2c_data_pdu() argument
920 struct nvme_tcp_data_pdu *data = &queue->pdu.data; in nvmet_tcp_handle_h2c_data_pdu()
924 if (likely(queue->nr_cmds)) { in nvmet_tcp_handle_h2c_data_pdu()
925 if (unlikely(data->ttag >= queue->nr_cmds)) { in nvmet_tcp_handle_h2c_data_pdu()
926 pr_err("queue %d: received out of bound ttag %u, nr_cmds %u\n", in nvmet_tcp_handle_h2c_data_pdu()
927 queue->idx, data->ttag, queue->nr_cmds); in nvmet_tcp_handle_h2c_data_pdu()
928 nvmet_tcp_fatal_error(queue); in nvmet_tcp_handle_h2c_data_pdu()
931 cmd = &queue->cmds[data->ttag]; in nvmet_tcp_handle_h2c_data_pdu()
933 cmd = &queue->connect; in nvmet_tcp_handle_h2c_data_pdu()
941 nvmet_tcp_fatal_error(queue); in nvmet_tcp_handle_h2c_data_pdu()
946 nvmet_tcp_hdgst_len(queue) - in nvmet_tcp_handle_h2c_data_pdu()
947 nvmet_tcp_ddgst_len(queue) - in nvmet_tcp_handle_h2c_data_pdu()
956 nvmet_tcp_fatal_error(queue); in nvmet_tcp_handle_h2c_data_pdu()
961 queue->cmd = cmd; in nvmet_tcp_handle_h2c_data_pdu()
962 queue->rcv_state = NVMET_TCP_RECV_DATA; in nvmet_tcp_handle_h2c_data_pdu()
967 static int nvmet_tcp_done_recv_pdu(struct nvmet_tcp_queue *queue) in nvmet_tcp_done_recv_pdu() argument
969 struct nvme_tcp_hdr *hdr = &queue->pdu.cmd.hdr; in nvmet_tcp_done_recv_pdu()
970 struct nvme_command *nvme_cmd = &queue->pdu.cmd.cmd; in nvmet_tcp_done_recv_pdu()
974 if (unlikely(queue->state == NVMET_TCP_Q_CONNECTING)) { in nvmet_tcp_done_recv_pdu()
978 nvmet_tcp_fatal_error(queue); in nvmet_tcp_done_recv_pdu()
981 return nvmet_tcp_handle_icreq(queue); in nvmet_tcp_done_recv_pdu()
985 ret = nvmet_tcp_handle_h2c_data_pdu(queue); in nvmet_tcp_done_recv_pdu()
991 queue->cmd = nvmet_tcp_get_cmd(queue); in nvmet_tcp_done_recv_pdu()
992 if (unlikely(!queue->cmd)) { in nvmet_tcp_done_recv_pdu()
994 pr_err("queue %d: out of commands (%d) send_list_len: %d, opcode: %d", in nvmet_tcp_done_recv_pdu()
995 queue->idx, queue->nr_cmds, queue->send_list_len, in nvmet_tcp_done_recv_pdu()
997 nvmet_tcp_fatal_error(queue); in nvmet_tcp_done_recv_pdu()
1001 req = &queue->cmd->req; in nvmet_tcp_done_recv_pdu()
1004 if (unlikely(!nvmet_req_init(req, &queue->nvme_cq, in nvmet_tcp_done_recv_pdu()
1005 &queue->nvme_sq, &nvmet_tcp_ops))) { in nvmet_tcp_done_recv_pdu()
1011 nvmet_tcp_handle_req_failure(queue, queue->cmd, req); in nvmet_tcp_done_recv_pdu()
1015 ret = nvmet_tcp_map_data(queue->cmd); in nvmet_tcp_done_recv_pdu()
1017 pr_err("queue %d: failed to map data\n", queue->idx); in nvmet_tcp_done_recv_pdu()
1018 if (nvmet_tcp_has_inline_data(queue->cmd)) in nvmet_tcp_done_recv_pdu()
1019 nvmet_tcp_fatal_error(queue); in nvmet_tcp_done_recv_pdu()
1026 if (nvmet_tcp_need_data_in(queue->cmd)) { in nvmet_tcp_done_recv_pdu()
1027 if (nvmet_tcp_has_inline_data(queue->cmd)) { in nvmet_tcp_done_recv_pdu()
1028 queue->rcv_state = NVMET_TCP_RECV_DATA; in nvmet_tcp_done_recv_pdu()
1029 nvmet_tcp_map_pdu_iovec(queue->cmd); in nvmet_tcp_done_recv_pdu()
1033 nvmet_tcp_queue_response(&queue->cmd->req); in nvmet_tcp_done_recv_pdu()
1037 queue->cmd->req.execute(&queue->cmd->req); in nvmet_tcp_done_recv_pdu()
1039 nvmet_prepare_receive_pdu(queue); in nvmet_tcp_done_recv_pdu()
1071 static int nvmet_tcp_try_recv_pdu(struct nvmet_tcp_queue *queue) in nvmet_tcp_try_recv_pdu() argument
1073 struct nvme_tcp_hdr *hdr = &queue->pdu.cmd.hdr; in nvmet_tcp_try_recv_pdu()
1079 iov.iov_base = (void *)&queue->pdu + queue->offset; in nvmet_tcp_try_recv_pdu()
1080 iov.iov_len = queue->left; in nvmet_tcp_try_recv_pdu()
1081 len = kernel_recvmsg(queue->sock, &msg, &iov, 1, in nvmet_tcp_try_recv_pdu()
1086 queue->offset += len; in nvmet_tcp_try_recv_pdu()
1087 queue->left -= len; in nvmet_tcp_try_recv_pdu()
1088 if (queue->left) in nvmet_tcp_try_recv_pdu()
1091 if (queue->offset == sizeof(struct nvme_tcp_hdr)) { in nvmet_tcp_try_recv_pdu()
1092 u8 hdgst = nvmet_tcp_hdgst_len(queue); in nvmet_tcp_try_recv_pdu()
1096 nvmet_tcp_fatal_error(queue); in nvmet_tcp_try_recv_pdu()
1105 queue->left = hdr->hlen - queue->offset + hdgst; in nvmet_tcp_try_recv_pdu()
1109 if (queue->hdr_digest && in nvmet_tcp_try_recv_pdu()
1110 nvmet_tcp_verify_hdgst(queue, &queue->pdu, hdr->hlen)) { in nvmet_tcp_try_recv_pdu()
1111 nvmet_tcp_fatal_error(queue); /* fatal */ in nvmet_tcp_try_recv_pdu()
1115 if (queue->data_digest && in nvmet_tcp_try_recv_pdu()
1116 nvmet_tcp_check_ddgst(queue, &queue->pdu)) { in nvmet_tcp_try_recv_pdu()
1117 nvmet_tcp_fatal_error(queue); /* fatal */ in nvmet_tcp_try_recv_pdu()
1121 return nvmet_tcp_done_recv_pdu(queue); in nvmet_tcp_try_recv_pdu()
1126 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_tcp_prep_recv_ddgst() local
1128 nvmet_tcp_recv_ddgst(queue->rcv_hash, cmd); in nvmet_tcp_prep_recv_ddgst()
1129 queue->offset = 0; in nvmet_tcp_prep_recv_ddgst()
1130 queue->left = NVME_TCP_DIGEST_LENGTH; in nvmet_tcp_prep_recv_ddgst()
1131 queue->rcv_state = NVMET_TCP_RECV_DDGST; in nvmet_tcp_prep_recv_ddgst()
1134 static int nvmet_tcp_try_recv_data(struct nvmet_tcp_queue *queue) in nvmet_tcp_try_recv_data() argument
1136 struct nvmet_tcp_cmd *cmd = queue->cmd; in nvmet_tcp_try_recv_data()
1140 ret = sock_recvmsg(cmd->queue->sock, &cmd->recv_msg, in nvmet_tcp_try_recv_data()
1150 if (queue->data_digest) { in nvmet_tcp_try_recv_data()
1158 nvmet_prepare_receive_pdu(queue); in nvmet_tcp_try_recv_data()
1162 static int nvmet_tcp_try_recv_ddgst(struct nvmet_tcp_queue *queue) in nvmet_tcp_try_recv_ddgst() argument
1164 struct nvmet_tcp_cmd *cmd = queue->cmd; in nvmet_tcp_try_recv_ddgst()
1168 .iov_base = (void *)&cmd->recv_ddgst + queue->offset, in nvmet_tcp_try_recv_ddgst()
1169 .iov_len = queue->left in nvmet_tcp_try_recv_ddgst()
1172 ret = kernel_recvmsg(queue->sock, &msg, &iov, 1, in nvmet_tcp_try_recv_ddgst()
1177 queue->offset += ret; in nvmet_tcp_try_recv_ddgst()
1178 queue->left -= ret; in nvmet_tcp_try_recv_ddgst()
1179 if (queue->left) in nvmet_tcp_try_recv_ddgst()
1182 if (queue->data_digest && cmd->exp_ddgst != cmd->recv_ddgst) { in nvmet_tcp_try_recv_ddgst()
1183 pr_err("queue %d: cmd %d pdu (%d) data digest error: recv %#x expected %#x\n", in nvmet_tcp_try_recv_ddgst()
1184 queue->idx, cmd->req.cmd->common.command_id, in nvmet_tcp_try_recv_ddgst()
1185 queue->pdu.cmd.hdr.type, le32_to_cpu(cmd->recv_ddgst), in nvmet_tcp_try_recv_ddgst()
1188 nvmet_tcp_fatal_error(queue); in nvmet_tcp_try_recv_ddgst()
1198 nvmet_prepare_receive_pdu(queue); in nvmet_tcp_try_recv_ddgst()
1202 static int nvmet_tcp_try_recv_one(struct nvmet_tcp_queue *queue) in nvmet_tcp_try_recv_one() argument
1206 if (unlikely(queue->rcv_state == NVMET_TCP_RECV_ERR)) in nvmet_tcp_try_recv_one()
1209 if (queue->rcv_state == NVMET_TCP_RECV_PDU) { in nvmet_tcp_try_recv_one()
1210 result = nvmet_tcp_try_recv_pdu(queue); in nvmet_tcp_try_recv_one()
1215 if (queue->rcv_state == NVMET_TCP_RECV_DATA) { in nvmet_tcp_try_recv_one()
1216 result = nvmet_tcp_try_recv_data(queue); in nvmet_tcp_try_recv_one()
1221 if (queue->rcv_state == NVMET_TCP_RECV_DDGST) { in nvmet_tcp_try_recv_one()
1222 result = nvmet_tcp_try_recv_ddgst(queue); in nvmet_tcp_try_recv_one()
1236 static int nvmet_tcp_try_recv(struct nvmet_tcp_queue *queue, in nvmet_tcp_try_recv() argument
1242 ret = nvmet_tcp_try_recv_one(queue); in nvmet_tcp_try_recv()
1244 nvmet_tcp_socket_error(queue, ret); in nvmet_tcp_try_recv()
1255 static void nvmet_tcp_schedule_release_queue(struct nvmet_tcp_queue *queue) in nvmet_tcp_schedule_release_queue() argument
1257 spin_lock(&queue->state_lock); in nvmet_tcp_schedule_release_queue()
1258 if (queue->state != NVMET_TCP_Q_DISCONNECTING) { in nvmet_tcp_schedule_release_queue()
1259 queue->state = NVMET_TCP_Q_DISCONNECTING; in nvmet_tcp_schedule_release_queue()
1260 schedule_work(&queue->release_work); in nvmet_tcp_schedule_release_queue()
1262 spin_unlock(&queue->state_lock); in nvmet_tcp_schedule_release_queue()
1267 struct nvmet_tcp_queue *queue = in nvmet_tcp_io_work() local
1275 ret = nvmet_tcp_try_recv(queue, NVMET_TCP_RECV_BUDGET, &ops); in nvmet_tcp_io_work()
1281 ret = nvmet_tcp_try_send(queue, NVMET_TCP_SEND_BUDGET, &ops); in nvmet_tcp_io_work()
1293 queue_work_on(queue_cpu(queue), nvmet_tcp_wq, &queue->io_work); in nvmet_tcp_io_work()
1296 static int nvmet_tcp_alloc_cmd(struct nvmet_tcp_queue *queue, in nvmet_tcp_alloc_cmd() argument
1299 u8 hdgst = nvmet_tcp_hdgst_len(queue); in nvmet_tcp_alloc_cmd()
1301 c->queue = queue; in nvmet_tcp_alloc_cmd()
1302 c->req.port = queue->port->nport; in nvmet_tcp_alloc_cmd()
1304 c->cmd_pdu = page_frag_alloc(&queue->pf_cache, in nvmet_tcp_alloc_cmd()
1310 c->rsp_pdu = page_frag_alloc(&queue->pf_cache, in nvmet_tcp_alloc_cmd()
1316 c->data_pdu = page_frag_alloc(&queue->pf_cache, in nvmet_tcp_alloc_cmd()
1321 c->r2t_pdu = page_frag_alloc(&queue->pf_cache, in nvmet_tcp_alloc_cmd()
1328 list_add_tail(&c->entry, &queue->free_list); in nvmet_tcp_alloc_cmd()
1348 static int nvmet_tcp_alloc_cmds(struct nvmet_tcp_queue *queue) in nvmet_tcp_alloc_cmds() argument
1351 int i, ret = -EINVAL, nr_cmds = queue->nr_cmds; in nvmet_tcp_alloc_cmds()
1358 ret = nvmet_tcp_alloc_cmd(queue, cmds + i); in nvmet_tcp_alloc_cmds()
1363 queue->cmds = cmds; in nvmet_tcp_alloc_cmds()
1374 static void nvmet_tcp_free_cmds(struct nvmet_tcp_queue *queue) in nvmet_tcp_free_cmds() argument
1376 struct nvmet_tcp_cmd *cmds = queue->cmds; in nvmet_tcp_free_cmds()
1379 for (i = 0; i < queue->nr_cmds; i++) in nvmet_tcp_free_cmds()
1382 nvmet_tcp_free_cmd(&queue->connect); in nvmet_tcp_free_cmds()
1386 static void nvmet_tcp_restore_socket_callbacks(struct nvmet_tcp_queue *queue) in nvmet_tcp_restore_socket_callbacks() argument
1388 struct socket *sock = queue->sock; in nvmet_tcp_restore_socket_callbacks()
1391 sock->sk->sk_data_ready = queue->data_ready; in nvmet_tcp_restore_socket_callbacks()
1392 sock->sk->sk_state_change = queue->state_change; in nvmet_tcp_restore_socket_callbacks()
1393 sock->sk->sk_write_space = queue->write_space; in nvmet_tcp_restore_socket_callbacks()
1406 static void nvmet_tcp_uninit_data_in_cmds(struct nvmet_tcp_queue *queue) in nvmet_tcp_uninit_data_in_cmds() argument
1408 struct nvmet_tcp_cmd *cmd = queue->cmds; in nvmet_tcp_uninit_data_in_cmds()
1411 for (i = 0; i < queue->nr_cmds; i++, cmd++) { in nvmet_tcp_uninit_data_in_cmds()
1416 if (!queue->nr_cmds && nvmet_tcp_need_data_in(&queue->connect)) { in nvmet_tcp_uninit_data_in_cmds()
1418 nvmet_tcp_finish_cmd(&queue->connect); in nvmet_tcp_uninit_data_in_cmds()
1425 struct nvmet_tcp_queue *queue = in nvmet_tcp_release_queue_work() local
1429 list_del_init(&queue->queue_list); in nvmet_tcp_release_queue_work()
1432 nvmet_tcp_restore_socket_callbacks(queue); in nvmet_tcp_release_queue_work()
1433 flush_work(&queue->io_work); in nvmet_tcp_release_queue_work()
1435 nvmet_tcp_uninit_data_in_cmds(queue); in nvmet_tcp_release_queue_work()
1436 nvmet_sq_destroy(&queue->nvme_sq); in nvmet_tcp_release_queue_work()
1437 cancel_work_sync(&queue->io_work); in nvmet_tcp_release_queue_work()
1438 sock_release(queue->sock); in nvmet_tcp_release_queue_work()
1439 nvmet_tcp_free_cmds(queue); in nvmet_tcp_release_queue_work()
1440 if (queue->hdr_digest || queue->data_digest) in nvmet_tcp_release_queue_work()
1441 nvmet_tcp_free_crypto(queue); in nvmet_tcp_release_queue_work()
1442 ida_simple_remove(&nvmet_tcp_queue_ida, queue->idx); in nvmet_tcp_release_queue_work()
1444 page = virt_to_head_page(queue->pf_cache.va); in nvmet_tcp_release_queue_work()
1445 __page_frag_cache_drain(page, queue->pf_cache.pagecnt_bias); in nvmet_tcp_release_queue_work()
1446 kfree(queue); in nvmet_tcp_release_queue_work()
1451 struct nvmet_tcp_queue *queue; in nvmet_tcp_data_ready() local
1454 queue = sk->sk_user_data; in nvmet_tcp_data_ready()
1455 if (likely(queue)) in nvmet_tcp_data_ready()
1456 queue_work_on(queue_cpu(queue), nvmet_tcp_wq, &queue->io_work); in nvmet_tcp_data_ready()
1462 struct nvmet_tcp_queue *queue; in nvmet_tcp_write_space() local
1465 queue = sk->sk_user_data; in nvmet_tcp_write_space()
1466 if (unlikely(!queue)) in nvmet_tcp_write_space()
1469 if (unlikely(queue->state == NVMET_TCP_Q_CONNECTING)) { in nvmet_tcp_write_space()
1470 queue->write_space(sk); in nvmet_tcp_write_space()
1476 queue_work_on(queue_cpu(queue), nvmet_tcp_wq, &queue->io_work); in nvmet_tcp_write_space()
1484 struct nvmet_tcp_queue *queue; in nvmet_tcp_state_change() local
1487 queue = sk->sk_user_data; in nvmet_tcp_state_change()
1488 if (!queue) in nvmet_tcp_state_change()
1499 nvmet_tcp_schedule_release_queue(queue); in nvmet_tcp_state_change()
1502 pr_warn("queue %d unhandled state %d\n", in nvmet_tcp_state_change()
1503 queue->idx, sk->sk_state); in nvmet_tcp_state_change()
1509 static int nvmet_tcp_set_queue_sock(struct nvmet_tcp_queue *queue) in nvmet_tcp_set_queue_sock() argument
1511 struct socket *sock = queue->sock; in nvmet_tcp_set_queue_sock()
1516 (struct sockaddr *)&queue->sockaddr); in nvmet_tcp_set_queue_sock()
1521 (struct sockaddr *)&queue->sockaddr_peer); in nvmet_tcp_set_queue_sock()
1526 * Cleanup whatever is sitting in the TCP transmit queue on socket in nvmet_tcp_set_queue_sock()
1548 sock->sk->sk_user_data = queue; in nvmet_tcp_set_queue_sock()
1549 queue->data_ready = sock->sk->sk_data_ready; in nvmet_tcp_set_queue_sock()
1551 queue->state_change = sock->sk->sk_state_change; in nvmet_tcp_set_queue_sock()
1553 queue->write_space = sock->sk->sk_write_space; in nvmet_tcp_set_queue_sock()
1555 queue_work_on(queue_cpu(queue), nvmet_tcp_wq, &queue->io_work); in nvmet_tcp_set_queue_sock()
1565 struct nvmet_tcp_queue *queue; in nvmet_tcp_alloc_queue() local
1568 queue = kzalloc(sizeof(*queue), GFP_KERNEL); in nvmet_tcp_alloc_queue()
1569 if (!queue) in nvmet_tcp_alloc_queue()
1572 INIT_WORK(&queue->release_work, nvmet_tcp_release_queue_work); in nvmet_tcp_alloc_queue()
1573 INIT_WORK(&queue->io_work, nvmet_tcp_io_work); in nvmet_tcp_alloc_queue()
1574 queue->sock = newsock; in nvmet_tcp_alloc_queue()
1575 queue->port = port; in nvmet_tcp_alloc_queue()
1576 queue->nr_cmds = 0; in nvmet_tcp_alloc_queue()
1577 spin_lock_init(&queue->state_lock); in nvmet_tcp_alloc_queue()
1578 queue->state = NVMET_TCP_Q_CONNECTING; in nvmet_tcp_alloc_queue()
1579 INIT_LIST_HEAD(&queue->free_list); in nvmet_tcp_alloc_queue()
1580 init_llist_head(&queue->resp_list); in nvmet_tcp_alloc_queue()
1581 INIT_LIST_HEAD(&queue->resp_send_list); in nvmet_tcp_alloc_queue()
1583 queue->idx = ida_simple_get(&nvmet_tcp_queue_ida, 0, 0, GFP_KERNEL); in nvmet_tcp_alloc_queue()
1584 if (queue->idx < 0) { in nvmet_tcp_alloc_queue()
1585 ret = queue->idx; in nvmet_tcp_alloc_queue()
1589 ret = nvmet_tcp_alloc_cmd(queue, &queue->connect); in nvmet_tcp_alloc_queue()
1593 ret = nvmet_sq_init(&queue->nvme_sq); in nvmet_tcp_alloc_queue()
1597 nvmet_prepare_receive_pdu(queue); in nvmet_tcp_alloc_queue()
1600 list_add_tail(&queue->queue_list, &nvmet_tcp_queue_list); in nvmet_tcp_alloc_queue()
1603 ret = nvmet_tcp_set_queue_sock(queue); in nvmet_tcp_alloc_queue()
1610 list_del_init(&queue->queue_list); in nvmet_tcp_alloc_queue()
1612 nvmet_sq_destroy(&queue->nvme_sq); in nvmet_tcp_alloc_queue()
1614 nvmet_tcp_free_cmd(&queue->connect); in nvmet_tcp_alloc_queue()
1616 ida_simple_remove(&nvmet_tcp_queue_ida, queue->idx); in nvmet_tcp_alloc_queue()
1618 kfree(queue); in nvmet_tcp_alloc_queue()
1638 pr_err("failed to allocate queue\n"); in nvmet_tcp_accept_work()
1739 struct nvmet_tcp_queue *queue; in nvmet_tcp_destroy_port_queues() local
1742 list_for_each_entry(queue, &nvmet_tcp_queue_list, queue_list) in nvmet_tcp_destroy_port_queues()
1743 if (queue->port == port) in nvmet_tcp_destroy_port_queues()
1744 kernel_sock_shutdown(queue->sock, SHUT_RDWR); in nvmet_tcp_destroy_port_queues()
1769 struct nvmet_tcp_queue *queue; in nvmet_tcp_delete_ctrl() local
1772 list_for_each_entry(queue, &nvmet_tcp_queue_list, queue_list) in nvmet_tcp_delete_ctrl()
1773 if (queue->nvme_sq.ctrl == ctrl) in nvmet_tcp_delete_ctrl()
1774 kernel_sock_shutdown(queue->sock, SHUT_RDWR); in nvmet_tcp_delete_ctrl()
1780 struct nvmet_tcp_queue *queue = in nvmet_tcp_install_queue() local
1788 queue->nr_cmds = sq->size * 2; in nvmet_tcp_install_queue()
1789 if (nvmet_tcp_alloc_cmds(queue)) { in nvmet_tcp_install_queue()
1790 queue->nr_cmds = 0; in nvmet_tcp_install_queue()
1804 struct nvmet_tcp_queue *queue = cmd->queue; in nvmet_tcp_disc_port_addr() local
1806 sprintf(traddr, "%pISc", (struct sockaddr *)&queue->sockaddr); in nvmet_tcp_disc_port_addr()
1845 struct nvmet_tcp_queue *queue; in nvmet_tcp_exit() local
1851 list_for_each_entry(queue, &nvmet_tcp_queue_list, queue_list) in nvmet_tcp_exit()
1852 kernel_sock_shutdown(queue->sock, SHUT_RDWR); in nvmet_tcp_exit()