/******************************************************************************* * * Copyright (c) 2015-2016 Intel Corporation. All rights reserved. * * This software is available to you under a choice of one of two * licenses. You may choose to be licensed under the terms of the GNU * General Public License (GPL) Version 2, available from the file * COPYING in the main directory of this source tree, or the * OpenFabrics.org BSD license below: * * Redistribution and use in source and binary forms, with or * without modification, are permitted provided that the following * conditions are met: * * - Redistributions of source code must retain the above * copyright notice, this list of conditions and the following * disclaimer. * * - Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials * provided with the distribution. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE * SOFTWARE. * *******************************************************************************/ #include "i40iw_osdep.h" #include "i40iw_register.h" #include "i40iw_status.h" #include "i40iw_hmc.h" #include "i40iw_d.h" #include "i40iw_type.h" #include "i40iw_p.h" #include "i40iw_vf.h" #include "i40iw_virtchnl.h" /** * i40iw_insert_wqe_hdr - write wqe header * @wqe: cqp wqe for header * @header: header for the cqp wqe */ static inline void i40iw_insert_wqe_hdr(u64 *wqe, u64 header) { wmb(); /* make sure WQE is populated before polarity is set */ set_64bit_val(wqe, 24, header); } /** * i40iw_get_cqp_reg_info - get head and tail for cqp using registers * @cqp: struct for cqp hw * @val: cqp tail register value * @tail:wqtail register value * @error: cqp processing err */ static inline void i40iw_get_cqp_reg_info(struct i40iw_sc_cqp *cqp, u32 *val, u32 *tail, u32 *error) { if (cqp->dev->is_pf) { *val = i40iw_rd32(cqp->dev->hw, I40E_PFPE_CQPTAIL); *tail = RS_32(*val, I40E_PFPE_CQPTAIL_WQTAIL); *error = RS_32(*val, I40E_PFPE_CQPTAIL_CQP_OP_ERR); } else { *val = i40iw_rd32(cqp->dev->hw, I40E_VFPE_CQPTAIL1); *tail = RS_32(*val, I40E_VFPE_CQPTAIL_WQTAIL); *error = RS_32(*val, I40E_VFPE_CQPTAIL_CQP_OP_ERR); } } /** * i40iw_cqp_poll_registers - poll cqp registers * @cqp: struct for cqp hw * @tail:wqtail register value * @count: how many times to try for completion */ static enum i40iw_status_code i40iw_cqp_poll_registers( struct i40iw_sc_cqp *cqp, u32 tail, u32 count) { u32 i = 0; u32 newtail, error, val; while (i < count) { i++; i40iw_get_cqp_reg_info(cqp, &val, &newtail, &error); if (error) { error = (cqp->dev->is_pf) ? i40iw_rd32(cqp->dev->hw, I40E_PFPE_CQPERRCODES) : i40iw_rd32(cqp->dev->hw, I40E_VFPE_CQPERRCODES1); return I40IW_ERR_CQP_COMPL_ERROR; } if (newtail != tail) { /* SUCCESS */ I40IW_RING_MOVE_TAIL(cqp->sq_ring); cqp->dev->cqp_cmd_stats[OP_COMPLETED_COMMANDS]++; return 0; } udelay(I40IW_SLEEP_COUNT); } return I40IW_ERR_TIMEOUT; } /** * i40iw_sc_parse_fpm_commit_buf - parse fpm commit buffer * @buf: ptr to fpm commit buffer * @info: ptr to i40iw_hmc_obj_info struct * @sd: number of SDs for HMC objects * * parses fpm commit info and copy base value * of hmc objects in hmc_info */ static enum i40iw_status_code i40iw_sc_parse_fpm_commit_buf( u64 *buf, struct i40iw_hmc_obj_info *info, u32 *sd) { u64 temp; u64 size; u64 base = 0; u32 i, j; u32 k = 0; /* copy base values in obj_info */ for (i = I40IW_HMC_IW_QP, j = 0; i <= I40IW_HMC_IW_PBLE; i++, j += 8) { if ((i == I40IW_HMC_IW_SRQ) || (i == I40IW_HMC_IW_FSIMC) || (i == I40IW_HMC_IW_FSIAV)) { info[i].base = 0; info[i].cnt = 0; continue; } get_64bit_val(buf, j, &temp); info[i].base = RS_64_1(temp, 32) * 512; if (info[i].base > base) { base = info[i].base; k = i; } if (i == I40IW_HMC_IW_APBVT_ENTRY) { info[i].cnt = 1; continue; } if (i == I40IW_HMC_IW_QP) info[i].cnt = (u32)RS_64(temp, I40IW_QUERY_FPM_MAX_QPS); else if (i == I40IW_HMC_IW_CQ) info[i].cnt = (u32)RS_64(temp, I40IW_QUERY_FPM_MAX_CQS); else info[i].cnt = (u32)(temp); } size = info[k].cnt * info[k].size + info[k].base; if (size & 0x1FFFFF) *sd = (u32)((size >> 21) + 1); /* add 1 for remainder */ else *sd = (u32)(size >> 21); return 0; } /** * i40iw_sc_decode_fpm_query() - Decode a 64 bit value into max count and size * @buf: ptr to fpm query buffer * @buf_idx: index into buf * @info: ptr to i40iw_hmc_obj_info struct * @rsrc_idx: resource index into info * * Decode a 64 bit value from fpm query buffer into max count and size */ static u64 i40iw_sc_decode_fpm_query(u64 *buf, u32 buf_idx, struct i40iw_hmc_obj_info *obj_info, u32 rsrc_idx) { u64 temp; u32 size; get_64bit_val(buf, buf_idx, &temp); obj_info[rsrc_idx].max_cnt = (u32)temp; size = (u32)RS_64_1(temp, 32); obj_info[rsrc_idx].size = LS_64_1(1, size); return temp; } /** * i40iw_sc_parse_fpm_query_buf() - parses fpm query buffer * @buf: ptr to fpm query buffer * @info: ptr to i40iw_hmc_obj_info struct * @hmc_fpm_misc: ptr to fpm data * * parses fpm query buffer and copy max_cnt and * size value of hmc objects in hmc_info */ static enum i40iw_status_code i40iw_sc_parse_fpm_query_buf( u64 *buf, struct i40iw_hmc_info *hmc_info, struct i40iw_hmc_fpm_misc *hmc_fpm_misc) { struct i40iw_hmc_obj_info *obj_info; u64 temp; u32 size; u16 max_pe_sds; obj_info = hmc_info->hmc_obj; get_64bit_val(buf, 0, &temp); hmc_info->first_sd_index = (u16)RS_64(temp, I40IW_QUERY_FPM_FIRST_PE_SD_INDEX); max_pe_sds = (u16)RS_64(temp, I40IW_QUERY_FPM_MAX_PE_SDS); /* Reduce SD count for VFs by 1 to account for PBLE backing page rounding */ if (hmc_info->hmc_fn_id >= I40IW_FIRST_VF_FPM_ID) max_pe_sds--; hmc_fpm_misc->max_sds = max_pe_sds; hmc_info->sd_table.sd_cnt = max_pe_sds + hmc_info->first_sd_index; get_64bit_val(buf, 8, &temp); obj_info[I40IW_HMC_IW_QP].max_cnt = (u32)RS_64(temp, I40IW_QUERY_FPM_MAX_QPS); size = (u32)RS_64_1(temp, 32); obj_info[I40IW_HMC_IW_QP].size = LS_64_1(1, size); get_64bit_val(buf, 16, &temp); obj_info[I40IW_HMC_IW_CQ].max_cnt = (u32)RS_64(temp, I40IW_QUERY_FPM_MAX_CQS); size = (u32)RS_64_1(temp, 32); obj_info[I40IW_HMC_IW_CQ].size = LS_64_1(1, size); i40iw_sc_decode_fpm_query(buf, 32, obj_info, I40IW_HMC_IW_HTE); i40iw_sc_decode_fpm_query(buf, 40, obj_info, I40IW_HMC_IW_ARP); obj_info[I40IW_HMC_IW_APBVT_ENTRY].size = 8192; obj_info[I40IW_HMC_IW_APBVT_ENTRY].max_cnt = 1; i40iw_sc_decode_fpm_query(buf, 48, obj_info, I40IW_HMC_IW_MR); i40iw_sc_decode_fpm_query(buf, 56, obj_info, I40IW_HMC_IW_XF); get_64bit_val(buf, 64, &temp); obj_info[I40IW_HMC_IW_XFFL].max_cnt = (u32)temp; obj_info[I40IW_HMC_IW_XFFL].size = 4; hmc_fpm_misc->xf_block_size = RS_64(temp, I40IW_QUERY_FPM_XFBLOCKSIZE); if (!hmc_fpm_misc->xf_block_size) return I40IW_ERR_INVALID_SIZE; i40iw_sc_decode_fpm_query(buf, 72, obj_info, I40IW_HMC_IW_Q1); get_64bit_val(buf, 80, &temp); obj_info[I40IW_HMC_IW_Q1FL].max_cnt = (u32)temp; obj_info[I40IW_HMC_IW_Q1FL].size = 4; hmc_fpm_misc->q1_block_size = RS_64(temp, I40IW_QUERY_FPM_Q1BLOCKSIZE); if (!hmc_fpm_misc->q1_block_size) return I40IW_ERR_INVALID_SIZE; i40iw_sc_decode_fpm_query(buf, 88, obj_info, I40IW_HMC_IW_TIMER); get_64bit_val(buf, 112, &temp); obj_info[I40IW_HMC_IW_PBLE].max_cnt = (u32)temp; obj_info[I40IW_HMC_IW_PBLE].size = 8; get_64bit_val(buf, 120, &temp); hmc_fpm_misc->max_ceqs = (u8)RS_64(temp, I40IW_QUERY_FPM_MAX_CEQS); hmc_fpm_misc->ht_multiplier = RS_64(temp, I40IW_QUERY_FPM_HTMULTIPLIER); hmc_fpm_misc->timer_bucket = RS_64(temp, I40IW_QUERY_FPM_TIMERBUCKET); return 0; } /** * i40iw_fill_qos_list - Change all unknown qs handles to available ones * @qs_list: list of qs_handles to be fixed with valid qs_handles */ static void i40iw_fill_qos_list(u16 *qs_list) { u16 qshandle = qs_list[0]; int i; for (i = 0; i < I40IW_MAX_USER_PRIORITY; i++) { if (qs_list[i] == QS_HANDLE_UNKNOWN) qs_list[i] = qshandle; else qshandle = qs_list[i]; } } /** * i40iw_qp_from_entry - Given entry, get to the qp structure * @entry: Points to list of qp structure */ static struct i40iw_sc_qp *i40iw_qp_from_entry(struct list_head *entry) { if (!entry) return NULL; return (struct i40iw_sc_qp *)((char *)entry - offsetof(struct i40iw_sc_qp, list)); } /** * i40iw_get_qp - get the next qp from the list given current qp * @head: Listhead of qp's * @qp: current qp */ static struct i40iw_sc_qp *i40iw_get_qp(struct list_head *head, struct i40iw_sc_qp *qp) { struct list_head *entry = NULL; struct list_head *lastentry; if (list_empty(head)) return NULL; if (!qp) { entry = head->next; } else { lastentry = &qp->list; entry = (lastentry != head) ? lastentry->next : NULL; } return i40iw_qp_from_entry(entry); } /** * i40iw_change_l2params - given the new l2 parameters, change all qp * @vsi: pointer to the vsi structure * @l2params: New paramaters from l2 */ void i40iw_change_l2params(struct i40iw_sc_vsi *vsi, struct i40iw_l2params *l2params) { struct i40iw_sc_dev *dev = vsi->dev; struct i40iw_sc_qp *qp = NULL; bool qs_handle_change = false; unsigned long flags; u16 qs_handle; int i; vsi->mss = l2params->mss; i40iw_fill_qos_list(l2params->qs_handle_list); for (i = 0; i < I40IW_MAX_USER_PRIORITY; i++) { qs_handle = l2params->qs_handle_list[i]; if (vsi->qos[i].qs_handle != qs_handle) qs_handle_change = true; spin_lock_irqsave(&vsi->qos[i].lock, flags); qp = i40iw_get_qp(&vsi->qos[i].qplist, qp); while (qp) { if (qs_handle_change) { qp->qs_handle = qs_handle; /* issue cqp suspend command */ i40iw_qp_suspend_resume(dev, qp, true); } qp = i40iw_get_qp(&vsi->qos[i].qplist, qp); } spin_unlock_irqrestore(&vsi->qos[i].lock, flags); vsi->qos[i].qs_handle = qs_handle; } } /** * i40iw_qp_rem_qos - remove qp from qos lists during destroy qp * @qp: qp to be removed from qos */ static void i40iw_qp_rem_qos(struct i40iw_sc_qp *qp) { struct i40iw_sc_vsi *vsi = qp->vsi; unsigned long flags; if (!qp->on_qoslist) return; spin_lock_irqsave(&vsi->qos[qp->user_pri].lock, flags); list_del(&qp->list); spin_unlock_irqrestore(&vsi->qos[qp->user_pri].lock, flags); } /** * i40iw_qp_add_qos - called during setctx fot qp to be added to qos * @qp: qp to be added to qos */ void i40iw_qp_add_qos(struct i40iw_sc_qp *qp) { struct i40iw_sc_vsi *vsi = qp->vsi; unsigned long flags; if (qp->on_qoslist) return; spin_lock_irqsave(&vsi->qos[qp->user_pri].lock, flags); qp->qs_handle = vsi->qos[qp->user_pri].qs_handle; list_add(&qp->list, &vsi->qos[qp->user_pri].qplist); qp->on_qoslist = true; spin_unlock_irqrestore(&vsi->qos[qp->user_pri].lock, flags); } /** * i40iw_sc_pd_init - initialize sc pd struct * @dev: sc device struct * @pd: sc pd ptr * @pd_id: pd_id for allocated pd * @abi_ver: ABI version from user context, -1 if not valid */ static void i40iw_sc_pd_init(struct i40iw_sc_dev *dev, struct i40iw_sc_pd *pd, u16 pd_id, int abi_ver) { pd->size = sizeof(*pd); pd->pd_id = pd_id; pd->abi_ver = abi_ver; pd->dev = dev; } /** * i40iw_get_encoded_wqe_size - given wq size, returns hardware encoded size * @wqsize: size of the wq (sq, rq, srq) to encoded_size * @cqpsq: encoded size for sq for cqp as its encoded size is 1+ other wq's */ u8 i40iw_get_encoded_wqe_size(u32 wqsize, bool cqpsq) { u8 encoded_size = 0; /* cqp sq's hw coded value starts from 1 for size of 4 * while it starts from 0 for qp' wq's. */ if (cqpsq) encoded_size = 1; wqsize >>= 2; while (wqsize >>= 1) encoded_size++; return encoded_size; } /** * i40iw_sc_cqp_init - Initialize buffers for a control Queue Pair * @cqp: IWARP control queue pair pointer * @info: IWARP control queue pair init info pointer * * Initializes the object and context buffers for a control Queue Pair. */ static enum i40iw_status_code i40iw_sc_cqp_init(struct i40iw_sc_cqp *cqp, struct i40iw_cqp_init_info *info) { u8 hw_sq_size; if ((info->sq_size > I40IW_CQP_SW_SQSIZE_2048) || (info->sq_size < I40IW_CQP_SW_SQSIZE_4) || ((info->sq_size & (info->sq_size - 1)))) return I40IW_ERR_INVALID_SIZE; hw_sq_size = i40iw_get_encoded_wqe_size(info->sq_size, true); cqp->size = sizeof(*cqp); cqp->sq_size = info->sq_size; cqp->hw_sq_size = hw_sq_size; cqp->sq_base = info->sq; cqp->host_ctx = info->host_ctx; cqp->sq_pa = info->sq_pa; cqp->host_ctx_pa = info->host_ctx_pa; cqp->dev = info->dev; cqp->struct_ver = info->struct_ver; cqp->scratch_array = info->scratch_array; cqp->polarity = 0; cqp->en_datacenter_tcp = info->en_datacenter_tcp; cqp->enabled_vf_count = info->enabled_vf_count; cqp->hmc_profile = info->hmc_profile; info->dev->cqp = cqp; I40IW_RING_INIT(cqp->sq_ring, cqp->sq_size); cqp->dev->cqp_cmd_stats[OP_REQUESTED_COMMANDS] = 0; cqp->dev->cqp_cmd_stats[OP_COMPLETED_COMMANDS] = 0; i40iw_debug(cqp->dev, I40IW_DEBUG_WQE, "%s: sq_size[%04d] hw_sq_size[%04d] sq_base[%p] sq_pa[%llxh] cqp[%p] polarity[x%04X]\n", __func__, cqp->sq_size, cqp->hw_sq_size, cqp->sq_base, cqp->sq_pa, cqp, cqp->polarity); return 0; } /** * i40iw_sc_cqp_create - create cqp during bringup * @cqp: struct for cqp hw * @maj_err: If error, major err number * @min_err: If error, minor err number */ static enum i40iw_status_code i40iw_sc_cqp_create(struct i40iw_sc_cqp *cqp, u16 *maj_err, u16 *min_err) { u64 temp; u32 cnt = 0, p1, p2, val = 0, err_code; enum i40iw_status_code ret_code; *maj_err = 0; *min_err = 0; ret_code = i40iw_allocate_dma_mem(cqp->dev->hw, &cqp->sdbuf, 128, I40IW_SD_BUF_ALIGNMENT); if (ret_code) goto exit; temp = LS_64(cqp->hw_sq_size, I40IW_CQPHC_SQSIZE) | LS_64(cqp->struct_ver, I40IW_CQPHC_SVER); set_64bit_val(cqp->host_ctx, 0, temp); set_64bit_val(cqp->host_ctx, 8, cqp->sq_pa); temp = LS_64(cqp->enabled_vf_count, I40IW_CQPHC_ENABLED_VFS) | LS_64(cqp->hmc_profile, I40IW_CQPHC_HMC_PROFILE); set_64bit_val(cqp->host_ctx, 16, temp); set_64bit_val(cqp->host_ctx, 24, (uintptr_t)cqp); set_64bit_val(cqp->host_ctx, 32, 0); set_64bit_val(cqp->host_ctx, 40, 0); set_64bit_val(cqp->host_ctx, 48, 0); set_64bit_val(cqp->host_ctx, 56, 0); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CQP_HOST_CTX", cqp->host_ctx, I40IW_CQP_CTX_SIZE * 8); p1 = RS_32_1(cqp->host_ctx_pa, 32); p2 = (u32)cqp->host_ctx_pa; if (cqp->dev->is_pf) { i40iw_wr32(cqp->dev->hw, I40E_PFPE_CCQPHIGH, p1); i40iw_wr32(cqp->dev->hw, I40E_PFPE_CCQPLOW, p2); } else { i40iw_wr32(cqp->dev->hw, I40E_VFPE_CCQPHIGH1, p1); i40iw_wr32(cqp->dev->hw, I40E_VFPE_CCQPLOW1, p2); } do { if (cnt++ > I40IW_DONE_COUNT) { i40iw_free_dma_mem(cqp->dev->hw, &cqp->sdbuf); ret_code = I40IW_ERR_TIMEOUT; /* * read PFPE_CQPERRORCODES register to get the minor * and major error code */ if (cqp->dev->is_pf) err_code = i40iw_rd32(cqp->dev->hw, I40E_PFPE_CQPERRCODES); else err_code = i40iw_rd32(cqp->dev->hw, I40E_VFPE_CQPERRCODES1); *min_err = RS_32(err_code, I40E_PFPE_CQPERRCODES_CQP_MINOR_CODE); *maj_err = RS_32(err_code, I40E_PFPE_CQPERRCODES_CQP_MAJOR_CODE); goto exit; } udelay(I40IW_SLEEP_COUNT); if (cqp->dev->is_pf) val = i40iw_rd32(cqp->dev->hw, I40E_PFPE_CCQPSTATUS); else val = i40iw_rd32(cqp->dev->hw, I40E_VFPE_CCQPSTATUS1); } while (!val); exit: if (!ret_code) cqp->process_cqp_sds = i40iw_update_sds_noccq; return ret_code; } /** * i40iw_sc_cqp_post_sq - post of cqp's sq * @cqp: struct for cqp hw */ void i40iw_sc_cqp_post_sq(struct i40iw_sc_cqp *cqp) { if (cqp->dev->is_pf) i40iw_wr32(cqp->dev->hw, I40E_PFPE_CQPDB, I40IW_RING_GETCURRENT_HEAD(cqp->sq_ring)); else i40iw_wr32(cqp->dev->hw, I40E_VFPE_CQPDB1, I40IW_RING_GETCURRENT_HEAD(cqp->sq_ring)); i40iw_debug(cqp->dev, I40IW_DEBUG_WQE, "%s: HEAD_TAIL[%04d,%04d,%04d]\n", __func__, cqp->sq_ring.head, cqp->sq_ring.tail, cqp->sq_ring.size); } /** * i40iw_sc_cqp_get_next_send_wqe - get next wqe on cqp sq * @cqp: struct for cqp hw * @wqe_idx: we index of cqp ring */ u64 *i40iw_sc_cqp_get_next_send_wqe(struct i40iw_sc_cqp *cqp, u64 scratch) { u64 *wqe = NULL; u32 wqe_idx; enum i40iw_status_code ret_code; if (I40IW_RING_FULL_ERR(cqp->sq_ring)) { i40iw_debug(cqp->dev, I40IW_DEBUG_WQE, "%s: ring is full head %x tail %x size %x\n", __func__, cqp->sq_ring.head, cqp->sq_ring.tail, cqp->sq_ring.size); return NULL; } I40IW_ATOMIC_RING_MOVE_HEAD(cqp->sq_ring, wqe_idx, ret_code); cqp->dev->cqp_cmd_stats[OP_REQUESTED_COMMANDS]++; if (ret_code) return NULL; if (!wqe_idx) cqp->polarity = !cqp->polarity; wqe = cqp->sq_base[wqe_idx].elem; cqp->scratch_array[wqe_idx] = scratch; I40IW_CQP_INIT_WQE(wqe); return wqe; } /** * i40iw_sc_cqp_destroy - destroy cqp during close * @cqp: struct for cqp hw */ static enum i40iw_status_code i40iw_sc_cqp_destroy(struct i40iw_sc_cqp *cqp) { u32 cnt = 0, val = 1; enum i40iw_status_code ret_code = 0; u32 cqpstat_addr; if (cqp->dev->is_pf) { i40iw_wr32(cqp->dev->hw, I40E_PFPE_CCQPHIGH, 0); i40iw_wr32(cqp->dev->hw, I40E_PFPE_CCQPLOW, 0); cqpstat_addr = I40E_PFPE_CCQPSTATUS; } else { i40iw_wr32(cqp->dev->hw, I40E_VFPE_CCQPHIGH1, 0); i40iw_wr32(cqp->dev->hw, I40E_VFPE_CCQPLOW1, 0); cqpstat_addr = I40E_VFPE_CCQPSTATUS1; } do { if (cnt++ > I40IW_DONE_COUNT) { ret_code = I40IW_ERR_TIMEOUT; break; } udelay(I40IW_SLEEP_COUNT); val = i40iw_rd32(cqp->dev->hw, cqpstat_addr); } while (val); i40iw_free_dma_mem(cqp->dev->hw, &cqp->sdbuf); return ret_code; } /** * i40iw_sc_ccq_arm - enable intr for control cq * @ccq: ccq sc struct */ static void i40iw_sc_ccq_arm(struct i40iw_sc_cq *ccq) { u64 temp_val; u16 sw_cq_sel; u8 arm_next_se; u8 arm_seq_num; /* write to cq doorbell shadow area */ /* arm next se should always be zero */ get_64bit_val(ccq->cq_uk.shadow_area, 32, &temp_val); sw_cq_sel = (u16)RS_64(temp_val, I40IW_CQ_DBSA_SW_CQ_SELECT); arm_next_se = (u8)RS_64(temp_val, I40IW_CQ_DBSA_ARM_NEXT_SE); arm_seq_num = (u8)RS_64(temp_val, I40IW_CQ_DBSA_ARM_SEQ_NUM); arm_seq_num++; temp_val = LS_64(arm_seq_num, I40IW_CQ_DBSA_ARM_SEQ_NUM) | LS_64(sw_cq_sel, I40IW_CQ_DBSA_SW_CQ_SELECT) | LS_64(arm_next_se, I40IW_CQ_DBSA_ARM_NEXT_SE) | LS_64(1, I40IW_CQ_DBSA_ARM_NEXT); set_64bit_val(ccq->cq_uk.shadow_area, 32, temp_val); wmb(); /* make sure shadow area is updated before arming */ if (ccq->dev->is_pf) i40iw_wr32(ccq->dev->hw, I40E_PFPE_CQARM, ccq->cq_uk.cq_id); else i40iw_wr32(ccq->dev->hw, I40E_VFPE_CQARM1, ccq->cq_uk.cq_id); } /** * i40iw_sc_ccq_get_cqe_info - get ccq's cq entry * @ccq: ccq sc struct * @info: completion q entry to return */ static enum i40iw_status_code i40iw_sc_ccq_get_cqe_info( struct i40iw_sc_cq *ccq, struct i40iw_ccq_cqe_info *info) { u64 qp_ctx, temp, temp1; u64 *cqe; struct i40iw_sc_cqp *cqp; u32 wqe_idx; u8 polarity; enum i40iw_status_code ret_code = 0; if (ccq->cq_uk.avoid_mem_cflct) cqe = (u64 *)I40IW_GET_CURRENT_EXTENDED_CQ_ELEMENT(&ccq->cq_uk); else cqe = (u64 *)I40IW_GET_CURRENT_CQ_ELEMENT(&ccq->cq_uk); get_64bit_val(cqe, 24, &temp); polarity = (u8)RS_64(temp, I40IW_CQ_VALID); if (polarity != ccq->cq_uk.polarity) return I40IW_ERR_QUEUE_EMPTY; get_64bit_val(cqe, 8, &qp_ctx); cqp = (struct i40iw_sc_cqp *)(unsigned long)qp_ctx; info->error = (bool)RS_64(temp, I40IW_CQ_ERROR); info->min_err_code = (u16)RS_64(temp, I40IW_CQ_MINERR); if (info->error) { info->maj_err_code = (u16)RS_64(temp, I40IW_CQ_MAJERR); info->min_err_code = (u16)RS_64(temp, I40IW_CQ_MINERR); } wqe_idx = (u32)RS_64(temp, I40IW_CQ_WQEIDX); info->scratch = cqp->scratch_array[wqe_idx]; get_64bit_val(cqe, 16, &temp1); info->op_ret_val = (u32)RS_64(temp1, I40IW_CCQ_OPRETVAL); get_64bit_val(cqp->sq_base[wqe_idx].elem, 24, &temp1); info->op_code = (u8)RS_64(temp1, I40IW_CQPSQ_OPCODE); info->cqp = cqp; /* move the head for cq */ I40IW_RING_MOVE_HEAD(ccq->cq_uk.cq_ring, ret_code); if (I40IW_RING_GETCURRENT_HEAD(ccq->cq_uk.cq_ring) == 0) ccq->cq_uk.polarity ^= 1; /* update cq tail in cq shadow memory also */ I40IW_RING_MOVE_TAIL(ccq->cq_uk.cq_ring); set_64bit_val(ccq->cq_uk.shadow_area, 0, I40IW_RING_GETCURRENT_HEAD(ccq->cq_uk.cq_ring)); wmb(); /* write shadow area before tail */ I40IW_RING_MOVE_TAIL(cqp->sq_ring); ccq->dev->cqp_cmd_stats[OP_COMPLETED_COMMANDS]++; return ret_code; } /** * i40iw_sc_poll_for_cqp_op_done - Waits for last write to complete in CQP SQ * @cqp: struct for cqp hw * @op_code: cqp opcode for completion * @info: completion q entry to return */ static enum i40iw_status_code i40iw_sc_poll_for_cqp_op_done( struct i40iw_sc_cqp *cqp, u8 op_code, struct i40iw_ccq_cqe_info *compl_info) { struct i40iw_ccq_cqe_info info; struct i40iw_sc_cq *ccq; enum i40iw_status_code ret_code = 0; u32 cnt = 0; memset(&info, 0, sizeof(info)); ccq = cqp->dev->ccq; while (1) { if (cnt++ > I40IW_DONE_COUNT) return I40IW_ERR_TIMEOUT; if (i40iw_sc_ccq_get_cqe_info(ccq, &info)) { udelay(I40IW_SLEEP_COUNT); continue; } if (info.error) { ret_code = I40IW_ERR_CQP_COMPL_ERROR; break; } /* check if opcode is cq create */ if (op_code != info.op_code) { i40iw_debug(cqp->dev, I40IW_DEBUG_WQE, "%s: opcode mismatch for my op code 0x%x, returned opcode %x\n", __func__, op_code, info.op_code); } /* success, exit out of the loop */ if (op_code == info.op_code) break; } if (compl_info) memcpy(compl_info, &info, sizeof(*compl_info)); return ret_code; } /** * i40iw_sc_manage_push_page - Handle push page * @cqp: struct for cqp hw * @info: push page info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_manage_push_page( struct i40iw_sc_cqp *cqp, struct i40iw_cqp_manage_push_page_info *info, u64 scratch, bool post_sq) { u64 *wqe; u64 header; if (info->push_idx >= I40IW_MAX_PUSH_PAGE_COUNT) return I40IW_ERR_INVALID_PUSH_PAGE_INDEX; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, info->qs_handle); header = LS_64(info->push_idx, I40IW_CQPSQ_MPP_PPIDX) | LS_64(I40IW_CQP_OP_MANAGE_PUSH_PAGES, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID) | LS_64(info->free_page, I40IW_CQPSQ_MPP_FREE_PAGE); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "MANAGE_PUSH_PAGES WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_manage_hmc_pm_func_table - manage of function table * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @vf_index: vf index for cqp * @free_pm_fcn: function number * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_manage_hmc_pm_func_table( struct i40iw_sc_cqp *cqp, u64 scratch, u8 vf_index, bool free_pm_fcn, bool post_sq) { u64 *wqe; u64 header; if (vf_index >= I40IW_MAX_VF_PER_PF) return I40IW_ERR_INVALID_VF_ID; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = LS_64(vf_index, I40IW_CQPSQ_MHMC_VFIDX) | LS_64(I40IW_CQP_OP_MANAGE_HMC_PM_FUNC_TABLE, I40IW_CQPSQ_OPCODE) | LS_64(free_pm_fcn, I40IW_CQPSQ_MHMC_FREEPMFN) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "MANAGE_HMC_PM_FUNC_TABLE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_set_hmc_resource_profile - cqp wqe for hmc profile * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @hmc_profile_type: type of profile to set * @vf_num: vf number for profile * @post_sq: flag for cqp db to ring * @poll_registers: flag to poll register for cqp completion */ static enum i40iw_status_code i40iw_sc_set_hmc_resource_profile( struct i40iw_sc_cqp *cqp, u64 scratch, u8 hmc_profile_type, u8 vf_num, bool post_sq, bool poll_registers) { u64 *wqe; u64 header; u32 val, tail, error; enum i40iw_status_code ret_code = 0; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, (LS_64(hmc_profile_type, I40IW_CQPSQ_SHMCRP_HMC_PROFILE) | LS_64(vf_num, I40IW_CQPSQ_SHMCRP_VFNUM))); header = LS_64(I40IW_CQP_OP_SET_HMC_RESOURCE_PROFILE, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "MANAGE_HMC_PM_FUNC_TABLE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); i40iw_get_cqp_reg_info(cqp, &val, &tail, &error); if (error) return I40IW_ERR_CQP_COMPL_ERROR; if (post_sq) { i40iw_sc_cqp_post_sq(cqp); if (poll_registers) ret_code = i40iw_cqp_poll_registers(cqp, tail, 1000000); else ret_code = i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_SHMC_PAGES_ALLOCATED, NULL); } return ret_code; } /** * i40iw_sc_manage_hmc_pm_func_table_done - wait for cqp wqe completion for function table * @cqp: struct for cqp hw */ static enum i40iw_status_code i40iw_sc_manage_hmc_pm_func_table_done(struct i40iw_sc_cqp *cqp) { return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_MANAGE_HMC_PM_FUNC_TABLE, NULL); } /** * i40iw_sc_commit_fpm_values_done - wait for cqp eqe completion for fpm commit * @cqp: struct for cqp hw */ static enum i40iw_status_code i40iw_sc_commit_fpm_values_done(struct i40iw_sc_cqp *cqp) { return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_COMMIT_FPM_VALUES, NULL); } /** * i40iw_sc_commit_fpm_values - cqp wqe for commit fpm values * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @hmc_fn_id: hmc function id * @commit_fpm_mem; Memory for fpm values * @post_sq: flag for cqp db to ring * @wait_type: poll ccq or cqp registers for cqp completion */ static enum i40iw_status_code i40iw_sc_commit_fpm_values( struct i40iw_sc_cqp *cqp, u64 scratch, u8 hmc_fn_id, struct i40iw_dma_mem *commit_fpm_mem, bool post_sq, u8 wait_type) { u64 *wqe; u64 header; u32 tail, val, error; enum i40iw_status_code ret_code = 0; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, hmc_fn_id); set_64bit_val(wqe, 32, commit_fpm_mem->pa); header = LS_64(I40IW_CQP_OP_COMMIT_FPM_VALUES, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "COMMIT_FPM_VALUES WQE", wqe, I40IW_CQP_WQE_SIZE * 8); i40iw_get_cqp_reg_info(cqp, &val, &tail, &error); if (error) return I40IW_ERR_CQP_COMPL_ERROR; if (post_sq) { i40iw_sc_cqp_post_sq(cqp); if (wait_type == I40IW_CQP_WAIT_POLL_REGS) ret_code = i40iw_cqp_poll_registers(cqp, tail, I40IW_DONE_COUNT); else if (wait_type == I40IW_CQP_WAIT_POLL_CQ) ret_code = i40iw_sc_commit_fpm_values_done(cqp); } return ret_code; } /** * i40iw_sc_query_fpm_values_done - poll for cqp wqe completion for query fpm * @cqp: struct for cqp hw */ static enum i40iw_status_code i40iw_sc_query_fpm_values_done(struct i40iw_sc_cqp *cqp) { return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_QUERY_FPM_VALUES, NULL); } /** * i40iw_sc_query_fpm_values - cqp wqe query fpm values * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @hmc_fn_id: hmc function id * @query_fpm_mem: memory for return fpm values * @post_sq: flag for cqp db to ring * @wait_type: poll ccq or cqp registers for cqp completion */ static enum i40iw_status_code i40iw_sc_query_fpm_values( struct i40iw_sc_cqp *cqp, u64 scratch, u8 hmc_fn_id, struct i40iw_dma_mem *query_fpm_mem, bool post_sq, u8 wait_type) { u64 *wqe; u64 header; u32 tail, val, error; enum i40iw_status_code ret_code = 0; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, hmc_fn_id); set_64bit_val(wqe, 32, query_fpm_mem->pa); header = LS_64(I40IW_CQP_OP_QUERY_FPM_VALUES, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "QUERY_FPM WQE", wqe, I40IW_CQP_WQE_SIZE * 8); /* read the tail from CQP_TAIL register */ i40iw_get_cqp_reg_info(cqp, &val, &tail, &error); if (error) return I40IW_ERR_CQP_COMPL_ERROR; if (post_sq) { i40iw_sc_cqp_post_sq(cqp); if (wait_type == I40IW_CQP_WAIT_POLL_REGS) ret_code = i40iw_cqp_poll_registers(cqp, tail, I40IW_DONE_COUNT); else if (wait_type == I40IW_CQP_WAIT_POLL_CQ) ret_code = i40iw_sc_query_fpm_values_done(cqp); } return ret_code; } /** * i40iw_sc_add_arp_cache_entry - cqp wqe add arp cache entry * @cqp: struct for cqp hw * @info: arp entry information * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_add_arp_cache_entry( struct i40iw_sc_cqp *cqp, struct i40iw_add_arp_cache_entry_info *info, u64 scratch, bool post_sq) { u64 *wqe; u64 temp, header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 8, info->reach_max); temp = info->mac_addr[5] | LS_64_1(info->mac_addr[4], 8) | LS_64_1(info->mac_addr[3], 16) | LS_64_1(info->mac_addr[2], 24) | LS_64_1(info->mac_addr[1], 32) | LS_64_1(info->mac_addr[0], 40); set_64bit_val(wqe, 16, temp); header = info->arp_index | LS_64(I40IW_CQP_OP_MANAGE_ARP, I40IW_CQPSQ_OPCODE) | LS_64((info->permanent ? 1 : 0), I40IW_CQPSQ_MAT_PERMANENT) | LS_64(1, I40IW_CQPSQ_MAT_ENTRYVALID) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "ARP_CACHE_ENTRY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_del_arp_cache_entry - dele arp cache entry * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @arp_index: arp index to delete arp entry * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_del_arp_cache_entry( struct i40iw_sc_cqp *cqp, u64 scratch, u16 arp_index, bool post_sq) { u64 *wqe; u64 header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = arp_index | LS_64(I40IW_CQP_OP_MANAGE_ARP, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "ARP_CACHE_DEL_ENTRY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_query_arp_cache_entry - cqp wqe to query arp and arp index * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @arp_index: arp index to delete arp entry * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_query_arp_cache_entry( struct i40iw_sc_cqp *cqp, u64 scratch, u16 arp_index, bool post_sq) { u64 *wqe; u64 header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = arp_index | LS_64(I40IW_CQP_OP_MANAGE_ARP, I40IW_CQPSQ_OPCODE) | LS_64(1, I40IW_CQPSQ_MAT_QUERY) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "QUERY_ARP_CACHE_ENTRY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_manage_apbvt_entry - for adding and deleting apbvt entries * @cqp: struct for cqp hw * @info: info for apbvt entry to add or delete * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_manage_apbvt_entry( struct i40iw_sc_cqp *cqp, struct i40iw_apbvt_info *info, u64 scratch, bool post_sq) { u64 *wqe; u64 header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, info->port); header = LS_64(I40IW_CQP_OP_MANAGE_APBVT, I40IW_CQPSQ_OPCODE) | LS_64(info->add, I40IW_CQPSQ_MAPT_ADDPORT) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "MANAGE_APBVT WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_manage_qhash_table_entry - manage quad hash entries * @cqp: struct for cqp hw * @info: info for quad hash to manage * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring * * This is called before connection establishment is started. For passive connections, when * listener is created, it will call with entry type of I40IW_QHASH_TYPE_TCP_SYN with local * ip address and tcp port. When SYN is received (passive connections) or * sent (active connections), this routine is called with entry type of * I40IW_QHASH_TYPE_TCP_ESTABLISHED and quad is passed in info. * * When iwarp connection is done and its state moves to RTS, the quad hash entry in * the hardware will point to iwarp's qp number and requires no calls from the driver. */ static enum i40iw_status_code i40iw_sc_manage_qhash_table_entry( struct i40iw_sc_cqp *cqp, struct i40iw_qhash_table_info *info, u64 scratch, bool post_sq) { u64 *wqe; u64 qw1 = 0; u64 qw2 = 0; u64 temp; struct i40iw_sc_vsi *vsi = info->vsi; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; temp = info->mac_addr[5] | LS_64_1(info->mac_addr[4], 8) | LS_64_1(info->mac_addr[3], 16) | LS_64_1(info->mac_addr[2], 24) | LS_64_1(info->mac_addr[1], 32) | LS_64_1(info->mac_addr[0], 40); set_64bit_val(wqe, 0, temp); qw1 = LS_64(info->qp_num, I40IW_CQPSQ_QHASH_QPN) | LS_64(info->dest_port, I40IW_CQPSQ_QHASH_DEST_PORT); if (info->ipv4_valid) { set_64bit_val(wqe, 48, LS_64(info->dest_ip[0], I40IW_CQPSQ_QHASH_ADDR3)); } else { set_64bit_val(wqe, 56, LS_64(info->dest_ip[0], I40IW_CQPSQ_QHASH_ADDR0) | LS_64(info->dest_ip[1], I40IW_CQPSQ_QHASH_ADDR1)); set_64bit_val(wqe, 48, LS_64(info->dest_ip[2], I40IW_CQPSQ_QHASH_ADDR2) | LS_64(info->dest_ip[3], I40IW_CQPSQ_QHASH_ADDR3)); } qw2 = LS_64(vsi->qos[info->user_pri].qs_handle, I40IW_CQPSQ_QHASH_QS_HANDLE); if (info->vlan_valid) qw2 |= LS_64(info->vlan_id, I40IW_CQPSQ_QHASH_VLANID); set_64bit_val(wqe, 16, qw2); if (info->entry_type == I40IW_QHASH_TYPE_TCP_ESTABLISHED) { qw1 |= LS_64(info->src_port, I40IW_CQPSQ_QHASH_SRC_PORT); if (!info->ipv4_valid) { set_64bit_val(wqe, 40, LS_64(info->src_ip[0], I40IW_CQPSQ_QHASH_ADDR0) | LS_64(info->src_ip[1], I40IW_CQPSQ_QHASH_ADDR1)); set_64bit_val(wqe, 32, LS_64(info->src_ip[2], I40IW_CQPSQ_QHASH_ADDR2) | LS_64(info->src_ip[3], I40IW_CQPSQ_QHASH_ADDR3)); } else { set_64bit_val(wqe, 32, LS_64(info->src_ip[0], I40IW_CQPSQ_QHASH_ADDR3)); } } set_64bit_val(wqe, 8, qw1); temp = LS_64(cqp->polarity, I40IW_CQPSQ_QHASH_WQEVALID) | LS_64(I40IW_CQP_OP_MANAGE_QUAD_HASH_TABLE_ENTRY, I40IW_CQPSQ_QHASH_OPCODE) | LS_64(info->manage, I40IW_CQPSQ_QHASH_MANAGE) | LS_64(info->ipv4_valid, I40IW_CQPSQ_QHASH_IPV4VALID) | LS_64(info->vlan_valid, I40IW_CQPSQ_QHASH_VLANVALID) | LS_64(info->entry_type, I40IW_CQPSQ_QHASH_ENTRYTYPE); i40iw_insert_wqe_hdr(wqe, temp); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "MANAGE_QHASH WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_alloc_local_mac_ipaddr_entry - cqp wqe for loc mac entry * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_alloc_local_mac_ipaddr_entry( struct i40iw_sc_cqp *cqp, u64 scratch, bool post_sq) { u64 *wqe; u64 header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = LS_64(I40IW_CQP_OP_ALLOCATE_LOC_MAC_IP_TABLE_ENTRY, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "ALLOCATE_LOCAL_MAC_IPADDR WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_add_local_mac_ipaddr_entry - add mac enry * @cqp: struct for cqp hw * @info:mac addr info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_add_local_mac_ipaddr_entry( struct i40iw_sc_cqp *cqp, struct i40iw_local_mac_ipaddr_entry_info *info, u64 scratch, bool post_sq) { u64 *wqe; u64 temp, header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; temp = info->mac_addr[5] | LS_64_1(info->mac_addr[4], 8) | LS_64_1(info->mac_addr[3], 16) | LS_64_1(info->mac_addr[2], 24) | LS_64_1(info->mac_addr[1], 32) | LS_64_1(info->mac_addr[0], 40); set_64bit_val(wqe, 32, temp); header = LS_64(info->entry_idx, I40IW_CQPSQ_MLIPA_IPTABLEIDX) | LS_64(I40IW_CQP_OP_MANAGE_LOC_MAC_IP_TABLE, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "ADD_LOCAL_MAC_IPADDR WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_del_local_mac_ipaddr_entry - cqp wqe to dele local mac * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @entry_idx: index of mac entry * @ ignore_ref_count: to force mac adde delete * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_del_local_mac_ipaddr_entry( struct i40iw_sc_cqp *cqp, u64 scratch, u8 entry_idx, u8 ignore_ref_count, bool post_sq) { u64 *wqe; u64 header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = LS_64(entry_idx, I40IW_CQPSQ_MLIPA_IPTABLEIDX) | LS_64(I40IW_CQP_OP_MANAGE_LOC_MAC_IP_TABLE, I40IW_CQPSQ_OPCODE) | LS_64(1, I40IW_CQPSQ_MLIPA_FREEENTRY) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID) | LS_64(ignore_ref_count, I40IW_CQPSQ_MLIPA_IGNORE_REF_CNT); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "DEL_LOCAL_MAC_IPADDR WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_cqp_nop - send a nop wqe * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_cqp_nop(struct i40iw_sc_cqp *cqp, u64 scratch, bool post_sq) { u64 *wqe; u64 header; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = LS_64(I40IW_CQP_OP_NOP, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "NOP WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_ceq_init - initialize ceq * @ceq: ceq sc structure * @info: ceq initialization info */ static enum i40iw_status_code i40iw_sc_ceq_init(struct i40iw_sc_ceq *ceq, struct i40iw_ceq_init_info *info) { u32 pble_obj_cnt; if ((info->elem_cnt < I40IW_MIN_CEQ_ENTRIES) || (info->elem_cnt > I40IW_MAX_CEQ_ENTRIES)) return I40IW_ERR_INVALID_SIZE; if (info->ceq_id >= I40IW_MAX_CEQID) return I40IW_ERR_INVALID_CEQ_ID; pble_obj_cnt = info->dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if (info->virtual_map && (info->first_pm_pbl_idx >= pble_obj_cnt)) return I40IW_ERR_INVALID_PBLE_INDEX; ceq->size = sizeof(*ceq); ceq->ceqe_base = (struct i40iw_ceqe *)info->ceqe_base; ceq->ceq_id = info->ceq_id; ceq->dev = info->dev; ceq->elem_cnt = info->elem_cnt; ceq->ceq_elem_pa = info->ceqe_pa; ceq->virtual_map = info->virtual_map; ceq->pbl_chunk_size = (ceq->virtual_map ? info->pbl_chunk_size : 0); ceq->first_pm_pbl_idx = (ceq->virtual_map ? info->first_pm_pbl_idx : 0); ceq->pbl_list = (ceq->virtual_map ? info->pbl_list : NULL); ceq->tph_en = info->tph_en; ceq->tph_val = info->tph_val; ceq->polarity = 1; I40IW_RING_INIT(ceq->ceq_ring, ceq->elem_cnt); ceq->dev->ceq[info->ceq_id] = ceq; return 0; } /** * i40iw_sc_ceq_create - create ceq wqe * @ceq: ceq sc structure * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_ceq_create(struct i40iw_sc_ceq *ceq, u64 scratch, bool post_sq) { struct i40iw_sc_cqp *cqp; u64 *wqe; u64 header; cqp = ceq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, ceq->elem_cnt); set_64bit_val(wqe, 32, (ceq->virtual_map ? 0 : ceq->ceq_elem_pa)); set_64bit_val(wqe, 48, (ceq->virtual_map ? ceq->first_pm_pbl_idx : 0)); set_64bit_val(wqe, 56, LS_64(ceq->tph_val, I40IW_CQPSQ_TPHVAL)); header = ceq->ceq_id | LS_64(I40IW_CQP_OP_CREATE_CEQ, I40IW_CQPSQ_OPCODE) | LS_64(ceq->pbl_chunk_size, I40IW_CQPSQ_CEQ_LPBLSIZE) | LS_64(ceq->virtual_map, I40IW_CQPSQ_CEQ_VMAP) | LS_64(ceq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CEQ_CREATE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_cceq_create_done - poll for control ceq wqe to complete * @ceq: ceq sc structure */ static enum i40iw_status_code i40iw_sc_cceq_create_done(struct i40iw_sc_ceq *ceq) { struct i40iw_sc_cqp *cqp; cqp = ceq->dev->cqp; return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_CREATE_CEQ, NULL); } /** * i40iw_sc_cceq_destroy_done - poll for destroy cceq to complete * @ceq: ceq sc structure */ static enum i40iw_status_code i40iw_sc_cceq_destroy_done(struct i40iw_sc_ceq *ceq) { struct i40iw_sc_cqp *cqp; cqp = ceq->dev->cqp; cqp->process_cqp_sds = i40iw_update_sds_noccq; return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_DESTROY_CEQ, NULL); } /** * i40iw_sc_cceq_create - create cceq * @ceq: ceq sc structure * @scratch: u64 saved to be used during cqp completion */ static enum i40iw_status_code i40iw_sc_cceq_create(struct i40iw_sc_ceq *ceq, u64 scratch) { enum i40iw_status_code ret_code; ret_code = i40iw_sc_ceq_create(ceq, scratch, true); if (!ret_code) ret_code = i40iw_sc_cceq_create_done(ceq); return ret_code; } /** * i40iw_sc_ceq_destroy - destroy ceq * @ceq: ceq sc structure * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_ceq_destroy(struct i40iw_sc_ceq *ceq, u64 scratch, bool post_sq) { struct i40iw_sc_cqp *cqp; u64 *wqe; u64 header; cqp = ceq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, ceq->elem_cnt); set_64bit_val(wqe, 48, ceq->first_pm_pbl_idx); header = ceq->ceq_id | LS_64(I40IW_CQP_OP_DESTROY_CEQ, I40IW_CQPSQ_OPCODE) | LS_64(ceq->pbl_chunk_size, I40IW_CQPSQ_CEQ_LPBLSIZE) | LS_64(ceq->virtual_map, I40IW_CQPSQ_CEQ_VMAP) | LS_64(ceq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CEQ_DESTROY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_process_ceq - process ceq * @dev: sc device struct * @ceq: ceq sc structure */ static void *i40iw_sc_process_ceq(struct i40iw_sc_dev *dev, struct i40iw_sc_ceq *ceq) { u64 temp; u64 *ceqe; struct i40iw_sc_cq *cq = NULL; u8 polarity; ceqe = (u64 *)I40IW_GET_CURRENT_CEQ_ELEMENT(ceq); get_64bit_val(ceqe, 0, &temp); polarity = (u8)RS_64(temp, I40IW_CEQE_VALID); if (polarity != ceq->polarity) return cq; cq = (struct i40iw_sc_cq *)(unsigned long)LS_64_1(temp, 1); I40IW_RING_MOVE_TAIL(ceq->ceq_ring); if (I40IW_RING_GETCURRENT_TAIL(ceq->ceq_ring) == 0) ceq->polarity ^= 1; if (dev->is_pf) i40iw_wr32(dev->hw, I40E_PFPE_CQACK, cq->cq_uk.cq_id); else i40iw_wr32(dev->hw, I40E_VFPE_CQACK1, cq->cq_uk.cq_id); return cq; } /** * i40iw_sc_aeq_init - initialize aeq * @aeq: aeq structure ptr * @info: aeq initialization info */ static enum i40iw_status_code i40iw_sc_aeq_init(struct i40iw_sc_aeq *aeq, struct i40iw_aeq_init_info *info) { u32 pble_obj_cnt; if ((info->elem_cnt < I40IW_MIN_AEQ_ENTRIES) || (info->elem_cnt > I40IW_MAX_AEQ_ENTRIES)) return I40IW_ERR_INVALID_SIZE; pble_obj_cnt = info->dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if (info->virtual_map && (info->first_pm_pbl_idx >= pble_obj_cnt)) return I40IW_ERR_INVALID_PBLE_INDEX; aeq->size = sizeof(*aeq); aeq->polarity = 1; aeq->aeqe_base = (struct i40iw_sc_aeqe *)info->aeqe_base; aeq->dev = info->dev; aeq->elem_cnt = info->elem_cnt; aeq->aeq_elem_pa = info->aeq_elem_pa; I40IW_RING_INIT(aeq->aeq_ring, aeq->elem_cnt); info->dev->aeq = aeq; aeq->virtual_map = info->virtual_map; aeq->pbl_list = (aeq->virtual_map ? info->pbl_list : NULL); aeq->pbl_chunk_size = (aeq->virtual_map ? info->pbl_chunk_size : 0); aeq->first_pm_pbl_idx = (aeq->virtual_map ? info->first_pm_pbl_idx : 0); info->dev->aeq = aeq; return 0; } /** * i40iw_sc_aeq_create - create aeq * @aeq: aeq structure ptr * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_aeq_create(struct i40iw_sc_aeq *aeq, u64 scratch, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; cqp = aeq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, aeq->elem_cnt); set_64bit_val(wqe, 32, (aeq->virtual_map ? 0 : aeq->aeq_elem_pa)); set_64bit_val(wqe, 48, (aeq->virtual_map ? aeq->first_pm_pbl_idx : 0)); header = LS_64(I40IW_CQP_OP_CREATE_AEQ, I40IW_CQPSQ_OPCODE) | LS_64(aeq->pbl_chunk_size, I40IW_CQPSQ_AEQ_LPBLSIZE) | LS_64(aeq->virtual_map, I40IW_CQPSQ_AEQ_VMAP) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "AEQ_CREATE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_aeq_destroy - destroy aeq during close * @aeq: aeq structure ptr * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_aeq_destroy(struct i40iw_sc_aeq *aeq, u64 scratch, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; cqp = aeq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, aeq->elem_cnt); set_64bit_val(wqe, 48, aeq->first_pm_pbl_idx); header = LS_64(I40IW_CQP_OP_DESTROY_AEQ, I40IW_CQPSQ_OPCODE) | LS_64(aeq->pbl_chunk_size, I40IW_CQPSQ_AEQ_LPBLSIZE) | LS_64(aeq->virtual_map, I40IW_CQPSQ_AEQ_VMAP) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "AEQ_DESTROY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_get_next_aeqe - get next aeq entry * @aeq: aeq structure ptr * @info: aeqe info to be returned */ static enum i40iw_status_code i40iw_sc_get_next_aeqe(struct i40iw_sc_aeq *aeq, struct i40iw_aeqe_info *info) { u64 temp, compl_ctx; u64 *aeqe; u16 wqe_idx; u8 ae_src; u8 polarity; aeqe = (u64 *)I40IW_GET_CURRENT_AEQ_ELEMENT(aeq); get_64bit_val(aeqe, 0, &compl_ctx); get_64bit_val(aeqe, 8, &temp); polarity = (u8)RS_64(temp, I40IW_AEQE_VALID); if (aeq->polarity != polarity) return I40IW_ERR_QUEUE_EMPTY; i40iw_debug_buf(aeq->dev, I40IW_DEBUG_WQE, "AEQ_ENTRY", aeqe, 16); ae_src = (u8)RS_64(temp, I40IW_AEQE_AESRC); wqe_idx = (u16)RS_64(temp, I40IW_AEQE_WQDESCIDX); info->qp_cq_id = (u32)RS_64(temp, I40IW_AEQE_QPCQID); info->ae_id = (u16)RS_64(temp, I40IW_AEQE_AECODE); info->tcp_state = (u8)RS_64(temp, I40IW_AEQE_TCPSTATE); info->iwarp_state = (u8)RS_64(temp, I40IW_AEQE_IWSTATE); info->q2_data_written = (u8)RS_64(temp, I40IW_AEQE_Q2DATA); info->aeqe_overflow = (bool)RS_64(temp, I40IW_AEQE_OVERFLOW); switch (ae_src) { case I40IW_AE_SOURCE_RQ: case I40IW_AE_SOURCE_RQ_0011: info->qp = true; info->wqe_idx = wqe_idx; info->compl_ctx = compl_ctx; break; case I40IW_AE_SOURCE_CQ: case I40IW_AE_SOURCE_CQ_0110: case I40IW_AE_SOURCE_CQ_1010: case I40IW_AE_SOURCE_CQ_1110: info->cq = true; info->compl_ctx = LS_64_1(compl_ctx, 1); break; case I40IW_AE_SOURCE_SQ: case I40IW_AE_SOURCE_SQ_0111: info->qp = true; info->sq = true; info->wqe_idx = wqe_idx; info->compl_ctx = compl_ctx; break; case I40IW_AE_SOURCE_IN_RR_WR: case I40IW_AE_SOURCE_IN_RR_WR_1011: info->qp = true; info->compl_ctx = compl_ctx; info->in_rdrsp_wr = true; break; case I40IW_AE_SOURCE_OUT_RR: case I40IW_AE_SOURCE_OUT_RR_1111: info->qp = true; info->compl_ctx = compl_ctx; info->out_rdrsp = true; break; default: break; } I40IW_RING_MOVE_TAIL(aeq->aeq_ring); if (I40IW_RING_GETCURRENT_TAIL(aeq->aeq_ring) == 0) aeq->polarity ^= 1; return 0; } /** * i40iw_sc_repost_aeq_entries - repost completed aeq entries * @dev: sc device struct * @count: allocate count */ static enum i40iw_status_code i40iw_sc_repost_aeq_entries(struct i40iw_sc_dev *dev, u32 count) { if (count > I40IW_MAX_AEQ_ALLOCATE_COUNT) return I40IW_ERR_INVALID_SIZE; if (dev->is_pf) i40iw_wr32(dev->hw, I40E_PFPE_AEQALLOC, count); else i40iw_wr32(dev->hw, I40E_VFPE_AEQALLOC1, count); return 0; } /** * i40iw_sc_aeq_create_done - create aeq * @aeq: aeq structure ptr */ static enum i40iw_status_code i40iw_sc_aeq_create_done(struct i40iw_sc_aeq *aeq) { struct i40iw_sc_cqp *cqp; cqp = aeq->dev->cqp; return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_CREATE_AEQ, NULL); } /** * i40iw_sc_aeq_destroy_done - destroy of aeq during close * @aeq: aeq structure ptr */ static enum i40iw_status_code i40iw_sc_aeq_destroy_done(struct i40iw_sc_aeq *aeq) { struct i40iw_sc_cqp *cqp; cqp = aeq->dev->cqp; return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_DESTROY_AEQ, NULL); } /** * i40iw_sc_ccq_init - initialize control cq * @cq: sc's cq ctruct * @info: info for control cq initialization */ static enum i40iw_status_code i40iw_sc_ccq_init(struct i40iw_sc_cq *cq, struct i40iw_ccq_init_info *info) { u32 pble_obj_cnt; if (info->num_elem < I40IW_MIN_CQ_SIZE || info->num_elem > I40IW_MAX_CQ_SIZE) return I40IW_ERR_INVALID_SIZE; if (info->ceq_id > I40IW_MAX_CEQID) return I40IW_ERR_INVALID_CEQ_ID; pble_obj_cnt = info->dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if (info->virtual_map && (info->first_pm_pbl_idx >= pble_obj_cnt)) return I40IW_ERR_INVALID_PBLE_INDEX; cq->cq_pa = info->cq_pa; cq->cq_uk.cq_base = info->cq_base; cq->shadow_area_pa = info->shadow_area_pa; cq->cq_uk.shadow_area = info->shadow_area; cq->shadow_read_threshold = info->shadow_read_threshold; cq->dev = info->dev; cq->ceq_id = info->ceq_id; cq->cq_uk.cq_size = info->num_elem; cq->cq_type = I40IW_CQ_TYPE_CQP; cq->ceqe_mask = info->ceqe_mask; I40IW_RING_INIT(cq->cq_uk.cq_ring, info->num_elem); cq->cq_uk.cq_id = 0; /* control cq is id 0 always */ cq->ceq_id_valid = info->ceq_id_valid; cq->tph_en = info->tph_en; cq->tph_val = info->tph_val; cq->cq_uk.avoid_mem_cflct = info->avoid_mem_cflct; cq->pbl_list = info->pbl_list; cq->virtual_map = info->virtual_map; cq->pbl_chunk_size = info->pbl_chunk_size; cq->first_pm_pbl_idx = info->first_pm_pbl_idx; cq->cq_uk.polarity = true; /* following are only for iw cqs so initialize them to zero */ cq->cq_uk.cqe_alloc_reg = NULL; info->dev->ccq = cq; return 0; } /** * i40iw_sc_ccq_create_done - poll cqp for ccq create * @ccq: ccq sc struct */ static enum i40iw_status_code i40iw_sc_ccq_create_done(struct i40iw_sc_cq *ccq) { struct i40iw_sc_cqp *cqp; cqp = ccq->dev->cqp; return i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_CREATE_CQ, NULL); } /** * i40iw_sc_ccq_create - create control cq * @ccq: ccq sc struct * @scratch: u64 saved to be used during cqp completion * @check_overflow: overlow flag for ccq * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_ccq_create(struct i40iw_sc_cq *ccq, u64 scratch, bool check_overflow, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; enum i40iw_status_code ret_code; cqp = ccq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 0, ccq->cq_uk.cq_size); set_64bit_val(wqe, 8, RS_64_1(ccq, 1)); set_64bit_val(wqe, 16, LS_64(ccq->shadow_read_threshold, I40IW_CQPSQ_CQ_SHADOW_READ_THRESHOLD)); set_64bit_val(wqe, 32, (ccq->virtual_map ? 0 : ccq->cq_pa)); set_64bit_val(wqe, 40, ccq->shadow_area_pa); set_64bit_val(wqe, 48, (ccq->virtual_map ? ccq->first_pm_pbl_idx : 0)); set_64bit_val(wqe, 56, LS_64(ccq->tph_val, I40IW_CQPSQ_TPHVAL)); header = ccq->cq_uk.cq_id | LS_64((ccq->ceq_id_valid ? ccq->ceq_id : 0), I40IW_CQPSQ_CQ_CEQID) | LS_64(I40IW_CQP_OP_CREATE_CQ, I40IW_CQPSQ_OPCODE) | LS_64(ccq->pbl_chunk_size, I40IW_CQPSQ_CQ_LPBLSIZE) | LS_64(check_overflow, I40IW_CQPSQ_CQ_CHKOVERFLOW) | LS_64(ccq->virtual_map, I40IW_CQPSQ_CQ_VIRTMAP) | LS_64(ccq->ceqe_mask, I40IW_CQPSQ_CQ_ENCEQEMASK) | LS_64(ccq->ceq_id_valid, I40IW_CQPSQ_CQ_CEQIDVALID) | LS_64(ccq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(ccq->cq_uk.avoid_mem_cflct, I40IW_CQPSQ_CQ_AVOIDMEMCNFLCT) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CCQ_CREATE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) { i40iw_sc_cqp_post_sq(cqp); ret_code = i40iw_sc_ccq_create_done(ccq); if (ret_code) return ret_code; } cqp->process_cqp_sds = i40iw_cqp_sds_cmd; return 0; } /** * i40iw_sc_ccq_destroy - destroy ccq during close * @ccq: ccq sc struct * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_ccq_destroy(struct i40iw_sc_cq *ccq, u64 scratch, bool post_sq) { struct i40iw_sc_cqp *cqp; u64 *wqe; u64 header; enum i40iw_status_code ret_code = 0; u32 tail, val, error; cqp = ccq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 0, ccq->cq_uk.cq_size); set_64bit_val(wqe, 8, RS_64_1(ccq, 1)); set_64bit_val(wqe, 40, ccq->shadow_area_pa); header = ccq->cq_uk.cq_id | LS_64((ccq->ceq_id_valid ? ccq->ceq_id : 0), I40IW_CQPSQ_CQ_CEQID) | LS_64(I40IW_CQP_OP_DESTROY_CQ, I40IW_CQPSQ_OPCODE) | LS_64(ccq->ceqe_mask, I40IW_CQPSQ_CQ_ENCEQEMASK) | LS_64(ccq->ceq_id_valid, I40IW_CQPSQ_CQ_CEQIDVALID) | LS_64(ccq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(ccq->cq_uk.avoid_mem_cflct, I40IW_CQPSQ_CQ_AVOIDMEMCNFLCT) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CCQ_DESTROY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); i40iw_get_cqp_reg_info(cqp, &val, &tail, &error); if (error) return I40IW_ERR_CQP_COMPL_ERROR; if (post_sq) { i40iw_sc_cqp_post_sq(cqp); ret_code = i40iw_cqp_poll_registers(cqp, tail, 1000); } cqp->process_cqp_sds = i40iw_update_sds_noccq; return ret_code; } /** * i40iw_sc_cq_init - initialize completion q * @cq: cq struct * @info: cq initialization info */ static enum i40iw_status_code i40iw_sc_cq_init(struct i40iw_sc_cq *cq, struct i40iw_cq_init_info *info) { u32 __iomem *cqe_alloc_reg = NULL; enum i40iw_status_code ret_code; u32 pble_obj_cnt; u32 arm_offset; pble_obj_cnt = info->dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if (info->virtual_map && (info->first_pm_pbl_idx >= pble_obj_cnt)) return I40IW_ERR_INVALID_PBLE_INDEX; cq->cq_pa = info->cq_base_pa; cq->dev = info->dev; cq->ceq_id = info->ceq_id; arm_offset = (info->dev->is_pf) ? I40E_PFPE_CQARM : I40E_VFPE_CQARM1; if (i40iw_get_hw_addr(cq->dev)) cqe_alloc_reg = (u32 __iomem *)(i40iw_get_hw_addr(cq->dev) + arm_offset); info->cq_uk_init_info.cqe_alloc_reg = cqe_alloc_reg; ret_code = i40iw_cq_uk_init(&cq->cq_uk, &info->cq_uk_init_info); if (ret_code) return ret_code; cq->virtual_map = info->virtual_map; cq->pbl_chunk_size = info->pbl_chunk_size; cq->ceqe_mask = info->ceqe_mask; cq->cq_type = (info->type) ? info->type : I40IW_CQ_TYPE_IWARP; cq->shadow_area_pa = info->shadow_area_pa; cq->shadow_read_threshold = info->shadow_read_threshold; cq->ceq_id_valid = info->ceq_id_valid; cq->tph_en = info->tph_en; cq->tph_val = info->tph_val; cq->first_pm_pbl_idx = info->first_pm_pbl_idx; return 0; } /** * i40iw_sc_cq_create - create completion q * @cq: cq struct * @scratch: u64 saved to be used during cqp completion * @check_overflow: flag for overflow check * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_cq_create(struct i40iw_sc_cq *cq, u64 scratch, bool check_overflow, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; if (cq->cq_uk.cq_id > I40IW_MAX_CQID) return I40IW_ERR_INVALID_CQ_ID; if (cq->ceq_id > I40IW_MAX_CEQID) return I40IW_ERR_INVALID_CEQ_ID; cqp = cq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 0, cq->cq_uk.cq_size); set_64bit_val(wqe, 8, RS_64_1(cq, 1)); set_64bit_val(wqe, 16, LS_64(cq->shadow_read_threshold, I40IW_CQPSQ_CQ_SHADOW_READ_THRESHOLD)); set_64bit_val(wqe, 32, (cq->virtual_map ? 0 : cq->cq_pa)); set_64bit_val(wqe, 40, cq->shadow_area_pa); set_64bit_val(wqe, 48, (cq->virtual_map ? cq->first_pm_pbl_idx : 0)); set_64bit_val(wqe, 56, LS_64(cq->tph_val, I40IW_CQPSQ_TPHVAL)); header = cq->cq_uk.cq_id | LS_64((cq->ceq_id_valid ? cq->ceq_id : 0), I40IW_CQPSQ_CQ_CEQID) | LS_64(I40IW_CQP_OP_CREATE_CQ, I40IW_CQPSQ_OPCODE) | LS_64(cq->pbl_chunk_size, I40IW_CQPSQ_CQ_LPBLSIZE) | LS_64(check_overflow, I40IW_CQPSQ_CQ_CHKOVERFLOW) | LS_64(cq->virtual_map, I40IW_CQPSQ_CQ_VIRTMAP) | LS_64(cq->ceqe_mask, I40IW_CQPSQ_CQ_ENCEQEMASK) | LS_64(cq->ceq_id_valid, I40IW_CQPSQ_CQ_CEQIDVALID) | LS_64(cq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(cq->cq_uk.avoid_mem_cflct, I40IW_CQPSQ_CQ_AVOIDMEMCNFLCT) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CQ_CREATE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_cq_destroy - destroy completion q * @cq: cq struct * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_cq_destroy(struct i40iw_sc_cq *cq, u64 scratch, bool post_sq) { struct i40iw_sc_cqp *cqp; u64 *wqe; u64 header; cqp = cq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 0, cq->cq_uk.cq_size); set_64bit_val(wqe, 8, RS_64_1(cq, 1)); set_64bit_val(wqe, 40, cq->shadow_area_pa); set_64bit_val(wqe, 48, (cq->virtual_map ? cq->first_pm_pbl_idx : 0)); header = cq->cq_uk.cq_id | LS_64((cq->ceq_id_valid ? cq->ceq_id : 0), I40IW_CQPSQ_CQ_CEQID) | LS_64(I40IW_CQP_OP_DESTROY_CQ, I40IW_CQPSQ_OPCODE) | LS_64(cq->pbl_chunk_size, I40IW_CQPSQ_CQ_LPBLSIZE) | LS_64(cq->virtual_map, I40IW_CQPSQ_CQ_VIRTMAP) | LS_64(cq->ceqe_mask, I40IW_CQPSQ_CQ_ENCEQEMASK) | LS_64(cq->ceq_id_valid, I40IW_CQPSQ_CQ_CEQIDVALID) | LS_64(cq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(cq->cq_uk.avoid_mem_cflct, I40IW_CQPSQ_CQ_AVOIDMEMCNFLCT) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CQ_DESTROY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_cq_modify - modify a Completion Queue * @cq: cq struct * @info: modification info struct * @scratch: * @post_sq: flag to post to sq */ static enum i40iw_status_code i40iw_sc_cq_modify(struct i40iw_sc_cq *cq, struct i40iw_modify_cq_info *info, u64 scratch, bool post_sq) { struct i40iw_sc_cqp *cqp; u64 *wqe; u64 header; u32 cq_size, ceq_id, first_pm_pbl_idx; u8 pbl_chunk_size; bool virtual_map, ceq_id_valid, check_overflow; u32 pble_obj_cnt; if (info->ceq_valid && (info->ceq_id > I40IW_MAX_CEQID)) return I40IW_ERR_INVALID_CEQ_ID; pble_obj_cnt = cq->dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if (info->cq_resize && info->virtual_map && (info->first_pm_pbl_idx >= pble_obj_cnt)) return I40IW_ERR_INVALID_PBLE_INDEX; cqp = cq->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; cq->pbl_list = info->pbl_list; cq->cq_pa = info->cq_pa; cq->first_pm_pbl_idx = info->first_pm_pbl_idx; cq_size = info->cq_resize ? info->cq_size : cq->cq_uk.cq_size; if (info->ceq_change) { ceq_id_valid = true; ceq_id = info->ceq_id; } else { ceq_id_valid = cq->ceq_id_valid; ceq_id = ceq_id_valid ? cq->ceq_id : 0; } virtual_map = info->cq_resize ? info->virtual_map : cq->virtual_map; first_pm_pbl_idx = (info->cq_resize ? (info->virtual_map ? info->first_pm_pbl_idx : 0) : (cq->virtual_map ? cq->first_pm_pbl_idx : 0)); pbl_chunk_size = (info->cq_resize ? (info->virtual_map ? info->pbl_chunk_size : 0) : (cq->virtual_map ? cq->pbl_chunk_size : 0)); check_overflow = info->check_overflow_change ? info->check_overflow : cq->check_overflow; cq->cq_uk.cq_size = cq_size; cq->ceq_id_valid = ceq_id_valid; cq->ceq_id = ceq_id; cq->virtual_map = virtual_map; cq->first_pm_pbl_idx = first_pm_pbl_idx; cq->pbl_chunk_size = pbl_chunk_size; cq->check_overflow = check_overflow; set_64bit_val(wqe, 0, cq_size); set_64bit_val(wqe, 8, RS_64_1(cq, 1)); set_64bit_val(wqe, 16, LS_64(info->shadow_read_threshold, I40IW_CQPSQ_CQ_SHADOW_READ_THRESHOLD)); set_64bit_val(wqe, 32, (cq->virtual_map ? 0 : cq->cq_pa)); set_64bit_val(wqe, 40, cq->shadow_area_pa); set_64bit_val(wqe, 48, (cq->virtual_map ? first_pm_pbl_idx : 0)); set_64bit_val(wqe, 56, LS_64(cq->tph_val, I40IW_CQPSQ_TPHVAL)); header = cq->cq_uk.cq_id | LS_64(ceq_id, I40IW_CQPSQ_CQ_CEQID) | LS_64(I40IW_CQP_OP_MODIFY_CQ, I40IW_CQPSQ_OPCODE) | LS_64(info->cq_resize, I40IW_CQPSQ_CQ_CQRESIZE) | LS_64(pbl_chunk_size, I40IW_CQPSQ_CQ_LPBLSIZE) | LS_64(check_overflow, I40IW_CQPSQ_CQ_CHKOVERFLOW) | LS_64(virtual_map, I40IW_CQPSQ_CQ_VIRTMAP) | LS_64(cq->ceqe_mask, I40IW_CQPSQ_CQ_ENCEQEMASK) | LS_64(ceq_id_valid, I40IW_CQPSQ_CQ_CEQIDVALID) | LS_64(cq->tph_en, I40IW_CQPSQ_TPHEN) | LS_64(cq->cq_uk.avoid_mem_cflct, I40IW_CQPSQ_CQ_AVOIDMEMCNFLCT) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "CQ_MODIFY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_qp_init - initialize qp * @qp: sc qp * @info: initialization qp info */ static enum i40iw_status_code i40iw_sc_qp_init(struct i40iw_sc_qp *qp, struct i40iw_qp_init_info *info) { u32 __iomem *wqe_alloc_reg = NULL; enum i40iw_status_code ret_code; u32 pble_obj_cnt; u8 wqe_size; u32 offset; qp->dev = info->pd->dev; qp->vsi = info->vsi; qp->sq_pa = info->sq_pa; qp->rq_pa = info->rq_pa; qp->hw_host_ctx_pa = info->host_ctx_pa; qp->q2_pa = info->q2_pa; qp->shadow_area_pa = info->shadow_area_pa; qp->q2_buf = info->q2; qp->pd = info->pd; qp->hw_host_ctx = info->host_ctx; offset = (qp->pd->dev->is_pf) ? I40E_PFPE_WQEALLOC : I40E_VFPE_WQEALLOC1; if (i40iw_get_hw_addr(qp->pd->dev)) wqe_alloc_reg = (u32 __iomem *)(i40iw_get_hw_addr(qp->pd->dev) + offset); info->qp_uk_init_info.wqe_alloc_reg = wqe_alloc_reg; info->qp_uk_init_info.abi_ver = qp->pd->abi_ver; ret_code = i40iw_qp_uk_init(&qp->qp_uk, &info->qp_uk_init_info); if (ret_code) return ret_code; qp->virtual_map = info->virtual_map; pble_obj_cnt = info->pd->dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if ((info->virtual_map && (info->sq_pa >= pble_obj_cnt)) || (info->virtual_map && (info->rq_pa >= pble_obj_cnt))) return I40IW_ERR_INVALID_PBLE_INDEX; qp->llp_stream_handle = (void *)(-1); qp->qp_type = (info->type) ? info->type : I40IW_QP_TYPE_IWARP; qp->hw_sq_size = i40iw_get_encoded_wqe_size(qp->qp_uk.sq_ring.size, false); i40iw_debug(qp->dev, I40IW_DEBUG_WQE, "%s: hw_sq_size[%04d] sq_ring.size[%04d]\n", __func__, qp->hw_sq_size, qp->qp_uk.sq_ring.size); switch (qp->pd->abi_ver) { case 4: ret_code = i40iw_fragcnt_to_wqesize_rq(qp->qp_uk.max_rq_frag_cnt, &wqe_size); if (ret_code) return ret_code; break; case 5: /* fallthrough until next ABI version */ default: if (qp->qp_uk.max_rq_frag_cnt > I40IW_MAX_WQ_FRAGMENT_COUNT) return I40IW_ERR_INVALID_FRAG_COUNT; wqe_size = I40IW_MAX_WQE_SIZE_RQ; break; } qp->hw_rq_size = i40iw_get_encoded_wqe_size(qp->qp_uk.rq_size * (wqe_size / I40IW_QP_WQE_MIN_SIZE), false); i40iw_debug(qp->dev, I40IW_DEBUG_WQE, "%s: hw_rq_size[%04d] qp_uk.rq_size[%04d] wqe_size[%04d]\n", __func__, qp->hw_rq_size, qp->qp_uk.rq_size, wqe_size); qp->sq_tph_val = info->sq_tph_val; qp->rq_tph_val = info->rq_tph_val; qp->sq_tph_en = info->sq_tph_en; qp->rq_tph_en = info->rq_tph_en; qp->rcv_tph_en = info->rcv_tph_en; qp->xmit_tph_en = info->xmit_tph_en; qp->qs_handle = qp->vsi->qos[qp->user_pri].qs_handle; qp->exception_lan_queue = qp->pd->dev->exception_lan_queue; return 0; } /** * i40iw_sc_qp_create - create qp * @qp: sc qp * @info: qp create info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_qp_create( struct i40iw_sc_qp *qp, struct i40iw_create_qp_info *info, u64 scratch, bool post_sq) { struct i40iw_sc_cqp *cqp; u64 *wqe; u64 header; if ((qp->qp_uk.qp_id < I40IW_MIN_IW_QP_ID) || (qp->qp_uk.qp_id > I40IW_MAX_IW_QP_ID)) return I40IW_ERR_INVALID_QP_ID; cqp = qp->pd->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, qp->hw_host_ctx_pa); set_64bit_val(wqe, 40, qp->shadow_area_pa); header = qp->qp_uk.qp_id | LS_64(I40IW_CQP_OP_CREATE_QP, I40IW_CQPSQ_OPCODE) | LS_64((info->ord_valid ? 1 : 0), I40IW_CQPSQ_QP_ORDVALID) | LS_64(info->tcp_ctx_valid, I40IW_CQPSQ_QP_TOECTXVALID) | LS_64(qp->qp_type, I40IW_CQPSQ_QP_QPTYPE) | LS_64(qp->virtual_map, I40IW_CQPSQ_QP_VQ) | LS_64(info->cq_num_valid, I40IW_CQPSQ_QP_CQNUMVALID) | LS_64(info->static_rsrc, I40IW_CQPSQ_QP_STATRSRC) | LS_64(info->arp_cache_idx_valid, I40IW_CQPSQ_QP_ARPTABIDXVALID) | LS_64(info->next_iwarp_state, I40IW_CQPSQ_QP_NEXTIWSTATE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "QP_CREATE WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_qp_modify - modify qp cqp wqe * @qp: sc qp * @info: modify qp info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_qp_modify( struct i40iw_sc_qp *qp, struct i40iw_modify_qp_info *info, u64 scratch, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; u8 term_actions = 0; u8 term_len = 0; cqp = qp->pd->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; if (info->next_iwarp_state == I40IW_QP_STATE_TERMINATE) { if (info->dont_send_fin) term_actions += I40IWQP_TERM_SEND_TERM_ONLY; if (info->dont_send_term) term_actions += I40IWQP_TERM_SEND_FIN_ONLY; if ((term_actions == I40IWQP_TERM_SEND_TERM_AND_FIN) || (term_actions == I40IWQP_TERM_SEND_TERM_ONLY)) term_len = info->termlen; } set_64bit_val(wqe, 8, LS_64(term_len, I40IW_CQPSQ_QP_TERMLEN)); set_64bit_val(wqe, 16, qp->hw_host_ctx_pa); set_64bit_val(wqe, 40, qp->shadow_area_pa); header = qp->qp_uk.qp_id | LS_64(I40IW_CQP_OP_MODIFY_QP, I40IW_CQPSQ_OPCODE) | LS_64(info->ord_valid, I40IW_CQPSQ_QP_ORDVALID) | LS_64(info->tcp_ctx_valid, I40IW_CQPSQ_QP_TOECTXVALID) | LS_64(info->cached_var_valid, I40IW_CQPSQ_QP_CACHEDVARVALID) | LS_64(qp->virtual_map, I40IW_CQPSQ_QP_VQ) | LS_64(info->cq_num_valid, I40IW_CQPSQ_QP_CQNUMVALID) | LS_64(info->force_loopback, I40IW_CQPSQ_QP_FORCELOOPBACK) | LS_64(qp->qp_type, I40IW_CQPSQ_QP_QPTYPE) | LS_64(info->static_rsrc, I40IW_CQPSQ_QP_STATRSRC) | LS_64(info->remove_hash_idx, I40IW_CQPSQ_QP_REMOVEHASHENTRY) | LS_64(term_actions, I40IW_CQPSQ_QP_TERMACT) | LS_64(info->reset_tcp_conn, I40IW_CQPSQ_QP_RESETCON) | LS_64(info->arp_cache_idx_valid, I40IW_CQPSQ_QP_ARPTABIDXVALID) | LS_64(info->next_iwarp_state, I40IW_CQPSQ_QP_NEXTIWSTATE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "QP_MODIFY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_qp_destroy - cqp destroy qp * @qp: sc qp * @scratch: u64 saved to be used during cqp completion * @remove_hash_idx: flag if to remove hash idx * @ignore_mw_bnd: memory window bind flag * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_qp_destroy( struct i40iw_sc_qp *qp, u64 scratch, bool remove_hash_idx, bool ignore_mw_bnd, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; i40iw_qp_rem_qos(qp); cqp = qp->pd->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, qp->hw_host_ctx_pa); set_64bit_val(wqe, 40, qp->shadow_area_pa); header = qp->qp_uk.qp_id | LS_64(I40IW_CQP_OP_DESTROY_QP, I40IW_CQPSQ_OPCODE) | LS_64(qp->qp_type, I40IW_CQPSQ_QP_QPTYPE) | LS_64(ignore_mw_bnd, I40IW_CQPSQ_QP_IGNOREMWBOUND) | LS_64(remove_hash_idx, I40IW_CQPSQ_QP_REMOVEHASHENTRY) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "QP_DESTROY WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_qp_flush_wqes - flush qp's wqe * @qp: sc qp * @info: dlush information * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_qp_flush_wqes( struct i40iw_sc_qp *qp, struct i40iw_qp_flush_info *info, u64 scratch, bool post_sq) { u64 temp = 0; u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; bool flush_sq = false, flush_rq = false; if (info->rq && !qp->flush_rq) flush_rq = true; if (info->sq && !qp->flush_sq) flush_sq = true; qp->flush_sq |= flush_sq; qp->flush_rq |= flush_rq; if (!flush_sq && !flush_rq) { if (info->ae_code != I40IW_AE_LLP_RECEIVED_MPA_CRC_ERROR) return 0; } cqp = qp->pd->dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; if (info->userflushcode) { if (flush_rq) { temp |= LS_64(info->rq_minor_code, I40IW_CQPSQ_FWQE_RQMNERR) | LS_64(info->rq_major_code, I40IW_CQPSQ_FWQE_RQMJERR); } if (flush_sq) { temp |= LS_64(info->sq_minor_code, I40IW_CQPSQ_FWQE_SQMNERR) | LS_64(info->sq_major_code, I40IW_CQPSQ_FWQE_SQMJERR); } } set_64bit_val(wqe, 16, temp); temp = (info->generate_ae) ? info->ae_code | LS_64(info->ae_source, I40IW_CQPSQ_FWQE_AESOURCE) : 0; set_64bit_val(wqe, 8, temp); header = qp->qp_uk.qp_id | LS_64(I40IW_CQP_OP_FLUSH_WQES, I40IW_CQPSQ_OPCODE) | LS_64(info->generate_ae, I40IW_CQPSQ_FWQE_GENERATE_AE) | LS_64(info->userflushcode, I40IW_CQPSQ_FWQE_USERFLCODE) | LS_64(flush_sq, I40IW_CQPSQ_FWQE_FLUSHSQ) | LS_64(flush_rq, I40IW_CQPSQ_FWQE_FLUSHRQ) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "QP_FLUSH WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_qp_upload_context - upload qp's context * @dev: sc device struct * @info: upload context info ptr for return * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_qp_upload_context( struct i40iw_sc_dev *dev, struct i40iw_upload_context_info *info, u64 scratch, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, info->buf_pa); header = LS_64(info->qp_id, I40IW_CQPSQ_UCTX_QPID) | LS_64(I40IW_CQP_OP_UPLOAD_CONTEXT, I40IW_CQPSQ_OPCODE) | LS_64(info->qp_type, I40IW_CQPSQ_UCTX_QPTYPE) | LS_64(info->raw_format, I40IW_CQPSQ_UCTX_RAWFORMAT) | LS_64(info->freeze_qp, I40IW_CQPSQ_UCTX_FREEZEQP) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "QP_UPLOAD_CTX WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_qp_setctx - set qp's context * @qp: sc qp * @qp_ctx: context ptr * @info: ctx info */ static enum i40iw_status_code i40iw_sc_qp_setctx( struct i40iw_sc_qp *qp, u64 *qp_ctx, struct i40iw_qp_host_ctx_info *info) { struct i40iwarp_offload_info *iw; struct i40iw_tcp_offload_info *tcp; struct i40iw_sc_vsi *vsi; struct i40iw_sc_dev *dev; u64 qw0, qw3, qw7 = 0; iw = info->iwarp_info; tcp = info->tcp_info; vsi = qp->vsi; dev = qp->dev; if (info->add_to_qoslist) { qp->user_pri = info->user_pri; i40iw_qp_add_qos(qp); i40iw_debug(qp->dev, I40IW_DEBUG_DCB, "%s qp[%d] UP[%d] qset[%d]\n", __func__, qp->qp_uk.qp_id, qp->user_pri, qp->qs_handle); } qw0 = LS_64(qp->qp_uk.rq_wqe_size, I40IWQPC_RQWQESIZE) | LS_64(info->err_rq_idx_valid, I40IWQPC_ERR_RQ_IDX_VALID) | LS_64(qp->rcv_tph_en, I40IWQPC_RCVTPHEN) | LS_64(qp->xmit_tph_en, I40IWQPC_XMITTPHEN) | LS_64(qp->rq_tph_en, I40IWQPC_RQTPHEN) | LS_64(qp->sq_tph_en, I40IWQPC_SQTPHEN) | LS_64(info->push_idx, I40IWQPC_PPIDX) | LS_64(info->push_mode_en, I40IWQPC_PMENA); set_64bit_val(qp_ctx, 8, qp->sq_pa); set_64bit_val(qp_ctx, 16, qp->rq_pa); qw3 = LS_64(qp->src_mac_addr_idx, I40IWQPC_SRCMACADDRIDX) | LS_64(qp->hw_rq_size, I40IWQPC_RQSIZE) | LS_64(qp->hw_sq_size, I40IWQPC_SQSIZE); set_64bit_val(qp_ctx, 128, LS_64(info->err_rq_idx, I40IWQPC_ERR_RQ_IDX)); set_64bit_val(qp_ctx, 136, LS_64(info->send_cq_num, I40IWQPC_TXCQNUM) | LS_64(info->rcv_cq_num, I40IWQPC_RXCQNUM)); set_64bit_val(qp_ctx, 168, LS_64(info->qp_compl_ctx, I40IWQPC_QPCOMPCTX)); set_64bit_val(qp_ctx, 176, LS_64(qp->sq_tph_val, I40IWQPC_SQTPHVAL) | LS_64(qp->rq_tph_val, I40IWQPC_RQTPHVAL) | LS_64(qp->qs_handle, I40IWQPC_QSHANDLE) | LS_64(qp->exception_lan_queue, I40IWQPC_EXCEPTION_LAN_QUEUE)); if (info->iwarp_info_valid) { qw0 |= LS_64(iw->ddp_ver, I40IWQPC_DDP_VER) | LS_64(iw->rdmap_ver, I40IWQPC_RDMAP_VER); qw7 |= LS_64(iw->pd_id, I40IWQPC_PDIDX); set_64bit_val(qp_ctx, 144, LS_64(qp->q2_pa, I40IWQPC_Q2ADDR) | LS_64(vsi->fcn_id, I40IWQPC_STAT_INDEX)); set_64bit_val(qp_ctx, 152, LS_64(iw->last_byte_sent, I40IWQPC_LASTBYTESENT)); set_64bit_val(qp_ctx, 160, LS_64(iw->ord_size, I40IWQPC_ORDSIZE) | LS_64(iw->ird_size, I40IWQPC_IRDSIZE) | LS_64(iw->wr_rdresp_en, I40IWQPC_WRRDRSPOK) | LS_64(iw->rd_enable, I40IWQPC_RDOK) | LS_64(iw->snd_mark_en, I40IWQPC_SNDMARKERS) | LS_64(iw->bind_en, I40IWQPC_BINDEN) | LS_64(iw->fast_reg_en, I40IWQPC_FASTREGEN) | LS_64(iw->priv_mode_en, I40IWQPC_PRIVEN) | LS_64((((vsi->stats_fcn_id_alloc) && (dev->is_pf) && (vsi->fcn_id >= I40IW_FIRST_NON_PF_STAT)) ? 1 : 0), I40IWQPC_USESTATSINSTANCE) | LS_64(1, I40IWQPC_IWARPMODE) | LS_64(iw->rcv_mark_en, I40IWQPC_RCVMARKERS) | LS_64(iw->align_hdrs, I40IWQPC_ALIGNHDRS) | LS_64(iw->rcv_no_mpa_crc, I40IWQPC_RCVNOMPACRC) | LS_64(iw->rcv_mark_offset, I40IWQPC_RCVMARKOFFSET) | LS_64(iw->snd_mark_offset, I40IWQPC_SNDMARKOFFSET)); } if (info->tcp_info_valid) { qw0 |= LS_64(tcp->ipv4, I40IWQPC_IPV4) | LS_64(tcp->no_nagle, I40IWQPC_NONAGLE) | LS_64(tcp->insert_vlan_tag, I40IWQPC_INSERTVLANTAG) | LS_64(tcp->time_stamp, I40IWQPC_TIMESTAMP) | LS_64(tcp->cwnd_inc_limit, I40IWQPC_LIMIT) | LS_64(tcp->drop_ooo_seg, I40IWQPC_DROPOOOSEG) | LS_64(tcp->dup_ack_thresh, I40IWQPC_DUPACK_THRESH); qw3 |= LS_64(tcp->ttl, I40IWQPC_TTL) | LS_64(tcp->src_mac_addr_idx, I40IWQPC_SRCMACADDRIDX) | LS_64(tcp->avoid_stretch_ack, I40IWQPC_AVOIDSTRETCHACK) | LS_64(tcp->tos, I40IWQPC_TOS) | LS_64(tcp->src_port, I40IWQPC_SRCPORTNUM) | LS_64(tcp->dst_port, I40IWQPC_DESTPORTNUM); qp->src_mac_addr_idx = tcp->src_mac_addr_idx; set_64bit_val(qp_ctx, 32, LS_64(tcp->dest_ip_addr2, I40IWQPC_DESTIPADDR2) | LS_64(tcp->dest_ip_addr3, I40IWQPC_DESTIPADDR3)); set_64bit_val(qp_ctx, 40, LS_64(tcp->dest_ip_addr0, I40IWQPC_DESTIPADDR0) | LS_64(tcp->dest_ip_addr1, I40IWQPC_DESTIPADDR1)); set_64bit_val(qp_ctx, 48, LS_64(tcp->snd_mss, I40IWQPC_SNDMSS) | LS_64(tcp->vlan_tag, I40IWQPC_VLANTAG) | LS_64(tcp->arp_idx, I40IWQPC_ARPIDX)); qw7 |= LS_64(tcp->flow_label, I40IWQPC_FLOWLABEL) | LS_64(tcp->wscale, I40IWQPC_WSCALE) | LS_64(tcp->ignore_tcp_opt, I40IWQPC_IGNORE_TCP_OPT) | LS_64(tcp->ignore_tcp_uns_opt, I40IWQPC_IGNORE_TCP_UNS_OPT) | LS_64(tcp->tcp_state, I40IWQPC_TCPSTATE) | LS_64(tcp->rcv_wscale, I40IWQPC_RCVSCALE) | LS_64(tcp->snd_wscale, I40IWQPC_SNDSCALE); set_64bit_val(qp_ctx, 72, LS_64(tcp->time_stamp_recent, I40IWQPC_TIMESTAMP_RECENT) | LS_64(tcp->time_stamp_age, I40IWQPC_TIMESTAMP_AGE)); set_64bit_val(qp_ctx, 80, LS_64(tcp->snd_nxt, I40IWQPC_SNDNXT) | LS_64(tcp->snd_wnd, I40IWQPC_SNDWND)); set_64bit_val(qp_ctx, 88, LS_64(tcp->rcv_nxt, I40IWQPC_RCVNXT) | LS_64(tcp->rcv_wnd, I40IWQPC_RCVWND)); set_64bit_val(qp_ctx, 96, LS_64(tcp->snd_max, I40IWQPC_SNDMAX) | LS_64(tcp->snd_una, I40IWQPC_SNDUNA)); set_64bit_val(qp_ctx, 104, LS_64(tcp->srtt, I40IWQPC_SRTT) | LS_64(tcp->rtt_var, I40IWQPC_RTTVAR)); set_64bit_val(qp_ctx, 112, LS_64(tcp->ss_thresh, I40IWQPC_SSTHRESH) | LS_64(tcp->cwnd, I40IWQPC_CWND)); set_64bit_val(qp_ctx, 120, LS_64(tcp->snd_wl1, I40IWQPC_SNDWL1) | LS_64(tcp->snd_wl2, I40IWQPC_SNDWL2)); set_64bit_val(qp_ctx, 128, LS_64(tcp->max_snd_window, I40IWQPC_MAXSNDWND) | LS_64(tcp->rexmit_thresh, I40IWQPC_REXMIT_THRESH)); set_64bit_val(qp_ctx, 184, LS_64(tcp->local_ipaddr3, I40IWQPC_LOCAL_IPADDR3) | LS_64(tcp->local_ipaddr2, I40IWQPC_LOCAL_IPADDR2)); set_64bit_val(qp_ctx, 192, LS_64(tcp->local_ipaddr1, I40IWQPC_LOCAL_IPADDR1) | LS_64(tcp->local_ipaddr0, I40IWQPC_LOCAL_IPADDR0)); } set_64bit_val(qp_ctx, 0, qw0); set_64bit_val(qp_ctx, 24, qw3); set_64bit_val(qp_ctx, 56, qw7); i40iw_debug_buf(qp->dev, I40IW_DEBUG_WQE, "QP_HOST)CTX WQE", qp_ctx, I40IW_QP_CTX_SIZE); return 0; } /** * i40iw_sc_alloc_stag - mr stag alloc * @dev: sc device struct * @info: stag info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_alloc_stag( struct i40iw_sc_dev *dev, struct i40iw_allocate_stag_info *info, u64 scratch, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 header; enum i40iw_page_size page_size; page_size = (info->page_size == 0x200000) ? I40IW_PAGE_SIZE_2M : I40IW_PAGE_SIZE_4K; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 8, LS_64(info->pd_id, I40IW_CQPSQ_STAG_PDID) | LS_64(info->total_len, I40IW_CQPSQ_STAG_STAGLEN)); set_64bit_val(wqe, 16, LS_64(info->stag_idx, I40IW_CQPSQ_STAG_IDX)); set_64bit_val(wqe, 40, LS_64(info->hmc_fcn_index, I40IW_CQPSQ_STAG_HMCFNIDX)); header = LS_64(I40IW_CQP_OP_ALLOC_STAG, I40IW_CQPSQ_OPCODE) | LS_64(1, I40IW_CQPSQ_STAG_MR) | LS_64(info->access_rights, I40IW_CQPSQ_STAG_ARIGHTS) | LS_64(info->chunk_size, I40IW_CQPSQ_STAG_LPBLSIZE) | LS_64(page_size, I40IW_CQPSQ_STAG_HPAGESIZE) | LS_64(info->remote_access, I40IW_CQPSQ_STAG_REMACCENABLED) | LS_64(info->use_hmc_fcn_index, I40IW_CQPSQ_STAG_USEHMCFNIDX) | LS_64(info->use_pf_rid, I40IW_CQPSQ_STAG_USEPFRID) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "ALLOC_STAG WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_mr_reg_non_shared - non-shared mr registration * @dev: sc device struct * @info: mr info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_mr_reg_non_shared( struct i40iw_sc_dev *dev, struct i40iw_reg_ns_stag_info *info, u64 scratch, bool post_sq) { u64 *wqe; u64 temp; struct i40iw_sc_cqp *cqp; u64 header; u32 pble_obj_cnt; bool remote_access; u8 addr_type; enum i40iw_page_size page_size; page_size = (info->page_size == 0x200000) ? I40IW_PAGE_SIZE_2M : I40IW_PAGE_SIZE_4K; if (info->access_rights & (I40IW_ACCESS_FLAGS_REMOTEREAD_ONLY | I40IW_ACCESS_FLAGS_REMOTEWRITE_ONLY)) remote_access = true; else remote_access = false; pble_obj_cnt = dev->hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt; if (info->chunk_size && (info->first_pm_pbl_index >= pble_obj_cnt)) return I40IW_ERR_INVALID_PBLE_INDEX; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; temp = (info->addr_type == I40IW_ADDR_TYPE_VA_BASED) ? (uintptr_t)info->va : info->fbo; set_64bit_val(wqe, 0, temp); set_64bit_val(wqe, 8, LS_64(info->total_len, I40IW_CQPSQ_STAG_STAGLEN) | LS_64(info->pd_id, I40IW_CQPSQ_STAG_PDID)); set_64bit_val(wqe, 16, LS_64(info->stag_key, I40IW_CQPSQ_STAG_KEY) | LS_64(info->stag_idx, I40IW_CQPSQ_STAG_IDX)); if (!info->chunk_size) { set_64bit_val(wqe, 32, info->reg_addr_pa); set_64bit_val(wqe, 48, 0); } else { set_64bit_val(wqe, 32, 0); set_64bit_val(wqe, 48, info->first_pm_pbl_index); } set_64bit_val(wqe, 40, info->hmc_fcn_index); set_64bit_val(wqe, 56, 0); addr_type = (info->addr_type == I40IW_ADDR_TYPE_VA_BASED) ? 1 : 0; header = LS_64(I40IW_CQP_OP_REG_MR, I40IW_CQPSQ_OPCODE) | LS_64(1, I40IW_CQPSQ_STAG_MR) | LS_64(info->chunk_size, I40IW_CQPSQ_STAG_LPBLSIZE) | LS_64(page_size, I40IW_CQPSQ_STAG_HPAGESIZE) | LS_64(info->access_rights, I40IW_CQPSQ_STAG_ARIGHTS) | LS_64(remote_access, I40IW_CQPSQ_STAG_REMACCENABLED) | LS_64(addr_type, I40IW_CQPSQ_STAG_VABASEDTO) | LS_64(info->use_hmc_fcn_index, I40IW_CQPSQ_STAG_USEHMCFNIDX) | LS_64(info->use_pf_rid, I40IW_CQPSQ_STAG_USEPFRID) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "MR_REG_NS WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_mr_reg_shared - registered shared memory region * @dev: sc device struct * @info: info for shared memory registeration * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_mr_reg_shared( struct i40iw_sc_dev *dev, struct i40iw_register_shared_stag *info, u64 scratch, bool post_sq) { u64 *wqe; struct i40iw_sc_cqp *cqp; u64 temp, va64, fbo, header; u32 va32; bool remote_access; u8 addr_type; if (info->access_rights & (I40IW_ACCESS_FLAGS_REMOTEREAD_ONLY | I40IW_ACCESS_FLAGS_REMOTEWRITE_ONLY)) remote_access = true; else remote_access = false; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; va64 = (uintptr_t)(info->va); va32 = (u32)(va64 & 0x00000000FFFFFFFF); fbo = (u64)(va32 & (4096 - 1)); set_64bit_val(wqe, 0, (info->addr_type == I40IW_ADDR_TYPE_VA_BASED ? (uintptr_t)info->va : fbo)); set_64bit_val(wqe, 8, LS_64(info->pd_id, I40IW_CQPSQ_STAG_PDID)); temp = LS_64(info->new_stag_key, I40IW_CQPSQ_STAG_KEY) | LS_64(info->new_stag_idx, I40IW_CQPSQ_STAG_IDX) | LS_64(info->parent_stag_idx, I40IW_CQPSQ_STAG_PARENTSTAGIDX); set_64bit_val(wqe, 16, temp); addr_type = (info->addr_type == I40IW_ADDR_TYPE_VA_BASED) ? 1 : 0; header = LS_64(I40IW_CQP_OP_REG_SMR, I40IW_CQPSQ_OPCODE) | LS_64(1, I40IW_CQPSQ_STAG_MR) | LS_64(info->access_rights, I40IW_CQPSQ_STAG_ARIGHTS) | LS_64(remote_access, I40IW_CQPSQ_STAG_REMACCENABLED) | LS_64(addr_type, I40IW_CQPSQ_STAG_VABASEDTO) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "MR_REG_SHARED WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_dealloc_stag - deallocate stag * @dev: sc device struct * @info: dealloc stag info * @scratch: u64 saved to be used during cqp completion * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_dealloc_stag( struct i40iw_sc_dev *dev, struct i40iw_dealloc_stag_info *info, u64 scratch, bool post_sq) { u64 header; u64 *wqe; struct i40iw_sc_cqp *cqp; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 8, LS_64(info->pd_id, I40IW_CQPSQ_STAG_PDID)); set_64bit_val(wqe, 16, LS_64(info->stag_idx, I40IW_CQPSQ_STAG_IDX)); header = LS_64(I40IW_CQP_OP_DEALLOC_STAG, I40IW_CQPSQ_OPCODE) | LS_64(info->mr, I40IW_CQPSQ_STAG_MR) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "DEALLOC_STAG WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_query_stag - query hardware for stag * @dev: sc device struct * @scratch: u64 saved to be used during cqp completion * @stag_index: stag index for query * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_query_stag(struct i40iw_sc_dev *dev, u64 scratch, u32 stag_index, bool post_sq) { u64 header; u64 *wqe; struct i40iw_sc_cqp *cqp; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, LS_64(stag_index, I40IW_CQPSQ_QUERYSTAG_IDX)); header = LS_64(I40IW_CQP_OP_QUERY_STAG, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "QUERY_STAG WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_mw_alloc - mw allocate * @dev: sc device struct * @scratch: u64 saved to be used during cqp completion * @mw_stag_index:stag index * @pd_id: pd is for this mw * @post_sq: flag for cqp db to ring */ static enum i40iw_status_code i40iw_sc_mw_alloc( struct i40iw_sc_dev *dev, u64 scratch, u32 mw_stag_index, u16 pd_id, bool post_sq) { u64 header; struct i40iw_sc_cqp *cqp; u64 *wqe; cqp = dev->cqp; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 8, LS_64(pd_id, I40IW_CQPSQ_STAG_PDID)); set_64bit_val(wqe, 16, LS_64(mw_stag_index, I40IW_CQPSQ_STAG_IDX)); header = LS_64(I40IW_CQP_OP_ALLOC_STAG, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(dev, I40IW_DEBUG_WQE, "MW_ALLOC WQE", wqe, I40IW_CQP_WQE_SIZE * 8); if (post_sq) i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_mr_fast_register - Posts RDMA fast register mr WR to iwarp qp * @qp: sc qp struct * @info: fast mr info * @post_sq: flag for cqp db to ring */ enum i40iw_status_code i40iw_sc_mr_fast_register( struct i40iw_sc_qp *qp, struct i40iw_fast_reg_stag_info *info, bool post_sq) { u64 temp, header; u64 *wqe; u32 wqe_idx; enum i40iw_page_size page_size; page_size = (info->page_size == 0x200000) ? I40IW_PAGE_SIZE_2M : I40IW_PAGE_SIZE_4K; wqe = i40iw_qp_get_next_send_wqe(&qp->qp_uk, &wqe_idx, I40IW_QP_WQE_MIN_SIZE, 0, info->wr_id); if (!wqe) return I40IW_ERR_QP_TOOMANY_WRS_POSTED; i40iw_debug(qp->dev, I40IW_DEBUG_MR, "%s: wr_id[%llxh] wqe_idx[%04d] location[%p]\n", __func__, info->wr_id, wqe_idx, &qp->qp_uk.sq_wrtrk_array[wqe_idx].wrid); temp = (info->addr_type == I40IW_ADDR_TYPE_VA_BASED) ? (uintptr_t)info->va : info->fbo; set_64bit_val(wqe, 0, temp); temp = RS_64(info->first_pm_pbl_index >> 16, I40IWQPSQ_FIRSTPMPBLIDXHI); set_64bit_val(wqe, 8, LS_64(temp, I40IWQPSQ_FIRSTPMPBLIDXHI) | LS_64(info->reg_addr_pa >> I40IWQPSQ_PBLADDR_SHIFT, I40IWQPSQ_PBLADDR)); set_64bit_val(wqe, 16, info->total_len | LS_64(info->first_pm_pbl_index, I40IWQPSQ_FIRSTPMPBLIDXLO)); header = LS_64(info->stag_key, I40IWQPSQ_STAGKEY) | LS_64(info->stag_idx, I40IWQPSQ_STAGINDEX) | LS_64(I40IWQP_OP_FAST_REGISTER, I40IWQPSQ_OPCODE) | LS_64(info->chunk_size, I40IWQPSQ_LPBLSIZE) | LS_64(page_size, I40IWQPSQ_HPAGESIZE) | LS_64(info->access_rights, I40IWQPSQ_STAGRIGHTS) | LS_64(info->addr_type, I40IWQPSQ_VABASEDTO) | LS_64(info->read_fence, I40IWQPSQ_READFENCE) | LS_64(info->local_fence, I40IWQPSQ_LOCALFENCE) | LS_64(info->signaled, I40IWQPSQ_SIGCOMPL) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(qp->dev, I40IW_DEBUG_WQE, "FAST_REG WQE", wqe, I40IW_QP_WQE_MIN_SIZE); if (post_sq) i40iw_qp_post_wr(&qp->qp_uk); return 0; } /** * i40iw_sc_send_lsmm - send last streaming mode message * @qp: sc qp struct * @lsmm_buf: buffer with lsmm message * @size: size of lsmm buffer * @stag: stag of lsmm buffer */ static void i40iw_sc_send_lsmm(struct i40iw_sc_qp *qp, void *lsmm_buf, u32 size, i40iw_stag stag) { u64 *wqe; u64 header; struct i40iw_qp_uk *qp_uk; qp_uk = &qp->qp_uk; wqe = qp_uk->sq_base->elem; set_64bit_val(wqe, 0, (uintptr_t)lsmm_buf); set_64bit_val(wqe, 8, (size | LS_64(stag, I40IWQPSQ_FRAG_STAG))); set_64bit_val(wqe, 16, 0); header = LS_64(I40IWQP_OP_RDMA_SEND, I40IWQPSQ_OPCODE) | LS_64(1, I40IWQPSQ_STREAMMODE) | LS_64(1, I40IWQPSQ_WAITFORRCVPDU) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(qp->dev, I40IW_DEBUG_QP, "SEND_LSMM WQE", wqe, I40IW_QP_WQE_MIN_SIZE); } /** * i40iw_sc_send_lsmm_nostag - for privilege qp * @qp: sc qp struct * @lsmm_buf: buffer with lsmm message * @size: size of lsmm buffer */ static void i40iw_sc_send_lsmm_nostag(struct i40iw_sc_qp *qp, void *lsmm_buf, u32 size) { u64 *wqe; u64 header; struct i40iw_qp_uk *qp_uk; qp_uk = &qp->qp_uk; wqe = qp_uk->sq_base->elem; set_64bit_val(wqe, 0, (uintptr_t)lsmm_buf); set_64bit_val(wqe, 8, size); set_64bit_val(wqe, 16, 0); header = LS_64(I40IWQP_OP_RDMA_SEND, I40IWQPSQ_OPCODE) | LS_64(1, I40IWQPSQ_STREAMMODE) | LS_64(1, I40IWQPSQ_WAITFORRCVPDU) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(qp->dev, I40IW_DEBUG_WQE, "SEND_LSMM_NOSTAG WQE", wqe, I40IW_QP_WQE_MIN_SIZE); } /** * i40iw_sc_send_rtt - send last read0 or write0 * @qp: sc qp struct * @read: Do read0 or write0 */ static void i40iw_sc_send_rtt(struct i40iw_sc_qp *qp, bool read) { u64 *wqe; u64 header; struct i40iw_qp_uk *qp_uk; qp_uk = &qp->qp_uk; wqe = qp_uk->sq_base->elem; set_64bit_val(wqe, 0, 0); set_64bit_val(wqe, 8, 0); set_64bit_val(wqe, 16, 0); if (read) { header = LS_64(0x1234, I40IWQPSQ_REMSTAG) | LS_64(I40IWQP_OP_RDMA_READ, I40IWQPSQ_OPCODE) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID); set_64bit_val(wqe, 8, ((u64)0xabcd << 32)); } else { header = LS_64(I40IWQP_OP_RDMA_WRITE, I40IWQPSQ_OPCODE) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID); } i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(qp->dev, I40IW_DEBUG_WQE, "RTR WQE", wqe, I40IW_QP_WQE_MIN_SIZE); } /** * i40iw_sc_post_wqe0 - send wqe with opcode * @qp: sc qp struct * @opcode: opcode to use for wqe0 */ static enum i40iw_status_code i40iw_sc_post_wqe0(struct i40iw_sc_qp *qp, u8 opcode) { u64 *wqe; u64 header; struct i40iw_qp_uk *qp_uk; qp_uk = &qp->qp_uk; wqe = qp_uk->sq_base->elem; if (!wqe) return I40IW_ERR_QP_TOOMANY_WRS_POSTED; switch (opcode) { case I40IWQP_OP_NOP: set_64bit_val(wqe, 0, 0); set_64bit_val(wqe, 8, 0); set_64bit_val(wqe, 16, 0); header = LS_64(I40IWQP_OP_NOP, I40IWQPSQ_OPCODE) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID); i40iw_insert_wqe_hdr(wqe, header); break; case I40IWQP_OP_RDMA_SEND: set_64bit_val(wqe, 0, 0); set_64bit_val(wqe, 8, 0); set_64bit_val(wqe, 16, 0); header = LS_64(I40IWQP_OP_RDMA_SEND, I40IWQPSQ_OPCODE) | LS_64(qp->qp_uk.swqe_polarity, I40IWQPSQ_VALID) | LS_64(1, I40IWQPSQ_STREAMMODE) | LS_64(1, I40IWQPSQ_WAITFORRCVPDU); i40iw_insert_wqe_hdr(wqe, header); break; default: i40iw_debug(qp->dev, I40IW_DEBUG_QP, "%s: Invalid WQE zero opcode\n", __func__); break; } return 0; } /** * i40iw_sc_init_iw_hmc() - queries fpm values using cqp and populates hmc_info * @dev : ptr to i40iw_dev struct * @hmc_fn_id: hmc function id */ enum i40iw_status_code i40iw_sc_init_iw_hmc(struct i40iw_sc_dev *dev, u8 hmc_fn_id) { struct i40iw_hmc_info *hmc_info; struct i40iw_dma_mem query_fpm_mem; struct i40iw_virt_mem virt_mem; struct i40iw_vfdev *vf_dev = NULL; u32 mem_size; enum i40iw_status_code ret_code = 0; bool poll_registers = true; u16 iw_vf_idx; u8 wait_type; if (hmc_fn_id >= I40IW_MAX_VF_FPM_ID || (dev->hmc_fn_id != hmc_fn_id && hmc_fn_id < I40IW_FIRST_VF_FPM_ID)) return I40IW_ERR_INVALID_HMCFN_ID; i40iw_debug(dev, I40IW_DEBUG_HMC, "hmc_fn_id %u, dev->hmc_fn_id %u\n", hmc_fn_id, dev->hmc_fn_id); if (hmc_fn_id == dev->hmc_fn_id) { hmc_info = dev->hmc_info; query_fpm_mem.pa = dev->fpm_query_buf_pa; query_fpm_mem.va = dev->fpm_query_buf; } else { vf_dev = i40iw_vfdev_from_fpm(dev, hmc_fn_id); if (!vf_dev) return I40IW_ERR_INVALID_VF_ID; hmc_info = &vf_dev->hmc_info; iw_vf_idx = vf_dev->iw_vf_idx; i40iw_debug(dev, I40IW_DEBUG_HMC, "vf_dev %p, hmc_info %p, hmc_obj %p\n", vf_dev, hmc_info, hmc_info->hmc_obj); if (!vf_dev->fpm_query_buf) { if (!dev->vf_fpm_query_buf[iw_vf_idx].va) { ret_code = i40iw_alloc_query_fpm_buf(dev, &dev->vf_fpm_query_buf[iw_vf_idx]); if (ret_code) return ret_code; } vf_dev->fpm_query_buf = dev->vf_fpm_query_buf[iw_vf_idx].va; vf_dev->fpm_query_buf_pa = dev->vf_fpm_query_buf[iw_vf_idx].pa; } query_fpm_mem.pa = vf_dev->fpm_query_buf_pa; query_fpm_mem.va = vf_dev->fpm_query_buf; /** * It is HARDWARE specific: * this call is done by PF for VF and * i40iw_sc_query_fpm_values needs ccq poll * because PF ccq is already created. */ poll_registers = false; } hmc_info->hmc_fn_id = hmc_fn_id; if (hmc_fn_id != dev->hmc_fn_id) { ret_code = i40iw_cqp_query_fpm_values_cmd(dev, &query_fpm_mem, hmc_fn_id); } else { wait_type = poll_registers ? (u8)I40IW_CQP_WAIT_POLL_REGS : (u8)I40IW_CQP_WAIT_POLL_CQ; ret_code = i40iw_sc_query_fpm_values( dev->cqp, 0, hmc_info->hmc_fn_id, &query_fpm_mem, true, wait_type); } if (ret_code) return ret_code; /* parse the fpm_query_buf and fill hmc obj info */ ret_code = i40iw_sc_parse_fpm_query_buf((u64 *)query_fpm_mem.va, hmc_info, &dev->hmc_fpm_misc); if (ret_code) return ret_code; i40iw_debug_buf(dev, I40IW_DEBUG_HMC, "QUERY FPM BUFFER", query_fpm_mem.va, I40IW_QUERY_FPM_BUF_SIZE); if (hmc_fn_id != dev->hmc_fn_id) { i40iw_cqp_commit_fpm_values_cmd(dev, &query_fpm_mem, hmc_fn_id); /* parse the fpm_commit_buf and fill hmc obj info */ i40iw_sc_parse_fpm_commit_buf((u64 *)query_fpm_mem.va, hmc_info->hmc_obj, &hmc_info->sd_table.sd_cnt); mem_size = sizeof(struct i40iw_hmc_sd_entry) * (hmc_info->sd_table.sd_cnt + hmc_info->first_sd_index); ret_code = i40iw_allocate_virt_mem(dev->hw, &virt_mem, mem_size); if (ret_code) return ret_code; hmc_info->sd_table.sd_entry = virt_mem.va; } return ret_code; } /** * i40iw_sc_configure_iw_fpm() - commits hmc obj cnt values using cqp command and * populates fpm base address in hmc_info * @dev : ptr to i40iw_dev struct * @hmc_fn_id: hmc function id */ static enum i40iw_status_code i40iw_sc_configure_iw_fpm(struct i40iw_sc_dev *dev, u8 hmc_fn_id) { struct i40iw_hmc_info *hmc_info; struct i40iw_hmc_obj_info *obj_info; u64 *buf; struct i40iw_dma_mem commit_fpm_mem; u32 i, j; enum i40iw_status_code ret_code = 0; bool poll_registers = true; u8 wait_type; if (hmc_fn_id >= I40IW_MAX_VF_FPM_ID || (dev->hmc_fn_id != hmc_fn_id && hmc_fn_id < I40IW_FIRST_VF_FPM_ID)) return I40IW_ERR_INVALID_HMCFN_ID; if (hmc_fn_id == dev->hmc_fn_id) { hmc_info = dev->hmc_info; } else { hmc_info = i40iw_vf_hmcinfo_from_fpm(dev, hmc_fn_id); poll_registers = false; } if (!hmc_info) return I40IW_ERR_BAD_PTR; obj_info = hmc_info->hmc_obj; buf = dev->fpm_commit_buf; /* copy cnt values in commit buf */ for (i = I40IW_HMC_IW_QP, j = 0; i <= I40IW_HMC_IW_PBLE; i++, j += 8) set_64bit_val(buf, j, (u64)obj_info[i].cnt); set_64bit_val(buf, 40, 0); /* APBVT rsvd */ commit_fpm_mem.pa = dev->fpm_commit_buf_pa; commit_fpm_mem.va = dev->fpm_commit_buf; wait_type = poll_registers ? (u8)I40IW_CQP_WAIT_POLL_REGS : (u8)I40IW_CQP_WAIT_POLL_CQ; ret_code = i40iw_sc_commit_fpm_values( dev->cqp, 0, hmc_info->hmc_fn_id, &commit_fpm_mem, true, wait_type); /* parse the fpm_commit_buf and fill hmc obj info */ if (!ret_code) ret_code = i40iw_sc_parse_fpm_commit_buf(dev->fpm_commit_buf, hmc_info->hmc_obj, &hmc_info->sd_table.sd_cnt); i40iw_debug_buf(dev, I40IW_DEBUG_HMC, "COMMIT FPM BUFFER", commit_fpm_mem.va, I40IW_COMMIT_FPM_BUF_SIZE); return ret_code; } /** * cqp_sds_wqe_fill - fill cqp wqe doe sd * @cqp: struct for cqp hw * @info; sd info for wqe * @scratch: u64 saved to be used during cqp completion */ static enum i40iw_status_code cqp_sds_wqe_fill(struct i40iw_sc_cqp *cqp, struct i40iw_update_sds_info *info, u64 scratch) { u64 data; u64 header; u64 *wqe; int mem_entries, wqe_entries; struct i40iw_dma_mem *sdbuf = &cqp->sdbuf; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; I40IW_CQP_INIT_WQE(wqe); wqe_entries = (info->cnt > 3) ? 3 : info->cnt; mem_entries = info->cnt - wqe_entries; header = LS_64(I40IW_CQP_OP_UPDATE_PE_SDS, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID) | LS_64(mem_entries, I40IW_CQPSQ_UPESD_ENTRY_COUNT); if (mem_entries) { memcpy(sdbuf->va, &info->entry[3], (mem_entries << 4)); data = sdbuf->pa; } else { data = 0; } data |= LS_64(info->hmc_fn_id, I40IW_CQPSQ_UPESD_HMCFNID); set_64bit_val(wqe, 16, data); switch (wqe_entries) { case 3: set_64bit_val(wqe, 48, (LS_64(info->entry[2].cmd, I40IW_CQPSQ_UPESD_SDCMD) | LS_64(1, I40IW_CQPSQ_UPESD_ENTRY_VALID))); set_64bit_val(wqe, 56, info->entry[2].data); /* fallthrough */ case 2: set_64bit_val(wqe, 32, (LS_64(info->entry[1].cmd, I40IW_CQPSQ_UPESD_SDCMD) | LS_64(1, I40IW_CQPSQ_UPESD_ENTRY_VALID))); set_64bit_val(wqe, 40, info->entry[1].data); /* fallthrough */ case 1: set_64bit_val(wqe, 0, LS_64(info->entry[0].cmd, I40IW_CQPSQ_UPESD_SDCMD)); set_64bit_val(wqe, 8, info->entry[0].data); break; default: break; } i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "UPDATE_PE_SDS WQE", wqe, I40IW_CQP_WQE_SIZE * 8); return 0; } /** * i40iw_update_pe_sds - cqp wqe for sd * @dev: ptr to i40iw_dev struct * @info: sd info for sd's * @scratch: u64 saved to be used during cqp completion */ static enum i40iw_status_code i40iw_update_pe_sds(struct i40iw_sc_dev *dev, struct i40iw_update_sds_info *info, u64 scratch) { struct i40iw_sc_cqp *cqp = dev->cqp; enum i40iw_status_code ret_code; ret_code = cqp_sds_wqe_fill(cqp, info, scratch); if (!ret_code) i40iw_sc_cqp_post_sq(cqp); return ret_code; } /** * i40iw_update_sds_noccq - update sd before ccq created * @dev: sc device struct * @info: sd info for sd's */ enum i40iw_status_code i40iw_update_sds_noccq(struct i40iw_sc_dev *dev, struct i40iw_update_sds_info *info) { u32 error, val, tail; struct i40iw_sc_cqp *cqp = dev->cqp; enum i40iw_status_code ret_code; ret_code = cqp_sds_wqe_fill(cqp, info, 0); if (ret_code) return ret_code; i40iw_get_cqp_reg_info(cqp, &val, &tail, &error); if (error) return I40IW_ERR_CQP_COMPL_ERROR; i40iw_sc_cqp_post_sq(cqp); ret_code = i40iw_cqp_poll_registers(cqp, tail, I40IW_DONE_COUNT); return ret_code; } /** * i40iw_sc_suspend_qp - suspend qp for param change * @cqp: struct for cqp hw * @qp: sc qp struct * @scratch: u64 saved to be used during cqp completion */ enum i40iw_status_code i40iw_sc_suspend_qp(struct i40iw_sc_cqp *cqp, struct i40iw_sc_qp *qp, u64 scratch) { u64 header; u64 *wqe; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; header = LS_64(qp->qp_uk.qp_id, I40IW_CQPSQ_SUSPENDQP_QPID) | LS_64(I40IW_CQP_OP_SUSPEND_QP, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "SUSPEND_QP WQE", wqe, I40IW_CQP_WQE_SIZE * 8); i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_resume_qp - resume qp after suspend * @cqp: struct for cqp hw * @qp: sc qp struct * @scratch: u64 saved to be used during cqp completion */ enum i40iw_status_code i40iw_sc_resume_qp(struct i40iw_sc_cqp *cqp, struct i40iw_sc_qp *qp, u64 scratch) { u64 header; u64 *wqe; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, LS_64(qp->qs_handle, I40IW_CQPSQ_RESUMEQP_QSHANDLE)); header = LS_64(qp->qp_uk.qp_id, I40IW_CQPSQ_RESUMEQP_QPID) | LS_64(I40IW_CQP_OP_RESUME_QP, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "RESUME_QP WQE", wqe, I40IW_CQP_WQE_SIZE * 8); i40iw_sc_cqp_post_sq(cqp); return 0; } /** * i40iw_sc_static_hmc_pages_allocated - cqp wqe to allocate hmc pages * @cqp: struct for cqp hw * @scratch: u64 saved to be used during cqp completion * @hmc_fn_id: hmc function id * @post_sq: flag for cqp db to ring * @poll_registers: flag to poll register for cqp completion */ enum i40iw_status_code i40iw_sc_static_hmc_pages_allocated( struct i40iw_sc_cqp *cqp, u64 scratch, u8 hmc_fn_id, bool post_sq, bool poll_registers) { u64 header; u64 *wqe; u32 tail, val, error; enum i40iw_status_code ret_code = 0; wqe = i40iw_sc_cqp_get_next_send_wqe(cqp, scratch); if (!wqe) return I40IW_ERR_RING_FULL; set_64bit_val(wqe, 16, LS_64(hmc_fn_id, I40IW_SHMC_PAGE_ALLOCATED_HMC_FN_ID)); header = LS_64(I40IW_CQP_OP_SHMC_PAGES_ALLOCATED, I40IW_CQPSQ_OPCODE) | LS_64(cqp->polarity, I40IW_CQPSQ_WQEVALID); i40iw_insert_wqe_hdr(wqe, header); i40iw_debug_buf(cqp->dev, I40IW_DEBUG_WQE, "SHMC_PAGES_ALLOCATED WQE", wqe, I40IW_CQP_WQE_SIZE * 8); i40iw_get_cqp_reg_info(cqp, &val, &tail, &error); if (error) { ret_code = I40IW_ERR_CQP_COMPL_ERROR; return ret_code; } if (post_sq) { i40iw_sc_cqp_post_sq(cqp); if (poll_registers) /* check for cqp sq tail update */ ret_code = i40iw_cqp_poll_registers(cqp, tail, 1000); else ret_code = i40iw_sc_poll_for_cqp_op_done(cqp, I40IW_CQP_OP_SHMC_PAGES_ALLOCATED, NULL); } return ret_code; } /** * i40iw_ring_full - check if cqp ring is full * @cqp: struct for cqp hw */ static bool i40iw_ring_full(struct i40iw_sc_cqp *cqp) { return I40IW_RING_FULL_ERR(cqp->sq_ring); } /** * i40iw_est_sd - returns approximate number of SDs for HMC * @dev: sc device struct * @hmc_info: hmc structure, size and count for HMC objects */ static u64 i40iw_est_sd(struct i40iw_sc_dev *dev, struct i40iw_hmc_info *hmc_info) { int i; u64 size = 0; u64 sd; for (i = I40IW_HMC_IW_QP; i < I40IW_HMC_IW_PBLE; i++) size += hmc_info->hmc_obj[i].cnt * hmc_info->hmc_obj[i].size; if (dev->is_pf) size += hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt * hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].size; if (size & 0x1FFFFF) sd = (size >> 21) + 1; /* add 1 for remainder */ else sd = size >> 21; if (!dev->is_pf) { /* 2MB alignment for VF PBLE HMC */ size = hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt * hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].size; if (size & 0x1FFFFF) sd += (size >> 21) + 1; /* add 1 for remainder */ else sd += size >> 21; } return sd; } /** * i40iw_config_fpm_values - configure HMC objects * @dev: sc device struct * @qp_count: desired qp count */ enum i40iw_status_code i40iw_config_fpm_values(struct i40iw_sc_dev *dev, u32 qp_count) { struct i40iw_virt_mem virt_mem; u32 i, mem_size; u32 qpwantedoriginal, qpwanted, mrwanted, pblewanted; u32 powerof2; u64 sd_needed; u32 loop_count = 0; struct i40iw_hmc_info *hmc_info; struct i40iw_hmc_fpm_misc *hmc_fpm_misc; enum i40iw_status_code ret_code = 0; hmc_info = dev->hmc_info; hmc_fpm_misc = &dev->hmc_fpm_misc; ret_code = i40iw_sc_init_iw_hmc(dev, dev->hmc_fn_id); if (ret_code) { i40iw_debug(dev, I40IW_DEBUG_HMC, "i40iw_sc_init_iw_hmc returned error_code = %d\n", ret_code); return ret_code; } for (i = I40IW_HMC_IW_QP; i < I40IW_HMC_IW_MAX; i++) hmc_info->hmc_obj[i].cnt = hmc_info->hmc_obj[i].max_cnt; sd_needed = i40iw_est_sd(dev, hmc_info); i40iw_debug(dev, I40IW_DEBUG_HMC, "%s: FW initial max sd_count[%08lld] first_sd_index[%04d]\n", __func__, sd_needed, hmc_info->first_sd_index); i40iw_debug(dev, I40IW_DEBUG_HMC, "%s: sd count %d where max sd is %d\n", __func__, hmc_info->sd_table.sd_cnt, hmc_fpm_misc->max_sds); qpwanted = min(qp_count, hmc_info->hmc_obj[I40IW_HMC_IW_QP].max_cnt); qpwantedoriginal = qpwanted; mrwanted = hmc_info->hmc_obj[I40IW_HMC_IW_MR].max_cnt; pblewanted = hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].max_cnt; i40iw_debug(dev, I40IW_DEBUG_HMC, "req_qp=%d max_sd=%d, max_qp = %d, max_cq=%d, max_mr=%d, max_pble=%d\n", qp_count, hmc_fpm_misc->max_sds, hmc_info->hmc_obj[I40IW_HMC_IW_QP].max_cnt, hmc_info->hmc_obj[I40IW_HMC_IW_CQ].max_cnt, hmc_info->hmc_obj[I40IW_HMC_IW_MR].max_cnt, hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].max_cnt); do { ++loop_count; hmc_info->hmc_obj[I40IW_HMC_IW_QP].cnt = qpwanted; hmc_info->hmc_obj[I40IW_HMC_IW_CQ].cnt = min(2 * qpwanted, hmc_info->hmc_obj[I40IW_HMC_IW_CQ].cnt); hmc_info->hmc_obj[I40IW_HMC_IW_SRQ].cnt = 0x00; /* Reserved */ hmc_info->hmc_obj[I40IW_HMC_IW_HTE].cnt = qpwanted * hmc_fpm_misc->ht_multiplier; hmc_info->hmc_obj[I40IW_HMC_IW_ARP].cnt = hmc_info->hmc_obj[I40IW_HMC_IW_ARP].max_cnt; hmc_info->hmc_obj[I40IW_HMC_IW_APBVT_ENTRY].cnt = 1; hmc_info->hmc_obj[I40IW_HMC_IW_MR].cnt = mrwanted; hmc_info->hmc_obj[I40IW_HMC_IW_XF].cnt = I40IW_MAX_WQ_ENTRIES * qpwanted; hmc_info->hmc_obj[I40IW_HMC_IW_Q1].cnt = 4 * I40IW_MAX_IRD_SIZE * qpwanted; hmc_info->hmc_obj[I40IW_HMC_IW_XFFL].cnt = hmc_info->hmc_obj[I40IW_HMC_IW_XF].cnt / hmc_fpm_misc->xf_block_size; hmc_info->hmc_obj[I40IW_HMC_IW_Q1FL].cnt = hmc_info->hmc_obj[I40IW_HMC_IW_Q1].cnt / hmc_fpm_misc->q1_block_size; hmc_info->hmc_obj[I40IW_HMC_IW_TIMER].cnt = ((qpwanted) / 512 + 1) * hmc_fpm_misc->timer_bucket; hmc_info->hmc_obj[I40IW_HMC_IW_FSIMC].cnt = 0x00; hmc_info->hmc_obj[I40IW_HMC_IW_FSIAV].cnt = 0x00; hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt = pblewanted; /* How much memory is needed for all the objects. */ sd_needed = i40iw_est_sd(dev, hmc_info); if ((loop_count > 1000) || ((!(loop_count % 10)) && (qpwanted > qpwantedoriginal * 2 / 3))) { if (qpwanted > FPM_MULTIPLIER) { qpwanted -= FPM_MULTIPLIER; powerof2 = 1; while (powerof2 < qpwanted) powerof2 *= 2; powerof2 /= 2; qpwanted = powerof2; } else { qpwanted /= 2; } } if (mrwanted > FPM_MULTIPLIER * 10) mrwanted -= FPM_MULTIPLIER * 10; if (pblewanted > FPM_MULTIPLIER * 1000) pblewanted -= FPM_MULTIPLIER * 1000; } while (sd_needed > hmc_fpm_misc->max_sds && loop_count < 2000); sd_needed = i40iw_est_sd(dev, hmc_info); i40iw_debug(dev, I40IW_DEBUG_HMC, "loop_cnt=%d, sd_needed=%lld, qpcnt = %d, cqcnt=%d, mrcnt=%d, pblecnt=%d\n", loop_count, sd_needed, hmc_info->hmc_obj[I40IW_HMC_IW_QP].cnt, hmc_info->hmc_obj[I40IW_HMC_IW_CQ].cnt, hmc_info->hmc_obj[I40IW_HMC_IW_MR].cnt, hmc_info->hmc_obj[I40IW_HMC_IW_PBLE].cnt); ret_code = i40iw_sc_configure_iw_fpm(dev, dev->hmc_fn_id); if (ret_code) { i40iw_debug(dev, I40IW_DEBUG_HMC, "configure_iw_fpm returned error_code[x%08X]\n", i40iw_rd32(dev->hw, dev->is_pf ? I40E_PFPE_CQPERRCODES : I40E_VFPE_CQPERRCODES1)); return ret_code; } mem_size = sizeof(struct i40iw_hmc_sd_entry) * (hmc_info->sd_table.sd_cnt + hmc_info->first_sd_index + 1); ret_code = i40iw_allocate_virt_mem(dev->hw, &virt_mem, mem_size); if (ret_code) { i40iw_debug(dev, I40IW_DEBUG_HMC, "%s: failed to allocate memory for sd_entry buffer\n", __func__); return ret_code; } hmc_info->sd_table.sd_entry = virt_mem.va; return ret_code; } /** * i40iw_exec_cqp_cmd - execute cqp cmd when wqe are available * @dev: rdma device * @pcmdinfo: cqp command info */ static enum i40iw_status_code i40iw_exec_cqp_cmd(struct i40iw_sc_dev *dev, struct cqp_commands_info *pcmdinfo) { enum i40iw_status_code status; struct i40iw_dma_mem values_mem; dev->cqp_cmd_stats[pcmdinfo->cqp_cmd]++; switch (pcmdinfo->cqp_cmd) { case OP_DELETE_LOCAL_MAC_IPADDR_ENTRY: status = i40iw_sc_del_local_mac_ipaddr_entry( pcmdinfo->in.u.del_local_mac_ipaddr_entry.cqp, pcmdinfo->in.u.del_local_mac_ipaddr_entry.scratch, pcmdinfo->in.u.del_local_mac_ipaddr_entry.entry_idx, pcmdinfo->in.u.del_local_mac_ipaddr_entry.ignore_ref_count, pcmdinfo->post_sq); break; case OP_CEQ_DESTROY: status = i40iw_sc_ceq_destroy(pcmdinfo->in.u.ceq_destroy.ceq, pcmdinfo->in.u.ceq_destroy.scratch, pcmdinfo->post_sq); break; case OP_AEQ_DESTROY: status = i40iw_sc_aeq_destroy(pcmdinfo->in.u.aeq_destroy.aeq, pcmdinfo->in.u.aeq_destroy.scratch, pcmdinfo->post_sq); break; case OP_DELETE_ARP_CACHE_ENTRY: status = i40iw_sc_del_arp_cache_entry( pcmdinfo->in.u.del_arp_cache_entry.cqp, pcmdinfo->in.u.del_arp_cache_entry.scratch, pcmdinfo->in.u.del_arp_cache_entry.arp_index, pcmdinfo->post_sq); break; case OP_MANAGE_APBVT_ENTRY: status = i40iw_sc_manage_apbvt_entry( pcmdinfo->in.u.manage_apbvt_entry.cqp, &pcmdinfo->in.u.manage_apbvt_entry.info, pcmdinfo->in.u.manage_apbvt_entry.scratch, pcmdinfo->post_sq); break; case OP_CEQ_CREATE: status = i40iw_sc_ceq_create(pcmdinfo->in.u.ceq_create.ceq, pcmdinfo->in.u.ceq_create.scratch, pcmdinfo->post_sq); break; case OP_AEQ_CREATE: status = i40iw_sc_aeq_create(pcmdinfo->in.u.aeq_create.aeq, pcmdinfo->in.u.aeq_create.scratch, pcmdinfo->post_sq); break; case OP_ALLOC_LOCAL_MAC_IPADDR_ENTRY: status = i40iw_sc_alloc_local_mac_ipaddr_entry( pcmdinfo->in.u.alloc_local_mac_ipaddr_entry.cqp, pcmdinfo->in.u.alloc_local_mac_ipaddr_entry.scratch, pcmdinfo->post_sq); break; case OP_ADD_LOCAL_MAC_IPADDR_ENTRY: status = i40iw_sc_add_local_mac_ipaddr_entry( pcmdinfo->in.u.add_local_mac_ipaddr_entry.cqp, &pcmdinfo->in.u.add_local_mac_ipaddr_entry.info, pcmdinfo->in.u.add_local_mac_ipaddr_entry.scratch, pcmdinfo->post_sq); break; case OP_MANAGE_QHASH_TABLE_ENTRY: status = i40iw_sc_manage_qhash_table_entry( pcmdinfo->in.u.manage_qhash_table_entry.cqp, &pcmdinfo->in.u.manage_qhash_table_entry.info, pcmdinfo->in.u.manage_qhash_table_entry.scratch, pcmdinfo->post_sq); break; case OP_QP_MODIFY: status = i40iw_sc_qp_modify( pcmdinfo->in.u.qp_modify.qp, &pcmdinfo->in.u.qp_modify.info, pcmdinfo->in.u.qp_modify.scratch, pcmdinfo->post_sq); break; case OP_QP_UPLOAD_CONTEXT: status = i40iw_sc_qp_upload_context( pcmdinfo->in.u.qp_upload_context.dev, &pcmdinfo->in.u.qp_upload_context.info, pcmdinfo->in.u.qp_upload_context.scratch, pcmdinfo->post_sq); break; case OP_CQ_CREATE: status = i40iw_sc_cq_create( pcmdinfo->in.u.cq_create.cq, pcmdinfo->in.u.cq_create.scratch, pcmdinfo->in.u.cq_create.check_overflow, pcmdinfo->post_sq); break; case OP_CQ_DESTROY: status = i40iw_sc_cq_destroy( pcmdinfo->in.u.cq_destroy.cq, pcmdinfo->in.u.cq_destroy.scratch, pcmdinfo->post_sq); break; case OP_QP_CREATE: status = i40iw_sc_qp_create( pcmdinfo->in.u.qp_create.qp, &pcmdinfo->in.u.qp_create.info, pcmdinfo->in.u.qp_create.scratch, pcmdinfo->post_sq); break; case OP_QP_DESTROY: status = i40iw_sc_qp_destroy( pcmdinfo->in.u.qp_destroy.qp, pcmdinfo->in.u.qp_destroy.scratch, pcmdinfo->in.u.qp_destroy.remove_hash_idx, pcmdinfo->in.u.qp_destroy. ignore_mw_bnd, pcmdinfo->post_sq); break; case OP_ALLOC_STAG: status = i40iw_sc_alloc_stag( pcmdinfo->in.u.alloc_stag.dev, &pcmdinfo->in.u.alloc_stag.info, pcmdinfo->in.u.alloc_stag.scratch, pcmdinfo->post_sq); break; case OP_MR_REG_NON_SHARED: status = i40iw_sc_mr_reg_non_shared( pcmdinfo->in.u.mr_reg_non_shared.dev, &pcmdinfo->in.u.mr_reg_non_shared.info, pcmdinfo->in.u.mr_reg_non_shared.scratch, pcmdinfo->post_sq); break; case OP_DEALLOC_STAG: status = i40iw_sc_dealloc_stag( pcmdinfo->in.u.dealloc_stag.dev, &pcmdinfo->in.u.dealloc_stag.info, pcmdinfo->in.u.dealloc_stag.scratch, pcmdinfo->post_sq); break; case OP_MW_ALLOC: status = i40iw_sc_mw_alloc( pcmdinfo->in.u.mw_alloc.dev, pcmdinfo->in.u.mw_alloc.scratch, pcmdinfo->in.u.mw_alloc.mw_stag_index, pcmdinfo->in.u.mw_alloc.pd_id, pcmdinfo->post_sq); break; case OP_QP_FLUSH_WQES: status = i40iw_sc_qp_flush_wqes( pcmdinfo->in.u.qp_flush_wqes.qp, &pcmdinfo->in.u.qp_flush_wqes.info, pcmdinfo->in.u.qp_flush_wqes. scratch, pcmdinfo->post_sq); break; case OP_ADD_ARP_CACHE_ENTRY: status = i40iw_sc_add_arp_cache_entry( pcmdinfo->in.u.add_arp_cache_entry.cqp, &pcmdinfo->in.u.add_arp_cache_entry.info, pcmdinfo->in.u.add_arp_cache_entry.scratch, pcmdinfo->post_sq); break; case OP_MANAGE_PUSH_PAGE: status = i40iw_sc_manage_push_page( pcmdinfo->in.u.manage_push_page.cqp, &pcmdinfo->in.u.manage_push_page.info, pcmdinfo->in.u.manage_push_page.scratch, pcmdinfo->post_sq); break; case OP_UPDATE_PE_SDS: /* case I40IW_CQP_OP_UPDATE_PE_SDS */ status = i40iw_update_pe_sds( pcmdinfo->in.u.update_pe_sds.dev, &pcmdinfo->in.u.update_pe_sds.info, pcmdinfo->in.u.update_pe_sds. scratch); break; case OP_MANAGE_HMC_PM_FUNC_TABLE: status = i40iw_sc_manage_hmc_pm_func_table( pcmdinfo->in.u.manage_hmc_pm.dev->cqp, pcmdinfo->in.u.manage_hmc_pm.scratch, (u8)pcmdinfo->in.u.manage_hmc_pm.info.vf_id, pcmdinfo->in.u.manage_hmc_pm.info.free_fcn, true); break; case OP_SUSPEND: status = i40iw_sc_suspend_qp( pcmdinfo->in.u.suspend_resume.cqp, pcmdinfo->in.u.suspend_resume.qp, pcmdinfo->in.u.suspend_resume.scratch); break; case OP_RESUME: status = i40iw_sc_resume_qp( pcmdinfo->in.u.suspend_resume.cqp, pcmdinfo->in.u.suspend_resume.qp, pcmdinfo->in.u.suspend_resume.scratch); break; case OP_MANAGE_VF_PBLE_BP: status = i40iw_manage_vf_pble_bp( pcmdinfo->in.u.manage_vf_pble_bp.cqp, &pcmdinfo->in.u.manage_vf_pble_bp.info, pcmdinfo->in.u.manage_vf_pble_bp.scratch, true); break; case OP_QUERY_FPM_VALUES: values_mem.pa = pcmdinfo->in.u.query_fpm_values.fpm_values_pa; values_mem.va = pcmdinfo->in.u.query_fpm_values.fpm_values_va; status = i40iw_sc_query_fpm_values( pcmdinfo->in.u.query_fpm_values.cqp, pcmdinfo->in.u.query_fpm_values.scratch, pcmdinfo->in.u.query_fpm_values.hmc_fn_id, &values_mem, true, I40IW_CQP_WAIT_EVENT); break; case OP_COMMIT_FPM_VALUES: values_mem.pa = pcmdinfo->in.u.commit_fpm_values.fpm_values_pa; values_mem.va = pcmdinfo->in.u.commit_fpm_values.fpm_values_va; status = i40iw_sc_commit_fpm_values( pcmdinfo->in.u.commit_fpm_values.cqp, pcmdinfo->in.u.commit_fpm_values.scratch, pcmdinfo->in.u.commit_fpm_values.hmc_fn_id, &values_mem, true, I40IW_CQP_WAIT_EVENT); break; default: status = I40IW_NOT_SUPPORTED; break; } return status; } /** * i40iw_process_cqp_cmd - process all cqp commands * @dev: sc device struct * @pcmdinfo: cqp command info */ enum i40iw_status_code i40iw_process_cqp_cmd(struct i40iw_sc_dev *dev, struct cqp_commands_info *pcmdinfo) { enum i40iw_status_code status = 0; unsigned long flags; spin_lock_irqsave(&dev->cqp_lock, flags); if (list_empty(&dev->cqp_cmd_head) && !i40iw_ring_full(dev->cqp)) status = i40iw_exec_cqp_cmd(dev, pcmdinfo); else list_add_tail(&pcmdinfo->cqp_cmd_entry, &dev->cqp_cmd_head); spin_unlock_irqrestore(&dev->cqp_lock, flags); return status; } /** * i40iw_process_bh - called from tasklet for cqp list * @dev: sc device struct */ enum i40iw_status_code i40iw_process_bh(struct i40iw_sc_dev *dev) { enum i40iw_status_code status = 0; struct cqp_commands_info *pcmdinfo; unsigned long flags; spin_lock_irqsave(&dev->cqp_lock, flags); while (!list_empty(&dev->cqp_cmd_head) && !i40iw_ring_full(dev->cqp)) { pcmdinfo = (struct cqp_commands_info *)i40iw_remove_head(&dev->cqp_cmd_head); status = i40iw_exec_cqp_cmd(dev, pcmdinfo); if (status) break; } spin_unlock_irqrestore(&dev->cqp_lock, flags); return status; } /** * i40iw_iwarp_opcode - determine if incoming is rdma layer * @info: aeq info for the packet * @pkt: packet for error */ static u32 i40iw_iwarp_opcode(struct i40iw_aeqe_info *info, u8 *pkt) { __be16 *mpa; u32 opcode = 0xffffffff; if (info->q2_data_written) { mpa = (__be16 *)pkt; opcode = ntohs(mpa[1]) & 0xf; } return opcode; } /** * i40iw_locate_mpa - return pointer to mpa in the pkt * @pkt: packet with data */ static u8 *i40iw_locate_mpa(u8 *pkt) { /* skip over ethernet header */ pkt += I40IW_MAC_HLEN; /* Skip over IP and TCP headers */ pkt += 4 * (pkt[0] & 0x0f); pkt += 4 * ((pkt[12] >> 4) & 0x0f); return pkt; } /** * i40iw_setup_termhdr - termhdr for terminate pkt * @qp: sc qp ptr for pkt * @hdr: term hdr * @opcode: flush opcode for termhdr * @layer_etype: error layer + error type * @err: error cod ein the header */ static void i40iw_setup_termhdr(struct i40iw_sc_qp *qp, struct i40iw_terminate_hdr *hdr, enum i40iw_flush_opcode opcode, u8 layer_etype, u8 err) { qp->flush_code = opcode; hdr->layer_etype = layer_etype; hdr->error_code = err; } /** * i40iw_bld_terminate_hdr - build terminate message header * @qp: qp associated with received terminate AE * @info: the struct contiaing AE information */ static int i40iw_bld_terminate_hdr(struct i40iw_sc_qp *qp, struct i40iw_aeqe_info *info) { u8 *pkt = qp->q2_buf + Q2_BAD_FRAME_OFFSET; u16 ddp_seg_len; int copy_len = 0; u8 is_tagged = 0; u32 opcode; struct i40iw_terminate_hdr *termhdr; termhdr = (struct i40iw_terminate_hdr *)qp->q2_buf; memset(termhdr, 0, Q2_BAD_FRAME_OFFSET); if (info->q2_data_written) { /* Use data from offending packet to fill in ddp & rdma hdrs */ pkt = i40iw_locate_mpa(pkt); ddp_seg_len = ntohs(*(__be16 *)pkt); if (ddp_seg_len) { copy_len = 2; termhdr->hdrct = DDP_LEN_FLAG; if (pkt[2] & 0x80) { is_tagged = 1; if (ddp_seg_len >= TERM_DDP_LEN_TAGGED) { copy_len += TERM_DDP_LEN_TAGGED; termhdr->hdrct |= DDP_HDR_FLAG; } } else { if (ddp_seg_len >= TERM_DDP_LEN_UNTAGGED) { copy_len += TERM_DDP_LEN_UNTAGGED; termhdr->hdrct |= DDP_HDR_FLAG; } if (ddp_seg_len >= (TERM_DDP_LEN_UNTAGGED + TERM_RDMA_LEN)) { if ((pkt[3] & RDMA_OPCODE_MASK) == RDMA_READ_REQ_OPCODE) { copy_len += TERM_RDMA_LEN; termhdr->hdrct |= RDMA_HDR_FLAG; } } } } } opcode = i40iw_iwarp_opcode(info, pkt); switch (info->ae_id) { case I40IW_AE_AMP_UNALLOCATED_STAG: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; if (opcode == I40IW_OP_TYPE_RDMA_WRITE) i40iw_setup_termhdr(qp, termhdr, FLUSH_PROT_ERR, (LAYER_DDP << 4) | DDP_TAGGED_BUFFER, DDP_TAGGED_INV_STAG); else i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_INV_STAG); break; case I40IW_AE_AMP_BOUNDS_VIOLATION: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; if (info->q2_data_written) i40iw_setup_termhdr(qp, termhdr, FLUSH_PROT_ERR, (LAYER_DDP << 4) | DDP_TAGGED_BUFFER, DDP_TAGGED_BOUNDS); else i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_INV_BOUNDS); break; case I40IW_AE_AMP_BAD_PD: switch (opcode) { case I40IW_OP_TYPE_RDMA_WRITE: i40iw_setup_termhdr(qp, termhdr, FLUSH_PROT_ERR, (LAYER_DDP << 4) | DDP_TAGGED_BUFFER, DDP_TAGGED_UNASSOC_STAG); break; case I40IW_OP_TYPE_SEND_INV: case I40IW_OP_TYPE_SEND_SOL_INV: i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_CANT_INV_STAG); break; default: i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_UNASSOC_STAG); } break; case I40IW_AE_AMP_INVALID_STAG: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_INV_STAG); break; case I40IW_AE_AMP_BAD_QP: i40iw_setup_termhdr(qp, termhdr, FLUSH_LOC_QP_OP_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_QN); break; case I40IW_AE_AMP_BAD_STAG_KEY: case I40IW_AE_AMP_BAD_STAG_INDEX: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; switch (opcode) { case I40IW_OP_TYPE_SEND_INV: case I40IW_OP_TYPE_SEND_SOL_INV: i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_OP_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_OP, RDMAP_CANT_INV_STAG); break; default: i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_OP, RDMAP_INV_STAG); } break; case I40IW_AE_AMP_RIGHTS_VIOLATION: case I40IW_AE_AMP_INVALIDATE_NO_REMOTE_ACCESS_RIGHTS: case I40IW_AE_PRIV_OPERATION_DENIED: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_ACCESS); break; case I40IW_AE_AMP_TO_WRAP: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_ACCESS_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_PROT, RDMAP_TO_WRAP); break; case I40IW_AE_LLP_RECEIVED_MARKER_AND_LENGTH_FIELDS_DONT_MATCH: i40iw_setup_termhdr(qp, termhdr, FLUSH_LOC_LEN_ERR, (LAYER_MPA << 4) | DDP_LLP, MPA_MARKER); break; case I40IW_AE_LLP_RECEIVED_MPA_CRC_ERROR: i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_MPA << 4) | DDP_LLP, MPA_CRC); break; case I40IW_AE_LLP_SEGMENT_TOO_LARGE: case I40IW_AE_LLP_SEGMENT_TOO_SMALL: i40iw_setup_termhdr(qp, termhdr, FLUSH_LOC_LEN_ERR, (LAYER_DDP << 4) | DDP_CATASTROPHIC, DDP_CATASTROPHIC_LOCAL); break; case I40IW_AE_LCE_QP_CATASTROPHIC: case I40IW_AE_DDP_NO_L_BIT: i40iw_setup_termhdr(qp, termhdr, FLUSH_FATAL_ERR, (LAYER_DDP << 4) | DDP_CATASTROPHIC, DDP_CATASTROPHIC_LOCAL); break; case I40IW_AE_DDP_INVALID_MSN_GAP_IN_MSN: case I40IW_AE_DDP_INVALID_MSN_RANGE_IS_NOT_VALID: i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_MSN_RANGE); break; case I40IW_AE_DDP_UBE_DDP_MESSAGE_TOO_LONG_FOR_AVAILABLE_BUFFER: qp->eventtype = TERM_EVENT_QP_ACCESS_ERR; i40iw_setup_termhdr(qp, termhdr, FLUSH_LOC_LEN_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_TOO_LONG); break; case I40IW_AE_DDP_UBE_INVALID_DDP_VERSION: if (is_tagged) i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_DDP << 4) | DDP_TAGGED_BUFFER, DDP_TAGGED_INV_DDP_VER); else i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_DDP_VER); break; case I40IW_AE_DDP_UBE_INVALID_MO: i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_MO); break; case I40IW_AE_DDP_UBE_INVALID_MSN_NO_BUFFER_AVAILABLE: i40iw_setup_termhdr(qp, termhdr, FLUSH_REM_OP_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_MSN_NO_BUF); break; case I40IW_AE_DDP_UBE_INVALID_QN: i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_DDP << 4) | DDP_UNTAGGED_BUFFER, DDP_UNTAGGED_INV_QN); break; case I40IW_AE_RDMAP_ROE_INVALID_RDMAP_VERSION: i40iw_setup_termhdr(qp, termhdr, FLUSH_GENERAL_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_OP, RDMAP_INV_RDMAP_VER); break; case I40IW_AE_RDMAP_ROE_UNEXPECTED_OPCODE: i40iw_setup_termhdr(qp, termhdr, FLUSH_LOC_QP_OP_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_OP, RDMAP_UNEXPECTED_OP); break; default: i40iw_setup_termhdr(qp, termhdr, FLUSH_FATAL_ERR, (LAYER_RDMA << 4) | RDMAP_REMOTE_OP, RDMAP_UNSPECIFIED); break; } if (copy_len) memcpy(termhdr + 1, pkt, copy_len); return sizeof(struct i40iw_terminate_hdr) + copy_len; } /** * i40iw_terminate_send_fin() - Send fin for terminate message * @qp: qp associated with received terminate AE */ void i40iw_terminate_send_fin(struct i40iw_sc_qp *qp) { /* Send the fin only */ i40iw_term_modify_qp(qp, I40IW_QP_STATE_TERMINATE, I40IWQP_TERM_SEND_FIN_ONLY, 0); } /** * i40iw_terminate_connection() - Bad AE and send terminate to remote QP * @qp: qp associated with received terminate AE * @info: the struct contiaing AE information */ void i40iw_terminate_connection(struct i40iw_sc_qp *qp, struct i40iw_aeqe_info *info) { u8 termlen = 0; if (qp->term_flags & I40IW_TERM_SENT) return; /* Sanity check */ /* Eventtype can change from bld_terminate_hdr */ qp->eventtype = TERM_EVENT_QP_FATAL; termlen = i40iw_bld_terminate_hdr(qp, info); i40iw_terminate_start_timer(qp); qp->term_flags |= I40IW_TERM_SENT; i40iw_term_modify_qp(qp, I40IW_QP_STATE_TERMINATE, I40IWQP_TERM_SEND_TERM_ONLY, termlen); } /** * i40iw_terminate_received - handle terminate received AE * @qp: qp associated with received terminate AE * @info: the struct contiaing AE information */ void i40iw_terminate_received(struct i40iw_sc_qp *qp, struct i40iw_aeqe_info *info) { u8 *pkt = qp->q2_buf + Q2_BAD_FRAME_OFFSET; __be32 *mpa; u8 ddp_ctl; u8 rdma_ctl; u16 aeq_id = 0; struct i40iw_terminate_hdr *termhdr; mpa = (__be32 *)i40iw_locate_mpa(pkt); if (info->q2_data_written) { /* did not validate the frame - do it now */ ddp_ctl = (ntohl(mpa[0]) >> 8) & 0xff; rdma_ctl = ntohl(mpa[0]) & 0xff; if ((ddp_ctl & 0xc0) != 0x40) aeq_id = I40IW_AE_LCE_QP_CATASTROPHIC; else if ((ddp_ctl & 0x03) != 1) aeq_id = I40IW_AE_DDP_UBE_INVALID_DDP_VERSION; else if (ntohl(mpa[2]) != 2) aeq_id = I40IW_AE_DDP_UBE_INVALID_QN; else if (ntohl(mpa[3]) != 1) aeq_id = I40IW_AE_DDP_INVALID_MSN_GAP_IN_MSN; else if (ntohl(mpa[4]) != 0) aeq_id = I40IW_AE_DDP_UBE_INVALID_MO; else if ((rdma_ctl & 0xc0) != 0x40) aeq_id = I40IW_AE_RDMAP_ROE_INVALID_RDMAP_VERSION; info->ae_id = aeq_id; if (info->ae_id) { /* Bad terminate recvd - send back a terminate */ i40iw_terminate_connection(qp, info); return; } } qp->term_flags |= I40IW_TERM_RCVD; qp->eventtype = TERM_EVENT_QP_FATAL; termhdr = (struct i40iw_terminate_hdr *)&mpa[5]; if (termhdr->layer_etype == RDMAP_REMOTE_PROT || termhdr->layer_etype == RDMAP_REMOTE_OP) { i40iw_terminate_done(qp, 0); } else { i40iw_terminate_start_timer(qp); i40iw_terminate_send_fin(qp); } } /** * i40iw_sc_vsi_init - Initialize virtual device * @vsi: pointer to the vsi structure * @info: parameters to initialize vsi **/ void i40iw_sc_vsi_init(struct i40iw_sc_vsi *vsi, struct i40iw_vsi_init_info *info) { int i; vsi->dev = info->dev; vsi->back_vsi = info->back_vsi; vsi->mss = info->params->mss; i40iw_fill_qos_list(info->params->qs_handle_list); for (i = 0; i < I40IW_MAX_USER_PRIORITY; i++) { vsi->qos[i].qs_handle = info->params->qs_handle_list[i]; i40iw_debug(vsi->dev, I40IW_DEBUG_DCB, "qset[%d]: %d\n", i, vsi->qos[i].qs_handle); spin_lock_init(&vsi->qos[i].lock); INIT_LIST_HEAD(&vsi->qos[i].qplist); } } /** * i40iw_hw_stats_init - Initiliaze HW stats table * @stats: pestat struct * @fcn_idx: PCI fn id * @is_pf: Is it a PF? * * Populate the HW stats table with register offset addr for each * stats. And start the perioidic stats timer. */ void i40iw_hw_stats_init(struct i40iw_vsi_pestat *stats, u8 fcn_idx, bool is_pf) { u32 stats_reg_offset; u32 stats_index; struct i40iw_dev_hw_stats_offsets *stats_table = &stats->hw_stats_offsets; struct i40iw_dev_hw_stats *last_rd_stats = &stats->last_read_hw_stats; if (is_pf) { stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP4RXDISCARD] = I40E_GLPES_PFIP4RXDISCARD(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP4RXTRUNC] = I40E_GLPES_PFIP4RXTRUNC(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP4TXNOROUTE] = I40E_GLPES_PFIP4TXNOROUTE(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP6RXDISCARD] = I40E_GLPES_PFIP6RXDISCARD(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP6RXTRUNC] = I40E_GLPES_PFIP6RXTRUNC(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP6TXNOROUTE] = I40E_GLPES_PFIP6TXNOROUTE(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_TCPRTXSEG] = I40E_GLPES_PFTCPRTXSEG(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_TCPRXOPTERR] = I40E_GLPES_PFTCPRXOPTERR(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_TCPRXPROTOERR] = I40E_GLPES_PFTCPRXPROTOERR(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXOCTS] = I40E_GLPES_PFIP4RXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXPKTS] = I40E_GLPES_PFIP4RXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXFRAGS] = I40E_GLPES_PFIP4RXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXMCPKTS] = I40E_GLPES_PFIP4RXMCPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXOCTS] = I40E_GLPES_PFIP4TXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXPKTS] = I40E_GLPES_PFIP4TXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXFRAGS] = I40E_GLPES_PFIP4TXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXMCPKTS] = I40E_GLPES_PFIP4TXMCPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXOCTS] = I40E_GLPES_PFIP6RXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXPKTS] = I40E_GLPES_PFIP6RXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXFRAGS] = I40E_GLPES_PFIP6RXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXMCPKTS] = I40E_GLPES_PFIP6RXMCPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXOCTS] = I40E_GLPES_PFIP6TXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXPKTS] = I40E_GLPES_PFIP6TXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXPKTS] = I40E_GLPES_PFIP6TXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXFRAGS] = I40E_GLPES_PFIP6TXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_TCPRXSEGS] = I40E_GLPES_PFTCPRXSEGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_TCPTXSEG] = I40E_GLPES_PFTCPTXSEGLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMARXRDS] = I40E_GLPES_PFRDMARXRDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMARXSNDS] = I40E_GLPES_PFRDMARXSNDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMARXWRS] = I40E_GLPES_PFRDMARXWRSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMATXRDS] = I40E_GLPES_PFRDMATXRDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMATXSNDS] = I40E_GLPES_PFRDMATXSNDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMATXWRS] = I40E_GLPES_PFRDMATXWRSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMAVBND] = I40E_GLPES_PFRDMAVBNDLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMAVINV] = I40E_GLPES_PFRDMAVINVLO(fcn_idx); } else { stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP4RXDISCARD] = I40E_GLPES_VFIP4RXDISCARD(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP4RXTRUNC] = I40E_GLPES_VFIP4RXTRUNC(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP4TXNOROUTE] = I40E_GLPES_VFIP4TXNOROUTE(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP6RXDISCARD] = I40E_GLPES_VFIP6RXDISCARD(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP6RXTRUNC] = I40E_GLPES_VFIP6RXTRUNC(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_IP6TXNOROUTE] = I40E_GLPES_VFIP6TXNOROUTE(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_TCPRTXSEG] = I40E_GLPES_VFTCPRTXSEG(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_TCPRXOPTERR] = I40E_GLPES_VFTCPRXOPTERR(fcn_idx); stats_table->stats_offset_32[I40IW_HW_STAT_INDEX_TCPRXPROTOERR] = I40E_GLPES_VFTCPRXPROTOERR(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXOCTS] = I40E_GLPES_VFIP4RXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXPKTS] = I40E_GLPES_VFIP4RXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXFRAGS] = I40E_GLPES_VFIP4RXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4RXMCPKTS] = I40E_GLPES_VFIP4RXMCPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXOCTS] = I40E_GLPES_VFIP4TXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXPKTS] = I40E_GLPES_VFIP4TXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXFRAGS] = I40E_GLPES_VFIP4TXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP4TXMCPKTS] = I40E_GLPES_VFIP4TXMCPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXOCTS] = I40E_GLPES_VFIP6RXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXPKTS] = I40E_GLPES_VFIP6RXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXFRAGS] = I40E_GLPES_VFIP6RXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6RXMCPKTS] = I40E_GLPES_VFIP6RXMCPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXOCTS] = I40E_GLPES_VFIP6TXOCTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXPKTS] = I40E_GLPES_VFIP6TXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXPKTS] = I40E_GLPES_VFIP6TXPKTSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_IP6TXFRAGS] = I40E_GLPES_VFIP6TXFRAGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_TCPRXSEGS] = I40E_GLPES_VFTCPRXSEGSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_TCPTXSEG] = I40E_GLPES_VFTCPTXSEGLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMARXRDS] = I40E_GLPES_VFRDMARXRDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMARXSNDS] = I40E_GLPES_VFRDMARXSNDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMARXWRS] = I40E_GLPES_VFRDMARXWRSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMATXRDS] = I40E_GLPES_VFRDMATXRDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMATXSNDS] = I40E_GLPES_VFRDMATXSNDSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMATXWRS] = I40E_GLPES_VFRDMATXWRSLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMAVBND] = I40E_GLPES_VFRDMAVBNDLO(fcn_idx); stats_table->stats_offset_64[I40IW_HW_STAT_INDEX_RDMAVINV] = I40E_GLPES_VFRDMAVINVLO(fcn_idx); } for (stats_index = 0; stats_index < I40IW_HW_STAT_INDEX_MAX_64; stats_index++) { stats_reg_offset = stats_table->stats_offset_64[stats_index]; last_rd_stats->stats_value_64[stats_index] = readq(stats->hw->hw_addr + stats_reg_offset); } for (stats_index = 0; stats_index < I40IW_HW_STAT_INDEX_MAX_32; stats_index++) { stats_reg_offset = stats_table->stats_offset_32[stats_index]; last_rd_stats->stats_value_32[stats_index] = i40iw_rd32(stats->hw, stats_reg_offset); } } /** * i40iw_hw_stats_read_32 - Read 32-bit HW stats counters and accommodates for roll-overs. * @stat: pestat struct * @index: index in HW stats table which contains offset reg-addr * @value: hw stats value */ void i40iw_hw_stats_read_32(struct i40iw_vsi_pestat *stats, enum i40iw_hw_stats_index_32b index, u64 *value) { struct i40iw_dev_hw_stats_offsets *stats_table = &stats->hw_stats_offsets; struct i40iw_dev_hw_stats *last_rd_stats = &stats->last_read_hw_stats; struct i40iw_dev_hw_stats *hw_stats = &stats->hw_stats; u64 new_stats_value = 0; u32 stats_reg_offset = stats_table->stats_offset_32[index]; new_stats_value = i40iw_rd32(stats->hw, stats_reg_offset); /*roll-over case */ if (new_stats_value < last_rd_stats->stats_value_32[index]) hw_stats->stats_value_32[index] += new_stats_value; else hw_stats->stats_value_32[index] += new_stats_value - last_rd_stats->stats_value_32[index]; last_rd_stats->stats_value_32[index] = new_stats_value; *value = hw_stats->stats_value_32[index]; } /** * i40iw_hw_stats_read_64 - Read HW stats counters (greater than 32-bit) and accommodates for roll-overs. * @stats: pestat struct * @index: index in HW stats table which contains offset reg-addr * @value: hw stats value */ void i40iw_hw_stats_read_64(struct i40iw_vsi_pestat *stats, enum i40iw_hw_stats_index_64b index, u64 *value) { struct i40iw_dev_hw_stats_offsets *stats_table = &stats->hw_stats_offsets; struct i40iw_dev_hw_stats *last_rd_stats = &stats->last_read_hw_stats; struct i40iw_dev_hw_stats *hw_stats = &stats->hw_stats; u64 new_stats_value = 0; u32 stats_reg_offset = stats_table->stats_offset_64[index]; new_stats_value = readq(stats->hw->hw_addr + stats_reg_offset); /*roll-over case */ if (new_stats_value < last_rd_stats->stats_value_64[index]) hw_stats->stats_value_64[index] += new_stats_value; else hw_stats->stats_value_64[index] += new_stats_value - last_rd_stats->stats_value_64[index]; last_rd_stats->stats_value_64[index] = new_stats_value; *value = hw_stats->stats_value_64[index]; } /** * i40iw_hw_stats_read_all - read all HW stat counters * @stats: pestat struct * @stats_values: hw stats structure * * Read all the HW stat counters and populates hw_stats structure * of passed-in vsi's pestat as well as copy created in stat_values. */ void i40iw_hw_stats_read_all(struct i40iw_vsi_pestat *stats, struct i40iw_dev_hw_stats *stats_values) { u32 stats_index; unsigned long flags; spin_lock_irqsave(&stats->lock, flags); for (stats_index = 0; stats_index < I40IW_HW_STAT_INDEX_MAX_32; stats_index++) i40iw_hw_stats_read_32(stats, stats_index, &stats_values->stats_value_32[stats_index]); for (stats_index = 0; stats_index < I40IW_HW_STAT_INDEX_MAX_64; stats_index++) i40iw_hw_stats_read_64(stats, stats_index, &stats_values->stats_value_64[stats_index]); spin_unlock_irqrestore(&stats->lock, flags); } /** * i40iw_hw_stats_refresh_all - Update all HW stats structs * @stats: pestat struct * * Read all the HW stats counters to refresh values in hw_stats structure * of passed-in dev's pestat */ void i40iw_hw_stats_refresh_all(struct i40iw_vsi_pestat *stats) { u64 stats_value; u32 stats_index; unsigned long flags; spin_lock_irqsave(&stats->lock, flags); for (stats_index = 0; stats_index < I40IW_HW_STAT_INDEX_MAX_32; stats_index++) i40iw_hw_stats_read_32(stats, stats_index, &stats_value); for (stats_index = 0; stats_index < I40IW_HW_STAT_INDEX_MAX_64; stats_index++) i40iw_hw_stats_read_64(stats, stats_index, &stats_value); spin_unlock_irqrestore(&stats->lock, flags); } /** * i40iw_get_fcn_id - Return the function id * @dev: pointer to the device */ static u8 i40iw_get_fcn_id(struct i40iw_sc_dev *dev) { u8 fcn_id = I40IW_INVALID_FCN_ID; u8 i; for (i = I40IW_FIRST_NON_PF_STAT; i < I40IW_MAX_STATS_COUNT; i++) if (!dev->fcn_id_array[i]) { fcn_id = i; dev->fcn_id_array[i] = true; break; } return fcn_id; } /** * i40iw_vsi_stats_init - Initialize the vsi statistics * @vsi: pointer to the vsi structure * @info: The info structure used for initialization */ enum i40iw_status_code i40iw_vsi_stats_init(struct i40iw_sc_vsi *vsi, struct i40iw_vsi_stats_info *info) { u8 fcn_id = info->fcn_id; if (info->alloc_fcn_id) fcn_id = i40iw_get_fcn_id(vsi->dev); if (fcn_id == I40IW_INVALID_FCN_ID) return I40IW_ERR_NOT_READY; vsi->pestat = info->pestat; vsi->pestat->hw = vsi->dev->hw; if (info->stats_initialize) { i40iw_hw_stats_init(vsi->pestat, fcn_id, true); spin_lock_init(&vsi->pestat->lock); i40iw_hw_stats_start_timer(vsi); } vsi->stats_fcn_id_alloc = info->alloc_fcn_id; vsi->fcn_id = fcn_id; return I40IW_SUCCESS; } /** * i40iw_vsi_stats_free - Free the vsi stats * @vsi: pointer to the vsi structure */ void i40iw_vsi_stats_free(struct i40iw_sc_vsi *vsi) { u8 fcn_id = vsi->fcn_id; if (vsi->stats_fcn_id_alloc && fcn_id < I40IW_MAX_STATS_COUNT) vsi->dev->fcn_id_array[fcn_id] = false; i40iw_hw_stats_stop_timer(vsi); } static struct i40iw_cqp_ops iw_cqp_ops = { .cqp_init = i40iw_sc_cqp_init, .cqp_create = i40iw_sc_cqp_create, .cqp_post_sq = i40iw_sc_cqp_post_sq, .cqp_get_next_send_wqe = i40iw_sc_cqp_get_next_send_wqe, .cqp_destroy = i40iw_sc_cqp_destroy, .poll_for_cqp_op_done = i40iw_sc_poll_for_cqp_op_done }; static struct i40iw_ccq_ops iw_ccq_ops = { .ccq_init = i40iw_sc_ccq_init, .ccq_create = i40iw_sc_ccq_create, .ccq_destroy = i40iw_sc_ccq_destroy, .ccq_create_done = i40iw_sc_ccq_create_done, .ccq_get_cqe_info = i40iw_sc_ccq_get_cqe_info, .ccq_arm = i40iw_sc_ccq_arm }; static struct i40iw_ceq_ops iw_ceq_ops = { .ceq_init = i40iw_sc_ceq_init, .ceq_create = i40iw_sc_ceq_create, .cceq_create_done = i40iw_sc_cceq_create_done, .cceq_destroy_done = i40iw_sc_cceq_destroy_done, .cceq_create = i40iw_sc_cceq_create, .ceq_destroy = i40iw_sc_ceq_destroy, .process_ceq = i40iw_sc_process_ceq }; static struct i40iw_aeq_ops iw_aeq_ops = { .aeq_init = i40iw_sc_aeq_init, .aeq_create = i40iw_sc_aeq_create, .aeq_destroy = i40iw_sc_aeq_destroy, .get_next_aeqe = i40iw_sc_get_next_aeqe, .repost_aeq_entries = i40iw_sc_repost_aeq_entries, .aeq_create_done = i40iw_sc_aeq_create_done, .aeq_destroy_done = i40iw_sc_aeq_destroy_done }; /* iwarp pd ops */ static struct i40iw_pd_ops iw_pd_ops = { .pd_init = i40iw_sc_pd_init, }; static struct i40iw_priv_qp_ops iw_priv_qp_ops = { .qp_init = i40iw_sc_qp_init, .qp_create = i40iw_sc_qp_create, .qp_modify = i40iw_sc_qp_modify, .qp_destroy = i40iw_sc_qp_destroy, .qp_flush_wqes = i40iw_sc_qp_flush_wqes, .qp_upload_context = i40iw_sc_qp_upload_context, .qp_setctx = i40iw_sc_qp_setctx, .qp_send_lsmm = i40iw_sc_send_lsmm, .qp_send_lsmm_nostag = i40iw_sc_send_lsmm_nostag, .qp_send_rtt = i40iw_sc_send_rtt, .qp_post_wqe0 = i40iw_sc_post_wqe0, .iw_mr_fast_register = i40iw_sc_mr_fast_register }; static struct i40iw_priv_cq_ops iw_priv_cq_ops = { .cq_init = i40iw_sc_cq_init, .cq_create = i40iw_sc_cq_create, .cq_destroy = i40iw_sc_cq_destroy, .cq_modify = i40iw_sc_cq_modify, }; static struct i40iw_mr_ops iw_mr_ops = { .alloc_stag = i40iw_sc_alloc_stag, .mr_reg_non_shared = i40iw_sc_mr_reg_non_shared, .mr_reg_shared = i40iw_sc_mr_reg_shared, .dealloc_stag = i40iw_sc_dealloc_stag, .query_stag = i40iw_sc_query_stag, .mw_alloc = i40iw_sc_mw_alloc }; static struct i40iw_cqp_misc_ops iw_cqp_misc_ops = { .manage_push_page = i40iw_sc_manage_push_page, .manage_hmc_pm_func_table = i40iw_sc_manage_hmc_pm_func_table, .set_hmc_resource_profile = i40iw_sc_set_hmc_resource_profile, .commit_fpm_values = i40iw_sc_commit_fpm_values, .query_fpm_values = i40iw_sc_query_fpm_values, .static_hmc_pages_allocated = i40iw_sc_static_hmc_pages_allocated, .add_arp_cache_entry = i40iw_sc_add_arp_cache_entry, .del_arp_cache_entry = i40iw_sc_del_arp_cache_entry, .query_arp_cache_entry = i40iw_sc_query_arp_cache_entry, .manage_apbvt_entry = i40iw_sc_manage_apbvt_entry, .manage_qhash_table_entry = i40iw_sc_manage_qhash_table_entry, .alloc_local_mac_ipaddr_table_entry = i40iw_sc_alloc_local_mac_ipaddr_entry, .add_local_mac_ipaddr_entry = i40iw_sc_add_local_mac_ipaddr_entry, .del_local_mac_ipaddr_entry = i40iw_sc_del_local_mac_ipaddr_entry, .cqp_nop = i40iw_sc_cqp_nop, .commit_fpm_values_done = i40iw_sc_commit_fpm_values_done, .query_fpm_values_done = i40iw_sc_query_fpm_values_done, .manage_hmc_pm_func_table_done = i40iw_sc_manage_hmc_pm_func_table_done, .update_suspend_qp = i40iw_sc_suspend_qp, .update_resume_qp = i40iw_sc_resume_qp }; static struct i40iw_hmc_ops iw_hmc_ops = { .init_iw_hmc = i40iw_sc_init_iw_hmc, .parse_fpm_query_buf = i40iw_sc_parse_fpm_query_buf, .configure_iw_fpm = i40iw_sc_configure_iw_fpm, .parse_fpm_commit_buf = i40iw_sc_parse_fpm_commit_buf, .create_hmc_object = i40iw_sc_create_hmc_obj, .del_hmc_object = i40iw_sc_del_hmc_obj }; /** * i40iw_device_init - Initialize IWARP device * @dev: IWARP device pointer * @info: IWARP init info */ enum i40iw_status_code i40iw_device_init(struct i40iw_sc_dev *dev, struct i40iw_device_init_info *info) { u32 val; u32 vchnl_ver = 0; u16 hmc_fcn = 0; enum i40iw_status_code ret_code = 0; u8 db_size; spin_lock_init(&dev->cqp_lock); INIT_LIST_HEAD(&dev->cqp_cmd_head); /* for the cqp commands backlog. */ i40iw_device_init_uk(&dev->dev_uk); dev->debug_mask = info->debug_mask; dev->hmc_fn_id = info->hmc_fn_id; dev->exception_lan_queue = info->exception_lan_queue; dev->is_pf = info->is_pf; dev->fpm_query_buf_pa = info->fpm_query_buf_pa; dev->fpm_query_buf = info->fpm_query_buf; dev->fpm_commit_buf_pa = info->fpm_commit_buf_pa; dev->fpm_commit_buf = info->fpm_commit_buf; dev->hw = info->hw; dev->hw->hw_addr = info->bar0; if (dev->is_pf) { val = i40iw_rd32(dev->hw, I40E_GLPCI_DREVID); dev->hw_rev = (u8)RS_32(val, I40E_GLPCI_DREVID_DEFAULT_REVID); val = i40iw_rd32(dev->hw, I40E_GLPCI_LBARCTRL); db_size = (u8)RS_32(val, I40E_GLPCI_LBARCTRL_PE_DB_SIZE); if ((db_size != I40IW_PE_DB_SIZE_4M) && (db_size != I40IW_PE_DB_SIZE_8M)) { i40iw_debug(dev, I40IW_DEBUG_DEV, "%s: PE doorbell is not enabled in CSR val 0x%x\n", __func__, val); ret_code = I40IW_ERR_PE_DOORBELL_NOT_ENABLED; return ret_code; } dev->db_addr = dev->hw->hw_addr + I40IW_DB_ADDR_OFFSET; dev->vchnl_if.vchnl_recv = i40iw_vchnl_recv_pf; } else { dev->db_addr = dev->hw->hw_addr + I40IW_VF_DB_ADDR_OFFSET; } dev->cqp_ops = &iw_cqp_ops; dev->ccq_ops = &iw_ccq_ops; dev->ceq_ops = &iw_ceq_ops; dev->aeq_ops = &iw_aeq_ops; dev->cqp_misc_ops = &iw_cqp_misc_ops; dev->iw_pd_ops = &iw_pd_ops; dev->iw_priv_qp_ops = &iw_priv_qp_ops; dev->iw_priv_cq_ops = &iw_priv_cq_ops; dev->mr_ops = &iw_mr_ops; dev->hmc_ops = &iw_hmc_ops; dev->vchnl_if.vchnl_send = info->vchnl_send; if (dev->vchnl_if.vchnl_send) dev->vchnl_up = true; else dev->vchnl_up = false; if (!dev->is_pf) { dev->vchnl_if.vchnl_recv = i40iw_vchnl_recv_vf; ret_code = i40iw_vchnl_vf_get_ver(dev, &vchnl_ver); if (!ret_code) { i40iw_debug(dev, I40IW_DEBUG_DEV, "%s: Get Channel version rc = 0x%0x, version is %u\n", __func__, ret_code, vchnl_ver); ret_code = i40iw_vchnl_vf_get_hmc_fcn(dev, &hmc_fcn); if (!ret_code) { i40iw_debug(dev, I40IW_DEBUG_DEV, "%s Get HMC function rc = 0x%0x, hmc fcn is %u\n", __func__, ret_code, hmc_fcn); dev->hmc_fn_id = (u8)hmc_fcn; } } } dev->iw_vf_cqp_ops = &iw_vf_cqp_ops; return ret_code; }