132a47e72SYuval Mintz /* QLogic qed NIC Driver 232a47e72SYuval Mintz * Copyright (c) 2015 QLogic Corporation 332a47e72SYuval Mintz * 432a47e72SYuval Mintz * This software is available under the terms of the GNU General Public License 532a47e72SYuval Mintz * (GPL) Version 2, available from the file COPYING in the main directory of 632a47e72SYuval Mintz * this source tree. 732a47e72SYuval Mintz */ 832a47e72SYuval Mintz 9dacd88d6SYuval Mintz #include <linux/etherdevice.h> 1036558c3dSYuval Mintz #include <linux/crc32.h> 110b55e27dSYuval Mintz #include <linux/qed/qed_iov_if.h> 121408cc1fSYuval Mintz #include "qed_cxt.h" 131408cc1fSYuval Mintz #include "qed_hsi.h" 1432a47e72SYuval Mintz #include "qed_hw.h" 151408cc1fSYuval Mintz #include "qed_init_ops.h" 1632a47e72SYuval Mintz #include "qed_int.h" 171408cc1fSYuval Mintz #include "qed_mcp.h" 1832a47e72SYuval Mintz #include "qed_reg_addr.h" 191408cc1fSYuval Mintz #include "qed_sp.h" 2032a47e72SYuval Mintz #include "qed_sriov.h" 2132a47e72SYuval Mintz #include "qed_vf.h" 2232a47e72SYuval Mintz 231408cc1fSYuval Mintz /* IOV ramrods */ 241408cc1fSYuval Mintz static int qed_sp_vf_start(struct qed_hwfn *p_hwfn, 251408cc1fSYuval Mintz u32 concrete_vfid, u16 opaque_vfid) 261408cc1fSYuval Mintz { 271408cc1fSYuval Mintz struct vf_start_ramrod_data *p_ramrod = NULL; 281408cc1fSYuval Mintz struct qed_spq_entry *p_ent = NULL; 291408cc1fSYuval Mintz struct qed_sp_init_data init_data; 301408cc1fSYuval Mintz int rc = -EINVAL; 311408cc1fSYuval Mintz 321408cc1fSYuval Mintz /* Get SPQ entry */ 331408cc1fSYuval Mintz memset(&init_data, 0, sizeof(init_data)); 341408cc1fSYuval Mintz init_data.cid = qed_spq_get_cid(p_hwfn); 351408cc1fSYuval Mintz init_data.opaque_fid = opaque_vfid; 361408cc1fSYuval Mintz init_data.comp_mode = QED_SPQ_MODE_EBLOCK; 371408cc1fSYuval Mintz 381408cc1fSYuval Mintz rc = qed_sp_init_request(p_hwfn, &p_ent, 391408cc1fSYuval Mintz COMMON_RAMROD_VF_START, 401408cc1fSYuval Mintz PROTOCOLID_COMMON, &init_data); 411408cc1fSYuval Mintz if (rc) 421408cc1fSYuval Mintz return rc; 431408cc1fSYuval Mintz 441408cc1fSYuval Mintz p_ramrod = &p_ent->ramrod.vf_start; 451408cc1fSYuval Mintz 461408cc1fSYuval Mintz p_ramrod->vf_id = GET_FIELD(concrete_vfid, PXP_CONCRETE_FID_VFID); 471408cc1fSYuval Mintz p_ramrod->opaque_fid = cpu_to_le16(opaque_vfid); 481408cc1fSYuval Mintz 491408cc1fSYuval Mintz p_ramrod->personality = PERSONALITY_ETH; 501408cc1fSYuval Mintz 511408cc1fSYuval Mintz return qed_spq_post(p_hwfn, p_ent, NULL); 521408cc1fSYuval Mintz } 531408cc1fSYuval Mintz 540b55e27dSYuval Mintz static int qed_sp_vf_stop(struct qed_hwfn *p_hwfn, 550b55e27dSYuval Mintz u32 concrete_vfid, u16 opaque_vfid) 560b55e27dSYuval Mintz { 570b55e27dSYuval Mintz struct vf_stop_ramrod_data *p_ramrod = NULL; 580b55e27dSYuval Mintz struct qed_spq_entry *p_ent = NULL; 590b55e27dSYuval Mintz struct qed_sp_init_data init_data; 600b55e27dSYuval Mintz int rc = -EINVAL; 610b55e27dSYuval Mintz 620b55e27dSYuval Mintz /* Get SPQ entry */ 630b55e27dSYuval Mintz memset(&init_data, 0, sizeof(init_data)); 640b55e27dSYuval Mintz init_data.cid = qed_spq_get_cid(p_hwfn); 650b55e27dSYuval Mintz init_data.opaque_fid = opaque_vfid; 660b55e27dSYuval Mintz init_data.comp_mode = QED_SPQ_MODE_EBLOCK; 670b55e27dSYuval Mintz 680b55e27dSYuval Mintz rc = qed_sp_init_request(p_hwfn, &p_ent, 690b55e27dSYuval Mintz COMMON_RAMROD_VF_STOP, 700b55e27dSYuval Mintz PROTOCOLID_COMMON, &init_data); 710b55e27dSYuval Mintz if (rc) 720b55e27dSYuval Mintz return rc; 730b55e27dSYuval Mintz 740b55e27dSYuval Mintz p_ramrod = &p_ent->ramrod.vf_stop; 750b55e27dSYuval Mintz 760b55e27dSYuval Mintz p_ramrod->vf_id = GET_FIELD(concrete_vfid, PXP_CONCRETE_FID_VFID); 770b55e27dSYuval Mintz 780b55e27dSYuval Mintz return qed_spq_post(p_hwfn, p_ent, NULL); 790b55e27dSYuval Mintz } 800b55e27dSYuval Mintz 8132a47e72SYuval Mintz bool qed_iov_is_valid_vfid(struct qed_hwfn *p_hwfn, 8232a47e72SYuval Mintz int rel_vf_id, bool b_enabled_only) 8332a47e72SYuval Mintz { 8432a47e72SYuval Mintz if (!p_hwfn->pf_iov_info) { 8532a47e72SYuval Mintz DP_NOTICE(p_hwfn->cdev, "No iov info\n"); 8632a47e72SYuval Mintz return false; 8732a47e72SYuval Mintz } 8832a47e72SYuval Mintz 8932a47e72SYuval Mintz if ((rel_vf_id >= p_hwfn->cdev->p_iov_info->total_vfs) || 9032a47e72SYuval Mintz (rel_vf_id < 0)) 9132a47e72SYuval Mintz return false; 9232a47e72SYuval Mintz 9332a47e72SYuval Mintz if ((!p_hwfn->pf_iov_info->vfs_array[rel_vf_id].b_init) && 9432a47e72SYuval Mintz b_enabled_only) 9532a47e72SYuval Mintz return false; 9632a47e72SYuval Mintz 9732a47e72SYuval Mintz return true; 9832a47e72SYuval Mintz } 9932a47e72SYuval Mintz 10037bff2b9SYuval Mintz static struct qed_vf_info *qed_iov_get_vf_info(struct qed_hwfn *p_hwfn, 10137bff2b9SYuval Mintz u16 relative_vf_id, 10237bff2b9SYuval Mintz bool b_enabled_only) 10337bff2b9SYuval Mintz { 10437bff2b9SYuval Mintz struct qed_vf_info *vf = NULL; 10537bff2b9SYuval Mintz 10637bff2b9SYuval Mintz if (!p_hwfn->pf_iov_info) { 10737bff2b9SYuval Mintz DP_NOTICE(p_hwfn->cdev, "No iov info\n"); 10837bff2b9SYuval Mintz return NULL; 10937bff2b9SYuval Mintz } 11037bff2b9SYuval Mintz 11137bff2b9SYuval Mintz if (qed_iov_is_valid_vfid(p_hwfn, relative_vf_id, b_enabled_only)) 11237bff2b9SYuval Mintz vf = &p_hwfn->pf_iov_info->vfs_array[relative_vf_id]; 11337bff2b9SYuval Mintz else 11437bff2b9SYuval Mintz DP_ERR(p_hwfn, "qed_iov_get_vf_info: VF[%d] is not enabled\n", 11537bff2b9SYuval Mintz relative_vf_id); 11637bff2b9SYuval Mintz 11737bff2b9SYuval Mintz return vf; 11837bff2b9SYuval Mintz } 11937bff2b9SYuval Mintz 12036558c3dSYuval Mintz int qed_iov_post_vf_bulletin(struct qed_hwfn *p_hwfn, 12136558c3dSYuval Mintz int vfid, struct qed_ptt *p_ptt) 12236558c3dSYuval Mintz { 12336558c3dSYuval Mintz struct qed_bulletin_content *p_bulletin; 12436558c3dSYuval Mintz int crc_size = sizeof(p_bulletin->crc); 12536558c3dSYuval Mintz struct qed_dmae_params params; 12636558c3dSYuval Mintz struct qed_vf_info *p_vf; 12736558c3dSYuval Mintz 12836558c3dSYuval Mintz p_vf = qed_iov_get_vf_info(p_hwfn, (u16) vfid, true); 12936558c3dSYuval Mintz if (!p_vf) 13036558c3dSYuval Mintz return -EINVAL; 13136558c3dSYuval Mintz 13236558c3dSYuval Mintz if (!p_vf->vf_bulletin) 13336558c3dSYuval Mintz return -EINVAL; 13436558c3dSYuval Mintz 13536558c3dSYuval Mintz p_bulletin = p_vf->bulletin.p_virt; 13636558c3dSYuval Mintz 13736558c3dSYuval Mintz /* Increment bulletin board version and compute crc */ 13836558c3dSYuval Mintz p_bulletin->version++; 13936558c3dSYuval Mintz p_bulletin->crc = crc32(0, (u8 *)p_bulletin + crc_size, 14036558c3dSYuval Mintz p_vf->bulletin.size - crc_size); 14136558c3dSYuval Mintz 14236558c3dSYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 14336558c3dSYuval Mintz "Posting Bulletin 0x%08x to VF[%d] (CRC 0x%08x)\n", 14436558c3dSYuval Mintz p_bulletin->version, p_vf->relative_vf_id, p_bulletin->crc); 14536558c3dSYuval Mintz 14636558c3dSYuval Mintz /* propagate bulletin board via dmae to vm memory */ 14736558c3dSYuval Mintz memset(¶ms, 0, sizeof(params)); 14836558c3dSYuval Mintz params.flags = QED_DMAE_FLAG_VF_DST; 14936558c3dSYuval Mintz params.dst_vfid = p_vf->abs_vf_id; 15036558c3dSYuval Mintz return qed_dmae_host2host(p_hwfn, p_ptt, p_vf->bulletin.phys, 15136558c3dSYuval Mintz p_vf->vf_bulletin, p_vf->bulletin.size / 4, 15236558c3dSYuval Mintz ¶ms); 15336558c3dSYuval Mintz } 15436558c3dSYuval Mintz 15532a47e72SYuval Mintz static int qed_iov_pci_cfg_info(struct qed_dev *cdev) 15632a47e72SYuval Mintz { 15732a47e72SYuval Mintz struct qed_hw_sriov_info *iov = cdev->p_iov_info; 15832a47e72SYuval Mintz int pos = iov->pos; 15932a47e72SYuval Mintz 16032a47e72SYuval Mintz DP_VERBOSE(cdev, QED_MSG_IOV, "sriov ext pos %d\n", pos); 16132a47e72SYuval Mintz pci_read_config_word(cdev->pdev, pos + PCI_SRIOV_CTRL, &iov->ctrl); 16232a47e72SYuval Mintz 16332a47e72SYuval Mintz pci_read_config_word(cdev->pdev, 16432a47e72SYuval Mintz pos + PCI_SRIOV_TOTAL_VF, &iov->total_vfs); 16532a47e72SYuval Mintz pci_read_config_word(cdev->pdev, 16632a47e72SYuval Mintz pos + PCI_SRIOV_INITIAL_VF, &iov->initial_vfs); 16732a47e72SYuval Mintz 16832a47e72SYuval Mintz pci_read_config_word(cdev->pdev, pos + PCI_SRIOV_NUM_VF, &iov->num_vfs); 16932a47e72SYuval Mintz if (iov->num_vfs) { 17032a47e72SYuval Mintz DP_VERBOSE(cdev, 17132a47e72SYuval Mintz QED_MSG_IOV, 17232a47e72SYuval Mintz "Number of VFs are already set to non-zero value. Ignoring PCI configuration value\n"); 17332a47e72SYuval Mintz iov->num_vfs = 0; 17432a47e72SYuval Mintz } 17532a47e72SYuval Mintz 17632a47e72SYuval Mintz pci_read_config_word(cdev->pdev, 17732a47e72SYuval Mintz pos + PCI_SRIOV_VF_OFFSET, &iov->offset); 17832a47e72SYuval Mintz 17932a47e72SYuval Mintz pci_read_config_word(cdev->pdev, 18032a47e72SYuval Mintz pos + PCI_SRIOV_VF_STRIDE, &iov->stride); 18132a47e72SYuval Mintz 18232a47e72SYuval Mintz pci_read_config_word(cdev->pdev, 18332a47e72SYuval Mintz pos + PCI_SRIOV_VF_DID, &iov->vf_device_id); 18432a47e72SYuval Mintz 18532a47e72SYuval Mintz pci_read_config_dword(cdev->pdev, 18632a47e72SYuval Mintz pos + PCI_SRIOV_SUP_PGSIZE, &iov->pgsz); 18732a47e72SYuval Mintz 18832a47e72SYuval Mintz pci_read_config_dword(cdev->pdev, pos + PCI_SRIOV_CAP, &iov->cap); 18932a47e72SYuval Mintz 19032a47e72SYuval Mintz pci_read_config_byte(cdev->pdev, pos + PCI_SRIOV_FUNC_LINK, &iov->link); 19132a47e72SYuval Mintz 19232a47e72SYuval Mintz DP_VERBOSE(cdev, 19332a47e72SYuval Mintz QED_MSG_IOV, 19432a47e72SYuval Mintz "IOV info: nres %d, cap 0x%x, ctrl 0x%x, total %d, initial %d, num vfs %d, offset %d, stride %d, page size 0x%x\n", 19532a47e72SYuval Mintz iov->nres, 19632a47e72SYuval Mintz iov->cap, 19732a47e72SYuval Mintz iov->ctrl, 19832a47e72SYuval Mintz iov->total_vfs, 19932a47e72SYuval Mintz iov->initial_vfs, 20032a47e72SYuval Mintz iov->nr_virtfn, iov->offset, iov->stride, iov->pgsz); 20132a47e72SYuval Mintz 20232a47e72SYuval Mintz /* Some sanity checks */ 20332a47e72SYuval Mintz if (iov->num_vfs > NUM_OF_VFS(cdev) || 20432a47e72SYuval Mintz iov->total_vfs > NUM_OF_VFS(cdev)) { 20532a47e72SYuval Mintz /* This can happen only due to a bug. In this case we set 20632a47e72SYuval Mintz * num_vfs to zero to avoid memory corruption in the code that 20732a47e72SYuval Mintz * assumes max number of vfs 20832a47e72SYuval Mintz */ 20932a47e72SYuval Mintz DP_NOTICE(cdev, 21032a47e72SYuval Mintz "IOV: Unexpected number of vfs set: %d setting num_vf to zero\n", 21132a47e72SYuval Mintz iov->num_vfs); 21232a47e72SYuval Mintz 21332a47e72SYuval Mintz iov->num_vfs = 0; 21432a47e72SYuval Mintz iov->total_vfs = 0; 21532a47e72SYuval Mintz } 21632a47e72SYuval Mintz 21732a47e72SYuval Mintz return 0; 21832a47e72SYuval Mintz } 21932a47e72SYuval Mintz 22032a47e72SYuval Mintz static void qed_iov_clear_vf_igu_blocks(struct qed_hwfn *p_hwfn, 22132a47e72SYuval Mintz struct qed_ptt *p_ptt) 22232a47e72SYuval Mintz { 22332a47e72SYuval Mintz struct qed_igu_block *p_sb; 22432a47e72SYuval Mintz u16 sb_id; 22532a47e72SYuval Mintz u32 val; 22632a47e72SYuval Mintz 22732a47e72SYuval Mintz if (!p_hwfn->hw_info.p_igu_info) { 22832a47e72SYuval Mintz DP_ERR(p_hwfn, 22932a47e72SYuval Mintz "qed_iov_clear_vf_igu_blocks IGU Info not initialized\n"); 23032a47e72SYuval Mintz return; 23132a47e72SYuval Mintz } 23232a47e72SYuval Mintz 23332a47e72SYuval Mintz for (sb_id = 0; sb_id < QED_MAPPING_MEMORY_SIZE(p_hwfn->cdev); 23432a47e72SYuval Mintz sb_id++) { 23532a47e72SYuval Mintz p_sb = &p_hwfn->hw_info.p_igu_info->igu_map.igu_blocks[sb_id]; 23632a47e72SYuval Mintz if ((p_sb->status & QED_IGU_STATUS_FREE) && 23732a47e72SYuval Mintz !(p_sb->status & QED_IGU_STATUS_PF)) { 23832a47e72SYuval Mintz val = qed_rd(p_hwfn, p_ptt, 23932a47e72SYuval Mintz IGU_REG_MAPPING_MEMORY + sb_id * 4); 24032a47e72SYuval Mintz SET_FIELD(val, IGU_MAPPING_LINE_VALID, 0); 24132a47e72SYuval Mintz qed_wr(p_hwfn, p_ptt, 24232a47e72SYuval Mintz IGU_REG_MAPPING_MEMORY + 4 * sb_id, val); 24332a47e72SYuval Mintz } 24432a47e72SYuval Mintz } 24532a47e72SYuval Mintz } 24632a47e72SYuval Mintz 24732a47e72SYuval Mintz static void qed_iov_setup_vfdb(struct qed_hwfn *p_hwfn) 24832a47e72SYuval Mintz { 24932a47e72SYuval Mintz struct qed_hw_sriov_info *p_iov = p_hwfn->cdev->p_iov_info; 25032a47e72SYuval Mintz struct qed_pf_iov *p_iov_info = p_hwfn->pf_iov_info; 25132a47e72SYuval Mintz struct qed_bulletin_content *p_bulletin_virt; 25232a47e72SYuval Mintz dma_addr_t req_p, rply_p, bulletin_p; 25332a47e72SYuval Mintz union pfvf_tlvs *p_reply_virt_addr; 25432a47e72SYuval Mintz union vfpf_tlvs *p_req_virt_addr; 25532a47e72SYuval Mintz u8 idx = 0; 25632a47e72SYuval Mintz 25732a47e72SYuval Mintz memset(p_iov_info->vfs_array, 0, sizeof(p_iov_info->vfs_array)); 25832a47e72SYuval Mintz 25932a47e72SYuval Mintz p_req_virt_addr = p_iov_info->mbx_msg_virt_addr; 26032a47e72SYuval Mintz req_p = p_iov_info->mbx_msg_phys_addr; 26132a47e72SYuval Mintz p_reply_virt_addr = p_iov_info->mbx_reply_virt_addr; 26232a47e72SYuval Mintz rply_p = p_iov_info->mbx_reply_phys_addr; 26332a47e72SYuval Mintz p_bulletin_virt = p_iov_info->p_bulletins; 26432a47e72SYuval Mintz bulletin_p = p_iov_info->bulletins_phys; 26532a47e72SYuval Mintz if (!p_req_virt_addr || !p_reply_virt_addr || !p_bulletin_virt) { 26632a47e72SYuval Mintz DP_ERR(p_hwfn, 26732a47e72SYuval Mintz "qed_iov_setup_vfdb called without allocating mem first\n"); 26832a47e72SYuval Mintz return; 26932a47e72SYuval Mintz } 27032a47e72SYuval Mintz 27132a47e72SYuval Mintz for (idx = 0; idx < p_iov->total_vfs; idx++) { 27232a47e72SYuval Mintz struct qed_vf_info *vf = &p_iov_info->vfs_array[idx]; 27332a47e72SYuval Mintz u32 concrete; 27432a47e72SYuval Mintz 27532a47e72SYuval Mintz vf->vf_mbx.req_virt = p_req_virt_addr + idx; 27632a47e72SYuval Mintz vf->vf_mbx.req_phys = req_p + idx * sizeof(union vfpf_tlvs); 27732a47e72SYuval Mintz vf->vf_mbx.reply_virt = p_reply_virt_addr + idx; 27832a47e72SYuval Mintz vf->vf_mbx.reply_phys = rply_p + idx * sizeof(union pfvf_tlvs); 27932a47e72SYuval Mintz 28032a47e72SYuval Mintz vf->state = VF_STOPPED; 28132a47e72SYuval Mintz vf->b_init = false; 28232a47e72SYuval Mintz 28332a47e72SYuval Mintz vf->bulletin.phys = idx * 28432a47e72SYuval Mintz sizeof(struct qed_bulletin_content) + 28532a47e72SYuval Mintz bulletin_p; 28632a47e72SYuval Mintz vf->bulletin.p_virt = p_bulletin_virt + idx; 28732a47e72SYuval Mintz vf->bulletin.size = sizeof(struct qed_bulletin_content); 28832a47e72SYuval Mintz 28932a47e72SYuval Mintz vf->relative_vf_id = idx; 29032a47e72SYuval Mintz vf->abs_vf_id = idx + p_iov->first_vf_in_pf; 29132a47e72SYuval Mintz concrete = qed_vfid_to_concrete(p_hwfn, vf->abs_vf_id); 29232a47e72SYuval Mintz vf->concrete_fid = concrete; 29332a47e72SYuval Mintz vf->opaque_fid = (p_hwfn->hw_info.opaque_fid & 0xff) | 29432a47e72SYuval Mintz (vf->abs_vf_id << 8); 29532a47e72SYuval Mintz vf->vport_id = idx + 1; 29632a47e72SYuval Mintz } 29732a47e72SYuval Mintz } 29832a47e72SYuval Mintz 29932a47e72SYuval Mintz static int qed_iov_allocate_vfdb(struct qed_hwfn *p_hwfn) 30032a47e72SYuval Mintz { 30132a47e72SYuval Mintz struct qed_pf_iov *p_iov_info = p_hwfn->pf_iov_info; 30232a47e72SYuval Mintz void **p_v_addr; 30332a47e72SYuval Mintz u16 num_vfs = 0; 30432a47e72SYuval Mintz 30532a47e72SYuval Mintz num_vfs = p_hwfn->cdev->p_iov_info->total_vfs; 30632a47e72SYuval Mintz 30732a47e72SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 30832a47e72SYuval Mintz "qed_iov_allocate_vfdb for %d VFs\n", num_vfs); 30932a47e72SYuval Mintz 31032a47e72SYuval Mintz /* Allocate PF Mailbox buffer (per-VF) */ 31132a47e72SYuval Mintz p_iov_info->mbx_msg_size = sizeof(union vfpf_tlvs) * num_vfs; 31232a47e72SYuval Mintz p_v_addr = &p_iov_info->mbx_msg_virt_addr; 31332a47e72SYuval Mintz *p_v_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev, 31432a47e72SYuval Mintz p_iov_info->mbx_msg_size, 31532a47e72SYuval Mintz &p_iov_info->mbx_msg_phys_addr, 31632a47e72SYuval Mintz GFP_KERNEL); 31732a47e72SYuval Mintz if (!*p_v_addr) 31832a47e72SYuval Mintz return -ENOMEM; 31932a47e72SYuval Mintz 32032a47e72SYuval Mintz /* Allocate PF Mailbox Reply buffer (per-VF) */ 32132a47e72SYuval Mintz p_iov_info->mbx_reply_size = sizeof(union pfvf_tlvs) * num_vfs; 32232a47e72SYuval Mintz p_v_addr = &p_iov_info->mbx_reply_virt_addr; 32332a47e72SYuval Mintz *p_v_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev, 32432a47e72SYuval Mintz p_iov_info->mbx_reply_size, 32532a47e72SYuval Mintz &p_iov_info->mbx_reply_phys_addr, 32632a47e72SYuval Mintz GFP_KERNEL); 32732a47e72SYuval Mintz if (!*p_v_addr) 32832a47e72SYuval Mintz return -ENOMEM; 32932a47e72SYuval Mintz 33032a47e72SYuval Mintz p_iov_info->bulletins_size = sizeof(struct qed_bulletin_content) * 33132a47e72SYuval Mintz num_vfs; 33232a47e72SYuval Mintz p_v_addr = &p_iov_info->p_bulletins; 33332a47e72SYuval Mintz *p_v_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev, 33432a47e72SYuval Mintz p_iov_info->bulletins_size, 33532a47e72SYuval Mintz &p_iov_info->bulletins_phys, 33632a47e72SYuval Mintz GFP_KERNEL); 33732a47e72SYuval Mintz if (!*p_v_addr) 33832a47e72SYuval Mintz return -ENOMEM; 33932a47e72SYuval Mintz 34032a47e72SYuval Mintz DP_VERBOSE(p_hwfn, 34132a47e72SYuval Mintz QED_MSG_IOV, 34232a47e72SYuval Mintz "PF's Requests mailbox [%p virt 0x%llx phys], Response mailbox [%p virt 0x%llx phys] Bulletins [%p virt 0x%llx phys]\n", 34332a47e72SYuval Mintz p_iov_info->mbx_msg_virt_addr, 34432a47e72SYuval Mintz (u64) p_iov_info->mbx_msg_phys_addr, 34532a47e72SYuval Mintz p_iov_info->mbx_reply_virt_addr, 34632a47e72SYuval Mintz (u64) p_iov_info->mbx_reply_phys_addr, 34732a47e72SYuval Mintz p_iov_info->p_bulletins, (u64) p_iov_info->bulletins_phys); 34832a47e72SYuval Mintz 34932a47e72SYuval Mintz return 0; 35032a47e72SYuval Mintz } 35132a47e72SYuval Mintz 35232a47e72SYuval Mintz static void qed_iov_free_vfdb(struct qed_hwfn *p_hwfn) 35332a47e72SYuval Mintz { 35432a47e72SYuval Mintz struct qed_pf_iov *p_iov_info = p_hwfn->pf_iov_info; 35532a47e72SYuval Mintz 35632a47e72SYuval Mintz if (p_hwfn->pf_iov_info->mbx_msg_virt_addr) 35732a47e72SYuval Mintz dma_free_coherent(&p_hwfn->cdev->pdev->dev, 35832a47e72SYuval Mintz p_iov_info->mbx_msg_size, 35932a47e72SYuval Mintz p_iov_info->mbx_msg_virt_addr, 36032a47e72SYuval Mintz p_iov_info->mbx_msg_phys_addr); 36132a47e72SYuval Mintz 36232a47e72SYuval Mintz if (p_hwfn->pf_iov_info->mbx_reply_virt_addr) 36332a47e72SYuval Mintz dma_free_coherent(&p_hwfn->cdev->pdev->dev, 36432a47e72SYuval Mintz p_iov_info->mbx_reply_size, 36532a47e72SYuval Mintz p_iov_info->mbx_reply_virt_addr, 36632a47e72SYuval Mintz p_iov_info->mbx_reply_phys_addr); 36732a47e72SYuval Mintz 36832a47e72SYuval Mintz if (p_iov_info->p_bulletins) 36932a47e72SYuval Mintz dma_free_coherent(&p_hwfn->cdev->pdev->dev, 37032a47e72SYuval Mintz p_iov_info->bulletins_size, 37132a47e72SYuval Mintz p_iov_info->p_bulletins, 37232a47e72SYuval Mintz p_iov_info->bulletins_phys); 37332a47e72SYuval Mintz } 37432a47e72SYuval Mintz 37532a47e72SYuval Mintz int qed_iov_alloc(struct qed_hwfn *p_hwfn) 37632a47e72SYuval Mintz { 37732a47e72SYuval Mintz struct qed_pf_iov *p_sriov; 37832a47e72SYuval Mintz 37932a47e72SYuval Mintz if (!IS_PF_SRIOV(p_hwfn)) { 38032a47e72SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 38132a47e72SYuval Mintz "No SR-IOV - no need for IOV db\n"); 38232a47e72SYuval Mintz return 0; 38332a47e72SYuval Mintz } 38432a47e72SYuval Mintz 38532a47e72SYuval Mintz p_sriov = kzalloc(sizeof(*p_sriov), GFP_KERNEL); 38632a47e72SYuval Mintz if (!p_sriov) { 38732a47e72SYuval Mintz DP_NOTICE(p_hwfn, "Failed to allocate `struct qed_sriov'\n"); 38832a47e72SYuval Mintz return -ENOMEM; 38932a47e72SYuval Mintz } 39032a47e72SYuval Mintz 39132a47e72SYuval Mintz p_hwfn->pf_iov_info = p_sriov; 39232a47e72SYuval Mintz 39332a47e72SYuval Mintz return qed_iov_allocate_vfdb(p_hwfn); 39432a47e72SYuval Mintz } 39532a47e72SYuval Mintz 39632a47e72SYuval Mintz void qed_iov_setup(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt) 39732a47e72SYuval Mintz { 39832a47e72SYuval Mintz if (!IS_PF_SRIOV(p_hwfn) || !IS_PF_SRIOV_ALLOC(p_hwfn)) 39932a47e72SYuval Mintz return; 40032a47e72SYuval Mintz 40132a47e72SYuval Mintz qed_iov_setup_vfdb(p_hwfn); 40232a47e72SYuval Mintz qed_iov_clear_vf_igu_blocks(p_hwfn, p_ptt); 40332a47e72SYuval Mintz } 40432a47e72SYuval Mintz 40532a47e72SYuval Mintz void qed_iov_free(struct qed_hwfn *p_hwfn) 40632a47e72SYuval Mintz { 40732a47e72SYuval Mintz if (IS_PF_SRIOV_ALLOC(p_hwfn)) { 40832a47e72SYuval Mintz qed_iov_free_vfdb(p_hwfn); 40932a47e72SYuval Mintz kfree(p_hwfn->pf_iov_info); 41032a47e72SYuval Mintz } 41132a47e72SYuval Mintz } 41232a47e72SYuval Mintz 41332a47e72SYuval Mintz void qed_iov_free_hw_info(struct qed_dev *cdev) 41432a47e72SYuval Mintz { 41532a47e72SYuval Mintz kfree(cdev->p_iov_info); 41632a47e72SYuval Mintz cdev->p_iov_info = NULL; 41732a47e72SYuval Mintz } 41832a47e72SYuval Mintz 41932a47e72SYuval Mintz int qed_iov_hw_info(struct qed_hwfn *p_hwfn) 42032a47e72SYuval Mintz { 42132a47e72SYuval Mintz struct qed_dev *cdev = p_hwfn->cdev; 42232a47e72SYuval Mintz int pos; 42332a47e72SYuval Mintz int rc; 42432a47e72SYuval Mintz 4251408cc1fSYuval Mintz if (IS_VF(p_hwfn->cdev)) 4261408cc1fSYuval Mintz return 0; 4271408cc1fSYuval Mintz 42832a47e72SYuval Mintz /* Learn the PCI configuration */ 42932a47e72SYuval Mintz pos = pci_find_ext_capability(p_hwfn->cdev->pdev, 43032a47e72SYuval Mintz PCI_EXT_CAP_ID_SRIOV); 43132a47e72SYuval Mintz if (!pos) { 43232a47e72SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, "No PCIe IOV support\n"); 43332a47e72SYuval Mintz return 0; 43432a47e72SYuval Mintz } 43532a47e72SYuval Mintz 43632a47e72SYuval Mintz /* Allocate a new struct for IOV information */ 43732a47e72SYuval Mintz cdev->p_iov_info = kzalloc(sizeof(*cdev->p_iov_info), GFP_KERNEL); 43832a47e72SYuval Mintz if (!cdev->p_iov_info) { 43932a47e72SYuval Mintz DP_NOTICE(p_hwfn, "Can't support IOV due to lack of memory\n"); 44032a47e72SYuval Mintz return -ENOMEM; 44132a47e72SYuval Mintz } 44232a47e72SYuval Mintz cdev->p_iov_info->pos = pos; 44332a47e72SYuval Mintz 44432a47e72SYuval Mintz rc = qed_iov_pci_cfg_info(cdev); 44532a47e72SYuval Mintz if (rc) 44632a47e72SYuval Mintz return rc; 44732a47e72SYuval Mintz 44832a47e72SYuval Mintz /* We want PF IOV to be synonemous with the existance of p_iov_info; 44932a47e72SYuval Mintz * In case the capability is published but there are no VFs, simply 45032a47e72SYuval Mintz * de-allocate the struct. 45132a47e72SYuval Mintz */ 45232a47e72SYuval Mintz if (!cdev->p_iov_info->total_vfs) { 45332a47e72SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 45432a47e72SYuval Mintz "IOV capabilities, but no VFs are published\n"); 45532a47e72SYuval Mintz kfree(cdev->p_iov_info); 45632a47e72SYuval Mintz cdev->p_iov_info = NULL; 45732a47e72SYuval Mintz return 0; 45832a47e72SYuval Mintz } 45932a47e72SYuval Mintz 46032a47e72SYuval Mintz /* Calculate the first VF index - this is a bit tricky; Basically, 46132a47e72SYuval Mintz * VFs start at offset 16 relative to PF0, and 2nd engine VFs begin 46232a47e72SYuval Mintz * after the first engine's VFs. 46332a47e72SYuval Mintz */ 46432a47e72SYuval Mintz cdev->p_iov_info->first_vf_in_pf = p_hwfn->cdev->p_iov_info->offset + 46532a47e72SYuval Mintz p_hwfn->abs_pf_id - 16; 46632a47e72SYuval Mintz if (QED_PATH_ID(p_hwfn)) 46732a47e72SYuval Mintz cdev->p_iov_info->first_vf_in_pf -= MAX_NUM_VFS_BB; 46832a47e72SYuval Mintz 46932a47e72SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 47032a47e72SYuval Mintz "First VF in hwfn 0x%08x\n", 47132a47e72SYuval Mintz cdev->p_iov_info->first_vf_in_pf); 47232a47e72SYuval Mintz 47332a47e72SYuval Mintz return 0; 47432a47e72SYuval Mintz } 47532a47e72SYuval Mintz 47637bff2b9SYuval Mintz static bool qed_iov_pf_sanity_check(struct qed_hwfn *p_hwfn, int vfid) 47737bff2b9SYuval Mintz { 47837bff2b9SYuval Mintz /* Check PF supports sriov */ 47937bff2b9SYuval Mintz if (!IS_QED_SRIOV(p_hwfn->cdev) || !IS_PF_SRIOV_ALLOC(p_hwfn)) 48037bff2b9SYuval Mintz return false; 48137bff2b9SYuval Mintz 48237bff2b9SYuval Mintz /* Check VF validity */ 4831408cc1fSYuval Mintz if (IS_VF(p_hwfn->cdev) || !IS_QED_SRIOV(p_hwfn->cdev) || 4841408cc1fSYuval Mintz !IS_PF_SRIOV_ALLOC(p_hwfn)) 48537bff2b9SYuval Mintz return false; 48637bff2b9SYuval Mintz 48737bff2b9SYuval Mintz return true; 48837bff2b9SYuval Mintz } 48937bff2b9SYuval Mintz 4900b55e27dSYuval Mintz static void qed_iov_set_vf_to_disable(struct qed_dev *cdev, 4910b55e27dSYuval Mintz u16 rel_vf_id, u8 to_disable) 4920b55e27dSYuval Mintz { 4930b55e27dSYuval Mintz struct qed_vf_info *vf; 4940b55e27dSYuval Mintz int i; 4950b55e27dSYuval Mintz 4960b55e27dSYuval Mintz for_each_hwfn(cdev, i) { 4970b55e27dSYuval Mintz struct qed_hwfn *p_hwfn = &cdev->hwfns[i]; 4980b55e27dSYuval Mintz 4990b55e27dSYuval Mintz vf = qed_iov_get_vf_info(p_hwfn, rel_vf_id, false); 5000b55e27dSYuval Mintz if (!vf) 5010b55e27dSYuval Mintz continue; 5020b55e27dSYuval Mintz 5030b55e27dSYuval Mintz vf->to_disable = to_disable; 5040b55e27dSYuval Mintz } 5050b55e27dSYuval Mintz } 5060b55e27dSYuval Mintz 5070b55e27dSYuval Mintz void qed_iov_set_vfs_to_disable(struct qed_dev *cdev, u8 to_disable) 5080b55e27dSYuval Mintz { 5090b55e27dSYuval Mintz u16 i; 5100b55e27dSYuval Mintz 5110b55e27dSYuval Mintz if (!IS_QED_SRIOV(cdev)) 5120b55e27dSYuval Mintz return; 5130b55e27dSYuval Mintz 5140b55e27dSYuval Mintz for (i = 0; i < cdev->p_iov_info->total_vfs; i++) 5150b55e27dSYuval Mintz qed_iov_set_vf_to_disable(cdev, i, to_disable); 5160b55e27dSYuval Mintz } 5170b55e27dSYuval Mintz 5181408cc1fSYuval Mintz static void qed_iov_vf_pglue_clear_err(struct qed_hwfn *p_hwfn, 5191408cc1fSYuval Mintz struct qed_ptt *p_ptt, u8 abs_vfid) 5201408cc1fSYuval Mintz { 5211408cc1fSYuval Mintz qed_wr(p_hwfn, p_ptt, 5221408cc1fSYuval Mintz PGLUE_B_REG_WAS_ERROR_VF_31_0_CLR + (abs_vfid >> 5) * 4, 5231408cc1fSYuval Mintz 1 << (abs_vfid & 0x1f)); 5241408cc1fSYuval Mintz } 5251408cc1fSYuval Mintz 526dacd88d6SYuval Mintz static void qed_iov_vf_igu_reset(struct qed_hwfn *p_hwfn, 527dacd88d6SYuval Mintz struct qed_ptt *p_ptt, struct qed_vf_info *vf) 528dacd88d6SYuval Mintz { 529dacd88d6SYuval Mintz u16 igu_sb_id; 530dacd88d6SYuval Mintz int i; 531dacd88d6SYuval Mintz 532dacd88d6SYuval Mintz /* Set VF masks and configuration - pretend */ 533dacd88d6SYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) vf->concrete_fid); 534dacd88d6SYuval Mintz 535dacd88d6SYuval Mintz qed_wr(p_hwfn, p_ptt, IGU_REG_STATISTIC_NUM_VF_MSG_SENT, 0); 536dacd88d6SYuval Mintz 537dacd88d6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 538dacd88d6SYuval Mintz "value in VF_CONFIGURATION of vf %d after write %x\n", 539dacd88d6SYuval Mintz vf->abs_vf_id, 540dacd88d6SYuval Mintz qed_rd(p_hwfn, p_ptt, IGU_REG_VF_CONFIGURATION)); 541dacd88d6SYuval Mintz 542dacd88d6SYuval Mintz /* unpretend */ 543dacd88d6SYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) p_hwfn->hw_info.concrete_fid); 544dacd88d6SYuval Mintz 545dacd88d6SYuval Mintz /* iterate over all queues, clear sb consumer */ 546dacd88d6SYuval Mintz for (i = 0; i < vf->num_sbs; i++) { 547dacd88d6SYuval Mintz igu_sb_id = vf->igu_sbs[i]; 548dacd88d6SYuval Mintz /* Set then clear... */ 549dacd88d6SYuval Mintz qed_int_igu_cleanup_sb(p_hwfn, p_ptt, igu_sb_id, 1, 550dacd88d6SYuval Mintz vf->opaque_fid); 551dacd88d6SYuval Mintz qed_int_igu_cleanup_sb(p_hwfn, p_ptt, igu_sb_id, 0, 552dacd88d6SYuval Mintz vf->opaque_fid); 553dacd88d6SYuval Mintz } 554dacd88d6SYuval Mintz } 555dacd88d6SYuval Mintz 5560b55e27dSYuval Mintz static void qed_iov_vf_igu_set_int(struct qed_hwfn *p_hwfn, 5570b55e27dSYuval Mintz struct qed_ptt *p_ptt, 5580b55e27dSYuval Mintz struct qed_vf_info *vf, bool enable) 5590b55e27dSYuval Mintz { 5600b55e27dSYuval Mintz u32 igu_vf_conf; 5610b55e27dSYuval Mintz 5620b55e27dSYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) vf->concrete_fid); 5630b55e27dSYuval Mintz 5640b55e27dSYuval Mintz igu_vf_conf = qed_rd(p_hwfn, p_ptt, IGU_REG_VF_CONFIGURATION); 5650b55e27dSYuval Mintz 5660b55e27dSYuval Mintz if (enable) 5670b55e27dSYuval Mintz igu_vf_conf |= IGU_VF_CONF_MSI_MSIX_EN; 5680b55e27dSYuval Mintz else 5690b55e27dSYuval Mintz igu_vf_conf &= ~IGU_VF_CONF_MSI_MSIX_EN; 5700b55e27dSYuval Mintz 5710b55e27dSYuval Mintz qed_wr(p_hwfn, p_ptt, IGU_REG_VF_CONFIGURATION, igu_vf_conf); 5720b55e27dSYuval Mintz 5730b55e27dSYuval Mintz /* unpretend */ 5740b55e27dSYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) p_hwfn->hw_info.concrete_fid); 5750b55e27dSYuval Mintz } 5760b55e27dSYuval Mintz 5771408cc1fSYuval Mintz static int qed_iov_enable_vf_access(struct qed_hwfn *p_hwfn, 5781408cc1fSYuval Mintz struct qed_ptt *p_ptt, 5791408cc1fSYuval Mintz struct qed_vf_info *vf) 5801408cc1fSYuval Mintz { 5811408cc1fSYuval Mintz u32 igu_vf_conf = IGU_VF_CONF_FUNC_EN; 5821408cc1fSYuval Mintz int rc; 5831408cc1fSYuval Mintz 5840b55e27dSYuval Mintz if (vf->to_disable) 5850b55e27dSYuval Mintz return 0; 5860b55e27dSYuval Mintz 5871408cc1fSYuval Mintz DP_VERBOSE(p_hwfn, 5881408cc1fSYuval Mintz QED_MSG_IOV, 5891408cc1fSYuval Mintz "Enable internal access for vf %x [abs %x]\n", 5901408cc1fSYuval Mintz vf->abs_vf_id, QED_VF_ABS_ID(p_hwfn, vf)); 5911408cc1fSYuval Mintz 5921408cc1fSYuval Mintz qed_iov_vf_pglue_clear_err(p_hwfn, p_ptt, QED_VF_ABS_ID(p_hwfn, vf)); 5931408cc1fSYuval Mintz 5941408cc1fSYuval Mintz rc = qed_mcp_config_vf_msix(p_hwfn, p_ptt, vf->abs_vf_id, vf->num_sbs); 5951408cc1fSYuval Mintz if (rc) 5961408cc1fSYuval Mintz return rc; 5971408cc1fSYuval Mintz 5981408cc1fSYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) vf->concrete_fid); 5991408cc1fSYuval Mintz 6001408cc1fSYuval Mintz SET_FIELD(igu_vf_conf, IGU_VF_CONF_PARENT, p_hwfn->rel_pf_id); 6011408cc1fSYuval Mintz STORE_RT_REG(p_hwfn, IGU_REG_VF_CONFIGURATION_RT_OFFSET, igu_vf_conf); 6021408cc1fSYuval Mintz 6031408cc1fSYuval Mintz qed_init_run(p_hwfn, p_ptt, PHASE_VF, vf->abs_vf_id, 6041408cc1fSYuval Mintz p_hwfn->hw_info.hw_mode); 6051408cc1fSYuval Mintz 6061408cc1fSYuval Mintz /* unpretend */ 6071408cc1fSYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) p_hwfn->hw_info.concrete_fid); 6081408cc1fSYuval Mintz 6091408cc1fSYuval Mintz if (vf->state != VF_STOPPED) { 6101408cc1fSYuval Mintz DP_NOTICE(p_hwfn, "VF[%02x] is already started\n", 6111408cc1fSYuval Mintz vf->abs_vf_id); 6121408cc1fSYuval Mintz return -EINVAL; 6131408cc1fSYuval Mintz } 6141408cc1fSYuval Mintz 6151408cc1fSYuval Mintz /* Start VF */ 6161408cc1fSYuval Mintz rc = qed_sp_vf_start(p_hwfn, vf->concrete_fid, vf->opaque_fid); 6171408cc1fSYuval Mintz if (rc) 6181408cc1fSYuval Mintz DP_NOTICE(p_hwfn, "Failed to start VF[%02x]\n", vf->abs_vf_id); 6191408cc1fSYuval Mintz 6201408cc1fSYuval Mintz vf->state = VF_FREE; 6211408cc1fSYuval Mintz 6221408cc1fSYuval Mintz return rc; 6231408cc1fSYuval Mintz } 6241408cc1fSYuval Mintz 6250b55e27dSYuval Mintz /** 6260b55e27dSYuval Mintz * @brief qed_iov_config_perm_table - configure the permission 6270b55e27dSYuval Mintz * zone table. 6280b55e27dSYuval Mintz * In E4, queue zone permission table size is 320x9. There 6290b55e27dSYuval Mintz * are 320 VF queues for single engine device (256 for dual 6300b55e27dSYuval Mintz * engine device), and each entry has the following format: 6310b55e27dSYuval Mintz * {Valid, VF[7:0]} 6320b55e27dSYuval Mintz * @param p_hwfn 6330b55e27dSYuval Mintz * @param p_ptt 6340b55e27dSYuval Mintz * @param vf 6350b55e27dSYuval Mintz * @param enable 6360b55e27dSYuval Mintz */ 6370b55e27dSYuval Mintz static void qed_iov_config_perm_table(struct qed_hwfn *p_hwfn, 6380b55e27dSYuval Mintz struct qed_ptt *p_ptt, 6390b55e27dSYuval Mintz struct qed_vf_info *vf, u8 enable) 6400b55e27dSYuval Mintz { 6410b55e27dSYuval Mintz u32 reg_addr, val; 6420b55e27dSYuval Mintz u16 qzone_id = 0; 6430b55e27dSYuval Mintz int qid; 6440b55e27dSYuval Mintz 6450b55e27dSYuval Mintz for (qid = 0; qid < vf->num_rxqs; qid++) { 6460b55e27dSYuval Mintz qed_fw_l2_queue(p_hwfn, vf->vf_queues[qid].fw_rx_qid, 6470b55e27dSYuval Mintz &qzone_id); 6480b55e27dSYuval Mintz 6490b55e27dSYuval Mintz reg_addr = PSWHST_REG_ZONE_PERMISSION_TABLE + qzone_id * 4; 6500b55e27dSYuval Mintz val = enable ? (vf->abs_vf_id | (1 << 8)) : 0; 6510b55e27dSYuval Mintz qed_wr(p_hwfn, p_ptt, reg_addr, val); 6520b55e27dSYuval Mintz } 6530b55e27dSYuval Mintz } 6540b55e27dSYuval Mintz 655dacd88d6SYuval Mintz static void qed_iov_enable_vf_traffic(struct qed_hwfn *p_hwfn, 656dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 657dacd88d6SYuval Mintz struct qed_vf_info *vf) 658dacd88d6SYuval Mintz { 659dacd88d6SYuval Mintz /* Reset vf in IGU - interrupts are still disabled */ 660dacd88d6SYuval Mintz qed_iov_vf_igu_reset(p_hwfn, p_ptt, vf); 661dacd88d6SYuval Mintz 662dacd88d6SYuval Mintz qed_iov_vf_igu_set_int(p_hwfn, p_ptt, vf, 1); 663dacd88d6SYuval Mintz 664dacd88d6SYuval Mintz /* Permission Table */ 665dacd88d6SYuval Mintz qed_iov_config_perm_table(p_hwfn, p_ptt, vf, true); 666dacd88d6SYuval Mintz } 667dacd88d6SYuval Mintz 6681408cc1fSYuval Mintz static u8 qed_iov_alloc_vf_igu_sbs(struct qed_hwfn *p_hwfn, 6691408cc1fSYuval Mintz struct qed_ptt *p_ptt, 6701408cc1fSYuval Mintz struct qed_vf_info *vf, u16 num_rx_queues) 6711408cc1fSYuval Mintz { 6721408cc1fSYuval Mintz struct qed_igu_block *igu_blocks; 6731408cc1fSYuval Mintz int qid = 0, igu_id = 0; 6741408cc1fSYuval Mintz u32 val = 0; 6751408cc1fSYuval Mintz 6761408cc1fSYuval Mintz igu_blocks = p_hwfn->hw_info.p_igu_info->igu_map.igu_blocks; 6771408cc1fSYuval Mintz 6781408cc1fSYuval Mintz if (num_rx_queues > p_hwfn->hw_info.p_igu_info->free_blks) 6791408cc1fSYuval Mintz num_rx_queues = p_hwfn->hw_info.p_igu_info->free_blks; 6801408cc1fSYuval Mintz p_hwfn->hw_info.p_igu_info->free_blks -= num_rx_queues; 6811408cc1fSYuval Mintz 6821408cc1fSYuval Mintz SET_FIELD(val, IGU_MAPPING_LINE_FUNCTION_NUMBER, vf->abs_vf_id); 6831408cc1fSYuval Mintz SET_FIELD(val, IGU_MAPPING_LINE_VALID, 1); 6841408cc1fSYuval Mintz SET_FIELD(val, IGU_MAPPING_LINE_PF_VALID, 0); 6851408cc1fSYuval Mintz 6861408cc1fSYuval Mintz while ((qid < num_rx_queues) && 6871408cc1fSYuval Mintz (igu_id < QED_MAPPING_MEMORY_SIZE(p_hwfn->cdev))) { 6881408cc1fSYuval Mintz if (igu_blocks[igu_id].status & QED_IGU_STATUS_FREE) { 6891408cc1fSYuval Mintz struct cau_sb_entry sb_entry; 6901408cc1fSYuval Mintz 6911408cc1fSYuval Mintz vf->igu_sbs[qid] = (u16)igu_id; 6921408cc1fSYuval Mintz igu_blocks[igu_id].status &= ~QED_IGU_STATUS_FREE; 6931408cc1fSYuval Mintz 6941408cc1fSYuval Mintz SET_FIELD(val, IGU_MAPPING_LINE_VECTOR_NUMBER, qid); 6951408cc1fSYuval Mintz 6961408cc1fSYuval Mintz qed_wr(p_hwfn, p_ptt, 6971408cc1fSYuval Mintz IGU_REG_MAPPING_MEMORY + sizeof(u32) * igu_id, 6981408cc1fSYuval Mintz val); 6991408cc1fSYuval Mintz 7001408cc1fSYuval Mintz /* Configure igu sb in CAU which were marked valid */ 7011408cc1fSYuval Mintz qed_init_cau_sb_entry(p_hwfn, &sb_entry, 7021408cc1fSYuval Mintz p_hwfn->rel_pf_id, 7031408cc1fSYuval Mintz vf->abs_vf_id, 1); 7041408cc1fSYuval Mintz qed_dmae_host2grc(p_hwfn, p_ptt, 7051408cc1fSYuval Mintz (u64)(uintptr_t)&sb_entry, 7061408cc1fSYuval Mintz CAU_REG_SB_VAR_MEMORY + 7071408cc1fSYuval Mintz igu_id * sizeof(u64), 2, 0); 7081408cc1fSYuval Mintz qid++; 7091408cc1fSYuval Mintz } 7101408cc1fSYuval Mintz igu_id++; 7111408cc1fSYuval Mintz } 7121408cc1fSYuval Mintz 7131408cc1fSYuval Mintz vf->num_sbs = (u8) num_rx_queues; 7141408cc1fSYuval Mintz 7151408cc1fSYuval Mintz return vf->num_sbs; 7161408cc1fSYuval Mintz } 7171408cc1fSYuval Mintz 7180b55e27dSYuval Mintz static void qed_iov_free_vf_igu_sbs(struct qed_hwfn *p_hwfn, 7190b55e27dSYuval Mintz struct qed_ptt *p_ptt, 7200b55e27dSYuval Mintz struct qed_vf_info *vf) 7210b55e27dSYuval Mintz { 7220b55e27dSYuval Mintz struct qed_igu_info *p_info = p_hwfn->hw_info.p_igu_info; 7230b55e27dSYuval Mintz int idx, igu_id; 7240b55e27dSYuval Mintz u32 addr, val; 7250b55e27dSYuval Mintz 7260b55e27dSYuval Mintz /* Invalidate igu CAM lines and mark them as free */ 7270b55e27dSYuval Mintz for (idx = 0; idx < vf->num_sbs; idx++) { 7280b55e27dSYuval Mintz igu_id = vf->igu_sbs[idx]; 7290b55e27dSYuval Mintz addr = IGU_REG_MAPPING_MEMORY + sizeof(u32) * igu_id; 7300b55e27dSYuval Mintz 7310b55e27dSYuval Mintz val = qed_rd(p_hwfn, p_ptt, addr); 7320b55e27dSYuval Mintz SET_FIELD(val, IGU_MAPPING_LINE_VALID, 0); 7330b55e27dSYuval Mintz qed_wr(p_hwfn, p_ptt, addr, val); 7340b55e27dSYuval Mintz 7350b55e27dSYuval Mintz p_info->igu_map.igu_blocks[igu_id].status |= 7360b55e27dSYuval Mintz QED_IGU_STATUS_FREE; 7370b55e27dSYuval Mintz 7380b55e27dSYuval Mintz p_hwfn->hw_info.p_igu_info->free_blks++; 7390b55e27dSYuval Mintz } 7400b55e27dSYuval Mintz 7410b55e27dSYuval Mintz vf->num_sbs = 0; 7420b55e27dSYuval Mintz } 7430b55e27dSYuval Mintz 7441408cc1fSYuval Mintz static int qed_iov_init_hw_for_vf(struct qed_hwfn *p_hwfn, 7451408cc1fSYuval Mintz struct qed_ptt *p_ptt, 7461408cc1fSYuval Mintz u16 rel_vf_id, u16 num_rx_queues) 7471408cc1fSYuval Mintz { 7481408cc1fSYuval Mintz u8 num_of_vf_avaiable_chains = 0; 7491408cc1fSYuval Mintz struct qed_vf_info *vf = NULL; 7501408cc1fSYuval Mintz int rc = 0; 7511408cc1fSYuval Mintz u32 cids; 7521408cc1fSYuval Mintz u8 i; 7531408cc1fSYuval Mintz 7541408cc1fSYuval Mintz vf = qed_iov_get_vf_info(p_hwfn, rel_vf_id, false); 7551408cc1fSYuval Mintz if (!vf) { 7561408cc1fSYuval Mintz DP_ERR(p_hwfn, "qed_iov_init_hw_for_vf : vf is NULL\n"); 7571408cc1fSYuval Mintz return -EINVAL; 7581408cc1fSYuval Mintz } 7591408cc1fSYuval Mintz 7601408cc1fSYuval Mintz if (vf->b_init) { 7611408cc1fSYuval Mintz DP_NOTICE(p_hwfn, "VF[%d] is already active.\n", rel_vf_id); 7621408cc1fSYuval Mintz return -EINVAL; 7631408cc1fSYuval Mintz } 7641408cc1fSYuval Mintz 7651408cc1fSYuval Mintz /* Limit number of queues according to number of CIDs */ 7661408cc1fSYuval Mintz qed_cxt_get_proto_cid_count(p_hwfn, PROTOCOLID_ETH, &cids); 7671408cc1fSYuval Mintz DP_VERBOSE(p_hwfn, 7681408cc1fSYuval Mintz QED_MSG_IOV, 7691408cc1fSYuval Mintz "VF[%d] - requesting to initialize for 0x%04x queues [0x%04x CIDs available]\n", 7701408cc1fSYuval Mintz vf->relative_vf_id, num_rx_queues, (u16) cids); 7711408cc1fSYuval Mintz num_rx_queues = min_t(u16, num_rx_queues, ((u16) cids)); 7721408cc1fSYuval Mintz 7731408cc1fSYuval Mintz num_of_vf_avaiable_chains = qed_iov_alloc_vf_igu_sbs(p_hwfn, 7741408cc1fSYuval Mintz p_ptt, 7751408cc1fSYuval Mintz vf, 7761408cc1fSYuval Mintz num_rx_queues); 7771408cc1fSYuval Mintz if (!num_of_vf_avaiable_chains) { 7781408cc1fSYuval Mintz DP_ERR(p_hwfn, "no available igu sbs\n"); 7791408cc1fSYuval Mintz return -ENOMEM; 7801408cc1fSYuval Mintz } 7811408cc1fSYuval Mintz 7821408cc1fSYuval Mintz /* Choose queue number and index ranges */ 7831408cc1fSYuval Mintz vf->num_rxqs = num_of_vf_avaiable_chains; 7841408cc1fSYuval Mintz vf->num_txqs = num_of_vf_avaiable_chains; 7851408cc1fSYuval Mintz 7861408cc1fSYuval Mintz for (i = 0; i < vf->num_rxqs; i++) { 7871408cc1fSYuval Mintz u16 queue_id = qed_int_queue_id_from_sb_id(p_hwfn, 7881408cc1fSYuval Mintz vf->igu_sbs[i]); 7891408cc1fSYuval Mintz 7901408cc1fSYuval Mintz if (queue_id > RESC_NUM(p_hwfn, QED_L2_QUEUE)) { 7911408cc1fSYuval Mintz DP_NOTICE(p_hwfn, 7921408cc1fSYuval Mintz "VF[%d] will require utilizing of out-of-bounds queues - %04x\n", 7931408cc1fSYuval Mintz vf->relative_vf_id, queue_id); 7941408cc1fSYuval Mintz return -EINVAL; 7951408cc1fSYuval Mintz } 7961408cc1fSYuval Mintz 7971408cc1fSYuval Mintz /* CIDs are per-VF, so no problem having them 0-based. */ 7981408cc1fSYuval Mintz vf->vf_queues[i].fw_rx_qid = queue_id; 7991408cc1fSYuval Mintz vf->vf_queues[i].fw_tx_qid = queue_id; 8001408cc1fSYuval Mintz vf->vf_queues[i].fw_cid = i; 8011408cc1fSYuval Mintz 8021408cc1fSYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 8031408cc1fSYuval Mintz "VF[%d] - [%d] SB %04x, Tx/Rx queue %04x CID %04x\n", 8041408cc1fSYuval Mintz vf->relative_vf_id, i, vf->igu_sbs[i], queue_id, i); 8051408cc1fSYuval Mintz } 8061408cc1fSYuval Mintz rc = qed_iov_enable_vf_access(p_hwfn, p_ptt, vf); 8071408cc1fSYuval Mintz if (!rc) { 8081408cc1fSYuval Mintz vf->b_init = true; 8091408cc1fSYuval Mintz 8101408cc1fSYuval Mintz if (IS_LEAD_HWFN(p_hwfn)) 8111408cc1fSYuval Mintz p_hwfn->cdev->p_iov_info->num_vfs++; 8121408cc1fSYuval Mintz } 8131408cc1fSYuval Mintz 8141408cc1fSYuval Mintz return rc; 8151408cc1fSYuval Mintz } 8161408cc1fSYuval Mintz 8170b55e27dSYuval Mintz static int qed_iov_release_hw_for_vf(struct qed_hwfn *p_hwfn, 8180b55e27dSYuval Mintz struct qed_ptt *p_ptt, u16 rel_vf_id) 8190b55e27dSYuval Mintz { 8200b55e27dSYuval Mintz struct qed_vf_info *vf = NULL; 8210b55e27dSYuval Mintz int rc = 0; 8220b55e27dSYuval Mintz 8230b55e27dSYuval Mintz vf = qed_iov_get_vf_info(p_hwfn, rel_vf_id, true); 8240b55e27dSYuval Mintz if (!vf) { 8250b55e27dSYuval Mintz DP_ERR(p_hwfn, "qed_iov_release_hw_for_vf : vf is NULL\n"); 8260b55e27dSYuval Mintz return -EINVAL; 8270b55e27dSYuval Mintz } 8280b55e27dSYuval Mintz 82936558c3dSYuval Mintz if (vf->bulletin.p_virt) 83036558c3dSYuval Mintz memset(vf->bulletin.p_virt, 0, sizeof(*vf->bulletin.p_virt)); 83136558c3dSYuval Mintz 83236558c3dSYuval Mintz memset(&vf->p_vf_info, 0, sizeof(vf->p_vf_info)); 83336558c3dSYuval Mintz 8340b55e27dSYuval Mintz if (vf->state != VF_STOPPED) { 8350b55e27dSYuval Mintz /* Stopping the VF */ 8360b55e27dSYuval Mintz rc = qed_sp_vf_stop(p_hwfn, vf->concrete_fid, vf->opaque_fid); 8370b55e27dSYuval Mintz 8380b55e27dSYuval Mintz if (rc != 0) { 8390b55e27dSYuval Mintz DP_ERR(p_hwfn, "qed_sp_vf_stop returned error %d\n", 8400b55e27dSYuval Mintz rc); 8410b55e27dSYuval Mintz return rc; 8420b55e27dSYuval Mintz } 8430b55e27dSYuval Mintz 8440b55e27dSYuval Mintz vf->state = VF_STOPPED; 8450b55e27dSYuval Mintz } 8460b55e27dSYuval Mintz 8470b55e27dSYuval Mintz /* disablng interrupts and resetting permission table was done during 8480b55e27dSYuval Mintz * vf-close, however, we could get here without going through vf_close 8490b55e27dSYuval Mintz */ 8500b55e27dSYuval Mintz /* Disable Interrupts for VF */ 8510b55e27dSYuval Mintz qed_iov_vf_igu_set_int(p_hwfn, p_ptt, vf, 0); 8520b55e27dSYuval Mintz 8530b55e27dSYuval Mintz /* Reset Permission table */ 8540b55e27dSYuval Mintz qed_iov_config_perm_table(p_hwfn, p_ptt, vf, 0); 8550b55e27dSYuval Mintz 8560b55e27dSYuval Mintz vf->num_rxqs = 0; 8570b55e27dSYuval Mintz vf->num_txqs = 0; 8580b55e27dSYuval Mintz qed_iov_free_vf_igu_sbs(p_hwfn, p_ptt, vf); 8590b55e27dSYuval Mintz 8600b55e27dSYuval Mintz if (vf->b_init) { 8610b55e27dSYuval Mintz vf->b_init = false; 8620b55e27dSYuval Mintz 8630b55e27dSYuval Mintz if (IS_LEAD_HWFN(p_hwfn)) 8640b55e27dSYuval Mintz p_hwfn->cdev->p_iov_info->num_vfs--; 8650b55e27dSYuval Mintz } 8660b55e27dSYuval Mintz 8670b55e27dSYuval Mintz return 0; 8680b55e27dSYuval Mintz } 8690b55e27dSYuval Mintz 87037bff2b9SYuval Mintz static bool qed_iov_tlv_supported(u16 tlvtype) 87137bff2b9SYuval Mintz { 87237bff2b9SYuval Mintz return CHANNEL_TLV_NONE < tlvtype && tlvtype < CHANNEL_TLV_MAX; 87337bff2b9SYuval Mintz } 87437bff2b9SYuval Mintz 87537bff2b9SYuval Mintz /* place a given tlv on the tlv buffer, continuing current tlv list */ 87637bff2b9SYuval Mintz void *qed_add_tlv(struct qed_hwfn *p_hwfn, u8 **offset, u16 type, u16 length) 87737bff2b9SYuval Mintz { 87837bff2b9SYuval Mintz struct channel_tlv *tl = (struct channel_tlv *)*offset; 87937bff2b9SYuval Mintz 88037bff2b9SYuval Mintz tl->type = type; 88137bff2b9SYuval Mintz tl->length = length; 88237bff2b9SYuval Mintz 88337bff2b9SYuval Mintz /* Offset should keep pointing to next TLV (the end of the last) */ 88437bff2b9SYuval Mintz *offset += length; 88537bff2b9SYuval Mintz 88637bff2b9SYuval Mintz /* Return a pointer to the start of the added tlv */ 88737bff2b9SYuval Mintz return *offset - length; 88837bff2b9SYuval Mintz } 88937bff2b9SYuval Mintz 89037bff2b9SYuval Mintz /* list the types and lengths of the tlvs on the buffer */ 89137bff2b9SYuval Mintz void qed_dp_tlv_list(struct qed_hwfn *p_hwfn, void *tlvs_list) 89237bff2b9SYuval Mintz { 89337bff2b9SYuval Mintz u16 i = 1, total_length = 0; 89437bff2b9SYuval Mintz struct channel_tlv *tlv; 89537bff2b9SYuval Mintz 89637bff2b9SYuval Mintz do { 89737bff2b9SYuval Mintz tlv = (struct channel_tlv *)((u8 *)tlvs_list + total_length); 89837bff2b9SYuval Mintz 89937bff2b9SYuval Mintz /* output tlv */ 90037bff2b9SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 90137bff2b9SYuval Mintz "TLV number %d: type %d, length %d\n", 90237bff2b9SYuval Mintz i, tlv->type, tlv->length); 90337bff2b9SYuval Mintz 90437bff2b9SYuval Mintz if (tlv->type == CHANNEL_TLV_LIST_END) 90537bff2b9SYuval Mintz return; 90637bff2b9SYuval Mintz 90737bff2b9SYuval Mintz /* Validate entry - protect against malicious VFs */ 90837bff2b9SYuval Mintz if (!tlv->length) { 90937bff2b9SYuval Mintz DP_NOTICE(p_hwfn, "TLV of length 0 found\n"); 91037bff2b9SYuval Mintz return; 91137bff2b9SYuval Mintz } 91237bff2b9SYuval Mintz 91337bff2b9SYuval Mintz total_length += tlv->length; 91437bff2b9SYuval Mintz 91537bff2b9SYuval Mintz if (total_length >= sizeof(struct tlv_buffer_size)) { 91637bff2b9SYuval Mintz DP_NOTICE(p_hwfn, "TLV ==> Buffer overflow\n"); 91737bff2b9SYuval Mintz return; 91837bff2b9SYuval Mintz } 91937bff2b9SYuval Mintz 92037bff2b9SYuval Mintz i++; 92137bff2b9SYuval Mintz } while (1); 92237bff2b9SYuval Mintz } 92337bff2b9SYuval Mintz 92437bff2b9SYuval Mintz static void qed_iov_send_response(struct qed_hwfn *p_hwfn, 92537bff2b9SYuval Mintz struct qed_ptt *p_ptt, 92637bff2b9SYuval Mintz struct qed_vf_info *p_vf, 92737bff2b9SYuval Mintz u16 length, u8 status) 92837bff2b9SYuval Mintz { 92937bff2b9SYuval Mintz struct qed_iov_vf_mbx *mbx = &p_vf->vf_mbx; 93037bff2b9SYuval Mintz struct qed_dmae_params params; 93137bff2b9SYuval Mintz u8 eng_vf_id; 93237bff2b9SYuval Mintz 93337bff2b9SYuval Mintz mbx->reply_virt->default_resp.hdr.status = status; 93437bff2b9SYuval Mintz 93537bff2b9SYuval Mintz qed_dp_tlv_list(p_hwfn, mbx->reply_virt); 93637bff2b9SYuval Mintz 93737bff2b9SYuval Mintz eng_vf_id = p_vf->abs_vf_id; 93837bff2b9SYuval Mintz 93937bff2b9SYuval Mintz memset(¶ms, 0, sizeof(struct qed_dmae_params)); 94037bff2b9SYuval Mintz params.flags = QED_DMAE_FLAG_VF_DST; 94137bff2b9SYuval Mintz params.dst_vfid = eng_vf_id; 94237bff2b9SYuval Mintz 94337bff2b9SYuval Mintz qed_dmae_host2host(p_hwfn, p_ptt, mbx->reply_phys + sizeof(u64), 94437bff2b9SYuval Mintz mbx->req_virt->first_tlv.reply_address + 94537bff2b9SYuval Mintz sizeof(u64), 94637bff2b9SYuval Mintz (sizeof(union pfvf_tlvs) - sizeof(u64)) / 4, 94737bff2b9SYuval Mintz ¶ms); 94837bff2b9SYuval Mintz 94937bff2b9SYuval Mintz qed_dmae_host2host(p_hwfn, p_ptt, mbx->reply_phys, 95037bff2b9SYuval Mintz mbx->req_virt->first_tlv.reply_address, 95137bff2b9SYuval Mintz sizeof(u64) / 4, ¶ms); 95237bff2b9SYuval Mintz 95337bff2b9SYuval Mintz REG_WR(p_hwfn, 95437bff2b9SYuval Mintz GTT_BAR0_MAP_REG_USDM_RAM + 95537bff2b9SYuval Mintz USTORM_VF_PF_CHANNEL_READY_OFFSET(eng_vf_id), 1); 95637bff2b9SYuval Mintz } 95737bff2b9SYuval Mintz 958dacd88d6SYuval Mintz static u16 qed_iov_vport_to_tlv(struct qed_hwfn *p_hwfn, 959dacd88d6SYuval Mintz enum qed_iov_vport_update_flag flag) 960dacd88d6SYuval Mintz { 961dacd88d6SYuval Mintz switch (flag) { 962dacd88d6SYuval Mintz case QED_IOV_VP_UPDATE_ACTIVATE: 963dacd88d6SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_ACTIVATE; 96417b235c1SYuval Mintz case QED_IOV_VP_UPDATE_VLAN_STRIP: 96517b235c1SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_VLAN_STRIP; 96617b235c1SYuval Mintz case QED_IOV_VP_UPDATE_TX_SWITCH: 96717b235c1SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_TX_SWITCH; 968dacd88d6SYuval Mintz case QED_IOV_VP_UPDATE_MCAST: 969dacd88d6SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_MCAST; 970dacd88d6SYuval Mintz case QED_IOV_VP_UPDATE_ACCEPT_PARAM: 971dacd88d6SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_ACCEPT_PARAM; 972dacd88d6SYuval Mintz case QED_IOV_VP_UPDATE_RSS: 973dacd88d6SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_RSS; 97417b235c1SYuval Mintz case QED_IOV_VP_UPDATE_ACCEPT_ANY_VLAN: 97517b235c1SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_ACCEPT_ANY_VLAN; 97617b235c1SYuval Mintz case QED_IOV_VP_UPDATE_SGE_TPA: 97717b235c1SYuval Mintz return CHANNEL_TLV_VPORT_UPDATE_SGE_TPA; 978dacd88d6SYuval Mintz default: 979dacd88d6SYuval Mintz return 0; 980dacd88d6SYuval Mintz } 981dacd88d6SYuval Mintz } 982dacd88d6SYuval Mintz 983dacd88d6SYuval Mintz static u16 qed_iov_prep_vp_update_resp_tlvs(struct qed_hwfn *p_hwfn, 984dacd88d6SYuval Mintz struct qed_vf_info *p_vf, 985dacd88d6SYuval Mintz struct qed_iov_vf_mbx *p_mbx, 986dacd88d6SYuval Mintz u8 status, 987dacd88d6SYuval Mintz u16 tlvs_mask, u16 tlvs_accepted) 988dacd88d6SYuval Mintz { 989dacd88d6SYuval Mintz struct pfvf_def_resp_tlv *resp; 990dacd88d6SYuval Mintz u16 size, total_len, i; 991dacd88d6SYuval Mintz 992dacd88d6SYuval Mintz memset(p_mbx->reply_virt, 0, sizeof(union pfvf_tlvs)); 993dacd88d6SYuval Mintz p_mbx->offset = (u8 *)p_mbx->reply_virt; 994dacd88d6SYuval Mintz size = sizeof(struct pfvf_def_resp_tlv); 995dacd88d6SYuval Mintz total_len = size; 996dacd88d6SYuval Mintz 997dacd88d6SYuval Mintz qed_add_tlv(p_hwfn, &p_mbx->offset, CHANNEL_TLV_VPORT_UPDATE, size); 998dacd88d6SYuval Mintz 999dacd88d6SYuval Mintz /* Prepare response for all extended tlvs if they are found by PF */ 1000dacd88d6SYuval Mintz for (i = 0; i < QED_IOV_VP_UPDATE_MAX; i++) { 1001dacd88d6SYuval Mintz if (!(tlvs_mask & (1 << i))) 1002dacd88d6SYuval Mintz continue; 1003dacd88d6SYuval Mintz 1004dacd88d6SYuval Mintz resp = qed_add_tlv(p_hwfn, &p_mbx->offset, 1005dacd88d6SYuval Mintz qed_iov_vport_to_tlv(p_hwfn, i), size); 1006dacd88d6SYuval Mintz 1007dacd88d6SYuval Mintz if (tlvs_accepted & (1 << i)) 1008dacd88d6SYuval Mintz resp->hdr.status = status; 1009dacd88d6SYuval Mintz else 1010dacd88d6SYuval Mintz resp->hdr.status = PFVF_STATUS_NOT_SUPPORTED; 1011dacd88d6SYuval Mintz 1012dacd88d6SYuval Mintz DP_VERBOSE(p_hwfn, 1013dacd88d6SYuval Mintz QED_MSG_IOV, 1014dacd88d6SYuval Mintz "VF[%d] - vport_update response: TLV %d, status %02x\n", 1015dacd88d6SYuval Mintz p_vf->relative_vf_id, 1016dacd88d6SYuval Mintz qed_iov_vport_to_tlv(p_hwfn, i), resp->hdr.status); 1017dacd88d6SYuval Mintz 1018dacd88d6SYuval Mintz total_len += size; 1019dacd88d6SYuval Mintz } 1020dacd88d6SYuval Mintz 1021dacd88d6SYuval Mintz qed_add_tlv(p_hwfn, &p_mbx->offset, CHANNEL_TLV_LIST_END, 1022dacd88d6SYuval Mintz sizeof(struct channel_list_end_tlv)); 1023dacd88d6SYuval Mintz 1024dacd88d6SYuval Mintz return total_len; 1025dacd88d6SYuval Mintz } 1026dacd88d6SYuval Mintz 102737bff2b9SYuval Mintz static void qed_iov_prepare_resp(struct qed_hwfn *p_hwfn, 102837bff2b9SYuval Mintz struct qed_ptt *p_ptt, 102937bff2b9SYuval Mintz struct qed_vf_info *vf_info, 103037bff2b9SYuval Mintz u16 type, u16 length, u8 status) 103137bff2b9SYuval Mintz { 103237bff2b9SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf_info->vf_mbx; 103337bff2b9SYuval Mintz 103437bff2b9SYuval Mintz mbx->offset = (u8 *)mbx->reply_virt; 103537bff2b9SYuval Mintz 103637bff2b9SYuval Mintz qed_add_tlv(p_hwfn, &mbx->offset, type, length); 103737bff2b9SYuval Mintz qed_add_tlv(p_hwfn, &mbx->offset, CHANNEL_TLV_LIST_END, 103837bff2b9SYuval Mintz sizeof(struct channel_list_end_tlv)); 103937bff2b9SYuval Mintz 104037bff2b9SYuval Mintz qed_iov_send_response(p_hwfn, p_ptt, vf_info, length, status); 104137bff2b9SYuval Mintz } 104237bff2b9SYuval Mintz 10430b55e27dSYuval Mintz struct qed_public_vf_info *qed_iov_get_public_vf_info(struct qed_hwfn *p_hwfn, 10440b55e27dSYuval Mintz u16 relative_vf_id, 10450b55e27dSYuval Mintz bool b_enabled_only) 10460b55e27dSYuval Mintz { 10470b55e27dSYuval Mintz struct qed_vf_info *vf = NULL; 10480b55e27dSYuval Mintz 10490b55e27dSYuval Mintz vf = qed_iov_get_vf_info(p_hwfn, relative_vf_id, b_enabled_only); 10500b55e27dSYuval Mintz if (!vf) 10510b55e27dSYuval Mintz return NULL; 10520b55e27dSYuval Mintz 10530b55e27dSYuval Mintz return &vf->p_vf_info; 10540b55e27dSYuval Mintz } 10550b55e27dSYuval Mintz 10560b55e27dSYuval Mintz void qed_iov_clean_vf(struct qed_hwfn *p_hwfn, u8 vfid) 10570b55e27dSYuval Mintz { 10580b55e27dSYuval Mintz struct qed_public_vf_info *vf_info; 10590b55e27dSYuval Mintz 10600b55e27dSYuval Mintz vf_info = qed_iov_get_public_vf_info(p_hwfn, vfid, false); 10610b55e27dSYuval Mintz 10620b55e27dSYuval Mintz if (!vf_info) 10630b55e27dSYuval Mintz return; 10640b55e27dSYuval Mintz 10650b55e27dSYuval Mintz /* Clear the VF mac */ 10660b55e27dSYuval Mintz memset(vf_info->mac, 0, ETH_ALEN); 10670b55e27dSYuval Mintz } 10680b55e27dSYuval Mintz 10690b55e27dSYuval Mintz static void qed_iov_vf_cleanup(struct qed_hwfn *p_hwfn, 10700b55e27dSYuval Mintz struct qed_vf_info *p_vf) 10710b55e27dSYuval Mintz { 10720b55e27dSYuval Mintz u32 i; 10730b55e27dSYuval Mintz 10740b55e27dSYuval Mintz p_vf->vf_bulletin = 0; 1075dacd88d6SYuval Mintz p_vf->vport_instance = 0; 10760b55e27dSYuval Mintz p_vf->num_mac_filters = 0; 10770b55e27dSYuval Mintz p_vf->num_vlan_filters = 0; 107808feecd7SYuval Mintz p_vf->configured_features = 0; 10790b55e27dSYuval Mintz 10800b55e27dSYuval Mintz /* If VF previously requested less resources, go back to default */ 10810b55e27dSYuval Mintz p_vf->num_rxqs = p_vf->num_sbs; 10820b55e27dSYuval Mintz p_vf->num_txqs = p_vf->num_sbs; 10830b55e27dSYuval Mintz 1084dacd88d6SYuval Mintz p_vf->num_active_rxqs = 0; 1085dacd88d6SYuval Mintz 10860b55e27dSYuval Mintz for (i = 0; i < QED_MAX_VF_CHAINS_PER_PF; i++) 10870b55e27dSYuval Mintz p_vf->vf_queues[i].rxq_active = 0; 10880b55e27dSYuval Mintz 108908feecd7SYuval Mintz memset(&p_vf->shadow_config, 0, sizeof(p_vf->shadow_config)); 10900b55e27dSYuval Mintz qed_iov_clean_vf(p_hwfn, p_vf->relative_vf_id); 10910b55e27dSYuval Mintz } 10920b55e27dSYuval Mintz 10931408cc1fSYuval Mintz static void qed_iov_vf_mbx_acquire(struct qed_hwfn *p_hwfn, 109437bff2b9SYuval Mintz struct qed_ptt *p_ptt, 10951408cc1fSYuval Mintz struct qed_vf_info *vf) 109637bff2b9SYuval Mintz { 10971408cc1fSYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 10981408cc1fSYuval Mintz struct pfvf_acquire_resp_tlv *resp = &mbx->reply_virt->acquire_resp; 10991408cc1fSYuval Mintz struct pf_vf_pfdev_info *pfdev_info = &resp->pfdev_info; 11001408cc1fSYuval Mintz struct vfpf_acquire_tlv *req = &mbx->req_virt->acquire; 11011408cc1fSYuval Mintz u8 i, vfpf_status = PFVF_STATUS_SUCCESS; 11021408cc1fSYuval Mintz struct pf_vf_resc *resc = &resp->resc; 11031408cc1fSYuval Mintz 11041408cc1fSYuval Mintz /* Validate FW compatibility */ 11051408cc1fSYuval Mintz if (req->vfdev_info.fw_major != FW_MAJOR_VERSION || 11061408cc1fSYuval Mintz req->vfdev_info.fw_minor != FW_MINOR_VERSION || 11071408cc1fSYuval Mintz req->vfdev_info.fw_revision != FW_REVISION_VERSION || 11081408cc1fSYuval Mintz req->vfdev_info.fw_engineering != FW_ENGINEERING_VERSION) { 11091408cc1fSYuval Mintz DP_INFO(p_hwfn, 11101408cc1fSYuval Mintz "VF[%d] is running an incompatible driver [VF needs FW %02x:%02x:%02x:%02x but Hypervisor is using %02x:%02x:%02x:%02x]\n", 11111408cc1fSYuval Mintz vf->abs_vf_id, 11121408cc1fSYuval Mintz req->vfdev_info.fw_major, 11131408cc1fSYuval Mintz req->vfdev_info.fw_minor, 11141408cc1fSYuval Mintz req->vfdev_info.fw_revision, 11151408cc1fSYuval Mintz req->vfdev_info.fw_engineering, 11161408cc1fSYuval Mintz FW_MAJOR_VERSION, 11171408cc1fSYuval Mintz FW_MINOR_VERSION, 11181408cc1fSYuval Mintz FW_REVISION_VERSION, FW_ENGINEERING_VERSION); 11191408cc1fSYuval Mintz vfpf_status = PFVF_STATUS_NOT_SUPPORTED; 11201408cc1fSYuval Mintz goto out; 11211408cc1fSYuval Mintz } 11221408cc1fSYuval Mintz 11231408cc1fSYuval Mintz /* On 100g PFs, prevent old VFs from loading */ 11241408cc1fSYuval Mintz if ((p_hwfn->cdev->num_hwfns > 1) && 11251408cc1fSYuval Mintz !(req->vfdev_info.capabilities & VFPF_ACQUIRE_CAP_100G)) { 11261408cc1fSYuval Mintz DP_INFO(p_hwfn, 11271408cc1fSYuval Mintz "VF[%d] is running an old driver that doesn't support 100g\n", 11281408cc1fSYuval Mintz vf->abs_vf_id); 11291408cc1fSYuval Mintz vfpf_status = PFVF_STATUS_NOT_SUPPORTED; 11301408cc1fSYuval Mintz goto out; 11311408cc1fSYuval Mintz } 11321408cc1fSYuval Mintz 11331408cc1fSYuval Mintz memset(resp, 0, sizeof(*resp)); 11341408cc1fSYuval Mintz 11351408cc1fSYuval Mintz /* Fill in vf info stuff */ 11361408cc1fSYuval Mintz vf->opaque_fid = req->vfdev_info.opaque_fid; 11371408cc1fSYuval Mintz vf->num_mac_filters = 1; 11381408cc1fSYuval Mintz vf->num_vlan_filters = QED_ETH_VF_NUM_VLAN_FILTERS; 11391408cc1fSYuval Mintz 11401408cc1fSYuval Mintz vf->vf_bulletin = req->bulletin_addr; 11411408cc1fSYuval Mintz vf->bulletin.size = (vf->bulletin.size < req->bulletin_size) ? 11421408cc1fSYuval Mintz vf->bulletin.size : req->bulletin_size; 11431408cc1fSYuval Mintz 11441408cc1fSYuval Mintz /* fill in pfdev info */ 11451408cc1fSYuval Mintz pfdev_info->chip_num = p_hwfn->cdev->chip_num; 11461408cc1fSYuval Mintz pfdev_info->db_size = 0; 11471408cc1fSYuval Mintz pfdev_info->indices_per_sb = PIS_PER_SB; 11481408cc1fSYuval Mintz 11491408cc1fSYuval Mintz pfdev_info->capabilities = PFVF_ACQUIRE_CAP_DEFAULT_UNTAGGED | 11501408cc1fSYuval Mintz PFVF_ACQUIRE_CAP_POST_FW_OVERRIDE; 11511408cc1fSYuval Mintz if (p_hwfn->cdev->num_hwfns > 1) 11521408cc1fSYuval Mintz pfdev_info->capabilities |= PFVF_ACQUIRE_CAP_100G; 11531408cc1fSYuval Mintz 11541408cc1fSYuval Mintz pfdev_info->stats_info.mstats.address = 11551408cc1fSYuval Mintz PXP_VF_BAR0_START_MSDM_ZONE_B + 11561408cc1fSYuval Mintz offsetof(struct mstorm_vf_zone, non_trigger.eth_queue_stat); 11571408cc1fSYuval Mintz pfdev_info->stats_info.mstats.len = 11581408cc1fSYuval Mintz sizeof(struct eth_mstorm_per_queue_stat); 11591408cc1fSYuval Mintz 11601408cc1fSYuval Mintz pfdev_info->stats_info.ustats.address = 11611408cc1fSYuval Mintz PXP_VF_BAR0_START_USDM_ZONE_B + 11621408cc1fSYuval Mintz offsetof(struct ustorm_vf_zone, non_trigger.eth_queue_stat); 11631408cc1fSYuval Mintz pfdev_info->stats_info.ustats.len = 11641408cc1fSYuval Mintz sizeof(struct eth_ustorm_per_queue_stat); 11651408cc1fSYuval Mintz 11661408cc1fSYuval Mintz pfdev_info->stats_info.pstats.address = 11671408cc1fSYuval Mintz PXP_VF_BAR0_START_PSDM_ZONE_B + 11681408cc1fSYuval Mintz offsetof(struct pstorm_vf_zone, non_trigger.eth_queue_stat); 11691408cc1fSYuval Mintz pfdev_info->stats_info.pstats.len = 11701408cc1fSYuval Mintz sizeof(struct eth_pstorm_per_queue_stat); 11711408cc1fSYuval Mintz 11721408cc1fSYuval Mintz pfdev_info->stats_info.tstats.address = 0; 11731408cc1fSYuval Mintz pfdev_info->stats_info.tstats.len = 0; 11741408cc1fSYuval Mintz 11751408cc1fSYuval Mintz memcpy(pfdev_info->port_mac, p_hwfn->hw_info.hw_mac_addr, ETH_ALEN); 11761408cc1fSYuval Mintz 11771408cc1fSYuval Mintz pfdev_info->fw_major = FW_MAJOR_VERSION; 11781408cc1fSYuval Mintz pfdev_info->fw_minor = FW_MINOR_VERSION; 11791408cc1fSYuval Mintz pfdev_info->fw_rev = FW_REVISION_VERSION; 11801408cc1fSYuval Mintz pfdev_info->fw_eng = FW_ENGINEERING_VERSION; 11811408cc1fSYuval Mintz pfdev_info->os_type = VFPF_ACQUIRE_OS_LINUX; 11821408cc1fSYuval Mintz qed_mcp_get_mfw_ver(p_hwfn, p_ptt, &pfdev_info->mfw_ver, NULL); 11831408cc1fSYuval Mintz 11841408cc1fSYuval Mintz pfdev_info->dev_type = p_hwfn->cdev->type; 11851408cc1fSYuval Mintz pfdev_info->chip_rev = p_hwfn->cdev->chip_rev; 11861408cc1fSYuval Mintz 11871408cc1fSYuval Mintz resc->num_rxqs = vf->num_rxqs; 11881408cc1fSYuval Mintz resc->num_txqs = vf->num_txqs; 11891408cc1fSYuval Mintz resc->num_sbs = vf->num_sbs; 11901408cc1fSYuval Mintz for (i = 0; i < resc->num_sbs; i++) { 11911408cc1fSYuval Mintz resc->hw_sbs[i].hw_sb_id = vf->igu_sbs[i]; 11921408cc1fSYuval Mintz resc->hw_sbs[i].sb_qid = 0; 11931408cc1fSYuval Mintz } 11941408cc1fSYuval Mintz 11951408cc1fSYuval Mintz for (i = 0; i < resc->num_rxqs; i++) { 11961408cc1fSYuval Mintz qed_fw_l2_queue(p_hwfn, vf->vf_queues[i].fw_rx_qid, 11971408cc1fSYuval Mintz (u16 *)&resc->hw_qid[i]); 11981408cc1fSYuval Mintz resc->cid[i] = vf->vf_queues[i].fw_cid; 11991408cc1fSYuval Mintz } 12001408cc1fSYuval Mintz 12011408cc1fSYuval Mintz resc->num_mac_filters = min_t(u8, vf->num_mac_filters, 12021408cc1fSYuval Mintz req->resc_request.num_mac_filters); 12031408cc1fSYuval Mintz resc->num_vlan_filters = min_t(u8, vf->num_vlan_filters, 12041408cc1fSYuval Mintz req->resc_request.num_vlan_filters); 12051408cc1fSYuval Mintz 12061408cc1fSYuval Mintz /* This isn't really required as VF isn't limited, but some VFs might 12071408cc1fSYuval Mintz * actually test this value, so need to provide it. 12081408cc1fSYuval Mintz */ 12091408cc1fSYuval Mintz resc->num_mc_filters = req->resc_request.num_mc_filters; 12101408cc1fSYuval Mintz 12111408cc1fSYuval Mintz /* Fill agreed size of bulletin board in response */ 12121408cc1fSYuval Mintz resp->bulletin_size = vf->bulletin.size; 121336558c3dSYuval Mintz qed_iov_post_vf_bulletin(p_hwfn, vf->relative_vf_id, p_ptt); 12141408cc1fSYuval Mintz 12151408cc1fSYuval Mintz DP_VERBOSE(p_hwfn, 12161408cc1fSYuval Mintz QED_MSG_IOV, 12171408cc1fSYuval Mintz "VF[%d] ACQUIRE_RESPONSE: pfdev_info- chip_num=0x%x, db_size=%d, idx_per_sb=%d, pf_cap=0x%llx\n" 12181408cc1fSYuval Mintz "resources- n_rxq-%d, n_txq-%d, n_sbs-%d, n_macs-%d, n_vlans-%d\n", 12191408cc1fSYuval Mintz vf->abs_vf_id, 12201408cc1fSYuval Mintz resp->pfdev_info.chip_num, 12211408cc1fSYuval Mintz resp->pfdev_info.db_size, 12221408cc1fSYuval Mintz resp->pfdev_info.indices_per_sb, 12231408cc1fSYuval Mintz resp->pfdev_info.capabilities, 12241408cc1fSYuval Mintz resc->num_rxqs, 12251408cc1fSYuval Mintz resc->num_txqs, 12261408cc1fSYuval Mintz resc->num_sbs, 12271408cc1fSYuval Mintz resc->num_mac_filters, 12281408cc1fSYuval Mintz resc->num_vlan_filters); 12291408cc1fSYuval Mintz vf->state = VF_ACQUIRED; 12301408cc1fSYuval Mintz 12311408cc1fSYuval Mintz /* Prepare Response */ 12321408cc1fSYuval Mintz out: 12331408cc1fSYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_ACQUIRE, 12341408cc1fSYuval Mintz sizeof(struct pfvf_acquire_resp_tlv), vfpf_status); 123537bff2b9SYuval Mintz } 123637bff2b9SYuval Mintz 123708feecd7SYuval Mintz static int qed_iov_reconfigure_unicast_vlan(struct qed_hwfn *p_hwfn, 123808feecd7SYuval Mintz struct qed_vf_info *p_vf) 123908feecd7SYuval Mintz { 124008feecd7SYuval Mintz struct qed_filter_ucast filter; 124108feecd7SYuval Mintz int rc = 0; 124208feecd7SYuval Mintz int i; 124308feecd7SYuval Mintz 124408feecd7SYuval Mintz memset(&filter, 0, sizeof(filter)); 124508feecd7SYuval Mintz filter.is_rx_filter = 1; 124608feecd7SYuval Mintz filter.is_tx_filter = 1; 124708feecd7SYuval Mintz filter.vport_to_add_to = p_vf->vport_id; 124808feecd7SYuval Mintz filter.opcode = QED_FILTER_ADD; 124908feecd7SYuval Mintz 125008feecd7SYuval Mintz /* Reconfigure vlans */ 125108feecd7SYuval Mintz for (i = 0; i < QED_ETH_VF_NUM_VLAN_FILTERS + 1; i++) { 125208feecd7SYuval Mintz if (!p_vf->shadow_config.vlans[i].used) 125308feecd7SYuval Mintz continue; 125408feecd7SYuval Mintz 125508feecd7SYuval Mintz filter.type = QED_FILTER_VLAN; 125608feecd7SYuval Mintz filter.vlan = p_vf->shadow_config.vlans[i].vid; 125708feecd7SYuval Mintz DP_VERBOSE(p_hwfn, 125808feecd7SYuval Mintz QED_MSG_IOV, 125908feecd7SYuval Mintz "Reconfiguring VLAN [0x%04x] for VF [%04x]\n", 126008feecd7SYuval Mintz filter.vlan, p_vf->relative_vf_id); 126108feecd7SYuval Mintz rc = qed_sp_eth_filter_ucast(p_hwfn, 126208feecd7SYuval Mintz p_vf->opaque_fid, 126308feecd7SYuval Mintz &filter, 126408feecd7SYuval Mintz QED_SPQ_MODE_CB, NULL); 126508feecd7SYuval Mintz if (rc) { 126608feecd7SYuval Mintz DP_NOTICE(p_hwfn, 126708feecd7SYuval Mintz "Failed to configure VLAN [%04x] to VF [%04x]\n", 126808feecd7SYuval Mintz filter.vlan, p_vf->relative_vf_id); 126908feecd7SYuval Mintz break; 127008feecd7SYuval Mintz } 127108feecd7SYuval Mintz } 127208feecd7SYuval Mintz 127308feecd7SYuval Mintz return rc; 127408feecd7SYuval Mintz } 127508feecd7SYuval Mintz 127608feecd7SYuval Mintz static int 127708feecd7SYuval Mintz qed_iov_reconfigure_unicast_shadow(struct qed_hwfn *p_hwfn, 127808feecd7SYuval Mintz struct qed_vf_info *p_vf, u64 events) 127908feecd7SYuval Mintz { 128008feecd7SYuval Mintz int rc = 0; 128108feecd7SYuval Mintz 128208feecd7SYuval Mintz if ((events & (1 << VLAN_ADDR_FORCED)) && 128308feecd7SYuval Mintz !(p_vf->configured_features & (1 << VLAN_ADDR_FORCED))) 128408feecd7SYuval Mintz rc = qed_iov_reconfigure_unicast_vlan(p_hwfn, p_vf); 128508feecd7SYuval Mintz 128608feecd7SYuval Mintz return rc; 128708feecd7SYuval Mintz } 128808feecd7SYuval Mintz 128908feecd7SYuval Mintz static int qed_iov_configure_vport_forced(struct qed_hwfn *p_hwfn, 129008feecd7SYuval Mintz struct qed_vf_info *p_vf, u64 events) 129108feecd7SYuval Mintz { 129208feecd7SYuval Mintz int rc = 0; 129308feecd7SYuval Mintz struct qed_filter_ucast filter; 129408feecd7SYuval Mintz 129508feecd7SYuval Mintz if (!p_vf->vport_instance) 129608feecd7SYuval Mintz return -EINVAL; 129708feecd7SYuval Mintz 129808feecd7SYuval Mintz if (events & (1 << VLAN_ADDR_FORCED)) { 129908feecd7SYuval Mintz struct qed_sp_vport_update_params vport_update; 130008feecd7SYuval Mintz u8 removal; 130108feecd7SYuval Mintz int i; 130208feecd7SYuval Mintz 130308feecd7SYuval Mintz memset(&filter, 0, sizeof(filter)); 130408feecd7SYuval Mintz filter.type = QED_FILTER_VLAN; 130508feecd7SYuval Mintz filter.is_rx_filter = 1; 130608feecd7SYuval Mintz filter.is_tx_filter = 1; 130708feecd7SYuval Mintz filter.vport_to_add_to = p_vf->vport_id; 130808feecd7SYuval Mintz filter.vlan = p_vf->bulletin.p_virt->pvid; 130908feecd7SYuval Mintz filter.opcode = filter.vlan ? QED_FILTER_REPLACE : 131008feecd7SYuval Mintz QED_FILTER_FLUSH; 131108feecd7SYuval Mintz 131208feecd7SYuval Mintz /* Send the ramrod */ 131308feecd7SYuval Mintz rc = qed_sp_eth_filter_ucast(p_hwfn, p_vf->opaque_fid, 131408feecd7SYuval Mintz &filter, QED_SPQ_MODE_CB, NULL); 131508feecd7SYuval Mintz if (rc) { 131608feecd7SYuval Mintz DP_NOTICE(p_hwfn, 131708feecd7SYuval Mintz "PF failed to configure VLAN for VF\n"); 131808feecd7SYuval Mintz return rc; 131908feecd7SYuval Mintz } 132008feecd7SYuval Mintz 132108feecd7SYuval Mintz /* Update the default-vlan & silent vlan stripping */ 132208feecd7SYuval Mintz memset(&vport_update, 0, sizeof(vport_update)); 132308feecd7SYuval Mintz vport_update.opaque_fid = p_vf->opaque_fid; 132408feecd7SYuval Mintz vport_update.vport_id = p_vf->vport_id; 132508feecd7SYuval Mintz vport_update.update_default_vlan_enable_flg = 1; 132608feecd7SYuval Mintz vport_update.default_vlan_enable_flg = filter.vlan ? 1 : 0; 132708feecd7SYuval Mintz vport_update.update_default_vlan_flg = 1; 132808feecd7SYuval Mintz vport_update.default_vlan = filter.vlan; 132908feecd7SYuval Mintz 133008feecd7SYuval Mintz vport_update.update_inner_vlan_removal_flg = 1; 133108feecd7SYuval Mintz removal = filter.vlan ? 1 133208feecd7SYuval Mintz : p_vf->shadow_config.inner_vlan_removal; 133308feecd7SYuval Mintz vport_update.inner_vlan_removal_flg = removal; 133408feecd7SYuval Mintz vport_update.silent_vlan_removal_flg = filter.vlan ? 1 : 0; 133508feecd7SYuval Mintz rc = qed_sp_vport_update(p_hwfn, 133608feecd7SYuval Mintz &vport_update, 133708feecd7SYuval Mintz QED_SPQ_MODE_EBLOCK, NULL); 133808feecd7SYuval Mintz if (rc) { 133908feecd7SYuval Mintz DP_NOTICE(p_hwfn, 134008feecd7SYuval Mintz "PF failed to configure VF vport for vlan\n"); 134108feecd7SYuval Mintz return rc; 134208feecd7SYuval Mintz } 134308feecd7SYuval Mintz 134408feecd7SYuval Mintz /* Update all the Rx queues */ 134508feecd7SYuval Mintz for (i = 0; i < QED_MAX_VF_CHAINS_PER_PF; i++) { 134608feecd7SYuval Mintz u16 qid; 134708feecd7SYuval Mintz 134808feecd7SYuval Mintz if (!p_vf->vf_queues[i].rxq_active) 134908feecd7SYuval Mintz continue; 135008feecd7SYuval Mintz 135108feecd7SYuval Mintz qid = p_vf->vf_queues[i].fw_rx_qid; 135208feecd7SYuval Mintz 135308feecd7SYuval Mintz rc = qed_sp_eth_rx_queues_update(p_hwfn, qid, 135408feecd7SYuval Mintz 1, 0, 1, 135508feecd7SYuval Mintz QED_SPQ_MODE_EBLOCK, 135608feecd7SYuval Mintz NULL); 135708feecd7SYuval Mintz if (rc) { 135808feecd7SYuval Mintz DP_NOTICE(p_hwfn, 135908feecd7SYuval Mintz "Failed to send Rx update fo queue[0x%04x]\n", 136008feecd7SYuval Mintz qid); 136108feecd7SYuval Mintz return rc; 136208feecd7SYuval Mintz } 136308feecd7SYuval Mintz } 136408feecd7SYuval Mintz 136508feecd7SYuval Mintz if (filter.vlan) 136608feecd7SYuval Mintz p_vf->configured_features |= 1 << VLAN_ADDR_FORCED; 136708feecd7SYuval Mintz else 136808feecd7SYuval Mintz p_vf->configured_features &= ~(1 << VLAN_ADDR_FORCED); 136908feecd7SYuval Mintz } 137008feecd7SYuval Mintz 137108feecd7SYuval Mintz /* If forced features are terminated, we need to configure the shadow 137208feecd7SYuval Mintz * configuration back again. 137308feecd7SYuval Mintz */ 137408feecd7SYuval Mintz if (events) 137508feecd7SYuval Mintz qed_iov_reconfigure_unicast_shadow(p_hwfn, p_vf, events); 137608feecd7SYuval Mintz 137708feecd7SYuval Mintz return rc; 137808feecd7SYuval Mintz } 137908feecd7SYuval Mintz 1380dacd88d6SYuval Mintz static void qed_iov_vf_mbx_start_vport(struct qed_hwfn *p_hwfn, 1381dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1382dacd88d6SYuval Mintz struct qed_vf_info *vf) 1383dacd88d6SYuval Mintz { 1384dacd88d6SYuval Mintz struct qed_sp_vport_start_params params = { 0 }; 1385dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 1386dacd88d6SYuval Mintz struct vfpf_vport_start_tlv *start; 1387dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 1388dacd88d6SYuval Mintz struct qed_vf_info *vf_info; 138908feecd7SYuval Mintz u64 *p_bitmap; 1390dacd88d6SYuval Mintz int sb_id; 1391dacd88d6SYuval Mintz int rc; 1392dacd88d6SYuval Mintz 1393dacd88d6SYuval Mintz vf_info = qed_iov_get_vf_info(p_hwfn, (u16) vf->relative_vf_id, true); 1394dacd88d6SYuval Mintz if (!vf_info) { 1395dacd88d6SYuval Mintz DP_NOTICE(p_hwfn->cdev, 1396dacd88d6SYuval Mintz "Failed to get VF info, invalid vfid [%d]\n", 1397dacd88d6SYuval Mintz vf->relative_vf_id); 1398dacd88d6SYuval Mintz return; 1399dacd88d6SYuval Mintz } 1400dacd88d6SYuval Mintz 1401dacd88d6SYuval Mintz vf->state = VF_ENABLED; 1402dacd88d6SYuval Mintz start = &mbx->req_virt->start_vport; 1403dacd88d6SYuval Mintz 1404dacd88d6SYuval Mintz /* Initialize Status block in CAU */ 1405dacd88d6SYuval Mintz for (sb_id = 0; sb_id < vf->num_sbs; sb_id++) { 1406dacd88d6SYuval Mintz if (!start->sb_addr[sb_id]) { 1407dacd88d6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 1408dacd88d6SYuval Mintz "VF[%d] did not fill the address of SB %d\n", 1409dacd88d6SYuval Mintz vf->relative_vf_id, sb_id); 1410dacd88d6SYuval Mintz break; 1411dacd88d6SYuval Mintz } 1412dacd88d6SYuval Mintz 1413dacd88d6SYuval Mintz qed_int_cau_conf_sb(p_hwfn, p_ptt, 1414dacd88d6SYuval Mintz start->sb_addr[sb_id], 1415dacd88d6SYuval Mintz vf->igu_sbs[sb_id], 1416dacd88d6SYuval Mintz vf->abs_vf_id, 1); 1417dacd88d6SYuval Mintz } 1418dacd88d6SYuval Mintz qed_iov_enable_vf_traffic(p_hwfn, p_ptt, vf); 1419dacd88d6SYuval Mintz 1420dacd88d6SYuval Mintz vf->mtu = start->mtu; 142108feecd7SYuval Mintz vf->shadow_config.inner_vlan_removal = start->inner_vlan_removal; 142208feecd7SYuval Mintz 142308feecd7SYuval Mintz /* Take into consideration configuration forced by hypervisor; 142408feecd7SYuval Mintz * If none is configured, use the supplied VF values [for old 142508feecd7SYuval Mintz * vfs that would still be fine, since they passed '0' as padding]. 142608feecd7SYuval Mintz */ 142708feecd7SYuval Mintz p_bitmap = &vf_info->bulletin.p_virt->valid_bitmap; 142808feecd7SYuval Mintz if (!(*p_bitmap & (1 << VFPF_BULLETIN_UNTAGGED_DEFAULT_FORCED))) { 142908feecd7SYuval Mintz u8 vf_req = start->only_untagged; 143008feecd7SYuval Mintz 143108feecd7SYuval Mintz vf_info->bulletin.p_virt->default_only_untagged = vf_req; 143208feecd7SYuval Mintz *p_bitmap |= 1 << VFPF_BULLETIN_UNTAGGED_DEFAULT; 143308feecd7SYuval Mintz } 1434dacd88d6SYuval Mintz 1435dacd88d6SYuval Mintz params.tpa_mode = start->tpa_mode; 1436dacd88d6SYuval Mintz params.remove_inner_vlan = start->inner_vlan_removal; 1437dacd88d6SYuval Mintz 143808feecd7SYuval Mintz params.only_untagged = vf_info->bulletin.p_virt->default_only_untagged; 1439dacd88d6SYuval Mintz params.drop_ttl0 = false; 1440dacd88d6SYuval Mintz params.concrete_fid = vf->concrete_fid; 1441dacd88d6SYuval Mintz params.opaque_fid = vf->opaque_fid; 1442dacd88d6SYuval Mintz params.vport_id = vf->vport_id; 1443dacd88d6SYuval Mintz params.max_buffers_per_cqe = start->max_buffers_per_cqe; 1444dacd88d6SYuval Mintz params.mtu = vf->mtu; 1445dacd88d6SYuval Mintz 1446dacd88d6SYuval Mintz rc = qed_sp_eth_vport_start(p_hwfn, ¶ms); 1447dacd88d6SYuval Mintz if (rc != 0) { 1448dacd88d6SYuval Mintz DP_ERR(p_hwfn, 1449dacd88d6SYuval Mintz "qed_iov_vf_mbx_start_vport returned error %d\n", rc); 1450dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 1451dacd88d6SYuval Mintz } else { 1452dacd88d6SYuval Mintz vf->vport_instance++; 145308feecd7SYuval Mintz 145408feecd7SYuval Mintz /* Force configuration if needed on the newly opened vport */ 145508feecd7SYuval Mintz qed_iov_configure_vport_forced(p_hwfn, vf, *p_bitmap); 1456dacd88d6SYuval Mintz } 1457dacd88d6SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_VPORT_START, 1458dacd88d6SYuval Mintz sizeof(struct pfvf_def_resp_tlv), status); 1459dacd88d6SYuval Mintz } 1460dacd88d6SYuval Mintz 1461dacd88d6SYuval Mintz static void qed_iov_vf_mbx_stop_vport(struct qed_hwfn *p_hwfn, 1462dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1463dacd88d6SYuval Mintz struct qed_vf_info *vf) 1464dacd88d6SYuval Mintz { 1465dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 1466dacd88d6SYuval Mintz int rc; 1467dacd88d6SYuval Mintz 1468dacd88d6SYuval Mintz vf->vport_instance--; 1469dacd88d6SYuval Mintz 1470dacd88d6SYuval Mintz rc = qed_sp_vport_stop(p_hwfn, vf->opaque_fid, vf->vport_id); 1471dacd88d6SYuval Mintz if (rc != 0) { 1472dacd88d6SYuval Mintz DP_ERR(p_hwfn, "qed_iov_vf_mbx_stop_vport returned error %d\n", 1473dacd88d6SYuval Mintz rc); 1474dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 1475dacd88d6SYuval Mintz } 1476dacd88d6SYuval Mintz 147708feecd7SYuval Mintz /* Forget the configuration on the vport */ 147808feecd7SYuval Mintz vf->configured_features = 0; 147908feecd7SYuval Mintz memset(&vf->shadow_config, 0, sizeof(vf->shadow_config)); 148008feecd7SYuval Mintz 1481dacd88d6SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_VPORT_TEARDOWN, 1482dacd88d6SYuval Mintz sizeof(struct pfvf_def_resp_tlv), status); 1483dacd88d6SYuval Mintz } 1484dacd88d6SYuval Mintz 1485dacd88d6SYuval Mintz #define TSTORM_QZONE_START PXP_VF_BAR0_START_SDM_ZONE_A 1486dacd88d6SYuval Mintz #define MSTORM_QZONE_START(dev) (TSTORM_QZONE_START + \ 1487dacd88d6SYuval Mintz (TSTORM_QZONE_SIZE * NUM_OF_L2_QUEUES(dev))) 1488dacd88d6SYuval Mintz 1489dacd88d6SYuval Mintz static void qed_iov_vf_mbx_start_rxq_resp(struct qed_hwfn *p_hwfn, 1490dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1491dacd88d6SYuval Mintz struct qed_vf_info *vf, u8 status) 1492dacd88d6SYuval Mintz { 1493dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 1494dacd88d6SYuval Mintz struct pfvf_start_queue_resp_tlv *p_tlv; 1495dacd88d6SYuval Mintz struct vfpf_start_rxq_tlv *req; 1496dacd88d6SYuval Mintz 1497dacd88d6SYuval Mintz mbx->offset = (u8 *)mbx->reply_virt; 1498dacd88d6SYuval Mintz 1499dacd88d6SYuval Mintz p_tlv = qed_add_tlv(p_hwfn, &mbx->offset, CHANNEL_TLV_START_RXQ, 1500dacd88d6SYuval Mintz sizeof(*p_tlv)); 1501dacd88d6SYuval Mintz qed_add_tlv(p_hwfn, &mbx->offset, CHANNEL_TLV_LIST_END, 1502dacd88d6SYuval Mintz sizeof(struct channel_list_end_tlv)); 1503dacd88d6SYuval Mintz 1504dacd88d6SYuval Mintz /* Update the TLV with the response */ 1505dacd88d6SYuval Mintz if (status == PFVF_STATUS_SUCCESS) { 1506dacd88d6SYuval Mintz u16 hw_qid = 0; 1507dacd88d6SYuval Mintz 1508dacd88d6SYuval Mintz req = &mbx->req_virt->start_rxq; 1509dacd88d6SYuval Mintz qed_fw_l2_queue(p_hwfn, vf->vf_queues[req->rx_qid].fw_rx_qid, 1510dacd88d6SYuval Mintz &hw_qid); 1511dacd88d6SYuval Mintz 1512dacd88d6SYuval Mintz p_tlv->offset = MSTORM_QZONE_START(p_hwfn->cdev) + 1513dacd88d6SYuval Mintz hw_qid * MSTORM_QZONE_SIZE + 1514dacd88d6SYuval Mintz offsetof(struct mstorm_eth_queue_zone, 1515dacd88d6SYuval Mintz rx_producers); 1516dacd88d6SYuval Mintz } 1517dacd88d6SYuval Mintz 1518dacd88d6SYuval Mintz qed_iov_send_response(p_hwfn, p_ptt, vf, sizeof(*p_tlv), status); 1519dacd88d6SYuval Mintz } 1520dacd88d6SYuval Mintz 1521dacd88d6SYuval Mintz static void qed_iov_vf_mbx_start_rxq(struct qed_hwfn *p_hwfn, 1522dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1523dacd88d6SYuval Mintz struct qed_vf_info *vf) 1524dacd88d6SYuval Mintz { 1525dacd88d6SYuval Mintz struct qed_queue_start_common_params params; 1526dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 1527dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 1528dacd88d6SYuval Mintz struct vfpf_start_rxq_tlv *req; 1529dacd88d6SYuval Mintz int rc; 1530dacd88d6SYuval Mintz 1531dacd88d6SYuval Mintz memset(¶ms, 0, sizeof(params)); 1532dacd88d6SYuval Mintz req = &mbx->req_virt->start_rxq; 1533dacd88d6SYuval Mintz params.queue_id = vf->vf_queues[req->rx_qid].fw_rx_qid; 1534dacd88d6SYuval Mintz params.vport_id = vf->vport_id; 1535dacd88d6SYuval Mintz params.sb = req->hw_sb; 1536dacd88d6SYuval Mintz params.sb_idx = req->sb_index; 1537dacd88d6SYuval Mintz 1538dacd88d6SYuval Mintz rc = qed_sp_eth_rxq_start_ramrod(p_hwfn, vf->opaque_fid, 1539dacd88d6SYuval Mintz vf->vf_queues[req->rx_qid].fw_cid, 1540dacd88d6SYuval Mintz ¶ms, 1541dacd88d6SYuval Mintz vf->abs_vf_id + 0x10, 1542dacd88d6SYuval Mintz req->bd_max_bytes, 1543dacd88d6SYuval Mintz req->rxq_addr, 1544dacd88d6SYuval Mintz req->cqe_pbl_addr, req->cqe_pbl_size); 1545dacd88d6SYuval Mintz 1546dacd88d6SYuval Mintz if (rc) { 1547dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 1548dacd88d6SYuval Mintz } else { 1549dacd88d6SYuval Mintz vf->vf_queues[req->rx_qid].rxq_active = true; 1550dacd88d6SYuval Mintz vf->num_active_rxqs++; 1551dacd88d6SYuval Mintz } 1552dacd88d6SYuval Mintz 1553dacd88d6SYuval Mintz qed_iov_vf_mbx_start_rxq_resp(p_hwfn, p_ptt, vf, status); 1554dacd88d6SYuval Mintz } 1555dacd88d6SYuval Mintz 1556dacd88d6SYuval Mintz static void qed_iov_vf_mbx_start_txq(struct qed_hwfn *p_hwfn, 1557dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1558dacd88d6SYuval Mintz struct qed_vf_info *vf) 1559dacd88d6SYuval Mintz { 1560dacd88d6SYuval Mintz u16 length = sizeof(struct pfvf_def_resp_tlv); 1561dacd88d6SYuval Mintz struct qed_queue_start_common_params params; 1562dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 1563dacd88d6SYuval Mintz union qed_qm_pq_params pq_params; 1564dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 1565dacd88d6SYuval Mintz struct vfpf_start_txq_tlv *req; 1566dacd88d6SYuval Mintz int rc; 1567dacd88d6SYuval Mintz 1568dacd88d6SYuval Mintz /* Prepare the parameters which would choose the right PQ */ 1569dacd88d6SYuval Mintz memset(&pq_params, 0, sizeof(pq_params)); 1570dacd88d6SYuval Mintz pq_params.eth.is_vf = 1; 1571dacd88d6SYuval Mintz pq_params.eth.vf_id = vf->relative_vf_id; 1572dacd88d6SYuval Mintz 1573dacd88d6SYuval Mintz memset(¶ms, 0, sizeof(params)); 1574dacd88d6SYuval Mintz req = &mbx->req_virt->start_txq; 1575dacd88d6SYuval Mintz params.queue_id = vf->vf_queues[req->tx_qid].fw_tx_qid; 1576dacd88d6SYuval Mintz params.vport_id = vf->vport_id; 1577dacd88d6SYuval Mintz params.sb = req->hw_sb; 1578dacd88d6SYuval Mintz params.sb_idx = req->sb_index; 1579dacd88d6SYuval Mintz 1580dacd88d6SYuval Mintz rc = qed_sp_eth_txq_start_ramrod(p_hwfn, 1581dacd88d6SYuval Mintz vf->opaque_fid, 1582dacd88d6SYuval Mintz vf->vf_queues[req->tx_qid].fw_cid, 1583dacd88d6SYuval Mintz ¶ms, 1584dacd88d6SYuval Mintz vf->abs_vf_id + 0x10, 1585dacd88d6SYuval Mintz req->pbl_addr, 1586dacd88d6SYuval Mintz req->pbl_size, &pq_params); 1587dacd88d6SYuval Mintz 1588dacd88d6SYuval Mintz if (rc) 1589dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 1590dacd88d6SYuval Mintz else 1591dacd88d6SYuval Mintz vf->vf_queues[req->tx_qid].txq_active = true; 1592dacd88d6SYuval Mintz 1593dacd88d6SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_START_TXQ, 1594dacd88d6SYuval Mintz length, status); 1595dacd88d6SYuval Mintz } 1596dacd88d6SYuval Mintz 1597dacd88d6SYuval Mintz static int qed_iov_vf_stop_rxqs(struct qed_hwfn *p_hwfn, 1598dacd88d6SYuval Mintz struct qed_vf_info *vf, 1599dacd88d6SYuval Mintz u16 rxq_id, u8 num_rxqs, bool cqe_completion) 1600dacd88d6SYuval Mintz { 1601dacd88d6SYuval Mintz int rc = 0; 1602dacd88d6SYuval Mintz int qid; 1603dacd88d6SYuval Mintz 1604dacd88d6SYuval Mintz if (rxq_id + num_rxqs > ARRAY_SIZE(vf->vf_queues)) 1605dacd88d6SYuval Mintz return -EINVAL; 1606dacd88d6SYuval Mintz 1607dacd88d6SYuval Mintz for (qid = rxq_id; qid < rxq_id + num_rxqs; qid++) { 1608dacd88d6SYuval Mintz if (vf->vf_queues[qid].rxq_active) { 1609dacd88d6SYuval Mintz rc = qed_sp_eth_rx_queue_stop(p_hwfn, 1610dacd88d6SYuval Mintz vf->vf_queues[qid]. 1611dacd88d6SYuval Mintz fw_rx_qid, false, 1612dacd88d6SYuval Mintz cqe_completion); 1613dacd88d6SYuval Mintz 1614dacd88d6SYuval Mintz if (rc) 1615dacd88d6SYuval Mintz return rc; 1616dacd88d6SYuval Mintz } 1617dacd88d6SYuval Mintz vf->vf_queues[qid].rxq_active = false; 1618dacd88d6SYuval Mintz vf->num_active_rxqs--; 1619dacd88d6SYuval Mintz } 1620dacd88d6SYuval Mintz 1621dacd88d6SYuval Mintz return rc; 1622dacd88d6SYuval Mintz } 1623dacd88d6SYuval Mintz 1624dacd88d6SYuval Mintz static int qed_iov_vf_stop_txqs(struct qed_hwfn *p_hwfn, 1625dacd88d6SYuval Mintz struct qed_vf_info *vf, u16 txq_id, u8 num_txqs) 1626dacd88d6SYuval Mintz { 1627dacd88d6SYuval Mintz int rc = 0; 1628dacd88d6SYuval Mintz int qid; 1629dacd88d6SYuval Mintz 1630dacd88d6SYuval Mintz if (txq_id + num_txqs > ARRAY_SIZE(vf->vf_queues)) 1631dacd88d6SYuval Mintz return -EINVAL; 1632dacd88d6SYuval Mintz 1633dacd88d6SYuval Mintz for (qid = txq_id; qid < txq_id + num_txqs; qid++) { 1634dacd88d6SYuval Mintz if (vf->vf_queues[qid].txq_active) { 1635dacd88d6SYuval Mintz rc = qed_sp_eth_tx_queue_stop(p_hwfn, 1636dacd88d6SYuval Mintz vf->vf_queues[qid]. 1637dacd88d6SYuval Mintz fw_tx_qid); 1638dacd88d6SYuval Mintz 1639dacd88d6SYuval Mintz if (rc) 1640dacd88d6SYuval Mintz return rc; 1641dacd88d6SYuval Mintz } 1642dacd88d6SYuval Mintz vf->vf_queues[qid].txq_active = false; 1643dacd88d6SYuval Mintz } 1644dacd88d6SYuval Mintz return rc; 1645dacd88d6SYuval Mintz } 1646dacd88d6SYuval Mintz 1647dacd88d6SYuval Mintz static void qed_iov_vf_mbx_stop_rxqs(struct qed_hwfn *p_hwfn, 1648dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1649dacd88d6SYuval Mintz struct qed_vf_info *vf) 1650dacd88d6SYuval Mintz { 1651dacd88d6SYuval Mintz u16 length = sizeof(struct pfvf_def_resp_tlv); 1652dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 1653dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 1654dacd88d6SYuval Mintz struct vfpf_stop_rxqs_tlv *req; 1655dacd88d6SYuval Mintz int rc; 1656dacd88d6SYuval Mintz 1657dacd88d6SYuval Mintz /* We give the option of starting from qid != 0, in this case we 1658dacd88d6SYuval Mintz * need to make sure that qid + num_qs doesn't exceed the actual 1659dacd88d6SYuval Mintz * amount of queues that exist. 1660dacd88d6SYuval Mintz */ 1661dacd88d6SYuval Mintz req = &mbx->req_virt->stop_rxqs; 1662dacd88d6SYuval Mintz rc = qed_iov_vf_stop_rxqs(p_hwfn, vf, req->rx_qid, 1663dacd88d6SYuval Mintz req->num_rxqs, req->cqe_completion); 1664dacd88d6SYuval Mintz if (rc) 1665dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 1666dacd88d6SYuval Mintz 1667dacd88d6SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_STOP_RXQS, 1668dacd88d6SYuval Mintz length, status); 1669dacd88d6SYuval Mintz } 1670dacd88d6SYuval Mintz 1671dacd88d6SYuval Mintz static void qed_iov_vf_mbx_stop_txqs(struct qed_hwfn *p_hwfn, 1672dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 1673dacd88d6SYuval Mintz struct qed_vf_info *vf) 1674dacd88d6SYuval Mintz { 1675dacd88d6SYuval Mintz u16 length = sizeof(struct pfvf_def_resp_tlv); 1676dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 1677dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 1678dacd88d6SYuval Mintz struct vfpf_stop_txqs_tlv *req; 1679dacd88d6SYuval Mintz int rc; 1680dacd88d6SYuval Mintz 1681dacd88d6SYuval Mintz /* We give the option of starting from qid != 0, in this case we 1682dacd88d6SYuval Mintz * need to make sure that qid + num_qs doesn't exceed the actual 1683dacd88d6SYuval Mintz * amount of queues that exist. 1684dacd88d6SYuval Mintz */ 1685dacd88d6SYuval Mintz req = &mbx->req_virt->stop_txqs; 1686dacd88d6SYuval Mintz rc = qed_iov_vf_stop_txqs(p_hwfn, vf, req->tx_qid, req->num_txqs); 1687dacd88d6SYuval Mintz if (rc) 1688dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 1689dacd88d6SYuval Mintz 1690dacd88d6SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_STOP_TXQS, 1691dacd88d6SYuval Mintz length, status); 1692dacd88d6SYuval Mintz } 1693dacd88d6SYuval Mintz 169417b235c1SYuval Mintz static void qed_iov_vf_mbx_update_rxqs(struct qed_hwfn *p_hwfn, 169517b235c1SYuval Mintz struct qed_ptt *p_ptt, 169617b235c1SYuval Mintz struct qed_vf_info *vf) 169717b235c1SYuval Mintz { 169817b235c1SYuval Mintz u16 length = sizeof(struct pfvf_def_resp_tlv); 169917b235c1SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 170017b235c1SYuval Mintz struct vfpf_update_rxq_tlv *req; 170117b235c1SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 170217b235c1SYuval Mintz u8 complete_event_flg; 170317b235c1SYuval Mintz u8 complete_cqe_flg; 170417b235c1SYuval Mintz u16 qid; 170517b235c1SYuval Mintz int rc; 170617b235c1SYuval Mintz u8 i; 170717b235c1SYuval Mintz 170817b235c1SYuval Mintz req = &mbx->req_virt->update_rxq; 170917b235c1SYuval Mintz complete_cqe_flg = !!(req->flags & VFPF_RXQ_UPD_COMPLETE_CQE_FLAG); 171017b235c1SYuval Mintz complete_event_flg = !!(req->flags & VFPF_RXQ_UPD_COMPLETE_EVENT_FLAG); 171117b235c1SYuval Mintz 171217b235c1SYuval Mintz for (i = 0; i < req->num_rxqs; i++) { 171317b235c1SYuval Mintz qid = req->rx_qid + i; 171417b235c1SYuval Mintz 171517b235c1SYuval Mintz if (!vf->vf_queues[qid].rxq_active) { 171617b235c1SYuval Mintz DP_NOTICE(p_hwfn, "VF rx_qid = %d isn`t active!\n", 171717b235c1SYuval Mintz qid); 171817b235c1SYuval Mintz status = PFVF_STATUS_FAILURE; 171917b235c1SYuval Mintz break; 172017b235c1SYuval Mintz } 172117b235c1SYuval Mintz 172217b235c1SYuval Mintz rc = qed_sp_eth_rx_queues_update(p_hwfn, 172317b235c1SYuval Mintz vf->vf_queues[qid].fw_rx_qid, 172417b235c1SYuval Mintz 1, 172517b235c1SYuval Mintz complete_cqe_flg, 172617b235c1SYuval Mintz complete_event_flg, 172717b235c1SYuval Mintz QED_SPQ_MODE_EBLOCK, NULL); 172817b235c1SYuval Mintz 172917b235c1SYuval Mintz if (rc) { 173017b235c1SYuval Mintz status = PFVF_STATUS_FAILURE; 173117b235c1SYuval Mintz break; 173217b235c1SYuval Mintz } 173317b235c1SYuval Mintz } 173417b235c1SYuval Mintz 173517b235c1SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_UPDATE_RXQ, 173617b235c1SYuval Mintz length, status); 173717b235c1SYuval Mintz } 173817b235c1SYuval Mintz 1739dacd88d6SYuval Mintz void *qed_iov_search_list_tlvs(struct qed_hwfn *p_hwfn, 1740dacd88d6SYuval Mintz void *p_tlvs_list, u16 req_type) 1741dacd88d6SYuval Mintz { 1742dacd88d6SYuval Mintz struct channel_tlv *p_tlv = (struct channel_tlv *)p_tlvs_list; 1743dacd88d6SYuval Mintz int len = 0; 1744dacd88d6SYuval Mintz 1745dacd88d6SYuval Mintz do { 1746dacd88d6SYuval Mintz if (!p_tlv->length) { 1747dacd88d6SYuval Mintz DP_NOTICE(p_hwfn, "Zero length TLV found\n"); 1748dacd88d6SYuval Mintz return NULL; 1749dacd88d6SYuval Mintz } 1750dacd88d6SYuval Mintz 1751dacd88d6SYuval Mintz if (p_tlv->type == req_type) { 1752dacd88d6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 1753dacd88d6SYuval Mintz "Extended tlv type %d, length %d found\n", 1754dacd88d6SYuval Mintz p_tlv->type, p_tlv->length); 1755dacd88d6SYuval Mintz return p_tlv; 1756dacd88d6SYuval Mintz } 1757dacd88d6SYuval Mintz 1758dacd88d6SYuval Mintz len += p_tlv->length; 1759dacd88d6SYuval Mintz p_tlv = (struct channel_tlv *)((u8 *)p_tlv + p_tlv->length); 1760dacd88d6SYuval Mintz 1761dacd88d6SYuval Mintz if ((len + p_tlv->length) > TLV_BUFFER_SIZE) { 1762dacd88d6SYuval Mintz DP_NOTICE(p_hwfn, "TLVs has overrun the buffer size\n"); 1763dacd88d6SYuval Mintz return NULL; 1764dacd88d6SYuval Mintz } 1765dacd88d6SYuval Mintz } while (p_tlv->type != CHANNEL_TLV_LIST_END); 1766dacd88d6SYuval Mintz 1767dacd88d6SYuval Mintz return NULL; 1768dacd88d6SYuval Mintz } 1769dacd88d6SYuval Mintz 1770dacd88d6SYuval Mintz static void 1771dacd88d6SYuval Mintz qed_iov_vp_update_act_param(struct qed_hwfn *p_hwfn, 1772dacd88d6SYuval Mintz struct qed_sp_vport_update_params *p_data, 1773dacd88d6SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 1774dacd88d6SYuval Mintz { 1775dacd88d6SYuval Mintz struct vfpf_vport_update_activate_tlv *p_act_tlv; 1776dacd88d6SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_ACTIVATE; 1777dacd88d6SYuval Mintz 1778dacd88d6SYuval Mintz p_act_tlv = (struct vfpf_vport_update_activate_tlv *) 1779dacd88d6SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, tlv); 1780dacd88d6SYuval Mintz if (!p_act_tlv) 1781dacd88d6SYuval Mintz return; 1782dacd88d6SYuval Mintz 1783dacd88d6SYuval Mintz p_data->update_vport_active_rx_flg = p_act_tlv->update_rx; 1784dacd88d6SYuval Mintz p_data->vport_active_rx_flg = p_act_tlv->active_rx; 1785dacd88d6SYuval Mintz p_data->update_vport_active_tx_flg = p_act_tlv->update_tx; 1786dacd88d6SYuval Mintz p_data->vport_active_tx_flg = p_act_tlv->active_tx; 1787dacd88d6SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_ACTIVATE; 1788dacd88d6SYuval Mintz } 1789dacd88d6SYuval Mintz 1790dacd88d6SYuval Mintz static void 179117b235c1SYuval Mintz qed_iov_vp_update_vlan_param(struct qed_hwfn *p_hwfn, 179217b235c1SYuval Mintz struct qed_sp_vport_update_params *p_data, 179317b235c1SYuval Mintz struct qed_vf_info *p_vf, 179417b235c1SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 179517b235c1SYuval Mintz { 179617b235c1SYuval Mintz struct vfpf_vport_update_vlan_strip_tlv *p_vlan_tlv; 179717b235c1SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_VLAN_STRIP; 179817b235c1SYuval Mintz 179917b235c1SYuval Mintz p_vlan_tlv = (struct vfpf_vport_update_vlan_strip_tlv *) 180017b235c1SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, tlv); 180117b235c1SYuval Mintz if (!p_vlan_tlv) 180217b235c1SYuval Mintz return; 180317b235c1SYuval Mintz 180408feecd7SYuval Mintz p_vf->shadow_config.inner_vlan_removal = p_vlan_tlv->remove_vlan; 180508feecd7SYuval Mintz 180608feecd7SYuval Mintz /* Ignore the VF request if we're forcing a vlan */ 180708feecd7SYuval Mintz if (!(p_vf->configured_features & (1 << VLAN_ADDR_FORCED))) { 180817b235c1SYuval Mintz p_data->update_inner_vlan_removal_flg = 1; 180917b235c1SYuval Mintz p_data->inner_vlan_removal_flg = p_vlan_tlv->remove_vlan; 181008feecd7SYuval Mintz } 181117b235c1SYuval Mintz 181217b235c1SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_VLAN_STRIP; 181317b235c1SYuval Mintz } 181417b235c1SYuval Mintz 181517b235c1SYuval Mintz static void 181617b235c1SYuval Mintz qed_iov_vp_update_tx_switch(struct qed_hwfn *p_hwfn, 181717b235c1SYuval Mintz struct qed_sp_vport_update_params *p_data, 181817b235c1SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 181917b235c1SYuval Mintz { 182017b235c1SYuval Mintz struct vfpf_vport_update_tx_switch_tlv *p_tx_switch_tlv; 182117b235c1SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_TX_SWITCH; 182217b235c1SYuval Mintz 182317b235c1SYuval Mintz p_tx_switch_tlv = (struct vfpf_vport_update_tx_switch_tlv *) 182417b235c1SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, 182517b235c1SYuval Mintz tlv); 182617b235c1SYuval Mintz if (!p_tx_switch_tlv) 182717b235c1SYuval Mintz return; 182817b235c1SYuval Mintz 182917b235c1SYuval Mintz p_data->update_tx_switching_flg = 1; 183017b235c1SYuval Mintz p_data->tx_switching_flg = p_tx_switch_tlv->tx_switching; 183117b235c1SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_TX_SWITCH; 183217b235c1SYuval Mintz } 183317b235c1SYuval Mintz 183417b235c1SYuval Mintz static void 1835dacd88d6SYuval Mintz qed_iov_vp_update_mcast_bin_param(struct qed_hwfn *p_hwfn, 1836dacd88d6SYuval Mintz struct qed_sp_vport_update_params *p_data, 1837dacd88d6SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 1838dacd88d6SYuval Mintz { 1839dacd88d6SYuval Mintz struct vfpf_vport_update_mcast_bin_tlv *p_mcast_tlv; 1840dacd88d6SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_MCAST; 1841dacd88d6SYuval Mintz 1842dacd88d6SYuval Mintz p_mcast_tlv = (struct vfpf_vport_update_mcast_bin_tlv *) 1843dacd88d6SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, tlv); 1844dacd88d6SYuval Mintz if (!p_mcast_tlv) 1845dacd88d6SYuval Mintz return; 1846dacd88d6SYuval Mintz 1847dacd88d6SYuval Mintz p_data->update_approx_mcast_flg = 1; 1848dacd88d6SYuval Mintz memcpy(p_data->bins, p_mcast_tlv->bins, 1849dacd88d6SYuval Mintz sizeof(unsigned long) * ETH_MULTICAST_MAC_BINS_IN_REGS); 1850dacd88d6SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_MCAST; 1851dacd88d6SYuval Mintz } 1852dacd88d6SYuval Mintz 1853dacd88d6SYuval Mintz static void 1854dacd88d6SYuval Mintz qed_iov_vp_update_accept_flag(struct qed_hwfn *p_hwfn, 1855dacd88d6SYuval Mintz struct qed_sp_vport_update_params *p_data, 1856dacd88d6SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 1857dacd88d6SYuval Mintz { 1858dacd88d6SYuval Mintz struct qed_filter_accept_flags *p_flags = &p_data->accept_flags; 1859dacd88d6SYuval Mintz struct vfpf_vport_update_accept_param_tlv *p_accept_tlv; 1860dacd88d6SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_ACCEPT_PARAM; 1861dacd88d6SYuval Mintz 1862dacd88d6SYuval Mintz p_accept_tlv = (struct vfpf_vport_update_accept_param_tlv *) 1863dacd88d6SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, tlv); 1864dacd88d6SYuval Mintz if (!p_accept_tlv) 1865dacd88d6SYuval Mintz return; 1866dacd88d6SYuval Mintz 1867dacd88d6SYuval Mintz p_flags->update_rx_mode_config = p_accept_tlv->update_rx_mode; 1868dacd88d6SYuval Mintz p_flags->rx_accept_filter = p_accept_tlv->rx_accept_filter; 1869dacd88d6SYuval Mintz p_flags->update_tx_mode_config = p_accept_tlv->update_tx_mode; 1870dacd88d6SYuval Mintz p_flags->tx_accept_filter = p_accept_tlv->tx_accept_filter; 1871dacd88d6SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_ACCEPT_PARAM; 1872dacd88d6SYuval Mintz } 1873dacd88d6SYuval Mintz 1874dacd88d6SYuval Mintz static void 187517b235c1SYuval Mintz qed_iov_vp_update_accept_any_vlan(struct qed_hwfn *p_hwfn, 187617b235c1SYuval Mintz struct qed_sp_vport_update_params *p_data, 187717b235c1SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 187817b235c1SYuval Mintz { 187917b235c1SYuval Mintz struct vfpf_vport_update_accept_any_vlan_tlv *p_accept_any_vlan; 188017b235c1SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_ACCEPT_ANY_VLAN; 188117b235c1SYuval Mintz 188217b235c1SYuval Mintz p_accept_any_vlan = (struct vfpf_vport_update_accept_any_vlan_tlv *) 188317b235c1SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, 188417b235c1SYuval Mintz tlv); 188517b235c1SYuval Mintz if (!p_accept_any_vlan) 188617b235c1SYuval Mintz return; 188717b235c1SYuval Mintz 188817b235c1SYuval Mintz p_data->accept_any_vlan = p_accept_any_vlan->accept_any_vlan; 188917b235c1SYuval Mintz p_data->update_accept_any_vlan_flg = 189017b235c1SYuval Mintz p_accept_any_vlan->update_accept_any_vlan_flg; 189117b235c1SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_ACCEPT_ANY_VLAN; 189217b235c1SYuval Mintz } 189317b235c1SYuval Mintz 189417b235c1SYuval Mintz static void 1895dacd88d6SYuval Mintz qed_iov_vp_update_rss_param(struct qed_hwfn *p_hwfn, 1896dacd88d6SYuval Mintz struct qed_vf_info *vf, 1897dacd88d6SYuval Mintz struct qed_sp_vport_update_params *p_data, 1898dacd88d6SYuval Mintz struct qed_rss_params *p_rss, 1899dacd88d6SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 1900dacd88d6SYuval Mintz { 1901dacd88d6SYuval Mintz struct vfpf_vport_update_rss_tlv *p_rss_tlv; 1902dacd88d6SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_RSS; 1903dacd88d6SYuval Mintz u16 i, q_idx, max_q_idx; 1904dacd88d6SYuval Mintz u16 table_size; 1905dacd88d6SYuval Mintz 1906dacd88d6SYuval Mintz p_rss_tlv = (struct vfpf_vport_update_rss_tlv *) 1907dacd88d6SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, tlv); 1908dacd88d6SYuval Mintz if (!p_rss_tlv) { 1909dacd88d6SYuval Mintz p_data->rss_params = NULL; 1910dacd88d6SYuval Mintz return; 1911dacd88d6SYuval Mintz } 1912dacd88d6SYuval Mintz 1913dacd88d6SYuval Mintz memset(p_rss, 0, sizeof(struct qed_rss_params)); 1914dacd88d6SYuval Mintz 1915dacd88d6SYuval Mintz p_rss->update_rss_config = !!(p_rss_tlv->update_rss_flags & 1916dacd88d6SYuval Mintz VFPF_UPDATE_RSS_CONFIG_FLAG); 1917dacd88d6SYuval Mintz p_rss->update_rss_capabilities = !!(p_rss_tlv->update_rss_flags & 1918dacd88d6SYuval Mintz VFPF_UPDATE_RSS_CAPS_FLAG); 1919dacd88d6SYuval Mintz p_rss->update_rss_ind_table = !!(p_rss_tlv->update_rss_flags & 1920dacd88d6SYuval Mintz VFPF_UPDATE_RSS_IND_TABLE_FLAG); 1921dacd88d6SYuval Mintz p_rss->update_rss_key = !!(p_rss_tlv->update_rss_flags & 1922dacd88d6SYuval Mintz VFPF_UPDATE_RSS_KEY_FLAG); 1923dacd88d6SYuval Mintz 1924dacd88d6SYuval Mintz p_rss->rss_enable = p_rss_tlv->rss_enable; 1925dacd88d6SYuval Mintz p_rss->rss_eng_id = vf->relative_vf_id + 1; 1926dacd88d6SYuval Mintz p_rss->rss_caps = p_rss_tlv->rss_caps; 1927dacd88d6SYuval Mintz p_rss->rss_table_size_log = p_rss_tlv->rss_table_size_log; 1928dacd88d6SYuval Mintz memcpy(p_rss->rss_ind_table, p_rss_tlv->rss_ind_table, 1929dacd88d6SYuval Mintz sizeof(p_rss->rss_ind_table)); 1930dacd88d6SYuval Mintz memcpy(p_rss->rss_key, p_rss_tlv->rss_key, sizeof(p_rss->rss_key)); 1931dacd88d6SYuval Mintz 1932dacd88d6SYuval Mintz table_size = min_t(u16, ARRAY_SIZE(p_rss->rss_ind_table), 1933dacd88d6SYuval Mintz (1 << p_rss_tlv->rss_table_size_log)); 1934dacd88d6SYuval Mintz 1935dacd88d6SYuval Mintz max_q_idx = ARRAY_SIZE(vf->vf_queues); 1936dacd88d6SYuval Mintz 1937dacd88d6SYuval Mintz for (i = 0; i < table_size; i++) { 1938dacd88d6SYuval Mintz u16 index = vf->vf_queues[0].fw_rx_qid; 1939dacd88d6SYuval Mintz 1940dacd88d6SYuval Mintz q_idx = p_rss->rss_ind_table[i]; 1941dacd88d6SYuval Mintz if (q_idx >= max_q_idx) 1942dacd88d6SYuval Mintz DP_NOTICE(p_hwfn, 1943dacd88d6SYuval Mintz "rss_ind_table[%d] = %d, rxq is out of range\n", 1944dacd88d6SYuval Mintz i, q_idx); 1945dacd88d6SYuval Mintz else if (!vf->vf_queues[q_idx].rxq_active) 1946dacd88d6SYuval Mintz DP_NOTICE(p_hwfn, 1947dacd88d6SYuval Mintz "rss_ind_table[%d] = %d, rxq is not active\n", 1948dacd88d6SYuval Mintz i, q_idx); 1949dacd88d6SYuval Mintz else 1950dacd88d6SYuval Mintz index = vf->vf_queues[q_idx].fw_rx_qid; 1951dacd88d6SYuval Mintz p_rss->rss_ind_table[i] = index; 1952dacd88d6SYuval Mintz } 1953dacd88d6SYuval Mintz 1954dacd88d6SYuval Mintz p_data->rss_params = p_rss; 1955dacd88d6SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_RSS; 1956dacd88d6SYuval Mintz } 1957dacd88d6SYuval Mintz 195817b235c1SYuval Mintz static void 195917b235c1SYuval Mintz qed_iov_vp_update_sge_tpa_param(struct qed_hwfn *p_hwfn, 196017b235c1SYuval Mintz struct qed_vf_info *vf, 196117b235c1SYuval Mintz struct qed_sp_vport_update_params *p_data, 196217b235c1SYuval Mintz struct qed_sge_tpa_params *p_sge_tpa, 196317b235c1SYuval Mintz struct qed_iov_vf_mbx *p_mbx, u16 *tlvs_mask) 196417b235c1SYuval Mintz { 196517b235c1SYuval Mintz struct vfpf_vport_update_sge_tpa_tlv *p_sge_tpa_tlv; 196617b235c1SYuval Mintz u16 tlv = CHANNEL_TLV_VPORT_UPDATE_SGE_TPA; 196717b235c1SYuval Mintz 196817b235c1SYuval Mintz p_sge_tpa_tlv = (struct vfpf_vport_update_sge_tpa_tlv *) 196917b235c1SYuval Mintz qed_iov_search_list_tlvs(p_hwfn, p_mbx->req_virt, tlv); 197017b235c1SYuval Mintz 197117b235c1SYuval Mintz if (!p_sge_tpa_tlv) { 197217b235c1SYuval Mintz p_data->sge_tpa_params = NULL; 197317b235c1SYuval Mintz return; 197417b235c1SYuval Mintz } 197517b235c1SYuval Mintz 197617b235c1SYuval Mintz memset(p_sge_tpa, 0, sizeof(struct qed_sge_tpa_params)); 197717b235c1SYuval Mintz 197817b235c1SYuval Mintz p_sge_tpa->update_tpa_en_flg = 197917b235c1SYuval Mintz !!(p_sge_tpa_tlv->update_sge_tpa_flags & VFPF_UPDATE_TPA_EN_FLAG); 198017b235c1SYuval Mintz p_sge_tpa->update_tpa_param_flg = 198117b235c1SYuval Mintz !!(p_sge_tpa_tlv->update_sge_tpa_flags & 198217b235c1SYuval Mintz VFPF_UPDATE_TPA_PARAM_FLAG); 198317b235c1SYuval Mintz 198417b235c1SYuval Mintz p_sge_tpa->tpa_ipv4_en_flg = 198517b235c1SYuval Mintz !!(p_sge_tpa_tlv->sge_tpa_flags & VFPF_TPA_IPV4_EN_FLAG); 198617b235c1SYuval Mintz p_sge_tpa->tpa_ipv6_en_flg = 198717b235c1SYuval Mintz !!(p_sge_tpa_tlv->sge_tpa_flags & VFPF_TPA_IPV6_EN_FLAG); 198817b235c1SYuval Mintz p_sge_tpa->tpa_pkt_split_flg = 198917b235c1SYuval Mintz !!(p_sge_tpa_tlv->sge_tpa_flags & VFPF_TPA_PKT_SPLIT_FLAG); 199017b235c1SYuval Mintz p_sge_tpa->tpa_hdr_data_split_flg = 199117b235c1SYuval Mintz !!(p_sge_tpa_tlv->sge_tpa_flags & VFPF_TPA_HDR_DATA_SPLIT_FLAG); 199217b235c1SYuval Mintz p_sge_tpa->tpa_gro_consistent_flg = 199317b235c1SYuval Mintz !!(p_sge_tpa_tlv->sge_tpa_flags & VFPF_TPA_GRO_CONSIST_FLAG); 199417b235c1SYuval Mintz 199517b235c1SYuval Mintz p_sge_tpa->tpa_max_aggs_num = p_sge_tpa_tlv->tpa_max_aggs_num; 199617b235c1SYuval Mintz p_sge_tpa->tpa_max_size = p_sge_tpa_tlv->tpa_max_size; 199717b235c1SYuval Mintz p_sge_tpa->tpa_min_size_to_start = p_sge_tpa_tlv->tpa_min_size_to_start; 199817b235c1SYuval Mintz p_sge_tpa->tpa_min_size_to_cont = p_sge_tpa_tlv->tpa_min_size_to_cont; 199917b235c1SYuval Mintz p_sge_tpa->max_buffers_per_cqe = p_sge_tpa_tlv->max_buffers_per_cqe; 200017b235c1SYuval Mintz 200117b235c1SYuval Mintz p_data->sge_tpa_params = p_sge_tpa; 200217b235c1SYuval Mintz 200317b235c1SYuval Mintz *tlvs_mask |= 1 << QED_IOV_VP_UPDATE_SGE_TPA; 200417b235c1SYuval Mintz } 200517b235c1SYuval Mintz 2006dacd88d6SYuval Mintz static void qed_iov_vf_mbx_vport_update(struct qed_hwfn *p_hwfn, 2007dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 2008dacd88d6SYuval Mintz struct qed_vf_info *vf) 2009dacd88d6SYuval Mintz { 2010dacd88d6SYuval Mintz struct qed_sp_vport_update_params params; 2011dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 201217b235c1SYuval Mintz struct qed_sge_tpa_params sge_tpa_params; 2013dacd88d6SYuval Mintz struct qed_rss_params rss_params; 2014dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 2015dacd88d6SYuval Mintz u16 tlvs_mask = 0; 2016dacd88d6SYuval Mintz u16 length; 2017dacd88d6SYuval Mintz int rc; 2018dacd88d6SYuval Mintz 2019dacd88d6SYuval Mintz memset(¶ms, 0, sizeof(params)); 2020dacd88d6SYuval Mintz params.opaque_fid = vf->opaque_fid; 2021dacd88d6SYuval Mintz params.vport_id = vf->vport_id; 2022dacd88d6SYuval Mintz params.rss_params = NULL; 2023dacd88d6SYuval Mintz 2024dacd88d6SYuval Mintz /* Search for extended tlvs list and update values 2025dacd88d6SYuval Mintz * from VF in struct qed_sp_vport_update_params. 2026dacd88d6SYuval Mintz */ 2027dacd88d6SYuval Mintz qed_iov_vp_update_act_param(p_hwfn, ¶ms, mbx, &tlvs_mask); 202817b235c1SYuval Mintz qed_iov_vp_update_vlan_param(p_hwfn, ¶ms, vf, mbx, &tlvs_mask); 202917b235c1SYuval Mintz qed_iov_vp_update_tx_switch(p_hwfn, ¶ms, mbx, &tlvs_mask); 2030dacd88d6SYuval Mintz qed_iov_vp_update_mcast_bin_param(p_hwfn, ¶ms, mbx, &tlvs_mask); 2031dacd88d6SYuval Mintz qed_iov_vp_update_accept_flag(p_hwfn, ¶ms, mbx, &tlvs_mask); 2032dacd88d6SYuval Mintz qed_iov_vp_update_rss_param(p_hwfn, vf, ¶ms, &rss_params, 2033dacd88d6SYuval Mintz mbx, &tlvs_mask); 203417b235c1SYuval Mintz qed_iov_vp_update_accept_any_vlan(p_hwfn, ¶ms, mbx, &tlvs_mask); 203517b235c1SYuval Mintz qed_iov_vp_update_sge_tpa_param(p_hwfn, vf, ¶ms, 203617b235c1SYuval Mintz &sge_tpa_params, mbx, &tlvs_mask); 2037dacd88d6SYuval Mintz 2038dacd88d6SYuval Mintz /* Just log a message if there is no single extended tlv in buffer. 2039dacd88d6SYuval Mintz * When all features of vport update ramrod would be requested by VF 2040dacd88d6SYuval Mintz * as extended TLVs in buffer then an error can be returned in response 2041dacd88d6SYuval Mintz * if there is no extended TLV present in buffer. 2042dacd88d6SYuval Mintz */ 2043dacd88d6SYuval Mintz if (!tlvs_mask) { 2044dacd88d6SYuval Mintz DP_NOTICE(p_hwfn, 2045dacd88d6SYuval Mintz "No feature tlvs found for vport update\n"); 2046dacd88d6SYuval Mintz status = PFVF_STATUS_NOT_SUPPORTED; 2047dacd88d6SYuval Mintz goto out; 2048dacd88d6SYuval Mintz } 2049dacd88d6SYuval Mintz 2050dacd88d6SYuval Mintz rc = qed_sp_vport_update(p_hwfn, ¶ms, QED_SPQ_MODE_EBLOCK, NULL); 2051dacd88d6SYuval Mintz 2052dacd88d6SYuval Mintz if (rc) 2053dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 2054dacd88d6SYuval Mintz 2055dacd88d6SYuval Mintz out: 2056dacd88d6SYuval Mintz length = qed_iov_prep_vp_update_resp_tlvs(p_hwfn, vf, mbx, status, 2057dacd88d6SYuval Mintz tlvs_mask, tlvs_mask); 2058dacd88d6SYuval Mintz qed_iov_send_response(p_hwfn, p_ptt, vf, length, status); 2059dacd88d6SYuval Mintz } 2060dacd88d6SYuval Mintz 206108feecd7SYuval Mintz static int qed_iov_vf_update_unicast_shadow(struct qed_hwfn *p_hwfn, 206208feecd7SYuval Mintz struct qed_vf_info *p_vf, 206308feecd7SYuval Mintz struct qed_filter_ucast *p_params) 206408feecd7SYuval Mintz { 206508feecd7SYuval Mintz int i; 206608feecd7SYuval Mintz 206708feecd7SYuval Mintz if (p_params->type == QED_FILTER_MAC) 206808feecd7SYuval Mintz return 0; 206908feecd7SYuval Mintz 207008feecd7SYuval Mintz /* First remove entries and then add new ones */ 207108feecd7SYuval Mintz if (p_params->opcode == QED_FILTER_REMOVE) { 207208feecd7SYuval Mintz for (i = 0; i < QED_ETH_VF_NUM_VLAN_FILTERS + 1; i++) 207308feecd7SYuval Mintz if (p_vf->shadow_config.vlans[i].used && 207408feecd7SYuval Mintz p_vf->shadow_config.vlans[i].vid == 207508feecd7SYuval Mintz p_params->vlan) { 207608feecd7SYuval Mintz p_vf->shadow_config.vlans[i].used = false; 207708feecd7SYuval Mintz break; 207808feecd7SYuval Mintz } 207908feecd7SYuval Mintz if (i == QED_ETH_VF_NUM_VLAN_FILTERS + 1) { 208008feecd7SYuval Mintz DP_VERBOSE(p_hwfn, 208108feecd7SYuval Mintz QED_MSG_IOV, 208208feecd7SYuval Mintz "VF [%d] - Tries to remove a non-existing vlan\n", 208308feecd7SYuval Mintz p_vf->relative_vf_id); 208408feecd7SYuval Mintz return -EINVAL; 208508feecd7SYuval Mintz } 208608feecd7SYuval Mintz } else if (p_params->opcode == QED_FILTER_REPLACE || 208708feecd7SYuval Mintz p_params->opcode == QED_FILTER_FLUSH) { 208808feecd7SYuval Mintz for (i = 0; i < QED_ETH_VF_NUM_VLAN_FILTERS + 1; i++) 208908feecd7SYuval Mintz p_vf->shadow_config.vlans[i].used = false; 209008feecd7SYuval Mintz } 209108feecd7SYuval Mintz 209208feecd7SYuval Mintz /* In forced mode, we're willing to remove entries - but we don't add 209308feecd7SYuval Mintz * new ones. 209408feecd7SYuval Mintz */ 209508feecd7SYuval Mintz if (p_vf->bulletin.p_virt->valid_bitmap & (1 << VLAN_ADDR_FORCED)) 209608feecd7SYuval Mintz return 0; 209708feecd7SYuval Mintz 209808feecd7SYuval Mintz if (p_params->opcode == QED_FILTER_ADD || 209908feecd7SYuval Mintz p_params->opcode == QED_FILTER_REPLACE) { 210008feecd7SYuval Mintz for (i = 0; i < QED_ETH_VF_NUM_VLAN_FILTERS + 1; i++) { 210108feecd7SYuval Mintz if (p_vf->shadow_config.vlans[i].used) 210208feecd7SYuval Mintz continue; 210308feecd7SYuval Mintz 210408feecd7SYuval Mintz p_vf->shadow_config.vlans[i].used = true; 210508feecd7SYuval Mintz p_vf->shadow_config.vlans[i].vid = p_params->vlan; 210608feecd7SYuval Mintz break; 210708feecd7SYuval Mintz } 210808feecd7SYuval Mintz 210908feecd7SYuval Mintz if (i == QED_ETH_VF_NUM_VLAN_FILTERS + 1) { 211008feecd7SYuval Mintz DP_VERBOSE(p_hwfn, 211108feecd7SYuval Mintz QED_MSG_IOV, 211208feecd7SYuval Mintz "VF [%d] - Tries to configure more than %d vlan filters\n", 211308feecd7SYuval Mintz p_vf->relative_vf_id, 211408feecd7SYuval Mintz QED_ETH_VF_NUM_VLAN_FILTERS + 1); 211508feecd7SYuval Mintz return -EINVAL; 211608feecd7SYuval Mintz } 211708feecd7SYuval Mintz } 211808feecd7SYuval Mintz 211908feecd7SYuval Mintz return 0; 212008feecd7SYuval Mintz } 212108feecd7SYuval Mintz 2122dacd88d6SYuval Mintz int qed_iov_chk_ucast(struct qed_hwfn *hwfn, 2123dacd88d6SYuval Mintz int vfid, struct qed_filter_ucast *params) 2124dacd88d6SYuval Mintz { 2125dacd88d6SYuval Mintz struct qed_public_vf_info *vf; 2126dacd88d6SYuval Mintz 2127dacd88d6SYuval Mintz vf = qed_iov_get_public_vf_info(hwfn, vfid, true); 2128dacd88d6SYuval Mintz if (!vf) 2129dacd88d6SYuval Mintz return -EINVAL; 2130dacd88d6SYuval Mintz 2131dacd88d6SYuval Mintz /* No real decision to make; Store the configured MAC */ 2132dacd88d6SYuval Mintz if (params->type == QED_FILTER_MAC || 2133dacd88d6SYuval Mintz params->type == QED_FILTER_MAC_VLAN) 2134dacd88d6SYuval Mintz ether_addr_copy(vf->mac, params->mac); 2135dacd88d6SYuval Mintz 2136dacd88d6SYuval Mintz return 0; 2137dacd88d6SYuval Mintz } 2138dacd88d6SYuval Mintz 2139dacd88d6SYuval Mintz static void qed_iov_vf_mbx_ucast_filter(struct qed_hwfn *p_hwfn, 2140dacd88d6SYuval Mintz struct qed_ptt *p_ptt, 2141dacd88d6SYuval Mintz struct qed_vf_info *vf) 2142dacd88d6SYuval Mintz { 214308feecd7SYuval Mintz struct qed_bulletin_content *p_bulletin = vf->bulletin.p_virt; 2144dacd88d6SYuval Mintz struct qed_iov_vf_mbx *mbx = &vf->vf_mbx; 2145dacd88d6SYuval Mintz struct vfpf_ucast_filter_tlv *req; 2146dacd88d6SYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 2147dacd88d6SYuval Mintz struct qed_filter_ucast params; 2148dacd88d6SYuval Mintz int rc; 2149dacd88d6SYuval Mintz 2150dacd88d6SYuval Mintz /* Prepare the unicast filter params */ 2151dacd88d6SYuval Mintz memset(¶ms, 0, sizeof(struct qed_filter_ucast)); 2152dacd88d6SYuval Mintz req = &mbx->req_virt->ucast_filter; 2153dacd88d6SYuval Mintz params.opcode = (enum qed_filter_opcode)req->opcode; 2154dacd88d6SYuval Mintz params.type = (enum qed_filter_ucast_type)req->type; 2155dacd88d6SYuval Mintz 2156dacd88d6SYuval Mintz params.is_rx_filter = 1; 2157dacd88d6SYuval Mintz params.is_tx_filter = 1; 2158dacd88d6SYuval Mintz params.vport_to_remove_from = vf->vport_id; 2159dacd88d6SYuval Mintz params.vport_to_add_to = vf->vport_id; 2160dacd88d6SYuval Mintz memcpy(params.mac, req->mac, ETH_ALEN); 2161dacd88d6SYuval Mintz params.vlan = req->vlan; 2162dacd88d6SYuval Mintz 2163dacd88d6SYuval Mintz DP_VERBOSE(p_hwfn, 2164dacd88d6SYuval Mintz QED_MSG_IOV, 2165dacd88d6SYuval Mintz "VF[%d]: opcode 0x%02x type 0x%02x [%s %s] [vport 0x%02x] MAC %02x:%02x:%02x:%02x:%02x:%02x, vlan 0x%04x\n", 2166dacd88d6SYuval Mintz vf->abs_vf_id, params.opcode, params.type, 2167dacd88d6SYuval Mintz params.is_rx_filter ? "RX" : "", 2168dacd88d6SYuval Mintz params.is_tx_filter ? "TX" : "", 2169dacd88d6SYuval Mintz params.vport_to_add_to, 2170dacd88d6SYuval Mintz params.mac[0], params.mac[1], 2171dacd88d6SYuval Mintz params.mac[2], params.mac[3], 2172dacd88d6SYuval Mintz params.mac[4], params.mac[5], params.vlan); 2173dacd88d6SYuval Mintz 2174dacd88d6SYuval Mintz if (!vf->vport_instance) { 2175dacd88d6SYuval Mintz DP_VERBOSE(p_hwfn, 2176dacd88d6SYuval Mintz QED_MSG_IOV, 2177dacd88d6SYuval Mintz "No VPORT instance available for VF[%d], failing ucast MAC configuration\n", 2178dacd88d6SYuval Mintz vf->abs_vf_id); 2179dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 2180dacd88d6SYuval Mintz goto out; 2181dacd88d6SYuval Mintz } 2182dacd88d6SYuval Mintz 218308feecd7SYuval Mintz /* Update shadow copy of the VF configuration */ 218408feecd7SYuval Mintz if (qed_iov_vf_update_unicast_shadow(p_hwfn, vf, ¶ms)) { 218508feecd7SYuval Mintz status = PFVF_STATUS_FAILURE; 218608feecd7SYuval Mintz goto out; 218708feecd7SYuval Mintz } 218808feecd7SYuval Mintz 218908feecd7SYuval Mintz /* Determine if the unicast filtering is acceptible by PF */ 219008feecd7SYuval Mintz if ((p_bulletin->valid_bitmap & (1 << VLAN_ADDR_FORCED)) && 219108feecd7SYuval Mintz (params.type == QED_FILTER_VLAN || 219208feecd7SYuval Mintz params.type == QED_FILTER_MAC_VLAN)) { 219308feecd7SYuval Mintz /* Once VLAN is forced or PVID is set, do not allow 219408feecd7SYuval Mintz * to add/replace any further VLANs. 219508feecd7SYuval Mintz */ 219608feecd7SYuval Mintz if (params.opcode == QED_FILTER_ADD || 219708feecd7SYuval Mintz params.opcode == QED_FILTER_REPLACE) 219808feecd7SYuval Mintz status = PFVF_STATUS_FORCED; 219908feecd7SYuval Mintz goto out; 220008feecd7SYuval Mintz } 220108feecd7SYuval Mintz 2202dacd88d6SYuval Mintz rc = qed_iov_chk_ucast(p_hwfn, vf->relative_vf_id, ¶ms); 2203dacd88d6SYuval Mintz if (rc) { 2204dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 2205dacd88d6SYuval Mintz goto out; 2206dacd88d6SYuval Mintz } 2207dacd88d6SYuval Mintz 2208dacd88d6SYuval Mintz rc = qed_sp_eth_filter_ucast(p_hwfn, vf->opaque_fid, ¶ms, 2209dacd88d6SYuval Mintz QED_SPQ_MODE_CB, NULL); 2210dacd88d6SYuval Mintz if (rc) 2211dacd88d6SYuval Mintz status = PFVF_STATUS_FAILURE; 2212dacd88d6SYuval Mintz 2213dacd88d6SYuval Mintz out: 2214dacd88d6SYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_UCAST_FILTER, 2215dacd88d6SYuval Mintz sizeof(struct pfvf_def_resp_tlv), status); 2216dacd88d6SYuval Mintz } 2217dacd88d6SYuval Mintz 22180b55e27dSYuval Mintz static void qed_iov_vf_mbx_int_cleanup(struct qed_hwfn *p_hwfn, 22190b55e27dSYuval Mintz struct qed_ptt *p_ptt, 22200b55e27dSYuval Mintz struct qed_vf_info *vf) 22210b55e27dSYuval Mintz { 22220b55e27dSYuval Mintz int i; 22230b55e27dSYuval Mintz 22240b55e27dSYuval Mintz /* Reset the SBs */ 22250b55e27dSYuval Mintz for (i = 0; i < vf->num_sbs; i++) 22260b55e27dSYuval Mintz qed_int_igu_init_pure_rt_single(p_hwfn, p_ptt, 22270b55e27dSYuval Mintz vf->igu_sbs[i], 22280b55e27dSYuval Mintz vf->opaque_fid, false); 22290b55e27dSYuval Mintz 22300b55e27dSYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_INT_CLEANUP, 22310b55e27dSYuval Mintz sizeof(struct pfvf_def_resp_tlv), 22320b55e27dSYuval Mintz PFVF_STATUS_SUCCESS); 22330b55e27dSYuval Mintz } 22340b55e27dSYuval Mintz 22350b55e27dSYuval Mintz static void qed_iov_vf_mbx_close(struct qed_hwfn *p_hwfn, 22360b55e27dSYuval Mintz struct qed_ptt *p_ptt, struct qed_vf_info *vf) 22370b55e27dSYuval Mintz { 22380b55e27dSYuval Mintz u16 length = sizeof(struct pfvf_def_resp_tlv); 22390b55e27dSYuval Mintz u8 status = PFVF_STATUS_SUCCESS; 22400b55e27dSYuval Mintz 22410b55e27dSYuval Mintz /* Disable Interrupts for VF */ 22420b55e27dSYuval Mintz qed_iov_vf_igu_set_int(p_hwfn, p_ptt, vf, 0); 22430b55e27dSYuval Mintz 22440b55e27dSYuval Mintz /* Reset Permission table */ 22450b55e27dSYuval Mintz qed_iov_config_perm_table(p_hwfn, p_ptt, vf, 0); 22460b55e27dSYuval Mintz 22470b55e27dSYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, vf, CHANNEL_TLV_CLOSE, 22480b55e27dSYuval Mintz length, status); 22490b55e27dSYuval Mintz } 22500b55e27dSYuval Mintz 22510b55e27dSYuval Mintz static void qed_iov_vf_mbx_release(struct qed_hwfn *p_hwfn, 22520b55e27dSYuval Mintz struct qed_ptt *p_ptt, 22530b55e27dSYuval Mintz struct qed_vf_info *p_vf) 22540b55e27dSYuval Mintz { 22550b55e27dSYuval Mintz u16 length = sizeof(struct pfvf_def_resp_tlv); 22560b55e27dSYuval Mintz 22570b55e27dSYuval Mintz qed_iov_vf_cleanup(p_hwfn, p_vf); 22580b55e27dSYuval Mintz 22590b55e27dSYuval Mintz qed_iov_prepare_resp(p_hwfn, p_ptt, p_vf, CHANNEL_TLV_RELEASE, 22600b55e27dSYuval Mintz length, PFVF_STATUS_SUCCESS); 22610b55e27dSYuval Mintz } 22620b55e27dSYuval Mintz 22630b55e27dSYuval Mintz static int 22640b55e27dSYuval Mintz qed_iov_vf_flr_poll_dorq(struct qed_hwfn *p_hwfn, 22650b55e27dSYuval Mintz struct qed_vf_info *p_vf, struct qed_ptt *p_ptt) 22660b55e27dSYuval Mintz { 22670b55e27dSYuval Mintz int cnt; 22680b55e27dSYuval Mintz u32 val; 22690b55e27dSYuval Mintz 22700b55e27dSYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) p_vf->concrete_fid); 22710b55e27dSYuval Mintz 22720b55e27dSYuval Mintz for (cnt = 0; cnt < 50; cnt++) { 22730b55e27dSYuval Mintz val = qed_rd(p_hwfn, p_ptt, DORQ_REG_VF_USAGE_CNT); 22740b55e27dSYuval Mintz if (!val) 22750b55e27dSYuval Mintz break; 22760b55e27dSYuval Mintz msleep(20); 22770b55e27dSYuval Mintz } 22780b55e27dSYuval Mintz qed_fid_pretend(p_hwfn, p_ptt, (u16) p_hwfn->hw_info.concrete_fid); 22790b55e27dSYuval Mintz 22800b55e27dSYuval Mintz if (cnt == 50) { 22810b55e27dSYuval Mintz DP_ERR(p_hwfn, 22820b55e27dSYuval Mintz "VF[%d] - dorq failed to cleanup [usage 0x%08x]\n", 22830b55e27dSYuval Mintz p_vf->abs_vf_id, val); 22840b55e27dSYuval Mintz return -EBUSY; 22850b55e27dSYuval Mintz } 22860b55e27dSYuval Mintz 22870b55e27dSYuval Mintz return 0; 22880b55e27dSYuval Mintz } 22890b55e27dSYuval Mintz 22900b55e27dSYuval Mintz static int 22910b55e27dSYuval Mintz qed_iov_vf_flr_poll_pbf(struct qed_hwfn *p_hwfn, 22920b55e27dSYuval Mintz struct qed_vf_info *p_vf, struct qed_ptt *p_ptt) 22930b55e27dSYuval Mintz { 22940b55e27dSYuval Mintz u32 cons[MAX_NUM_VOQS], distance[MAX_NUM_VOQS]; 22950b55e27dSYuval Mintz int i, cnt; 22960b55e27dSYuval Mintz 22970b55e27dSYuval Mintz /* Read initial consumers & producers */ 22980b55e27dSYuval Mintz for (i = 0; i < MAX_NUM_VOQS; i++) { 22990b55e27dSYuval Mintz u32 prod; 23000b55e27dSYuval Mintz 23010b55e27dSYuval Mintz cons[i] = qed_rd(p_hwfn, p_ptt, 23020b55e27dSYuval Mintz PBF_REG_NUM_BLOCKS_ALLOCATED_CONS_VOQ0 + 23030b55e27dSYuval Mintz i * 0x40); 23040b55e27dSYuval Mintz prod = qed_rd(p_hwfn, p_ptt, 23050b55e27dSYuval Mintz PBF_REG_NUM_BLOCKS_ALLOCATED_PROD_VOQ0 + 23060b55e27dSYuval Mintz i * 0x40); 23070b55e27dSYuval Mintz distance[i] = prod - cons[i]; 23080b55e27dSYuval Mintz } 23090b55e27dSYuval Mintz 23100b55e27dSYuval Mintz /* Wait for consumers to pass the producers */ 23110b55e27dSYuval Mintz i = 0; 23120b55e27dSYuval Mintz for (cnt = 0; cnt < 50; cnt++) { 23130b55e27dSYuval Mintz for (; i < MAX_NUM_VOQS; i++) { 23140b55e27dSYuval Mintz u32 tmp; 23150b55e27dSYuval Mintz 23160b55e27dSYuval Mintz tmp = qed_rd(p_hwfn, p_ptt, 23170b55e27dSYuval Mintz PBF_REG_NUM_BLOCKS_ALLOCATED_CONS_VOQ0 + 23180b55e27dSYuval Mintz i * 0x40); 23190b55e27dSYuval Mintz if (distance[i] > tmp - cons[i]) 23200b55e27dSYuval Mintz break; 23210b55e27dSYuval Mintz } 23220b55e27dSYuval Mintz 23230b55e27dSYuval Mintz if (i == MAX_NUM_VOQS) 23240b55e27dSYuval Mintz break; 23250b55e27dSYuval Mintz 23260b55e27dSYuval Mintz msleep(20); 23270b55e27dSYuval Mintz } 23280b55e27dSYuval Mintz 23290b55e27dSYuval Mintz if (cnt == 50) { 23300b55e27dSYuval Mintz DP_ERR(p_hwfn, "VF[%d] - pbf polling failed on VOQ %d\n", 23310b55e27dSYuval Mintz p_vf->abs_vf_id, i); 23320b55e27dSYuval Mintz return -EBUSY; 23330b55e27dSYuval Mintz } 23340b55e27dSYuval Mintz 23350b55e27dSYuval Mintz return 0; 23360b55e27dSYuval Mintz } 23370b55e27dSYuval Mintz 23380b55e27dSYuval Mintz static int qed_iov_vf_flr_poll(struct qed_hwfn *p_hwfn, 23390b55e27dSYuval Mintz struct qed_vf_info *p_vf, struct qed_ptt *p_ptt) 23400b55e27dSYuval Mintz { 23410b55e27dSYuval Mintz int rc; 23420b55e27dSYuval Mintz 23430b55e27dSYuval Mintz rc = qed_iov_vf_flr_poll_dorq(p_hwfn, p_vf, p_ptt); 23440b55e27dSYuval Mintz if (rc) 23450b55e27dSYuval Mintz return rc; 23460b55e27dSYuval Mintz 23470b55e27dSYuval Mintz rc = qed_iov_vf_flr_poll_pbf(p_hwfn, p_vf, p_ptt); 23480b55e27dSYuval Mintz if (rc) 23490b55e27dSYuval Mintz return rc; 23500b55e27dSYuval Mintz 23510b55e27dSYuval Mintz return 0; 23520b55e27dSYuval Mintz } 23530b55e27dSYuval Mintz 23540b55e27dSYuval Mintz static int 23550b55e27dSYuval Mintz qed_iov_execute_vf_flr_cleanup(struct qed_hwfn *p_hwfn, 23560b55e27dSYuval Mintz struct qed_ptt *p_ptt, 23570b55e27dSYuval Mintz u16 rel_vf_id, u32 *ack_vfs) 23580b55e27dSYuval Mintz { 23590b55e27dSYuval Mintz struct qed_vf_info *p_vf; 23600b55e27dSYuval Mintz int rc = 0; 23610b55e27dSYuval Mintz 23620b55e27dSYuval Mintz p_vf = qed_iov_get_vf_info(p_hwfn, rel_vf_id, false); 23630b55e27dSYuval Mintz if (!p_vf) 23640b55e27dSYuval Mintz return 0; 23650b55e27dSYuval Mintz 23660b55e27dSYuval Mintz if (p_hwfn->pf_iov_info->pending_flr[rel_vf_id / 64] & 23670b55e27dSYuval Mintz (1ULL << (rel_vf_id % 64))) { 23680b55e27dSYuval Mintz u16 vfid = p_vf->abs_vf_id; 23690b55e27dSYuval Mintz 23700b55e27dSYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 23710b55e27dSYuval Mintz "VF[%d] - Handling FLR\n", vfid); 23720b55e27dSYuval Mintz 23730b55e27dSYuval Mintz qed_iov_vf_cleanup(p_hwfn, p_vf); 23740b55e27dSYuval Mintz 23750b55e27dSYuval Mintz /* If VF isn't active, no need for anything but SW */ 23760b55e27dSYuval Mintz if (!p_vf->b_init) 23770b55e27dSYuval Mintz goto cleanup; 23780b55e27dSYuval Mintz 23790b55e27dSYuval Mintz rc = qed_iov_vf_flr_poll(p_hwfn, p_vf, p_ptt); 23800b55e27dSYuval Mintz if (rc) 23810b55e27dSYuval Mintz goto cleanup; 23820b55e27dSYuval Mintz 23830b55e27dSYuval Mintz rc = qed_final_cleanup(p_hwfn, p_ptt, vfid, true); 23840b55e27dSYuval Mintz if (rc) { 23850b55e27dSYuval Mintz DP_ERR(p_hwfn, "Failed handle FLR of VF[%d]\n", vfid); 23860b55e27dSYuval Mintz return rc; 23870b55e27dSYuval Mintz } 23880b55e27dSYuval Mintz 23890b55e27dSYuval Mintz /* VF_STOPPED has to be set only after final cleanup 23900b55e27dSYuval Mintz * but prior to re-enabling the VF. 23910b55e27dSYuval Mintz */ 23920b55e27dSYuval Mintz p_vf->state = VF_STOPPED; 23930b55e27dSYuval Mintz 23940b55e27dSYuval Mintz rc = qed_iov_enable_vf_access(p_hwfn, p_ptt, p_vf); 23950b55e27dSYuval Mintz if (rc) { 23960b55e27dSYuval Mintz DP_ERR(p_hwfn, "Failed to re-enable VF[%d] acces\n", 23970b55e27dSYuval Mintz vfid); 23980b55e27dSYuval Mintz return rc; 23990b55e27dSYuval Mintz } 24000b55e27dSYuval Mintz cleanup: 24010b55e27dSYuval Mintz /* Mark VF for ack and clean pending state */ 24020b55e27dSYuval Mintz if (p_vf->state == VF_RESET) 24030b55e27dSYuval Mintz p_vf->state = VF_STOPPED; 24040b55e27dSYuval Mintz ack_vfs[vfid / 32] |= (1 << (vfid % 32)); 24050b55e27dSYuval Mintz p_hwfn->pf_iov_info->pending_flr[rel_vf_id / 64] &= 24060b55e27dSYuval Mintz ~(1ULL << (rel_vf_id % 64)); 24070b55e27dSYuval Mintz p_hwfn->pf_iov_info->pending_events[rel_vf_id / 64] &= 24080b55e27dSYuval Mintz ~(1ULL << (rel_vf_id % 64)); 24090b55e27dSYuval Mintz } 24100b55e27dSYuval Mintz 24110b55e27dSYuval Mintz return rc; 24120b55e27dSYuval Mintz } 24130b55e27dSYuval Mintz 24140b55e27dSYuval Mintz int qed_iov_vf_flr_cleanup(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt) 24150b55e27dSYuval Mintz { 24160b55e27dSYuval Mintz u32 ack_vfs[VF_MAX_STATIC / 32]; 24170b55e27dSYuval Mintz int rc = 0; 24180b55e27dSYuval Mintz u16 i; 24190b55e27dSYuval Mintz 24200b55e27dSYuval Mintz memset(ack_vfs, 0, sizeof(u32) * (VF_MAX_STATIC / 32)); 24210b55e27dSYuval Mintz 24220b55e27dSYuval Mintz /* Since BRB <-> PRS interface can't be tested as part of the flr 24230b55e27dSYuval Mintz * polling due to HW limitations, simply sleep a bit. And since 24240b55e27dSYuval Mintz * there's no need to wait per-vf, do it before looping. 24250b55e27dSYuval Mintz */ 24260b55e27dSYuval Mintz msleep(100); 24270b55e27dSYuval Mintz 24280b55e27dSYuval Mintz for (i = 0; i < p_hwfn->cdev->p_iov_info->total_vfs; i++) 24290b55e27dSYuval Mintz qed_iov_execute_vf_flr_cleanup(p_hwfn, p_ptt, i, ack_vfs); 24300b55e27dSYuval Mintz 24310b55e27dSYuval Mintz rc = qed_mcp_ack_vf_flr(p_hwfn, p_ptt, ack_vfs); 24320b55e27dSYuval Mintz return rc; 24330b55e27dSYuval Mintz } 24340b55e27dSYuval Mintz 24350b55e27dSYuval Mintz int qed_iov_mark_vf_flr(struct qed_hwfn *p_hwfn, u32 *p_disabled_vfs) 24360b55e27dSYuval Mintz { 24370b55e27dSYuval Mintz u16 i, found = 0; 24380b55e27dSYuval Mintz 24390b55e27dSYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, "Marking FLR-ed VFs\n"); 24400b55e27dSYuval Mintz for (i = 0; i < (VF_MAX_STATIC / 32); i++) 24410b55e27dSYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 24420b55e27dSYuval Mintz "[%08x,...,%08x]: %08x\n", 24430b55e27dSYuval Mintz i * 32, (i + 1) * 32 - 1, p_disabled_vfs[i]); 24440b55e27dSYuval Mintz 24450b55e27dSYuval Mintz if (!p_hwfn->cdev->p_iov_info) { 24460b55e27dSYuval Mintz DP_NOTICE(p_hwfn, "VF flr but no IOV\n"); 24470b55e27dSYuval Mintz return 0; 24480b55e27dSYuval Mintz } 24490b55e27dSYuval Mintz 24500b55e27dSYuval Mintz /* Mark VFs */ 24510b55e27dSYuval Mintz for (i = 0; i < p_hwfn->cdev->p_iov_info->total_vfs; i++) { 24520b55e27dSYuval Mintz struct qed_vf_info *p_vf; 24530b55e27dSYuval Mintz u8 vfid; 24540b55e27dSYuval Mintz 24550b55e27dSYuval Mintz p_vf = qed_iov_get_vf_info(p_hwfn, i, false); 24560b55e27dSYuval Mintz if (!p_vf) 24570b55e27dSYuval Mintz continue; 24580b55e27dSYuval Mintz 24590b55e27dSYuval Mintz vfid = p_vf->abs_vf_id; 24600b55e27dSYuval Mintz if ((1 << (vfid % 32)) & p_disabled_vfs[vfid / 32]) { 24610b55e27dSYuval Mintz u64 *p_flr = p_hwfn->pf_iov_info->pending_flr; 24620b55e27dSYuval Mintz u16 rel_vf_id = p_vf->relative_vf_id; 24630b55e27dSYuval Mintz 24640b55e27dSYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 24650b55e27dSYuval Mintz "VF[%d] [rel %d] got FLR-ed\n", 24660b55e27dSYuval Mintz vfid, rel_vf_id); 24670b55e27dSYuval Mintz 24680b55e27dSYuval Mintz p_vf->state = VF_RESET; 24690b55e27dSYuval Mintz 24700b55e27dSYuval Mintz /* No need to lock here, since pending_flr should 24710b55e27dSYuval Mintz * only change here and before ACKing MFw. Since 24720b55e27dSYuval Mintz * MFW will not trigger an additional attention for 24730b55e27dSYuval Mintz * VF flr until ACKs, we're safe. 24740b55e27dSYuval Mintz */ 24750b55e27dSYuval Mintz p_flr[rel_vf_id / 64] |= 1ULL << (rel_vf_id % 64); 24760b55e27dSYuval Mintz found = 1; 24770b55e27dSYuval Mintz } 24780b55e27dSYuval Mintz } 24790b55e27dSYuval Mintz 24800b55e27dSYuval Mintz return found; 24810b55e27dSYuval Mintz } 24820b55e27dSYuval Mintz 248336558c3dSYuval Mintz void qed_iov_set_link(struct qed_hwfn *p_hwfn, 248436558c3dSYuval Mintz u16 vfid, 248536558c3dSYuval Mintz struct qed_mcp_link_params *params, 248636558c3dSYuval Mintz struct qed_mcp_link_state *link, 248736558c3dSYuval Mintz struct qed_mcp_link_capabilities *p_caps) 248836558c3dSYuval Mintz { 248936558c3dSYuval Mintz struct qed_vf_info *p_vf = qed_iov_get_vf_info(p_hwfn, 249036558c3dSYuval Mintz vfid, 249136558c3dSYuval Mintz false); 249236558c3dSYuval Mintz struct qed_bulletin_content *p_bulletin; 249336558c3dSYuval Mintz 249436558c3dSYuval Mintz if (!p_vf) 249536558c3dSYuval Mintz return; 249636558c3dSYuval Mintz 249736558c3dSYuval Mintz p_bulletin = p_vf->bulletin.p_virt; 249836558c3dSYuval Mintz p_bulletin->req_autoneg = params->speed.autoneg; 249936558c3dSYuval Mintz p_bulletin->req_adv_speed = params->speed.advertised_speeds; 250036558c3dSYuval Mintz p_bulletin->req_forced_speed = params->speed.forced_speed; 250136558c3dSYuval Mintz p_bulletin->req_autoneg_pause = params->pause.autoneg; 250236558c3dSYuval Mintz p_bulletin->req_forced_rx = params->pause.forced_rx; 250336558c3dSYuval Mintz p_bulletin->req_forced_tx = params->pause.forced_tx; 250436558c3dSYuval Mintz p_bulletin->req_loopback = params->loopback_mode; 250536558c3dSYuval Mintz 250636558c3dSYuval Mintz p_bulletin->link_up = link->link_up; 250736558c3dSYuval Mintz p_bulletin->speed = link->speed; 250836558c3dSYuval Mintz p_bulletin->full_duplex = link->full_duplex; 250936558c3dSYuval Mintz p_bulletin->autoneg = link->an; 251036558c3dSYuval Mintz p_bulletin->autoneg_complete = link->an_complete; 251136558c3dSYuval Mintz p_bulletin->parallel_detection = link->parallel_detection; 251236558c3dSYuval Mintz p_bulletin->pfc_enabled = link->pfc_enabled; 251336558c3dSYuval Mintz p_bulletin->partner_adv_speed = link->partner_adv_speed; 251436558c3dSYuval Mintz p_bulletin->partner_tx_flow_ctrl_en = link->partner_tx_flow_ctrl_en; 251536558c3dSYuval Mintz p_bulletin->partner_rx_flow_ctrl_en = link->partner_rx_flow_ctrl_en; 251636558c3dSYuval Mintz p_bulletin->partner_adv_pause = link->partner_adv_pause; 251736558c3dSYuval Mintz p_bulletin->sfp_tx_fault = link->sfp_tx_fault; 251836558c3dSYuval Mintz 251936558c3dSYuval Mintz p_bulletin->capability_speed = p_caps->speed_capabilities; 252036558c3dSYuval Mintz } 252136558c3dSYuval Mintz 252237bff2b9SYuval Mintz static void qed_iov_process_mbx_req(struct qed_hwfn *p_hwfn, 252337bff2b9SYuval Mintz struct qed_ptt *p_ptt, int vfid) 252437bff2b9SYuval Mintz { 252537bff2b9SYuval Mintz struct qed_iov_vf_mbx *mbx; 252637bff2b9SYuval Mintz struct qed_vf_info *p_vf; 252737bff2b9SYuval Mintz int i; 252837bff2b9SYuval Mintz 252937bff2b9SYuval Mintz p_vf = qed_iov_get_vf_info(p_hwfn, (u16) vfid, true); 253037bff2b9SYuval Mintz if (!p_vf) 253137bff2b9SYuval Mintz return; 253237bff2b9SYuval Mintz 253337bff2b9SYuval Mintz mbx = &p_vf->vf_mbx; 253437bff2b9SYuval Mintz 253537bff2b9SYuval Mintz /* qed_iov_process_mbx_request */ 253637bff2b9SYuval Mintz DP_VERBOSE(p_hwfn, 253737bff2b9SYuval Mintz QED_MSG_IOV, 253837bff2b9SYuval Mintz "qed_iov_process_mbx_req vfid %d\n", p_vf->abs_vf_id); 253937bff2b9SYuval Mintz 254037bff2b9SYuval Mintz mbx->first_tlv = mbx->req_virt->first_tlv; 254137bff2b9SYuval Mintz 254237bff2b9SYuval Mintz /* check if tlv type is known */ 254337bff2b9SYuval Mintz if (qed_iov_tlv_supported(mbx->first_tlv.tl.type)) { 25441408cc1fSYuval Mintz switch (mbx->first_tlv.tl.type) { 25451408cc1fSYuval Mintz case CHANNEL_TLV_ACQUIRE: 25461408cc1fSYuval Mintz qed_iov_vf_mbx_acquire(p_hwfn, p_ptt, p_vf); 25471408cc1fSYuval Mintz break; 2548dacd88d6SYuval Mintz case CHANNEL_TLV_VPORT_START: 2549dacd88d6SYuval Mintz qed_iov_vf_mbx_start_vport(p_hwfn, p_ptt, p_vf); 2550dacd88d6SYuval Mintz break; 2551dacd88d6SYuval Mintz case CHANNEL_TLV_VPORT_TEARDOWN: 2552dacd88d6SYuval Mintz qed_iov_vf_mbx_stop_vport(p_hwfn, p_ptt, p_vf); 2553dacd88d6SYuval Mintz break; 2554dacd88d6SYuval Mintz case CHANNEL_TLV_START_RXQ: 2555dacd88d6SYuval Mintz qed_iov_vf_mbx_start_rxq(p_hwfn, p_ptt, p_vf); 2556dacd88d6SYuval Mintz break; 2557dacd88d6SYuval Mintz case CHANNEL_TLV_START_TXQ: 2558dacd88d6SYuval Mintz qed_iov_vf_mbx_start_txq(p_hwfn, p_ptt, p_vf); 2559dacd88d6SYuval Mintz break; 2560dacd88d6SYuval Mintz case CHANNEL_TLV_STOP_RXQS: 2561dacd88d6SYuval Mintz qed_iov_vf_mbx_stop_rxqs(p_hwfn, p_ptt, p_vf); 2562dacd88d6SYuval Mintz break; 2563dacd88d6SYuval Mintz case CHANNEL_TLV_STOP_TXQS: 2564dacd88d6SYuval Mintz qed_iov_vf_mbx_stop_txqs(p_hwfn, p_ptt, p_vf); 2565dacd88d6SYuval Mintz break; 256617b235c1SYuval Mintz case CHANNEL_TLV_UPDATE_RXQ: 256717b235c1SYuval Mintz qed_iov_vf_mbx_update_rxqs(p_hwfn, p_ptt, p_vf); 256817b235c1SYuval Mintz break; 2569dacd88d6SYuval Mintz case CHANNEL_TLV_VPORT_UPDATE: 2570dacd88d6SYuval Mintz qed_iov_vf_mbx_vport_update(p_hwfn, p_ptt, p_vf); 2571dacd88d6SYuval Mintz break; 2572dacd88d6SYuval Mintz case CHANNEL_TLV_UCAST_FILTER: 2573dacd88d6SYuval Mintz qed_iov_vf_mbx_ucast_filter(p_hwfn, p_ptt, p_vf); 2574dacd88d6SYuval Mintz break; 25750b55e27dSYuval Mintz case CHANNEL_TLV_CLOSE: 25760b55e27dSYuval Mintz qed_iov_vf_mbx_close(p_hwfn, p_ptt, p_vf); 25770b55e27dSYuval Mintz break; 25780b55e27dSYuval Mintz case CHANNEL_TLV_INT_CLEANUP: 25790b55e27dSYuval Mintz qed_iov_vf_mbx_int_cleanup(p_hwfn, p_ptt, p_vf); 25800b55e27dSYuval Mintz break; 25810b55e27dSYuval Mintz case CHANNEL_TLV_RELEASE: 25820b55e27dSYuval Mintz qed_iov_vf_mbx_release(p_hwfn, p_ptt, p_vf); 25830b55e27dSYuval Mintz break; 25841408cc1fSYuval Mintz } 258537bff2b9SYuval Mintz } else { 258637bff2b9SYuval Mintz /* unknown TLV - this may belong to a VF driver from the future 258737bff2b9SYuval Mintz * - a version written after this PF driver was written, which 258837bff2b9SYuval Mintz * supports features unknown as of yet. Too bad since we don't 258937bff2b9SYuval Mintz * support them. Or this may be because someone wrote a crappy 259037bff2b9SYuval Mintz * VF driver and is sending garbage over the channel. 259137bff2b9SYuval Mintz */ 259237bff2b9SYuval Mintz DP_ERR(p_hwfn, 259337bff2b9SYuval Mintz "unknown TLV. type %d length %d. first 20 bytes of mailbox buffer:\n", 259437bff2b9SYuval Mintz mbx->first_tlv.tl.type, mbx->first_tlv.tl.length); 259537bff2b9SYuval Mintz 259637bff2b9SYuval Mintz for (i = 0; i < 20; i++) { 259737bff2b9SYuval Mintz DP_VERBOSE(p_hwfn, 259837bff2b9SYuval Mintz QED_MSG_IOV, 259937bff2b9SYuval Mintz "%x ", 260037bff2b9SYuval Mintz mbx->req_virt->tlv_buf_size.tlv_buffer[i]); 260137bff2b9SYuval Mintz } 260237bff2b9SYuval Mintz } 260337bff2b9SYuval Mintz } 260437bff2b9SYuval Mintz 260537bff2b9SYuval Mintz void qed_iov_pf_add_pending_events(struct qed_hwfn *p_hwfn, u8 vfid) 260637bff2b9SYuval Mintz { 260737bff2b9SYuval Mintz u64 add_bit = 1ULL << (vfid % 64); 260837bff2b9SYuval Mintz 260937bff2b9SYuval Mintz p_hwfn->pf_iov_info->pending_events[vfid / 64] |= add_bit; 261037bff2b9SYuval Mintz } 261137bff2b9SYuval Mintz 261237bff2b9SYuval Mintz static void qed_iov_pf_get_and_clear_pending_events(struct qed_hwfn *p_hwfn, 261337bff2b9SYuval Mintz u64 *events) 261437bff2b9SYuval Mintz { 261537bff2b9SYuval Mintz u64 *p_pending_events = p_hwfn->pf_iov_info->pending_events; 261637bff2b9SYuval Mintz 261737bff2b9SYuval Mintz memcpy(events, p_pending_events, sizeof(u64) * QED_VF_ARRAY_LENGTH); 261837bff2b9SYuval Mintz memset(p_pending_events, 0, sizeof(u64) * QED_VF_ARRAY_LENGTH); 261937bff2b9SYuval Mintz } 262037bff2b9SYuval Mintz 262137bff2b9SYuval Mintz static int qed_sriov_vfpf_msg(struct qed_hwfn *p_hwfn, 262237bff2b9SYuval Mintz u16 abs_vfid, struct regpair *vf_msg) 262337bff2b9SYuval Mintz { 262437bff2b9SYuval Mintz u8 min = (u8)p_hwfn->cdev->p_iov_info->first_vf_in_pf; 262537bff2b9SYuval Mintz struct qed_vf_info *p_vf; 262637bff2b9SYuval Mintz 262737bff2b9SYuval Mintz if (!qed_iov_pf_sanity_check(p_hwfn, (int)abs_vfid - min)) { 262837bff2b9SYuval Mintz DP_VERBOSE(p_hwfn, 262937bff2b9SYuval Mintz QED_MSG_IOV, 263037bff2b9SYuval Mintz "Got a message from VF [abs 0x%08x] that cannot be handled by PF\n", 263137bff2b9SYuval Mintz abs_vfid); 263237bff2b9SYuval Mintz return 0; 263337bff2b9SYuval Mintz } 263437bff2b9SYuval Mintz p_vf = &p_hwfn->pf_iov_info->vfs_array[(u8)abs_vfid - min]; 263537bff2b9SYuval Mintz 263637bff2b9SYuval Mintz /* List the physical address of the request so that handler 263737bff2b9SYuval Mintz * could later on copy the message from it. 263837bff2b9SYuval Mintz */ 263937bff2b9SYuval Mintz p_vf->vf_mbx.pending_req = (((u64)vf_msg->hi) << 32) | vf_msg->lo; 264037bff2b9SYuval Mintz 264137bff2b9SYuval Mintz /* Mark the event and schedule the workqueue */ 264237bff2b9SYuval Mintz qed_iov_pf_add_pending_events(p_hwfn, p_vf->relative_vf_id); 264337bff2b9SYuval Mintz qed_schedule_iov(p_hwfn, QED_IOV_WQ_MSG_FLAG); 264437bff2b9SYuval Mintz 264537bff2b9SYuval Mintz return 0; 264637bff2b9SYuval Mintz } 264737bff2b9SYuval Mintz 264837bff2b9SYuval Mintz int qed_sriov_eqe_event(struct qed_hwfn *p_hwfn, 264937bff2b9SYuval Mintz u8 opcode, __le16 echo, union event_ring_data *data) 265037bff2b9SYuval Mintz { 265137bff2b9SYuval Mintz switch (opcode) { 265237bff2b9SYuval Mintz case COMMON_EVENT_VF_PF_CHANNEL: 265337bff2b9SYuval Mintz return qed_sriov_vfpf_msg(p_hwfn, le16_to_cpu(echo), 265437bff2b9SYuval Mintz &data->vf_pf_channel.msg_addr); 265537bff2b9SYuval Mintz default: 265637bff2b9SYuval Mintz DP_INFO(p_hwfn->cdev, "Unknown sriov eqe event 0x%02x\n", 265737bff2b9SYuval Mintz opcode); 265837bff2b9SYuval Mintz return -EINVAL; 265937bff2b9SYuval Mintz } 266037bff2b9SYuval Mintz } 266137bff2b9SYuval Mintz 266232a47e72SYuval Mintz u16 qed_iov_get_next_active_vf(struct qed_hwfn *p_hwfn, u16 rel_vf_id) 266332a47e72SYuval Mintz { 266432a47e72SYuval Mintz struct qed_hw_sriov_info *p_iov = p_hwfn->cdev->p_iov_info; 266532a47e72SYuval Mintz u16 i; 266632a47e72SYuval Mintz 266732a47e72SYuval Mintz if (!p_iov) 266832a47e72SYuval Mintz goto out; 266932a47e72SYuval Mintz 267032a47e72SYuval Mintz for (i = rel_vf_id; i < p_iov->total_vfs; i++) 267132a47e72SYuval Mintz if (qed_iov_is_valid_vfid(p_hwfn, rel_vf_id, true)) 267232a47e72SYuval Mintz return i; 267332a47e72SYuval Mintz 267432a47e72SYuval Mintz out: 267532a47e72SYuval Mintz return MAX_NUM_VFS; 267632a47e72SYuval Mintz } 267737bff2b9SYuval Mintz 267837bff2b9SYuval Mintz static int qed_iov_copy_vf_msg(struct qed_hwfn *p_hwfn, struct qed_ptt *ptt, 267937bff2b9SYuval Mintz int vfid) 268037bff2b9SYuval Mintz { 268137bff2b9SYuval Mintz struct qed_dmae_params params; 268237bff2b9SYuval Mintz struct qed_vf_info *vf_info; 268337bff2b9SYuval Mintz 268437bff2b9SYuval Mintz vf_info = qed_iov_get_vf_info(p_hwfn, (u16) vfid, true); 268537bff2b9SYuval Mintz if (!vf_info) 268637bff2b9SYuval Mintz return -EINVAL; 268737bff2b9SYuval Mintz 268837bff2b9SYuval Mintz memset(¶ms, 0, sizeof(struct qed_dmae_params)); 268937bff2b9SYuval Mintz params.flags = QED_DMAE_FLAG_VF_SRC | QED_DMAE_FLAG_COMPLETION_DST; 269037bff2b9SYuval Mintz params.src_vfid = vf_info->abs_vf_id; 269137bff2b9SYuval Mintz 269237bff2b9SYuval Mintz if (qed_dmae_host2host(p_hwfn, ptt, 269337bff2b9SYuval Mintz vf_info->vf_mbx.pending_req, 269437bff2b9SYuval Mintz vf_info->vf_mbx.req_phys, 269537bff2b9SYuval Mintz sizeof(union vfpf_tlvs) / 4, ¶ms)) { 269637bff2b9SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_IOV, 269737bff2b9SYuval Mintz "Failed to copy message from VF 0x%02x\n", vfid); 269837bff2b9SYuval Mintz 269937bff2b9SYuval Mintz return -EIO; 270037bff2b9SYuval Mintz } 270137bff2b9SYuval Mintz 270237bff2b9SYuval Mintz return 0; 270337bff2b9SYuval Mintz } 270437bff2b9SYuval Mintz 270508feecd7SYuval Mintz void qed_iov_bulletin_set_forced_vlan(struct qed_hwfn *p_hwfn, 270608feecd7SYuval Mintz u16 pvid, int vfid) 270708feecd7SYuval Mintz { 270808feecd7SYuval Mintz struct qed_vf_info *vf_info; 270908feecd7SYuval Mintz u64 feature; 271008feecd7SYuval Mintz 271108feecd7SYuval Mintz vf_info = qed_iov_get_vf_info(p_hwfn, (u16) vfid, true); 271208feecd7SYuval Mintz if (!vf_info) { 271308feecd7SYuval Mintz DP_NOTICE(p_hwfn->cdev, 271408feecd7SYuval Mintz "Can not set forced MAC, invalid vfid [%d]\n", vfid); 271508feecd7SYuval Mintz return; 271608feecd7SYuval Mintz } 271708feecd7SYuval Mintz 271808feecd7SYuval Mintz feature = 1 << VLAN_ADDR_FORCED; 271908feecd7SYuval Mintz vf_info->bulletin.p_virt->pvid = pvid; 272008feecd7SYuval Mintz if (pvid) 272108feecd7SYuval Mintz vf_info->bulletin.p_virt->valid_bitmap |= feature; 272208feecd7SYuval Mintz else 272308feecd7SYuval Mintz vf_info->bulletin.p_virt->valid_bitmap &= ~feature; 272408feecd7SYuval Mintz 272508feecd7SYuval Mintz qed_iov_configure_vport_forced(p_hwfn, vf_info, feature); 272608feecd7SYuval Mintz } 272708feecd7SYuval Mintz 27280b55e27dSYuval Mintz bool qed_iov_is_vf_stopped(struct qed_hwfn *p_hwfn, int vfid) 27290b55e27dSYuval Mintz { 27300b55e27dSYuval Mintz struct qed_vf_info *p_vf_info; 27310b55e27dSYuval Mintz 27320b55e27dSYuval Mintz p_vf_info = qed_iov_get_vf_info(p_hwfn, (u16) vfid, true); 27330b55e27dSYuval Mintz if (!p_vf_info) 27340b55e27dSYuval Mintz return true; 27350b55e27dSYuval Mintz 27360b55e27dSYuval Mintz return p_vf_info->state == VF_STOPPED; 27370b55e27dSYuval Mintz } 27380b55e27dSYuval Mintz 273908feecd7SYuval Mintz u16 qed_iov_bulletin_get_forced_vlan(struct qed_hwfn *p_hwfn, u16 rel_vf_id) 274008feecd7SYuval Mintz { 274108feecd7SYuval Mintz struct qed_vf_info *p_vf; 274208feecd7SYuval Mintz 274308feecd7SYuval Mintz p_vf = qed_iov_get_vf_info(p_hwfn, rel_vf_id, true); 274408feecd7SYuval Mintz if (!p_vf || !p_vf->bulletin.p_virt) 274508feecd7SYuval Mintz return 0; 274608feecd7SYuval Mintz 274708feecd7SYuval Mintz if (!(p_vf->bulletin.p_virt->valid_bitmap & (1 << VLAN_ADDR_FORCED))) 274808feecd7SYuval Mintz return 0; 274908feecd7SYuval Mintz 275008feecd7SYuval Mintz return p_vf->bulletin.p_virt->pvid; 275108feecd7SYuval Mintz } 275208feecd7SYuval Mintz 275337bff2b9SYuval Mintz /** 275437bff2b9SYuval Mintz * qed_schedule_iov - schedules IOV task for VF and PF 275537bff2b9SYuval Mintz * @hwfn: hardware function pointer 275637bff2b9SYuval Mintz * @flag: IOV flag for VF/PF 275737bff2b9SYuval Mintz */ 275837bff2b9SYuval Mintz void qed_schedule_iov(struct qed_hwfn *hwfn, enum qed_iov_wq_flag flag) 275937bff2b9SYuval Mintz { 276037bff2b9SYuval Mintz smp_mb__before_atomic(); 276137bff2b9SYuval Mintz set_bit(flag, &hwfn->iov_task_flags); 276237bff2b9SYuval Mintz smp_mb__after_atomic(); 276337bff2b9SYuval Mintz DP_VERBOSE(hwfn, QED_MSG_IOV, "Scheduling iov task [Flag: %d]\n", flag); 276437bff2b9SYuval Mintz queue_delayed_work(hwfn->iov_wq, &hwfn->iov_task, 0); 276537bff2b9SYuval Mintz } 276637bff2b9SYuval Mintz 27671408cc1fSYuval Mintz void qed_vf_start_iov_wq(struct qed_dev *cdev) 27681408cc1fSYuval Mintz { 27691408cc1fSYuval Mintz int i; 27701408cc1fSYuval Mintz 27711408cc1fSYuval Mintz for_each_hwfn(cdev, i) 27721408cc1fSYuval Mintz queue_delayed_work(cdev->hwfns[i].iov_wq, 27731408cc1fSYuval Mintz &cdev->hwfns[i].iov_task, 0); 27741408cc1fSYuval Mintz } 27751408cc1fSYuval Mintz 27760b55e27dSYuval Mintz int qed_sriov_disable(struct qed_dev *cdev, bool pci_enabled) 27770b55e27dSYuval Mintz { 27780b55e27dSYuval Mintz int i, j; 27790b55e27dSYuval Mintz 27800b55e27dSYuval Mintz for_each_hwfn(cdev, i) 27810b55e27dSYuval Mintz if (cdev->hwfns[i].iov_wq) 27820b55e27dSYuval Mintz flush_workqueue(cdev->hwfns[i].iov_wq); 27830b55e27dSYuval Mintz 27840b55e27dSYuval Mintz /* Mark VFs for disablement */ 27850b55e27dSYuval Mintz qed_iov_set_vfs_to_disable(cdev, true); 27860b55e27dSYuval Mintz 27870b55e27dSYuval Mintz if (cdev->p_iov_info && cdev->p_iov_info->num_vfs && pci_enabled) 27880b55e27dSYuval Mintz pci_disable_sriov(cdev->pdev); 27890b55e27dSYuval Mintz 27900b55e27dSYuval Mintz for_each_hwfn(cdev, i) { 27910b55e27dSYuval Mintz struct qed_hwfn *hwfn = &cdev->hwfns[i]; 27920b55e27dSYuval Mintz struct qed_ptt *ptt = qed_ptt_acquire(hwfn); 27930b55e27dSYuval Mintz 27940b55e27dSYuval Mintz /* Failure to acquire the ptt in 100g creates an odd error 27950b55e27dSYuval Mintz * where the first engine has already relased IOV. 27960b55e27dSYuval Mintz */ 27970b55e27dSYuval Mintz if (!ptt) { 27980b55e27dSYuval Mintz DP_ERR(hwfn, "Failed to acquire ptt\n"); 27990b55e27dSYuval Mintz return -EBUSY; 28000b55e27dSYuval Mintz } 28010b55e27dSYuval Mintz 28020b55e27dSYuval Mintz qed_for_each_vf(hwfn, j) { 28030b55e27dSYuval Mintz int k; 28040b55e27dSYuval Mintz 28050b55e27dSYuval Mintz if (!qed_iov_is_valid_vfid(hwfn, j, true)) 28060b55e27dSYuval Mintz continue; 28070b55e27dSYuval Mintz 28080b55e27dSYuval Mintz /* Wait until VF is disabled before releasing */ 28090b55e27dSYuval Mintz for (k = 0; k < 100; k++) { 28100b55e27dSYuval Mintz if (!qed_iov_is_vf_stopped(hwfn, j)) 28110b55e27dSYuval Mintz msleep(20); 28120b55e27dSYuval Mintz else 28130b55e27dSYuval Mintz break; 28140b55e27dSYuval Mintz } 28150b55e27dSYuval Mintz 28160b55e27dSYuval Mintz if (k < 100) 28170b55e27dSYuval Mintz qed_iov_release_hw_for_vf(&cdev->hwfns[i], 28180b55e27dSYuval Mintz ptt, j); 28190b55e27dSYuval Mintz else 28200b55e27dSYuval Mintz DP_ERR(hwfn, 28210b55e27dSYuval Mintz "Timeout waiting for VF's FLR to end\n"); 28220b55e27dSYuval Mintz } 28230b55e27dSYuval Mintz 28240b55e27dSYuval Mintz qed_ptt_release(hwfn, ptt); 28250b55e27dSYuval Mintz } 28260b55e27dSYuval Mintz 28270b55e27dSYuval Mintz qed_iov_set_vfs_to_disable(cdev, false); 28280b55e27dSYuval Mintz 28290b55e27dSYuval Mintz return 0; 28300b55e27dSYuval Mintz } 28310b55e27dSYuval Mintz 28320b55e27dSYuval Mintz static int qed_sriov_enable(struct qed_dev *cdev, int num) 28330b55e27dSYuval Mintz { 28340b55e27dSYuval Mintz struct qed_sb_cnt_info sb_cnt_info; 28350b55e27dSYuval Mintz int i, j, rc; 28360b55e27dSYuval Mintz 28370b55e27dSYuval Mintz if (num >= RESC_NUM(&cdev->hwfns[0], QED_VPORT)) { 28380b55e27dSYuval Mintz DP_NOTICE(cdev, "Can start at most %d VFs\n", 28390b55e27dSYuval Mintz RESC_NUM(&cdev->hwfns[0], QED_VPORT) - 1); 28400b55e27dSYuval Mintz return -EINVAL; 28410b55e27dSYuval Mintz } 28420b55e27dSYuval Mintz 28430b55e27dSYuval Mintz /* Initialize HW for VF access */ 28440b55e27dSYuval Mintz for_each_hwfn(cdev, j) { 28450b55e27dSYuval Mintz struct qed_hwfn *hwfn = &cdev->hwfns[j]; 28460b55e27dSYuval Mintz struct qed_ptt *ptt = qed_ptt_acquire(hwfn); 28470b55e27dSYuval Mintz int num_sbs = 0, limit = 16; 28480b55e27dSYuval Mintz 28490b55e27dSYuval Mintz if (!ptt) { 28500b55e27dSYuval Mintz DP_ERR(hwfn, "Failed to acquire ptt\n"); 28510b55e27dSYuval Mintz rc = -EBUSY; 28520b55e27dSYuval Mintz goto err; 28530b55e27dSYuval Mintz } 28540b55e27dSYuval Mintz 28550b55e27dSYuval Mintz memset(&sb_cnt_info, 0, sizeof(sb_cnt_info)); 28560b55e27dSYuval Mintz qed_int_get_num_sbs(hwfn, &sb_cnt_info); 28570b55e27dSYuval Mintz num_sbs = min_t(int, sb_cnt_info.sb_free_blk, limit); 28580b55e27dSYuval Mintz 28590b55e27dSYuval Mintz for (i = 0; i < num; i++) { 28600b55e27dSYuval Mintz if (!qed_iov_is_valid_vfid(hwfn, i, false)) 28610b55e27dSYuval Mintz continue; 28620b55e27dSYuval Mintz 28630b55e27dSYuval Mintz rc = qed_iov_init_hw_for_vf(hwfn, 28640b55e27dSYuval Mintz ptt, i, num_sbs / num); 28650b55e27dSYuval Mintz if (rc) { 28660b55e27dSYuval Mintz DP_ERR(cdev, "Failed to enable VF[%d]\n", i); 28670b55e27dSYuval Mintz qed_ptt_release(hwfn, ptt); 28680b55e27dSYuval Mintz goto err; 28690b55e27dSYuval Mintz } 28700b55e27dSYuval Mintz } 28710b55e27dSYuval Mintz 28720b55e27dSYuval Mintz qed_ptt_release(hwfn, ptt); 28730b55e27dSYuval Mintz } 28740b55e27dSYuval Mintz 28750b55e27dSYuval Mintz /* Enable SRIOV PCIe functions */ 28760b55e27dSYuval Mintz rc = pci_enable_sriov(cdev->pdev, num); 28770b55e27dSYuval Mintz if (rc) { 28780b55e27dSYuval Mintz DP_ERR(cdev, "Failed to enable sriov [%d]\n", rc); 28790b55e27dSYuval Mintz goto err; 28800b55e27dSYuval Mintz } 28810b55e27dSYuval Mintz 28820b55e27dSYuval Mintz return num; 28830b55e27dSYuval Mintz 28840b55e27dSYuval Mintz err: 28850b55e27dSYuval Mintz qed_sriov_disable(cdev, false); 28860b55e27dSYuval Mintz return rc; 28870b55e27dSYuval Mintz } 28880b55e27dSYuval Mintz 28890b55e27dSYuval Mintz static int qed_sriov_configure(struct qed_dev *cdev, int num_vfs_param) 28900b55e27dSYuval Mintz { 28910b55e27dSYuval Mintz if (!IS_QED_SRIOV(cdev)) { 28920b55e27dSYuval Mintz DP_VERBOSE(cdev, QED_MSG_IOV, "SR-IOV is not supported\n"); 28930b55e27dSYuval Mintz return -EOPNOTSUPP; 28940b55e27dSYuval Mintz } 28950b55e27dSYuval Mintz 28960b55e27dSYuval Mintz if (num_vfs_param) 28970b55e27dSYuval Mintz return qed_sriov_enable(cdev, num_vfs_param); 28980b55e27dSYuval Mintz else 28990b55e27dSYuval Mintz return qed_sriov_disable(cdev, true); 29000b55e27dSYuval Mintz } 29010b55e27dSYuval Mintz 290208feecd7SYuval Mintz static int qed_sriov_pf_set_vlan(struct qed_dev *cdev, u16 vid, int vfid) 290308feecd7SYuval Mintz { 290408feecd7SYuval Mintz int i; 290508feecd7SYuval Mintz 290608feecd7SYuval Mintz if (!IS_QED_SRIOV(cdev) || !IS_PF_SRIOV_ALLOC(&cdev->hwfns[0])) { 290708feecd7SYuval Mintz DP_VERBOSE(cdev, QED_MSG_IOV, 290808feecd7SYuval Mintz "Cannot set a VF MAC; Sriov is not enabled\n"); 290908feecd7SYuval Mintz return -EINVAL; 291008feecd7SYuval Mintz } 291108feecd7SYuval Mintz 291208feecd7SYuval Mintz if (!qed_iov_is_valid_vfid(&cdev->hwfns[0], vfid, true)) { 291308feecd7SYuval Mintz DP_VERBOSE(cdev, QED_MSG_IOV, 291408feecd7SYuval Mintz "Cannot set VF[%d] MAC (VF is not active)\n", vfid); 291508feecd7SYuval Mintz return -EINVAL; 291608feecd7SYuval Mintz } 291708feecd7SYuval Mintz 291808feecd7SYuval Mintz for_each_hwfn(cdev, i) { 291908feecd7SYuval Mintz struct qed_hwfn *hwfn = &cdev->hwfns[i]; 292008feecd7SYuval Mintz struct qed_public_vf_info *vf_info; 292108feecd7SYuval Mintz 292208feecd7SYuval Mintz vf_info = qed_iov_get_public_vf_info(hwfn, vfid, true); 292308feecd7SYuval Mintz if (!vf_info) 292408feecd7SYuval Mintz continue; 292508feecd7SYuval Mintz 292608feecd7SYuval Mintz /* Set the forced vlan, and schedule the IOV task */ 292708feecd7SYuval Mintz vf_info->forced_vlan = vid; 292808feecd7SYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_SET_UNICAST_FILTER_FLAG); 292908feecd7SYuval Mintz } 293008feecd7SYuval Mintz 293108feecd7SYuval Mintz return 0; 293208feecd7SYuval Mintz } 293308feecd7SYuval Mintz 293436558c3dSYuval Mintz void qed_inform_vf_link_state(struct qed_hwfn *hwfn) 293536558c3dSYuval Mintz { 293636558c3dSYuval Mintz struct qed_mcp_link_capabilities caps; 293736558c3dSYuval Mintz struct qed_mcp_link_params params; 293836558c3dSYuval Mintz struct qed_mcp_link_state link; 293936558c3dSYuval Mintz int i; 294036558c3dSYuval Mintz 294136558c3dSYuval Mintz if (!hwfn->pf_iov_info) 294236558c3dSYuval Mintz return; 294336558c3dSYuval Mintz 294436558c3dSYuval Mintz /* Update bulletin of all future possible VFs with link configuration */ 294536558c3dSYuval Mintz for (i = 0; i < hwfn->cdev->p_iov_info->total_vfs; i++) { 294636558c3dSYuval Mintz memcpy(¶ms, qed_mcp_get_link_params(hwfn), sizeof(params)); 294736558c3dSYuval Mintz memcpy(&link, qed_mcp_get_link_state(hwfn), sizeof(link)); 294836558c3dSYuval Mintz memcpy(&caps, qed_mcp_get_link_capabilities(hwfn), 294936558c3dSYuval Mintz sizeof(caps)); 295036558c3dSYuval Mintz 295136558c3dSYuval Mintz qed_iov_set_link(hwfn, i, ¶ms, &link, &caps); 295236558c3dSYuval Mintz } 295336558c3dSYuval Mintz 295436558c3dSYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_BULLETIN_UPDATE_FLAG); 295536558c3dSYuval Mintz } 295636558c3dSYuval Mintz 295737bff2b9SYuval Mintz static void qed_handle_vf_msg(struct qed_hwfn *hwfn) 295837bff2b9SYuval Mintz { 295937bff2b9SYuval Mintz u64 events[QED_VF_ARRAY_LENGTH]; 296037bff2b9SYuval Mintz struct qed_ptt *ptt; 296137bff2b9SYuval Mintz int i; 296237bff2b9SYuval Mintz 296337bff2b9SYuval Mintz ptt = qed_ptt_acquire(hwfn); 296437bff2b9SYuval Mintz if (!ptt) { 296537bff2b9SYuval Mintz DP_VERBOSE(hwfn, QED_MSG_IOV, 296637bff2b9SYuval Mintz "Can't acquire PTT; re-scheduling\n"); 296737bff2b9SYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_MSG_FLAG); 296837bff2b9SYuval Mintz return; 296937bff2b9SYuval Mintz } 297037bff2b9SYuval Mintz 297137bff2b9SYuval Mintz qed_iov_pf_get_and_clear_pending_events(hwfn, events); 297237bff2b9SYuval Mintz 297337bff2b9SYuval Mintz DP_VERBOSE(hwfn, QED_MSG_IOV, 297437bff2b9SYuval Mintz "Event mask of VF events: 0x%llx 0x%llx 0x%llx\n", 297537bff2b9SYuval Mintz events[0], events[1], events[2]); 297637bff2b9SYuval Mintz 297737bff2b9SYuval Mintz qed_for_each_vf(hwfn, i) { 297837bff2b9SYuval Mintz /* Skip VFs with no pending messages */ 297937bff2b9SYuval Mintz if (!(events[i / 64] & (1ULL << (i % 64)))) 298037bff2b9SYuval Mintz continue; 298137bff2b9SYuval Mintz 298237bff2b9SYuval Mintz DP_VERBOSE(hwfn, QED_MSG_IOV, 298337bff2b9SYuval Mintz "Handling VF message from VF 0x%02x [Abs 0x%02x]\n", 298437bff2b9SYuval Mintz i, hwfn->cdev->p_iov_info->first_vf_in_pf + i); 298537bff2b9SYuval Mintz 298637bff2b9SYuval Mintz /* Copy VF's message to PF's request buffer for that VF */ 298737bff2b9SYuval Mintz if (qed_iov_copy_vf_msg(hwfn, ptt, i)) 298837bff2b9SYuval Mintz continue; 298937bff2b9SYuval Mintz 299037bff2b9SYuval Mintz qed_iov_process_mbx_req(hwfn, ptt, i); 299137bff2b9SYuval Mintz } 299237bff2b9SYuval Mintz 299337bff2b9SYuval Mintz qed_ptt_release(hwfn, ptt); 299437bff2b9SYuval Mintz } 299537bff2b9SYuval Mintz 299608feecd7SYuval Mintz static void qed_handle_pf_set_vf_unicast(struct qed_hwfn *hwfn) 299708feecd7SYuval Mintz { 299808feecd7SYuval Mintz int i; 299908feecd7SYuval Mintz 300008feecd7SYuval Mintz qed_for_each_vf(hwfn, i) { 300108feecd7SYuval Mintz struct qed_public_vf_info *info; 300208feecd7SYuval Mintz bool update = false; 300308feecd7SYuval Mintz 300408feecd7SYuval Mintz info = qed_iov_get_public_vf_info(hwfn, i, true); 300508feecd7SYuval Mintz if (!info) 300608feecd7SYuval Mintz continue; 300708feecd7SYuval Mintz 300808feecd7SYuval Mintz /* Update data on bulletin board */ 300908feecd7SYuval Mintz 301008feecd7SYuval Mintz if (qed_iov_bulletin_get_forced_vlan(hwfn, i) ^ 301108feecd7SYuval Mintz info->forced_vlan) { 301208feecd7SYuval Mintz DP_VERBOSE(hwfn, 301308feecd7SYuval Mintz QED_MSG_IOV, 301408feecd7SYuval Mintz "Handling PF setting of pvid [0x%04x] to VF 0x%02x [Abs 0x%02x]\n", 301508feecd7SYuval Mintz info->forced_vlan, 301608feecd7SYuval Mintz i, 301708feecd7SYuval Mintz hwfn->cdev->p_iov_info->first_vf_in_pf + i); 301808feecd7SYuval Mintz qed_iov_bulletin_set_forced_vlan(hwfn, 301908feecd7SYuval Mintz info->forced_vlan, i); 302008feecd7SYuval Mintz update = true; 302108feecd7SYuval Mintz } 302208feecd7SYuval Mintz 302308feecd7SYuval Mintz if (update) 302408feecd7SYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_BULLETIN_UPDATE_FLAG); 302508feecd7SYuval Mintz } 302608feecd7SYuval Mintz } 302708feecd7SYuval Mintz 302836558c3dSYuval Mintz static void qed_handle_bulletin_post(struct qed_hwfn *hwfn) 302936558c3dSYuval Mintz { 303036558c3dSYuval Mintz struct qed_ptt *ptt; 303136558c3dSYuval Mintz int i; 303236558c3dSYuval Mintz 303336558c3dSYuval Mintz ptt = qed_ptt_acquire(hwfn); 303436558c3dSYuval Mintz if (!ptt) { 303536558c3dSYuval Mintz DP_NOTICE(hwfn, "Failed allocating a ptt entry\n"); 303636558c3dSYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_BULLETIN_UPDATE_FLAG); 303736558c3dSYuval Mintz return; 303836558c3dSYuval Mintz } 303936558c3dSYuval Mintz 304036558c3dSYuval Mintz qed_for_each_vf(hwfn, i) 304136558c3dSYuval Mintz qed_iov_post_vf_bulletin(hwfn, i, ptt); 304236558c3dSYuval Mintz 304336558c3dSYuval Mintz qed_ptt_release(hwfn, ptt); 304436558c3dSYuval Mintz } 304536558c3dSYuval Mintz 304637bff2b9SYuval Mintz void qed_iov_pf_task(struct work_struct *work) 304737bff2b9SYuval Mintz { 304837bff2b9SYuval Mintz struct qed_hwfn *hwfn = container_of(work, struct qed_hwfn, 304937bff2b9SYuval Mintz iov_task.work); 30500b55e27dSYuval Mintz int rc; 305137bff2b9SYuval Mintz 305237bff2b9SYuval Mintz if (test_and_clear_bit(QED_IOV_WQ_STOP_WQ_FLAG, &hwfn->iov_task_flags)) 305337bff2b9SYuval Mintz return; 305437bff2b9SYuval Mintz 30550b55e27dSYuval Mintz if (test_and_clear_bit(QED_IOV_WQ_FLR_FLAG, &hwfn->iov_task_flags)) { 30560b55e27dSYuval Mintz struct qed_ptt *ptt = qed_ptt_acquire(hwfn); 30570b55e27dSYuval Mintz 30580b55e27dSYuval Mintz if (!ptt) { 30590b55e27dSYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_FLR_FLAG); 30600b55e27dSYuval Mintz return; 30610b55e27dSYuval Mintz } 30620b55e27dSYuval Mintz 30630b55e27dSYuval Mintz rc = qed_iov_vf_flr_cleanup(hwfn, ptt); 30640b55e27dSYuval Mintz if (rc) 30650b55e27dSYuval Mintz qed_schedule_iov(hwfn, QED_IOV_WQ_FLR_FLAG); 30660b55e27dSYuval Mintz 30670b55e27dSYuval Mintz qed_ptt_release(hwfn, ptt); 30680b55e27dSYuval Mintz } 30690b55e27dSYuval Mintz 307037bff2b9SYuval Mintz if (test_and_clear_bit(QED_IOV_WQ_MSG_FLAG, &hwfn->iov_task_flags)) 307137bff2b9SYuval Mintz qed_handle_vf_msg(hwfn); 307208feecd7SYuval Mintz 307308feecd7SYuval Mintz if (test_and_clear_bit(QED_IOV_WQ_SET_UNICAST_FILTER_FLAG, 307408feecd7SYuval Mintz &hwfn->iov_task_flags)) 307508feecd7SYuval Mintz qed_handle_pf_set_vf_unicast(hwfn); 307608feecd7SYuval Mintz 307736558c3dSYuval Mintz if (test_and_clear_bit(QED_IOV_WQ_BULLETIN_UPDATE_FLAG, 307836558c3dSYuval Mintz &hwfn->iov_task_flags)) 307936558c3dSYuval Mintz qed_handle_bulletin_post(hwfn); 308037bff2b9SYuval Mintz } 308137bff2b9SYuval Mintz 308237bff2b9SYuval Mintz void qed_iov_wq_stop(struct qed_dev *cdev, bool schedule_first) 308337bff2b9SYuval Mintz { 308437bff2b9SYuval Mintz int i; 308537bff2b9SYuval Mintz 308637bff2b9SYuval Mintz for_each_hwfn(cdev, i) { 308737bff2b9SYuval Mintz if (!cdev->hwfns[i].iov_wq) 308837bff2b9SYuval Mintz continue; 308937bff2b9SYuval Mintz 309037bff2b9SYuval Mintz if (schedule_first) { 309137bff2b9SYuval Mintz qed_schedule_iov(&cdev->hwfns[i], 309237bff2b9SYuval Mintz QED_IOV_WQ_STOP_WQ_FLAG); 309337bff2b9SYuval Mintz cancel_delayed_work_sync(&cdev->hwfns[i].iov_task); 309437bff2b9SYuval Mintz } 309537bff2b9SYuval Mintz 309637bff2b9SYuval Mintz flush_workqueue(cdev->hwfns[i].iov_wq); 309737bff2b9SYuval Mintz destroy_workqueue(cdev->hwfns[i].iov_wq); 309837bff2b9SYuval Mintz } 309937bff2b9SYuval Mintz } 310037bff2b9SYuval Mintz 310137bff2b9SYuval Mintz int qed_iov_wq_start(struct qed_dev *cdev) 310237bff2b9SYuval Mintz { 310337bff2b9SYuval Mintz char name[NAME_SIZE]; 310437bff2b9SYuval Mintz int i; 310537bff2b9SYuval Mintz 310637bff2b9SYuval Mintz for_each_hwfn(cdev, i) { 310737bff2b9SYuval Mintz struct qed_hwfn *p_hwfn = &cdev->hwfns[i]; 310837bff2b9SYuval Mintz 310936558c3dSYuval Mintz /* PFs needs a dedicated workqueue only if they support IOV. 311036558c3dSYuval Mintz * VFs always require one. 311136558c3dSYuval Mintz */ 311236558c3dSYuval Mintz if (IS_PF(p_hwfn->cdev) && !IS_PF_SRIOV(p_hwfn)) 311337bff2b9SYuval Mintz continue; 311437bff2b9SYuval Mintz 311537bff2b9SYuval Mintz snprintf(name, NAME_SIZE, "iov-%02x:%02x.%02x", 311637bff2b9SYuval Mintz cdev->pdev->bus->number, 311737bff2b9SYuval Mintz PCI_SLOT(cdev->pdev->devfn), p_hwfn->abs_pf_id); 311837bff2b9SYuval Mintz 311937bff2b9SYuval Mintz p_hwfn->iov_wq = create_singlethread_workqueue(name); 312037bff2b9SYuval Mintz if (!p_hwfn->iov_wq) { 312137bff2b9SYuval Mintz DP_NOTICE(p_hwfn, "Cannot create iov workqueue\n"); 312237bff2b9SYuval Mintz return -ENOMEM; 312337bff2b9SYuval Mintz } 312437bff2b9SYuval Mintz 312536558c3dSYuval Mintz if (IS_PF(cdev)) 312637bff2b9SYuval Mintz INIT_DELAYED_WORK(&p_hwfn->iov_task, qed_iov_pf_task); 312736558c3dSYuval Mintz else 312836558c3dSYuval Mintz INIT_DELAYED_WORK(&p_hwfn->iov_task, qed_iov_vf_task); 312937bff2b9SYuval Mintz } 313037bff2b9SYuval Mintz 313137bff2b9SYuval Mintz return 0; 313237bff2b9SYuval Mintz } 31330b55e27dSYuval Mintz 31340b55e27dSYuval Mintz const struct qed_iov_hv_ops qed_iov_ops_pass = { 31350b55e27dSYuval Mintz .configure = &qed_sriov_configure, 313608feecd7SYuval Mintz .set_vlan = &qed_sriov_pf_set_vlan, 31370b55e27dSYuval Mintz }; 3138