1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261 |
- /* QLogic qed NIC Driver
- * Copyright (c) 2015 QLogic Corporation
- *
- * This software is available under the terms of the GNU General Public License
- * (GPL) Version 2, available from the file COPYING in the main directory of
- * this source tree.
- */
- #include <linux/crc32.h>
- #include <linux/etherdevice.h>
- #include "qed.h"
- #include "qed_sriov.h"
- #include "qed_vf.h"
- static void *qed_vf_pf_prep(struct qed_hwfn *p_hwfn, u16 type, u16 length)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- void *p_tlv;
- /* This lock is released when we receive PF's response
- * in qed_send_msg2pf().
- * So, qed_vf_pf_prep() and qed_send_msg2pf()
- * must come in sequence.
- */
- mutex_lock(&(p_iov->mutex));
- DP_VERBOSE(p_hwfn,
- QED_MSG_IOV,
- "preparing to send 0x%04x tlv over vf pf channel\n",
- type);
- /* Reset Requst offset */
- p_iov->offset = (u8 *)p_iov->vf2pf_request;
- /* Clear mailbox - both request and reply */
- memset(p_iov->vf2pf_request, 0, sizeof(union vfpf_tlvs));
- memset(p_iov->pf2vf_reply, 0, sizeof(union pfvf_tlvs));
- /* Init type and length */
- p_tlv = qed_add_tlv(p_hwfn, &p_iov->offset, type, length);
- /* Init first tlv header */
- ((struct vfpf_first_tlv *)p_tlv)->reply_address =
- (u64)p_iov->pf2vf_reply_phys;
- return p_tlv;
- }
- static void qed_vf_pf_req_end(struct qed_hwfn *p_hwfn, int req_status)
- {
- union pfvf_tlvs *resp = p_hwfn->vf_iov_info->pf2vf_reply;
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "VF request status = 0x%x, PF reply status = 0x%x\n",
- req_status, resp->default_resp.hdr.status);
- mutex_unlock(&(p_hwfn->vf_iov_info->mutex));
- }
- static int qed_send_msg2pf(struct qed_hwfn *p_hwfn, u8 *done, u32 resp_size)
- {
- union vfpf_tlvs *p_req = p_hwfn->vf_iov_info->vf2pf_request;
- struct ustorm_trigger_vf_zone trigger;
- struct ustorm_vf_zone *zone_data;
- int rc = 0, time = 100;
- zone_data = (struct ustorm_vf_zone *)PXP_VF_BAR0_START_USDM_ZONE_B;
- /* output tlvs list */
- qed_dp_tlv_list(p_hwfn, p_req);
- /* need to add the END TLV to the message size */
- resp_size += sizeof(struct channel_list_end_tlv);
- /* Send TLVs over HW channel */
- memset(&trigger, 0, sizeof(struct ustorm_trigger_vf_zone));
- trigger.vf_pf_msg_valid = 1;
- DP_VERBOSE(p_hwfn,
- QED_MSG_IOV,
- "VF -> PF [%02x] message: [%08x, %08x] --> %p, %08x --> %p\n",
- GET_FIELD(p_hwfn->hw_info.concrete_fid,
- PXP_CONCRETE_FID_PFID),
- upper_32_bits(p_hwfn->vf_iov_info->vf2pf_request_phys),
- lower_32_bits(p_hwfn->vf_iov_info->vf2pf_request_phys),
- &zone_data->non_trigger.vf_pf_msg_addr,
- *((u32 *)&trigger), &zone_data->trigger);
- REG_WR(p_hwfn,
- (uintptr_t)&zone_data->non_trigger.vf_pf_msg_addr.lo,
- lower_32_bits(p_hwfn->vf_iov_info->vf2pf_request_phys));
- REG_WR(p_hwfn,
- (uintptr_t)&zone_data->non_trigger.vf_pf_msg_addr.hi,
- upper_32_bits(p_hwfn->vf_iov_info->vf2pf_request_phys));
- /* The message data must be written first, to prevent trigger before
- * data is written.
- */
- wmb();
- REG_WR(p_hwfn, (uintptr_t)&zone_data->trigger, *((u32 *)&trigger));
- /* When PF would be done with the response, it would write back to the
- * `done' address. Poll until then.
- */
- while ((!*done) && time) {
- msleep(25);
- time--;
- }
- if (!*done) {
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "VF <-- PF Timeout [Type %d]\n",
- p_req->first_tlv.tl.type);
- rc = -EBUSY;
- } else {
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "PF response: %d [Type %d]\n",
- *done, p_req->first_tlv.tl.type);
- }
- return rc;
- }
- #define VF_ACQUIRE_THRESH 3
- static void qed_vf_pf_acquire_reduce_resc(struct qed_hwfn *p_hwfn,
- struct vf_pf_resc_request *p_req,
- struct pf_vf_resc *p_resp)
- {
- DP_VERBOSE(p_hwfn,
- QED_MSG_IOV,
- "PF unwilling to fullill resource request: rxq [%02x/%02x] txq [%02x/%02x] sbs [%02x/%02x] mac [%02x/%02x] vlan [%02x/%02x] mc [%02x/%02x]. Try PF recommended amount\n",
- p_req->num_rxqs,
- p_resp->num_rxqs,
- p_req->num_rxqs,
- p_resp->num_txqs,
- p_req->num_sbs,
- p_resp->num_sbs,
- p_req->num_mac_filters,
- p_resp->num_mac_filters,
- p_req->num_vlan_filters,
- p_resp->num_vlan_filters,
- p_req->num_mc_filters, p_resp->num_mc_filters);
- /* humble our request */
- p_req->num_txqs = p_resp->num_txqs;
- p_req->num_rxqs = p_resp->num_rxqs;
- p_req->num_sbs = p_resp->num_sbs;
- p_req->num_mac_filters = p_resp->num_mac_filters;
- p_req->num_vlan_filters = p_resp->num_vlan_filters;
- p_req->num_mc_filters = p_resp->num_mc_filters;
- }
- static int qed_vf_pf_acquire(struct qed_hwfn *p_hwfn)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_acquire_resp_tlv *resp = &p_iov->pf2vf_reply->acquire_resp;
- struct pf_vf_pfdev_info *pfdev_info = &resp->pfdev_info;
- struct vf_pf_resc_request *p_resc;
- bool resources_acquired = false;
- struct vfpf_acquire_tlv *req;
- int rc = 0, attempts = 0;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_ACQUIRE, sizeof(*req));
- p_resc = &req->resc_request;
- /* starting filling the request */
- req->vfdev_info.opaque_fid = p_hwfn->hw_info.opaque_fid;
- p_resc->num_rxqs = QED_MAX_VF_CHAINS_PER_PF;
- p_resc->num_txqs = QED_MAX_VF_CHAINS_PER_PF;
- p_resc->num_sbs = QED_MAX_VF_CHAINS_PER_PF;
- p_resc->num_mac_filters = QED_ETH_VF_NUM_MAC_FILTERS;
- p_resc->num_vlan_filters = QED_ETH_VF_NUM_VLAN_FILTERS;
- req->vfdev_info.os_type = VFPF_ACQUIRE_OS_LINUX;
- req->vfdev_info.fw_major = FW_MAJOR_VERSION;
- req->vfdev_info.fw_minor = FW_MINOR_VERSION;
- req->vfdev_info.fw_revision = FW_REVISION_VERSION;
- req->vfdev_info.fw_engineering = FW_ENGINEERING_VERSION;
- req->vfdev_info.eth_fp_hsi_major = ETH_HSI_VER_MAJOR;
- req->vfdev_info.eth_fp_hsi_minor = ETH_HSI_VER_MINOR;
- /* Fill capability field with any non-deprecated config we support */
- req->vfdev_info.capabilities |= VFPF_ACQUIRE_CAP_100G;
- /* pf 2 vf bulletin board address */
- req->bulletin_addr = p_iov->bulletin.phys;
- req->bulletin_size = p_iov->bulletin.size;
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- while (!resources_acquired) {
- DP_VERBOSE(p_hwfn,
- QED_MSG_IOV, "attempting to acquire resources\n");
- /* Clear response buffer, as this might be a re-send */
- memset(p_iov->pf2vf_reply, 0, sizeof(union pfvf_tlvs));
- /* send acquire request */
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- return rc;
- /* copy acquire response from buffer to p_hwfn */
- memcpy(&p_iov->acquire_resp, resp, sizeof(p_iov->acquire_resp));
- attempts++;
- if (resp->hdr.status == PFVF_STATUS_SUCCESS) {
- /* PF agrees to allocate our resources */
- if (!(resp->pfdev_info.capabilities &
- PFVF_ACQUIRE_CAP_POST_FW_OVERRIDE)) {
- /* It's possible legacy PF mistakenly accepted;
- * but we don't care - simply mark it as
- * legacy and continue.
- */
- req->vfdev_info.capabilities |=
- VFPF_ACQUIRE_CAP_PRE_FP_HSI;
- }
- DP_VERBOSE(p_hwfn, QED_MSG_IOV, "resources acquired\n");
- resources_acquired = true;
- } else if (resp->hdr.status == PFVF_STATUS_NO_RESOURCE &&
- attempts < VF_ACQUIRE_THRESH) {
- qed_vf_pf_acquire_reduce_resc(p_hwfn, p_resc,
- &resp->resc);
- } else if (resp->hdr.status == PFVF_STATUS_NOT_SUPPORTED) {
- if (pfdev_info->major_fp_hsi &&
- (pfdev_info->major_fp_hsi != ETH_HSI_VER_MAJOR)) {
- DP_NOTICE(p_hwfn,
- "PF uses an incompatible fastpath HSI %02x.%02x [VF requires %02x.%02x]. Please change to a VF driver using %02x.xx.\n",
- pfdev_info->major_fp_hsi,
- pfdev_info->minor_fp_hsi,
- ETH_HSI_VER_MAJOR,
- ETH_HSI_VER_MINOR,
- pfdev_info->major_fp_hsi);
- rc = -EINVAL;
- goto exit;
- }
- if (!pfdev_info->major_fp_hsi) {
- if (req->vfdev_info.capabilities &
- VFPF_ACQUIRE_CAP_PRE_FP_HSI) {
- DP_NOTICE(p_hwfn,
- "PF uses very old drivers. Please change to a VF driver using no later than 8.8.x.x.\n");
- rc = -EINVAL;
- goto exit;
- } else {
- DP_INFO(p_hwfn,
- "PF is old - try re-acquire to see if it supports FW-version override\n");
- req->vfdev_info.capabilities |=
- VFPF_ACQUIRE_CAP_PRE_FP_HSI;
- continue;
- }
- }
- /* If PF/VF are using same Major, PF must have had
- * it's reasons. Simply fail.
- */
- DP_NOTICE(p_hwfn, "PF rejected acquisition by VF\n");
- rc = -EINVAL;
- goto exit;
- } else {
- DP_ERR(p_hwfn,
- "PF returned error %d to VF acquisition request\n",
- resp->hdr.status);
- rc = -EAGAIN;
- goto exit;
- }
- }
- /* Mark the PF as legacy, if needed */
- if (req->vfdev_info.capabilities & VFPF_ACQUIRE_CAP_PRE_FP_HSI)
- p_iov->b_pre_fp_hsi = true;
- /* Update bulletin board size with response from PF */
- p_iov->bulletin.size = resp->bulletin_size;
- /* get HW info */
- p_hwfn->cdev->type = resp->pfdev_info.dev_type;
- p_hwfn->cdev->chip_rev = resp->pfdev_info.chip_rev;
- p_hwfn->cdev->chip_num = pfdev_info->chip_num & 0xffff;
- /* Learn of the possibility of CMT */
- if (IS_LEAD_HWFN(p_hwfn)) {
- if (resp->pfdev_info.capabilities & PFVF_ACQUIRE_CAP_100G) {
- DP_NOTICE(p_hwfn, "100g VF\n");
- p_hwfn->cdev->num_hwfns = 2;
- }
- }
- if (!p_iov->b_pre_fp_hsi &&
- ETH_HSI_VER_MINOR &&
- (resp->pfdev_info.minor_fp_hsi < ETH_HSI_VER_MINOR)) {
- DP_INFO(p_hwfn,
- "PF is using older fastpath HSI; %02x.%02x is configured\n",
- ETH_HSI_VER_MAJOR, resp->pfdev_info.minor_fp_hsi);
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_hw_prepare(struct qed_hwfn *p_hwfn)
- {
- struct qed_vf_iov *p_iov;
- u32 reg;
- /* Set number of hwfns - might be overriden once leading hwfn learns
- * actual configuration from PF.
- */
- if (IS_LEAD_HWFN(p_hwfn))
- p_hwfn->cdev->num_hwfns = 1;
- /* Set the doorbell bar. Assumption: regview is set */
- p_hwfn->doorbells = (u8 __iomem *)p_hwfn->regview +
- PXP_VF_BAR0_START_DQ;
- reg = PXP_VF_BAR0_ME_OPAQUE_ADDRESS;
- p_hwfn->hw_info.opaque_fid = (u16)REG_RD(p_hwfn, reg);
- reg = PXP_VF_BAR0_ME_CONCRETE_ADDRESS;
- p_hwfn->hw_info.concrete_fid = REG_RD(p_hwfn, reg);
- /* Allocate vf sriov info */
- p_iov = kzalloc(sizeof(*p_iov), GFP_KERNEL);
- if (!p_iov)
- return -ENOMEM;
- /* Allocate vf2pf msg */
- p_iov->vf2pf_request = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
- sizeof(union vfpf_tlvs),
- &p_iov->vf2pf_request_phys,
- GFP_KERNEL);
- if (!p_iov->vf2pf_request)
- goto free_p_iov;
- p_iov->pf2vf_reply = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
- sizeof(union pfvf_tlvs),
- &p_iov->pf2vf_reply_phys,
- GFP_KERNEL);
- if (!p_iov->pf2vf_reply)
- goto free_vf2pf_request;
- DP_VERBOSE(p_hwfn,
- QED_MSG_IOV,
- "VF's Request mailbox [%p virt 0x%llx phys], Response mailbox [%p virt 0x%llx phys]\n",
- p_iov->vf2pf_request,
- (u64) p_iov->vf2pf_request_phys,
- p_iov->pf2vf_reply, (u64)p_iov->pf2vf_reply_phys);
- /* Allocate Bulletin board */
- p_iov->bulletin.size = sizeof(struct qed_bulletin_content);
- p_iov->bulletin.p_virt = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
- p_iov->bulletin.size,
- &p_iov->bulletin.phys,
- GFP_KERNEL);
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "VF's bulletin Board [%p virt 0x%llx phys 0x%08x bytes]\n",
- p_iov->bulletin.p_virt,
- (u64)p_iov->bulletin.phys, p_iov->bulletin.size);
- mutex_init(&p_iov->mutex);
- p_hwfn->vf_iov_info = p_iov;
- p_hwfn->hw_info.personality = QED_PCI_ETH;
- return qed_vf_pf_acquire(p_hwfn);
- free_vf2pf_request:
- dma_free_coherent(&p_hwfn->cdev->pdev->dev,
- sizeof(union vfpf_tlvs),
- p_iov->vf2pf_request, p_iov->vf2pf_request_phys);
- free_p_iov:
- kfree(p_iov);
- return -ENOMEM;
- }
- #define TSTORM_QZONE_START PXP_VF_BAR0_START_SDM_ZONE_A
- #define MSTORM_QZONE_START(dev) (TSTORM_QZONE_START + \
- (TSTORM_QZONE_SIZE * NUM_OF_L2_QUEUES(dev)))
- int
- qed_vf_pf_rxq_start(struct qed_hwfn *p_hwfn,
- struct qed_queue_cid *p_cid,
- u16 bd_max_bytes,
- dma_addr_t bd_chain_phys_addr,
- dma_addr_t cqe_pbl_addr,
- u16 cqe_pbl_size, void __iomem **pp_prod)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_start_queue_resp_tlv *resp;
- struct vfpf_start_rxq_tlv *req;
- u8 rx_qid = p_cid->rel.queue_id;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_START_RXQ, sizeof(*req));
- req->rx_qid = rx_qid;
- req->cqe_pbl_addr = cqe_pbl_addr;
- req->cqe_pbl_size = cqe_pbl_size;
- req->rxq_addr = bd_chain_phys_addr;
- req->hw_sb = p_cid->rel.sb;
- req->sb_index = p_cid->rel.sb_idx;
- req->bd_max_bytes = bd_max_bytes;
- req->stat_id = -1;
- /* If PF is legacy, we'll need to calculate producers ourselves
- * as well as clean them.
- */
- if (p_iov->b_pre_fp_hsi) {
- u8 hw_qid = p_iov->acquire_resp.resc.hw_qid[rx_qid];
- u32 init_prod_val = 0;
- *pp_prod = (u8 __iomem *)
- p_hwfn->regview +
- MSTORM_QZONE_START(p_hwfn->cdev) +
- hw_qid * MSTORM_QZONE_SIZE;
- /* Init the rcq, rx bd and rx sge (if valid) producers to 0 */
- __internal_ram_wr(p_hwfn, *pp_prod, sizeof(u32),
- (u32 *)(&init_prod_val));
- }
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->queue_start;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- /* Learn the address of the producer from the response */
- if (!p_iov->b_pre_fp_hsi) {
- u32 init_prod_val = 0;
- *pp_prod = (u8 __iomem *)p_hwfn->regview + resp->offset;
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "Rxq[0x%02x]: producer at %p [offset 0x%08x]\n",
- rx_qid, *pp_prod, resp->offset);
- /* Init the rcq, rx bd and rx sge (if valid) producers to 0 */
- __internal_ram_wr(p_hwfn, *pp_prod, sizeof(u32),
- (u32 *)&init_prod_val);
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_rxq_stop(struct qed_hwfn *p_hwfn,
- struct qed_queue_cid *p_cid, bool cqe_completion)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct vfpf_stop_rxqs_tlv *req;
- struct pfvf_def_resp_tlv *resp;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_STOP_RXQS, sizeof(*req));
- req->rx_qid = p_cid->rel.queue_id;
- req->num_rxqs = 1;
- req->cqe_completion = cqe_completion;
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->default_resp;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int
- qed_vf_pf_txq_start(struct qed_hwfn *p_hwfn,
- struct qed_queue_cid *p_cid,
- dma_addr_t pbl_addr,
- u16 pbl_size, void __iomem **pp_doorbell)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_start_queue_resp_tlv *resp;
- struct vfpf_start_txq_tlv *req;
- u16 qid = p_cid->rel.queue_id;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_START_TXQ, sizeof(*req));
- req->tx_qid = qid;
- /* Tx */
- req->pbl_addr = pbl_addr;
- req->pbl_size = pbl_size;
- req->hw_sb = p_cid->rel.sb;
- req->sb_index = p_cid->rel.sb_idx;
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->queue_start;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- /* Modern PFs provide the actual offsets, while legacy
- * provided only the queue id.
- */
- if (!p_iov->b_pre_fp_hsi) {
- *pp_doorbell = (u8 __iomem *)p_hwfn->doorbells + resp->offset;
- } else {
- u8 cid = p_iov->acquire_resp.resc.cid[qid];
- *pp_doorbell = (u8 __iomem *)p_hwfn->doorbells +
- qed_db_addr_vf(cid,
- DQ_DEMS_LEGACY);
- }
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "Txq[0x%02x]: doorbell at %p [offset 0x%08x]\n",
- qid, *pp_doorbell, resp->offset);
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_txq_stop(struct qed_hwfn *p_hwfn, struct qed_queue_cid *p_cid)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct vfpf_stop_txqs_tlv *req;
- struct pfvf_def_resp_tlv *resp;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_STOP_TXQS, sizeof(*req));
- req->tx_qid = p_cid->rel.queue_id;
- req->num_txqs = 1;
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->default_resp;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_vport_start(struct qed_hwfn *p_hwfn,
- u8 vport_id,
- u16 mtu,
- u8 inner_vlan_removal,
- enum qed_tpa_mode tpa_mode,
- u8 max_buffers_per_cqe, u8 only_untagged)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct vfpf_vport_start_tlv *req;
- struct pfvf_def_resp_tlv *resp;
- int rc, i;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_VPORT_START, sizeof(*req));
- req->mtu = mtu;
- req->vport_id = vport_id;
- req->inner_vlan_removal = inner_vlan_removal;
- req->tpa_mode = tpa_mode;
- req->max_buffers_per_cqe = max_buffers_per_cqe;
- req->only_untagged = only_untagged;
- /* status blocks */
- for (i = 0; i < p_hwfn->vf_iov_info->acquire_resp.resc.num_sbs; i++)
- if (p_hwfn->sbs_info[i])
- req->sb_addr[i] = p_hwfn->sbs_info[i]->sb_phys;
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->default_resp;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_vport_stop(struct qed_hwfn *p_hwfn)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_def_resp_tlv *resp = &p_iov->pf2vf_reply->default_resp;
- int rc;
- /* clear mailbox and prep first tlv */
- qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_VPORT_TEARDOWN,
- sizeof(struct vfpf_first_tlv));
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- static bool
- qed_vf_handle_vp_update_is_needed(struct qed_hwfn *p_hwfn,
- struct qed_sp_vport_update_params *p_data,
- u16 tlv)
- {
- switch (tlv) {
- case CHANNEL_TLV_VPORT_UPDATE_ACTIVATE:
- return !!(p_data->update_vport_active_rx_flg ||
- p_data->update_vport_active_tx_flg);
- case CHANNEL_TLV_VPORT_UPDATE_TX_SWITCH:
- return !!p_data->update_tx_switching_flg;
- case CHANNEL_TLV_VPORT_UPDATE_VLAN_STRIP:
- return !!p_data->update_inner_vlan_removal_flg;
- case CHANNEL_TLV_VPORT_UPDATE_ACCEPT_ANY_VLAN:
- return !!p_data->update_accept_any_vlan_flg;
- case CHANNEL_TLV_VPORT_UPDATE_MCAST:
- return !!p_data->update_approx_mcast_flg;
- case CHANNEL_TLV_VPORT_UPDATE_ACCEPT_PARAM:
- return !!(p_data->accept_flags.update_rx_mode_config ||
- p_data->accept_flags.update_tx_mode_config);
- case CHANNEL_TLV_VPORT_UPDATE_RSS:
- return !!p_data->rss_params;
- case CHANNEL_TLV_VPORT_UPDATE_SGE_TPA:
- return !!p_data->sge_tpa_params;
- default:
- DP_INFO(p_hwfn, "Unexpected vport-update TLV[%d]\n",
- tlv);
- return false;
- }
- }
- static void
- qed_vf_handle_vp_update_tlvs_resp(struct qed_hwfn *p_hwfn,
- struct qed_sp_vport_update_params *p_data)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_def_resp_tlv *p_resp;
- u16 tlv;
- for (tlv = CHANNEL_TLV_VPORT_UPDATE_ACTIVATE;
- tlv < CHANNEL_TLV_VPORT_UPDATE_MAX; tlv++) {
- if (!qed_vf_handle_vp_update_is_needed(p_hwfn, p_data, tlv))
- continue;
- p_resp = (struct pfvf_def_resp_tlv *)
- qed_iov_search_list_tlvs(p_hwfn, p_iov->pf2vf_reply,
- tlv);
- if (p_resp && p_resp->hdr.status)
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "TLV[%d] Configuration %s\n",
- tlv,
- (p_resp && p_resp->hdr.status) ? "succeeded"
- : "failed");
- }
- }
- int qed_vf_pf_vport_update(struct qed_hwfn *p_hwfn,
- struct qed_sp_vport_update_params *p_params)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct vfpf_vport_update_tlv *req;
- struct pfvf_def_resp_tlv *resp;
- u8 update_rx, update_tx;
- u32 resp_size = 0;
- u16 size, tlv;
- int rc;
- resp = &p_iov->pf2vf_reply->default_resp;
- resp_size = sizeof(*resp);
- update_rx = p_params->update_vport_active_rx_flg;
- update_tx = p_params->update_vport_active_tx_flg;
- /* clear mailbox and prep header tlv */
- qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_VPORT_UPDATE, sizeof(*req));
- /* Prepare extended tlvs */
- if (update_rx || update_tx) {
- struct vfpf_vport_update_activate_tlv *p_act_tlv;
- size = sizeof(struct vfpf_vport_update_activate_tlv);
- p_act_tlv = qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_VPORT_UPDATE_ACTIVATE,
- size);
- resp_size += sizeof(struct pfvf_def_resp_tlv);
- if (update_rx) {
- p_act_tlv->update_rx = update_rx;
- p_act_tlv->active_rx = p_params->vport_active_rx_flg;
- }
- if (update_tx) {
- p_act_tlv->update_tx = update_tx;
- p_act_tlv->active_tx = p_params->vport_active_tx_flg;
- }
- }
- if (p_params->update_tx_switching_flg) {
- struct vfpf_vport_update_tx_switch_tlv *p_tx_switch_tlv;
- size = sizeof(struct vfpf_vport_update_tx_switch_tlv);
- tlv = CHANNEL_TLV_VPORT_UPDATE_TX_SWITCH;
- p_tx_switch_tlv = qed_add_tlv(p_hwfn, &p_iov->offset,
- tlv, size);
- resp_size += sizeof(struct pfvf_def_resp_tlv);
- p_tx_switch_tlv->tx_switching = p_params->tx_switching_flg;
- }
- if (p_params->update_approx_mcast_flg) {
- struct vfpf_vport_update_mcast_bin_tlv *p_mcast_tlv;
- size = sizeof(struct vfpf_vport_update_mcast_bin_tlv);
- p_mcast_tlv = qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_VPORT_UPDATE_MCAST, size);
- resp_size += sizeof(struct pfvf_def_resp_tlv);
- memcpy(p_mcast_tlv->bins, p_params->bins,
- sizeof(unsigned long) * ETH_MULTICAST_MAC_BINS_IN_REGS);
- }
- update_rx = p_params->accept_flags.update_rx_mode_config;
- update_tx = p_params->accept_flags.update_tx_mode_config;
- if (update_rx || update_tx) {
- struct vfpf_vport_update_accept_param_tlv *p_accept_tlv;
- tlv = CHANNEL_TLV_VPORT_UPDATE_ACCEPT_PARAM;
- size = sizeof(struct vfpf_vport_update_accept_param_tlv);
- p_accept_tlv = qed_add_tlv(p_hwfn, &p_iov->offset, tlv, size);
- resp_size += sizeof(struct pfvf_def_resp_tlv);
- if (update_rx) {
- p_accept_tlv->update_rx_mode = update_rx;
- p_accept_tlv->rx_accept_filter =
- p_params->accept_flags.rx_accept_filter;
- }
- if (update_tx) {
- p_accept_tlv->update_tx_mode = update_tx;
- p_accept_tlv->tx_accept_filter =
- p_params->accept_flags.tx_accept_filter;
- }
- }
- if (p_params->rss_params) {
- struct qed_rss_params *rss_params = p_params->rss_params;
- struct vfpf_vport_update_rss_tlv *p_rss_tlv;
- size = sizeof(struct vfpf_vport_update_rss_tlv);
- p_rss_tlv = qed_add_tlv(p_hwfn,
- &p_iov->offset,
- CHANNEL_TLV_VPORT_UPDATE_RSS, size);
- resp_size += sizeof(struct pfvf_def_resp_tlv);
- if (rss_params->update_rss_config)
- p_rss_tlv->update_rss_flags |=
- VFPF_UPDATE_RSS_CONFIG_FLAG;
- if (rss_params->update_rss_capabilities)
- p_rss_tlv->update_rss_flags |=
- VFPF_UPDATE_RSS_CAPS_FLAG;
- if (rss_params->update_rss_ind_table)
- p_rss_tlv->update_rss_flags |=
- VFPF_UPDATE_RSS_IND_TABLE_FLAG;
- if (rss_params->update_rss_key)
- p_rss_tlv->update_rss_flags |= VFPF_UPDATE_RSS_KEY_FLAG;
- p_rss_tlv->rss_enable = rss_params->rss_enable;
- p_rss_tlv->rss_caps = rss_params->rss_caps;
- p_rss_tlv->rss_table_size_log = rss_params->rss_table_size_log;
- memcpy(p_rss_tlv->rss_ind_table, rss_params->rss_ind_table,
- sizeof(rss_params->rss_ind_table));
- memcpy(p_rss_tlv->rss_key, rss_params->rss_key,
- sizeof(rss_params->rss_key));
- }
- if (p_params->update_accept_any_vlan_flg) {
- struct vfpf_vport_update_accept_any_vlan_tlv *p_any_vlan_tlv;
- size = sizeof(struct vfpf_vport_update_accept_any_vlan_tlv);
- tlv = CHANNEL_TLV_VPORT_UPDATE_ACCEPT_ANY_VLAN;
- p_any_vlan_tlv = qed_add_tlv(p_hwfn, &p_iov->offset, tlv, size);
- resp_size += sizeof(struct pfvf_def_resp_tlv);
- p_any_vlan_tlv->accept_any_vlan = p_params->accept_any_vlan;
- p_any_vlan_tlv->update_accept_any_vlan_flg =
- p_params->update_accept_any_vlan_flg;
- }
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, resp_size);
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- qed_vf_handle_vp_update_tlvs_resp(p_hwfn, p_params);
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_reset(struct qed_hwfn *p_hwfn)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_def_resp_tlv *resp;
- struct vfpf_first_tlv *req;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_CLOSE, sizeof(*req));
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->default_resp;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EAGAIN;
- goto exit;
- }
- p_hwfn->b_int_enabled = 0;
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_release(struct qed_hwfn *p_hwfn)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_def_resp_tlv *resp;
- struct vfpf_first_tlv *req;
- u32 size;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_RELEASE, sizeof(*req));
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->default_resp;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (!rc && resp->hdr.status != PFVF_STATUS_SUCCESS)
- rc = -EAGAIN;
- qed_vf_pf_req_end(p_hwfn, rc);
- p_hwfn->b_int_enabled = 0;
- if (p_iov->vf2pf_request)
- dma_free_coherent(&p_hwfn->cdev->pdev->dev,
- sizeof(union vfpf_tlvs),
- p_iov->vf2pf_request,
- p_iov->vf2pf_request_phys);
- if (p_iov->pf2vf_reply)
- dma_free_coherent(&p_hwfn->cdev->pdev->dev,
- sizeof(union pfvf_tlvs),
- p_iov->pf2vf_reply, p_iov->pf2vf_reply_phys);
- if (p_iov->bulletin.p_virt) {
- size = sizeof(struct qed_bulletin_content);
- dma_free_coherent(&p_hwfn->cdev->pdev->dev,
- size,
- p_iov->bulletin.p_virt, p_iov->bulletin.phys);
- }
- kfree(p_hwfn->vf_iov_info);
- p_hwfn->vf_iov_info = NULL;
- return rc;
- }
- void qed_vf_pf_filter_mcast(struct qed_hwfn *p_hwfn,
- struct qed_filter_mcast *p_filter_cmd)
- {
- struct qed_sp_vport_update_params sp_params;
- int i;
- memset(&sp_params, 0, sizeof(sp_params));
- sp_params.update_approx_mcast_flg = 1;
- if (p_filter_cmd->opcode == QED_FILTER_ADD) {
- for (i = 0; i < p_filter_cmd->num_mc_addrs; i++) {
- u32 bit;
- bit = qed_mcast_bin_from_mac(p_filter_cmd->mac[i]);
- __set_bit(bit, sp_params.bins);
- }
- }
- qed_vf_pf_vport_update(p_hwfn, &sp_params);
- }
- int qed_vf_pf_filter_ucast(struct qed_hwfn *p_hwfn,
- struct qed_filter_ucast *p_ucast)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct vfpf_ucast_filter_tlv *req;
- struct pfvf_def_resp_tlv *resp;
- int rc;
- /* clear mailbox and prep first tlv */
- req = qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_UCAST_FILTER, sizeof(*req));
- req->opcode = (u8) p_ucast->opcode;
- req->type = (u8) p_ucast->type;
- memcpy(req->mac, p_ucast->mac, ETH_ALEN);
- req->vlan = p_ucast->vlan;
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- resp = &p_iov->pf2vf_reply->default_resp;
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EAGAIN;
- goto exit;
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- int qed_vf_pf_int_cleanup(struct qed_hwfn *p_hwfn)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct pfvf_def_resp_tlv *resp = &p_iov->pf2vf_reply->default_resp;
- int rc;
- /* clear mailbox and prep first tlv */
- qed_vf_pf_prep(p_hwfn, CHANNEL_TLV_INT_CLEANUP,
- sizeof(struct vfpf_first_tlv));
- /* add list termination tlv */
- qed_add_tlv(p_hwfn, &p_iov->offset,
- CHANNEL_TLV_LIST_END, sizeof(struct channel_list_end_tlv));
- rc = qed_send_msg2pf(p_hwfn, &resp->hdr.status, sizeof(*resp));
- if (rc)
- goto exit;
- if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
- rc = -EINVAL;
- goto exit;
- }
- exit:
- qed_vf_pf_req_end(p_hwfn, rc);
- return rc;
- }
- u16 qed_vf_get_igu_sb_id(struct qed_hwfn *p_hwfn, u16 sb_id)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- if (!p_iov) {
- DP_NOTICE(p_hwfn, "vf_sriov_info isn't initialized\n");
- return 0;
- }
- return p_iov->acquire_resp.resc.hw_sbs[sb_id].hw_sb_id;
- }
- int qed_vf_read_bulletin(struct qed_hwfn *p_hwfn, u8 *p_change)
- {
- struct qed_vf_iov *p_iov = p_hwfn->vf_iov_info;
- struct qed_bulletin_content shadow;
- u32 crc, crc_size;
- crc_size = sizeof(p_iov->bulletin.p_virt->crc);
- *p_change = 0;
- /* Need to guarantee PF is not in the middle of writing it */
- memcpy(&shadow, p_iov->bulletin.p_virt, p_iov->bulletin.size);
- /* If version did not update, no need to do anything */
- if (shadow.version == p_iov->bulletin_shadow.version)
- return 0;
- /* Verify the bulletin we see is valid */
- crc = crc32(0, (u8 *)&shadow + crc_size,
- p_iov->bulletin.size - crc_size);
- if (crc != shadow.crc)
- return -EAGAIN;
- /* Set the shadow bulletin and process it */
- memcpy(&p_iov->bulletin_shadow, &shadow, p_iov->bulletin.size);
- DP_VERBOSE(p_hwfn, QED_MSG_IOV,
- "Read a bulletin update %08x\n", shadow.version);
- *p_change = 1;
- return 0;
- }
- void __qed_vf_get_link_params(struct qed_hwfn *p_hwfn,
- struct qed_mcp_link_params *p_params,
- struct qed_bulletin_content *p_bulletin)
- {
- memset(p_params, 0, sizeof(*p_params));
- p_params->speed.autoneg = p_bulletin->req_autoneg;
- p_params->speed.advertised_speeds = p_bulletin->req_adv_speed;
- p_params->speed.forced_speed = p_bulletin->req_forced_speed;
- p_params->pause.autoneg = p_bulletin->req_autoneg_pause;
- p_params->pause.forced_rx = p_bulletin->req_forced_rx;
- p_params->pause.forced_tx = p_bulletin->req_forced_tx;
- p_params->loopback_mode = p_bulletin->req_loopback;
- }
- void qed_vf_get_link_params(struct qed_hwfn *p_hwfn,
- struct qed_mcp_link_params *params)
- {
- __qed_vf_get_link_params(p_hwfn, params,
- &(p_hwfn->vf_iov_info->bulletin_shadow));
- }
- void __qed_vf_get_link_state(struct qed_hwfn *p_hwfn,
- struct qed_mcp_link_state *p_link,
- struct qed_bulletin_content *p_bulletin)
- {
- memset(p_link, 0, sizeof(*p_link));
- p_link->link_up = p_bulletin->link_up;
- p_link->speed = p_bulletin->speed;
- p_link->full_duplex = p_bulletin->full_duplex;
- p_link->an = p_bulletin->autoneg;
- p_link->an_complete = p_bulletin->autoneg_complete;
- p_link->parallel_detection = p_bulletin->parallel_detection;
- p_link->pfc_enabled = p_bulletin->pfc_enabled;
- p_link->partner_adv_speed = p_bulletin->partner_adv_speed;
- p_link->partner_tx_flow_ctrl_en = p_bulletin->partner_tx_flow_ctrl_en;
- p_link->partner_rx_flow_ctrl_en = p_bulletin->partner_rx_flow_ctrl_en;
- p_link->partner_adv_pause = p_bulletin->partner_adv_pause;
- p_link->sfp_tx_fault = p_bulletin->sfp_tx_fault;
- }
- void qed_vf_get_link_state(struct qed_hwfn *p_hwfn,
- struct qed_mcp_link_state *link)
- {
- __qed_vf_get_link_state(p_hwfn, link,
- &(p_hwfn->vf_iov_info->bulletin_shadow));
- }
- void __qed_vf_get_link_caps(struct qed_hwfn *p_hwfn,
- struct qed_mcp_link_capabilities *p_link_caps,
- struct qed_bulletin_content *p_bulletin)
- {
- memset(p_link_caps, 0, sizeof(*p_link_caps));
- p_link_caps->speed_capabilities = p_bulletin->capability_speed;
- }
- void qed_vf_get_link_caps(struct qed_hwfn *p_hwfn,
- struct qed_mcp_link_capabilities *p_link_caps)
- {
- __qed_vf_get_link_caps(p_hwfn, p_link_caps,
- &(p_hwfn->vf_iov_info->bulletin_shadow));
- }
- void qed_vf_get_num_rxqs(struct qed_hwfn *p_hwfn, u8 *num_rxqs)
- {
- *num_rxqs = p_hwfn->vf_iov_info->acquire_resp.resc.num_rxqs;
- }
- void qed_vf_get_port_mac(struct qed_hwfn *p_hwfn, u8 *port_mac)
- {
- memcpy(port_mac,
- p_hwfn->vf_iov_info->acquire_resp.pfdev_info.port_mac, ETH_ALEN);
- }
- void qed_vf_get_num_vlan_filters(struct qed_hwfn *p_hwfn, u8 *num_vlan_filters)
- {
- struct qed_vf_iov *p_vf;
- p_vf = p_hwfn->vf_iov_info;
- *num_vlan_filters = p_vf->acquire_resp.resc.num_vlan_filters;
- }
- void qed_vf_get_num_mac_filters(struct qed_hwfn *p_hwfn, u8 *num_mac_filters)
- {
- struct qed_vf_iov *p_vf = p_hwfn->vf_iov_info;
- *num_mac_filters = p_vf->acquire_resp.resc.num_mac_filters;
- }
- bool qed_vf_check_mac(struct qed_hwfn *p_hwfn, u8 *mac)
- {
- struct qed_bulletin_content *bulletin;
- bulletin = &p_hwfn->vf_iov_info->bulletin_shadow;
- if (!(bulletin->valid_bitmap & (1 << MAC_ADDR_FORCED)))
- return true;
- /* Forbid VF from changing a MAC enforced by PF */
- if (ether_addr_equal(bulletin->mac, mac))
- return false;
- return false;
- }
- static bool qed_vf_bulletin_get_forced_mac(struct qed_hwfn *hwfn,
- u8 *dst_mac, u8 *p_is_forced)
- {
- struct qed_bulletin_content *bulletin;
- bulletin = &hwfn->vf_iov_info->bulletin_shadow;
- if (bulletin->valid_bitmap & (1 << MAC_ADDR_FORCED)) {
- if (p_is_forced)
- *p_is_forced = 1;
- } else if (bulletin->valid_bitmap & (1 << VFPF_BULLETIN_MAC_ADDR)) {
- if (p_is_forced)
- *p_is_forced = 0;
- } else {
- return false;
- }
- ether_addr_copy(dst_mac, bulletin->mac);
- return true;
- }
- void qed_vf_get_fw_version(struct qed_hwfn *p_hwfn,
- u16 *fw_major, u16 *fw_minor,
- u16 *fw_rev, u16 *fw_eng)
- {
- struct pf_vf_pfdev_info *info;
- info = &p_hwfn->vf_iov_info->acquire_resp.pfdev_info;
- *fw_major = info->fw_major;
- *fw_minor = info->fw_minor;
- *fw_rev = info->fw_rev;
- *fw_eng = info->fw_eng;
- }
- static void qed_handle_bulletin_change(struct qed_hwfn *hwfn)
- {
- struct qed_eth_cb_ops *ops = hwfn->cdev->protocol_ops.eth;
- u8 mac[ETH_ALEN], is_mac_exist, is_mac_forced;
- void *cookie = hwfn->cdev->ops_cookie;
- is_mac_exist = qed_vf_bulletin_get_forced_mac(hwfn, mac,
- &is_mac_forced);
- if (is_mac_exist && cookie)
- ops->force_mac(cookie, mac, !!is_mac_forced);
- /* Always update link configuration according to bulletin */
- qed_link_update(hwfn);
- }
- void qed_iov_vf_task(struct work_struct *work)
- {
- struct qed_hwfn *hwfn = container_of(work, struct qed_hwfn,
- iov_task.work);
- u8 change = 0;
- if (test_and_clear_bit(QED_IOV_WQ_STOP_WQ_FLAG, &hwfn->iov_task_flags))
- return;
- /* Handle bulletin board changes */
- qed_vf_read_bulletin(hwfn, &change);
- if (change)
- qed_handle_bulletin_change(hwfn);
- /* As VF is polling bulletin board, need to constantly re-schedule */
- queue_delayed_work(hwfn->iov_wq, &hwfn->iov_task, HZ);
- }
|