Quelle  rvu_cgx.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/* Marvell RVU Admin Function driver
 *
 * Copyright (C) 2018 Marvell.
 *
 */

#include <linux/types.h>
#include <linux/module.h>
#include <linux/pci.h>

#include "rvu.h"
#include "cgx.h"
#include "lmac_common.h"
#include "rvu_reg.h"
#include "rvu_trace.h"
#include "rvu_npc_hash.h"

struct cgx_evq_entry {
 struct list_head evq_node;
 struct cgx_link_event link_event;
};

#define M(_name, _id, _fn_name, _req_type, _rsp_type)   \
static struct _req_type __maybe_unused     \
*otx2_mbox_alloc_msg_ ## _fn_name(struct rvu *rvu, int devid)  \
{         \
 struct _req_type *req;      \
         \
 req = (struct _req_type *)otx2_mbox_alloc_msg_rsp(  \
  &rvu->afpf_wq_info.mbox_up, devid, sizeof(struct _req_type), \
  sizeof(struct _rsp_type));    \
 if (!req)       \
  return NULL;      \
 req->hdr.sig = OTX2_MBOX_REQ_SIG;    \
 req->hdr.id = _id;      \
 trace_otx2_msg_alloc(rvu->pdev, _id, sizeof(*req), 0);  \
 return req;       \
}

MBOX_UP_CGX_MESSAGES
#undef M

bool is_mac_feature_supported(struct rvu *rvu, int pf, int feature)
{
 u8 cgx_id, lmac_id;
 void *cgxd;

 if (!is_pf_cgxmapped(rvu, pf))
  return 0;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);

 return  (cgx_features_get(cgxd) & feature);
}

#define CGX_OFFSET(x)   ((x) * rvu->hw->lmac_per_cgx)
/* Returns bitmap of mapped PFs */
static u64 cgxlmac_to_pfmap(struct rvu *rvu, u8 cgx_id, u8 lmac_id)
{
 return rvu->cgxlmac2pf_map[CGX_OFFSET(cgx_id) + lmac_id];
}

int cgxlmac_to_pf(struct rvu *rvu, int cgx_id, int lmac_id)
{
 unsigned long pfmap;

 pfmap = cgxlmac_to_pfmap(rvu, cgx_id, lmac_id);

 /* Assumes only one pf mapped to a cgx lmac port */
 if (!pfmap)
  return -ENODEV;
 else
  return find_first_bit(&pfmap,
          rvu->cgx_cnt_max * rvu->hw->lmac_per_cgx);
}

static u8 cgxlmac_id_to_bmap(u8 cgx_id, u8 lmac_id)
{
 return ((cgx_id & 0xF) << 4) | (lmac_id & 0xF);
}

void *rvu_cgx_pdata(u8 cgx_id, struct rvu *rvu)
{
 if (cgx_id >= rvu->cgx_cnt_max)
  return NULL;

 return rvu->cgx_idmap[cgx_id];
}

/* Return first enabled CGX instance if none are enabled then return NULL */
void *rvu_first_cgx_pdata(struct rvu *rvu)
{
 int first_enabled_cgx = 0;
 void *cgxd = NULL;

 for (; first_enabled_cgx < rvu->cgx_cnt_max; first_enabled_cgx++) {
  cgxd = rvu_cgx_pdata(first_enabled_cgx, rvu);
  if (cgxd)
   break;
 }

 return cgxd;
}

/* Based on P2X connectivity find mapped NIX block for a PF */
static void rvu_map_cgx_nix_block(struct rvu *rvu, int pf,
      int cgx_id, int lmac_id)
{
 struct rvu_pfvf *pfvf = &rvu->pf[pf];
 u8 p2x;

 p2x = cgx_lmac_get_p2x(cgx_id, lmac_id);
 /* Firmware sets P2X_SELECT as either NIX0 or NIX1 */
 pfvf->nix_blkaddr = BLKADDR_NIX0;
 if (is_rvu_supports_nix1(rvu) && p2x == CMR_P2X_SEL_NIX1)
  pfvf->nix_blkaddr = BLKADDR_NIX1;
}

static int rvu_map_cgx_lmac_pf(struct rvu *rvu)
{
 struct npc_pkind *pkind = &rvu->hw->pkind;
 int cgx_cnt_max = rvu->cgx_cnt_max;
 int pf = PF_CGXMAP_BASE;
 unsigned long lmac_bmap;
 int size, free_pkind;
 int cgx, lmac, iter;
 int numvfs, hwvfs;

 if (!cgx_cnt_max)
  return 0;

 if (cgx_cnt_max > 0xF || rvu->hw->lmac_per_cgx > 0xF)
  return -EINVAL;

 /* Alloc map table
 * An additional entry is required since PF id starts from 1 and
 * hence entry at offset 0 is invalid.
 */
 size = (cgx_cnt_max * rvu->hw->lmac_per_cgx + 1) * sizeof(u8);
 rvu->pf2cgxlmac_map = devm_kmalloc(rvu->dev, size, GFP_KERNEL);
 if (!rvu->pf2cgxlmac_map)
  return -ENOMEM;

 /* Initialize all entries with an invalid cgx and lmac id */
 memset(rvu->pf2cgxlmac_map, 0xFF, size);

 /* Reverse map table */
 rvu->cgxlmac2pf_map =
  devm_kzalloc(rvu->dev,
        cgx_cnt_max * rvu->hw->lmac_per_cgx * sizeof(u64),
        GFP_KERNEL);
 if (!rvu->cgxlmac2pf_map)
  return -ENOMEM;

 rvu->cgx_mapped_pfs = 0;
 for (cgx = 0; cgx < cgx_cnt_max; cgx++) {
  if (!rvu_cgx_pdata(cgx, rvu))
   continue;
  lmac_bmap = cgx_get_lmac_bmap(rvu_cgx_pdata(cgx, rvu));
  for_each_set_bit(iter, &lmac_bmap, rvu->hw->lmac_per_cgx) {
   if (iter >= MAX_LMAC_COUNT)
    continue;
   lmac = cgx_get_lmacid(rvu_cgx_pdata(cgx, rvu),
           iter);
   rvu->pf2cgxlmac_map[pf] = cgxlmac_id_to_bmap(cgx, lmac);
   rvu->cgxlmac2pf_map[CGX_OFFSET(cgx) + lmac] = 1 << pf;
   free_pkind = rvu_alloc_rsrc(&pkind->rsrc);
   pkind->pfchan_map[free_pkind] = ((pf) & 0x3F) << 16;
   rvu_map_cgx_nix_block(rvu, pf, cgx, lmac);
   rvu->cgx_mapped_pfs++;
   rvu_get_pf_numvfs(rvu, pf, &numvfs, &hwvfs);
   rvu->cgx_mapped_vfs += numvfs;
   pf++;
  }
 }
 return 0;
}

static int rvu_cgx_send_link_info(int cgx_id, int lmac_id, struct rvu *rvu)
{
 struct cgx_evq_entry *qentry;
 unsigned long flags;
 int err;

 qentry = kmalloc(sizeof(*qentry), GFP_KERNEL);
 if (!qentry)
  return -ENOMEM;

 /* Lock the event queue before we read the local link status */
 spin_lock_irqsave(&rvu->cgx_evq_lock, flags);
 err = cgx_get_link_info(rvu_cgx_pdata(cgx_id, rvu), lmac_id,
    &qentry->link_event.link_uinfo);
 qentry->link_event.cgx_id = cgx_id;
 qentry->link_event.lmac_id = lmac_id;
 if (err) {
  kfree(qentry);
  goto skip_add;
 }
 list_add_tail(&qentry->evq_node, &rvu->cgx_evq_head);
skip_add:
 spin_unlock_irqrestore(&rvu->cgx_evq_lock, flags);

 /* start worker to process the events */
 queue_work(rvu->cgx_evh_wq, &rvu->cgx_evh_work);

 return 0;
}

/* This is called from interrupt context and is expected to be atomic */
static int cgx_lmac_postevent(struct cgx_link_event *event, void *data)
{
 struct cgx_evq_entry *qentry;
 struct rvu *rvu = data;

 /* post event to the event queue */
 qentry = kmalloc(sizeof(*qentry), GFP_ATOMIC);
 if (!qentry)
  return -ENOMEM;
 qentry->link_event = *event;
 spin_lock(&rvu->cgx_evq_lock);
 list_add_tail(&qentry->evq_node, &rvu->cgx_evq_head);
 spin_unlock(&rvu->cgx_evq_lock);

 /* start worker to process the events */
 queue_work(rvu->cgx_evh_wq, &rvu->cgx_evh_work);

 return 0;
}

static void cgx_notify_pfs(struct cgx_link_event *event, struct rvu *rvu)
{
 struct cgx_link_user_info *linfo;
 struct cgx_link_info_msg *msg;
 unsigned long pfmap;
 int pfid;

 linfo = &event->link_uinfo;
 pfmap = cgxlmac_to_pfmap(rvu, event->cgx_id, event->lmac_id);
 if (!pfmap) {
  dev_err(rvu->dev, "CGX port%d:%d not mapped with PF\n",
   event->cgx_id, event->lmac_id);
  return;
 }

 do {
  pfid = find_first_bit(&pfmap,
          rvu->cgx_cnt_max * rvu->hw->lmac_per_cgx);
  clear_bit(pfid, &pfmap);

  /* check if notification is enabled */
  if (!test_bit(pfid, &rvu->pf_notify_bmap)) {
   dev_info(rvu->dev, "cgx %d: lmac %d Link status %s\n",
     event->cgx_id, event->lmac_id,
     linfo->link_up ? "UP" : "DOWN");
   continue;
  }

  mutex_lock(&rvu->mbox_lock);

  /* Send mbox message to PF */
  msg = otx2_mbox_alloc_msg_cgx_link_event(rvu, pfid);
  if (!msg) {
   mutex_unlock(&rvu->mbox_lock);
   continue;
  }

  msg->link_info = *linfo;

  otx2_mbox_wait_for_zero(&rvu->afpf_wq_info.mbox_up, pfid);

  otx2_mbox_msg_send_up(&rvu->afpf_wq_info.mbox_up, pfid);

  otx2_mbox_wait_for_rsp(&rvu->afpf_wq_info.mbox_up, pfid);

  mutex_unlock(&rvu->mbox_lock);
 } while (pfmap);
}

static void cgx_evhandler_task(struct work_struct *work)
{
 struct rvu *rvu = container_of(work, struct rvu, cgx_evh_work);
 struct cgx_evq_entry *qentry;
 struct cgx_link_event *event;
 unsigned long flags;

 do {
  /* Dequeue an event */
  spin_lock_irqsave(&rvu->cgx_evq_lock, flags);
  qentry = list_first_entry_or_null(&rvu->cgx_evq_head,
        struct cgx_evq_entry,
        evq_node);
  if (qentry)
   list_del(&qentry->evq_node);
  spin_unlock_irqrestore(&rvu->cgx_evq_lock, flags);
  if (!qentry)
   break; /* nothing more to process */

  event = &qentry->link_event;

  /* process event */
  cgx_notify_pfs(event, rvu);
  kfree(qentry);
 } while (1);
}

static int cgx_lmac_event_handler_init(struct rvu *rvu)
{
 unsigned long lmac_bmap;
 struct cgx_event_cb cb;
 int cgx, lmac, err;
 void *cgxd;

 spin_lock_init(&rvu->cgx_evq_lock);
 INIT_LIST_HEAD(&rvu->cgx_evq_head);
 INIT_WORK(&rvu->cgx_evh_work, cgx_evhandler_task);
 rvu->cgx_evh_wq = alloc_workqueue("rvu_evh_wq", 0, 0);
 if (!rvu->cgx_evh_wq) {
  dev_err(rvu->dev, "alloc workqueue failed");
  return -ENOMEM;
 }

 cb.notify_link_chg = cgx_lmac_postevent; /* link change call back */
 cb.data = rvu;

 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) {
  cgxd = rvu_cgx_pdata(cgx, rvu);
  if (!cgxd)
   continue;
  lmac_bmap = cgx_get_lmac_bmap(cgxd);
  for_each_set_bit(lmac, &lmac_bmap, rvu->hw->lmac_per_cgx) {
   err = cgx_lmac_evh_register(&cb, cgxd, lmac);
   if (err)
    dev_err(rvu->dev,
     "%d:%d handler register failed\n",
     cgx, lmac);
  }
 }

 return 0;
}

static void rvu_cgx_wq_destroy(struct rvu *rvu)
{
 if (rvu->cgx_evh_wq) {
  destroy_workqueue(rvu->cgx_evh_wq);
  rvu->cgx_evh_wq = NULL;
 }
}

int rvu_cgx_init(struct rvu *rvu)
{
 struct mac_ops *mac_ops;
 int cgx, err;
 void *cgxd;

 /* CGX port id starts from 0 and are not necessarily contiguous
 * Hence we allocate resources based on the maximum port id value.
 */
 rvu->cgx_cnt_max = cgx_get_cgxcnt_max();
 if (!rvu->cgx_cnt_max) {
  dev_info(rvu->dev, "No CGX devices found!\n");
  return 0;
 }

 rvu->cgx_idmap = devm_kzalloc(rvu->dev, rvu->cgx_cnt_max *
          sizeof(void *), GFP_KERNEL);
 if (!rvu->cgx_idmap)
  return -ENOMEM;

 /* Initialize the cgxdata table */
 for (cgx = 0; cgx < rvu->cgx_cnt_max; cgx++)
  rvu->cgx_idmap[cgx] = cgx_get_pdata(cgx);

 /* Map CGX LMAC interfaces to RVU PFs */
 err = rvu_map_cgx_lmac_pf(rvu);
 if (err)
  return err;

 /* Clear X2P reset on all MAC blocks */
 for (cgx = 0; cgx < rvu->cgx_cnt_max; cgx++) {
  cgxd = rvu_cgx_pdata(cgx, rvu);
  if (!cgxd)
   continue;
  mac_ops = get_mac_ops(cgxd);
  mac_ops->mac_x2p_reset(cgxd, false);
 }

 /* Register for CGX events */
 err = cgx_lmac_event_handler_init(rvu);
 if (err)
  return err;

 mutex_init(&rvu->cgx_cfg_lock);

 return 0;
}

void cgx_start_linkup(struct rvu *rvu)
{
 unsigned long lmac_bmap;
 struct mac_ops *mac_ops;
 int cgx, lmac, err;
 void *cgxd;

 /* Enable receive on all LMACS */
 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) {
  cgxd = rvu_cgx_pdata(cgx, rvu);
  if (!cgxd)
   continue;
  mac_ops = get_mac_ops(cgxd);
  lmac_bmap = cgx_get_lmac_bmap(cgxd);
  for_each_set_bit(lmac, &lmac_bmap, rvu->hw->lmac_per_cgx)
   mac_ops->mac_enadis_rx(cgxd, lmac, true);
 }

 /* Do link up for all CGX ports */
 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) {
  cgxd = rvu_cgx_pdata(cgx, rvu);
  if (!cgxd)
   continue;
  err = cgx_lmac_linkup_start(cgxd);
  if (err)
   dev_err(rvu->dev,
    "Link up process failed to start on cgx %d\n",
    cgx);
 }
}

int rvu_cgx_exit(struct rvu *rvu)
{
 unsigned long lmac_bmap;
 int cgx, lmac;
 void *cgxd;

 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) {
  cgxd = rvu_cgx_pdata(cgx, rvu);
  if (!cgxd)
   continue;
  lmac_bmap = cgx_get_lmac_bmap(cgxd);
  for_each_set_bit(lmac, &lmac_bmap, rvu->hw->lmac_per_cgx)
   cgx_lmac_evh_unregister(cgxd, lmac);
 }

 /* Ensure event handler unregister is completed */
 mb();

 rvu_cgx_wq_destroy(rvu);
 return 0;
}

/* Most of the CGX configuration is restricted to the mapped PF only,
 * VF's of mapped PF and other PFs are not allowed. This fn() checks
 * whether a PFFUNC is permitted to do the config or not.
 */
inline bool is_cgx_config_permitted(struct rvu *rvu, u16 pcifunc)
{
 if ((pcifunc & RVU_PFVF_FUNC_MASK) ||
     !is_pf_cgxmapped(rvu, rvu_get_pf(rvu->pdev, pcifunc)))
  return false;
 return true;
}

void rvu_cgx_enadis_rx_bp(struct rvu *rvu, int pf, bool enable)
{
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;

 if (!is_pf_cgxmapped(rvu, pf))
  return;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);

 mac_ops = get_mac_ops(cgxd);
 /* Set / clear CTL_BCK to control pause frame forwarding to NIX */
 if (enable)
  mac_ops->mac_enadis_rx_pause_fwding(cgxd, lmac_id, true);
 else
  mac_ops->mac_enadis_rx_pause_fwding(cgxd, lmac_id, false);
}

int rvu_cgx_config_rxtx(struct rvu *rvu, u16 pcifunc, bool start)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;

 if (!is_cgx_config_permitted(rvu, pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);
 mac_ops = get_mac_ops(cgxd);

 return mac_ops->mac_rx_tx_enable(cgxd, lmac_id, start);
}

int rvu_cgx_tx_enable(struct rvu *rvu, u16 pcifunc, bool enable)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;

 if (!is_cgx_config_permitted(rvu, pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);
 mac_ops = get_mac_ops(cgxd);

 return mac_ops->mac_tx_enable(cgxd, lmac_id, enable);
}

int rvu_cgx_config_tx(void *cgxd, int lmac_id, bool enable)
{
 struct mac_ops *mac_ops;

 mac_ops = get_mac_ops(cgxd);
 return mac_ops->mac_tx_enable(cgxd, lmac_id, enable);
}

void rvu_cgx_disable_dmac_entries(struct rvu *rvu, u16 pcifunc)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 int i = 0, lmac_count = 0;
 struct mac_ops *mac_ops;
 u8 max_dmac_filters;
 u8 cgx_id, lmac_id;
 void *cgx_dev;

 if (!is_cgx_config_permitted(rvu, pcifunc))
  return;

 if (rvu_npc_exact_has_match_table(rvu)) {
  rvu_npc_exact_reset(rvu, pcifunc);
  return;
 }

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgx_dev = cgx_get_pdata(cgx_id);
 lmac_count = cgx_get_lmac_cnt(cgx_dev);

 mac_ops = get_mac_ops(cgx_dev);
 if (!mac_ops)
  return;

 max_dmac_filters = mac_ops->dmac_filter_count / lmac_count;

 for (i = 0; i < max_dmac_filters; i++)
  cgx_lmac_addr_del(cgx_id, lmac_id, i);

 /* As cgx_lmac_addr_del does not clear entry for index 0
 * so it needs to be done explicitly
 */
 cgx_lmac_addr_reset(cgx_id, lmac_id);
}

int rvu_mbox_handler_cgx_start_rxtx(struct rvu *rvu, struct msg_req *req,
        struct msg_rsp *rsp)
{
 rvu_cgx_config_rxtx(rvu, req->hdr.pcifunc, true);
 return 0;
}

int rvu_mbox_handler_cgx_stop_rxtx(struct rvu *rvu, struct msg_req *req,
       struct msg_rsp *rsp)
{
 rvu_cgx_config_rxtx(rvu, req->hdr.pcifunc, false);
 return 0;
}

static int rvu_lmac_get_stats(struct rvu *rvu, struct msg_req *req,
         void *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct mac_ops *mac_ops;
 int stat = 0, err = 0;
 u64 tx_stat, rx_stat;
 u8 cgx_idx, lmac;
 void *cgxd;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac);
 cgxd = rvu_cgx_pdata(cgx_idx, rvu);
 mac_ops = get_mac_ops(cgxd);

 /* Rx stats */
 while (stat < mac_ops->rx_stats_cnt) {
  err = mac_ops->mac_get_rx_stats(cgxd, lmac, stat, &rx_stat);
  if (err)
   return err;
  if (mac_ops->rx_stats_cnt == RPM_RX_STATS_COUNT)
   ((struct rpm_stats_rsp *)rsp)->rx_stats[stat] = rx_stat;
  else
   ((struct cgx_stats_rsp *)rsp)->rx_stats[stat] = rx_stat;
  stat++;
 }

 /* Tx stats */
 stat = 0;
 while (stat < mac_ops->tx_stats_cnt) {
  err = mac_ops->mac_get_tx_stats(cgxd, lmac, stat, &tx_stat);
  if (err)
   return err;
  if (mac_ops->tx_stats_cnt == RPM_TX_STATS_COUNT)
   ((struct rpm_stats_rsp *)rsp)->tx_stats[stat] = tx_stat;
  else
   ((struct cgx_stats_rsp *)rsp)->tx_stats[stat] = tx_stat;
  stat++;
 }
 return 0;
}

int rvu_mbox_handler_cgx_stats(struct rvu *rvu, struct msg_req *req,
          struct cgx_stats_rsp *rsp)
{
 return rvu_lmac_get_stats(rvu, req, (void *)rsp);
}

int rvu_mbox_handler_rpm_stats(struct rvu *rvu, struct msg_req *req,
          struct rpm_stats_rsp *rsp)
{
 return rvu_lmac_get_stats(rvu, req, (void *)rsp);
}

int rvu_mbox_handler_cgx_stats_rst(struct rvu *rvu, struct msg_req *req,
       struct msg_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct rvu_pfvf *parent_pf;
 struct mac_ops *mac_ops;
 u8 cgx_idx, lmac;
 void *cgxd;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;

 parent_pf = &rvu->pf[pf];
 /* To ensure reset cgx stats won't affect VF stats,
 *  check if it used by only PF interface.
 *  If not, return
 */
 if (parent_pf->cgx_users > 1) {
  dev_info(rvu->dev, "CGX busy, could not reset statistics\n");
  return 0;
 }

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac);
 cgxd = rvu_cgx_pdata(cgx_idx, rvu);
 mac_ops = get_mac_ops(cgxd);

 return mac_ops->mac_stats_reset(cgxd, lmac);
}

int rvu_mbox_handler_cgx_fec_stats(struct rvu *rvu,
       struct msg_req *req,
       struct cgx_fec_stats_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_idx, lmac;
 void *cgxd;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;
 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac);

 cgxd = rvu_cgx_pdata(cgx_idx, rvu);
 mac_ops = get_mac_ops(cgxd);
 return  mac_ops->get_fec_stats(cgxd, lmac, rsp);
}

int rvu_mbox_handler_cgx_mac_addr_set(struct rvu *rvu,
          struct cgx_mac_addr_set_or_get *req,
          struct cgx_mac_addr_set_or_get *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct rvu_pfvf *pfvf;
 u8 cgx_id, lmac_id;

 if (!is_pf_cgxmapped(rvu, pf))
  return LMAC_AF_ERR_PF_NOT_MAPPED;

 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_mac_addr_set(rvu, req, rsp);

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 pfvf = &rvu->pf[pf];
 ether_addr_copy(pfvf->mac_addr, req->mac_addr);
 cgx_lmac_addr_set(cgx_id, lmac_id, req->mac_addr);

 return 0;
}

int rvu_mbox_handler_cgx_mac_addr_add(struct rvu *rvu,
          struct cgx_mac_addr_add_req *req,
          struct cgx_mac_addr_add_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;
 int rc = 0;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return -EPERM;

 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_mac_addr_add(rvu, req, rsp);

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 rc = cgx_lmac_addr_add(cgx_id, lmac_id, req->mac_addr);
 if (rc >= 0) {
  rsp->index = rc;
  return 0;
 }

 return rc;
}

int rvu_mbox_handler_cgx_mac_addr_del(struct rvu *rvu,
          struct cgx_mac_addr_del_req *req,
          struct msg_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return -EPERM;

 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_mac_addr_del(rvu, req, rsp);

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 return cgx_lmac_addr_del(cgx_id, lmac_id, req->index);
}

int rvu_mbox_handler_cgx_mac_max_entries_get(struct rvu *rvu,
          struct msg_req *req,
          struct cgx_max_dmac_entries_get_rsp
          *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 /* If msg is received from PFs(which are not mapped to CGX LMACs)
 * or VF then no entries are allocated for DMAC filters at CGX level.
 * So returning zero.
 */
 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) {
  rsp->max_dmac_filters = 0;
  return 0;
 }

 if (rvu_npc_exact_has_match_table(rvu)) {
  rsp->max_dmac_filters = rvu_npc_exact_get_max_entries(rvu);
  return 0;
 }

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 rsp->max_dmac_filters = cgx_lmac_addr_max_entries_get(cgx_id, lmac_id);
 return 0;
}

int rvu_mbox_handler_cgx_mac_addr_get(struct rvu *rvu,
          struct cgx_mac_addr_set_or_get *req,
          struct cgx_mac_addr_set_or_get *rsp)
{
 struct rvu_pfvf *pfvf = rvu_get_pfvf(rvu, req->hdr.pcifunc);

 if (!is_pf_cgxmapped(rvu, rvu_get_pf(rvu->pdev, req->hdr.pcifunc)))
  return LMAC_AF_ERR_PF_NOT_MAPPED;

 ether_addr_copy(rsp->mac_addr, pfvf->mac_addr);
 return 0;
}

int rvu_mbox_handler_cgx_promisc_enable(struct rvu *rvu, struct msg_req *req,
     struct msg_rsp *rsp)
{
 u16 pcifunc = req->hdr.pcifunc;
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return -EPERM;

 /* Disable drop on non hit rule */
 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_promisc_enable(rvu, req->hdr.pcifunc);

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 cgx_lmac_promisc_config(cgx_id, lmac_id, true);
 return 0;
}

int rvu_mbox_handler_cgx_promisc_disable(struct rvu *rvu, struct msg_req *req,
      struct msg_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return -EPERM;

 /* Disable drop on non hit rule */
 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_promisc_disable(rvu, req->hdr.pcifunc);

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 cgx_lmac_promisc_config(cgx_id, lmac_id, false);
 return 0;
}

static int rvu_cgx_ptp_rx_cfg(struct rvu *rvu, u16 pcifunc, bool enable)
{
 struct rvu_pfvf *pfvf = rvu_get_pfvf(rvu, pcifunc);
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;

 if (!is_mac_feature_supported(rvu, pf, RVU_LMAC_FEAT_PTP))
  return 0;

 /* This msg is expected only from PF/VFs that are mapped to CGX/RPM LMACs,
 * if received from other PF/VF simply ACK, nothing to do.
 */
 if (!is_pf_cgxmapped(rvu, pf))
  return -EPERM;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);

 mac_ops = get_mac_ops(cgxd);
 mac_ops->mac_enadis_ptp_config(cgxd, lmac_id, enable);
 /* If PTP is enabled then inform NPC that packets to be
 * parsed by this PF will have their data shifted by 8 bytes
 * and if PTP is disabled then no shift is required
 */
 if (npc_config_ts_kpuaction(rvu, pf, pcifunc, enable))
  return -EINVAL;
 /* This flag is required to clean up CGX conf if app gets killed */
 pfvf->hw_rx_tstamp_en = enable;

 /* Inform MCS about 8B RX header */
 rvu_mcs_ptp_cfg(rvu, cgx_id, lmac_id, enable);
 return 0;
}

int rvu_mbox_handler_cgx_ptp_rx_enable(struct rvu *rvu, struct msg_req *req,
           struct msg_rsp *rsp)
{
 if (!is_pf_cgxmapped(rvu, rvu_get_pf(rvu->pdev, req->hdr.pcifunc)))
  return -EPERM;

 return rvu_cgx_ptp_rx_cfg(rvu, req->hdr.pcifunc, true);
}

int rvu_mbox_handler_cgx_ptp_rx_disable(struct rvu *rvu, struct msg_req *req,
     struct msg_rsp *rsp)
{
 return rvu_cgx_ptp_rx_cfg(rvu, req->hdr.pcifunc, false);
}

static int rvu_cgx_config_linkevents(struct rvu *rvu, u16 pcifunc, bool en)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, pcifunc))
  return -EPERM;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 if (en) {
  set_bit(pf, &rvu->pf_notify_bmap);
  /* Send the current link status to PF */
  rvu_cgx_send_link_info(cgx_id, lmac_id, rvu);
 } else {
  clear_bit(pf, &rvu->pf_notify_bmap);
 }

 return 0;
}

int rvu_mbox_handler_cgx_start_linkevents(struct rvu *rvu, struct msg_req *req,
       struct msg_rsp *rsp)
{
 rvu_cgx_config_linkevents(rvu, req->hdr.pcifunc, true);
 return 0;
}

int rvu_mbox_handler_cgx_stop_linkevents(struct rvu *rvu, struct msg_req *req,
      struct msg_rsp *rsp)
{
 rvu_cgx_config_linkevents(rvu, req->hdr.pcifunc, false);
 return 0;
}

int rvu_mbox_handler_cgx_get_linkinfo(struct rvu *rvu, struct msg_req *req,
          struct cgx_link_info_msg *rsp)
{
 u8 cgx_id, lmac_id;
 int pf, err;

 pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);

 if (!is_pf_cgxmapped(rvu, pf))
  return -ENODEV;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 err = cgx_get_link_info(rvu_cgx_pdata(cgx_id, rvu), lmac_id,
    &rsp->link_info);
 return err;
}

int rvu_mbox_handler_cgx_features_get(struct rvu *rvu,
          struct msg_req *req,
          struct cgx_features_info_msg *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_idx, lmac;
 void *cgxd;

 if (!is_pf_cgxmapped(rvu, pf))
  return 0;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac);
 cgxd = rvu_cgx_pdata(cgx_idx, rvu);
 rsp->lmac_features = cgx_features_get(cgxd);

 return 0;
}

u32 rvu_cgx_get_fifolen(struct rvu *rvu)
{
 void *cgxd = rvu_first_cgx_pdata(rvu);

 if (!cgxd)
  return 0;

 return cgx_get_fifo_len(cgxd);
}

u32 rvu_cgx_get_lmac_fifolen(struct rvu *rvu, int cgx, int lmac)
{
 struct mac_ops *mac_ops;
 void *cgxd;

 cgxd = rvu_cgx_pdata(cgx, rvu);
 if (!cgxd)
  return 0;

 mac_ops = get_mac_ops(cgxd);
 if (!mac_ops->lmac_fifo_len)
  return 0;

 return mac_ops->lmac_fifo_len(cgxd, lmac);
}

static int rvu_cgx_config_intlbk(struct rvu *rvu, u16 pcifunc, bool en)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, pcifunc))
  return -EPERM;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 mac_ops = get_mac_ops(rvu_cgx_pdata(cgx_id, rvu));

 return mac_ops->mac_lmac_intl_lbk(rvu_cgx_pdata(cgx_id, rvu),
       lmac_id, en);
}

int rvu_mbox_handler_cgx_intlbk_enable(struct rvu *rvu, struct msg_req *req,
           struct msg_rsp *rsp)
{
 rvu_cgx_config_intlbk(rvu, req->hdr.pcifunc, true);
 return 0;
}

int rvu_mbox_handler_cgx_intlbk_disable(struct rvu *rvu, struct msg_req *req,
     struct msg_rsp *rsp)
{
 rvu_cgx_config_intlbk(rvu, req->hdr.pcifunc, false);
 return 0;
}

int rvu_cgx_cfg_pause_frm(struct rvu *rvu, u16 pcifunc, u8 tx_pause, u8 rx_pause)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 u8 rx_pfc = 0, tx_pfc = 0;
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;

 if (!is_mac_feature_supported(rvu, pf, RVU_LMAC_FEAT_FC))
  return 0;

 /* This msg is expected only from PF/VFs that are mapped to CGX LMACs,
 * if received from other PF/VF simply ACK, nothing to do.
 */
 if (!is_pf_cgxmapped(rvu, pf))
  return LMAC_AF_ERR_PF_NOT_MAPPED;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);
 mac_ops = get_mac_ops(cgxd);

 mac_ops->mac_get_pfc_frm_cfg(cgxd, lmac_id, &tx_pfc, &rx_pfc);
 if (tx_pfc || rx_pfc) {
  dev_warn(rvu->dev,
    "Can not configure 802.3X flow control as PFC frames are enabled");
  return LMAC_AF_ERR_8023PAUSE_ENADIS_PERM_DENIED;
 }

 mutex_lock(&rvu->rsrc_lock);
 if (verify_lmac_fc_cfg(cgxd, lmac_id, tx_pause, rx_pause,
          pcifunc & RVU_PFVF_FUNC_MASK)) {
  mutex_unlock(&rvu->rsrc_lock);
  return LMAC_AF_ERR_PERM_DENIED;
 }
 mutex_unlock(&rvu->rsrc_lock);

 return mac_ops->mac_enadis_pause_frm(cgxd, lmac_id, tx_pause, rx_pause);
}

int rvu_mbox_handler_cgx_cfg_pause_frm(struct rvu *rvu,
           struct cgx_pause_frm_cfg *req,
           struct cgx_pause_frm_cfg *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 int err = 0;
 void *cgxd;

 /* This msg is expected only from PF/VFs that are mapped to CGX LMACs,
 * if received from other PF/VF simply ACK, nothing to do.
 */
 if (!is_pf_cgxmapped(rvu, pf))
  return -ENODEV;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);
 mac_ops = get_mac_ops(cgxd);

 if (req->set)
  err = rvu_cgx_cfg_pause_frm(rvu, req->hdr.pcifunc, req->tx_pause, req->rx_pause);
 else
  mac_ops->mac_get_pause_frm_status(cgxd, lmac_id, &rsp->tx_pause, &rsp->rx_pause);

 return err;
}

int rvu_mbox_handler_cgx_get_phy_fec_stats(struct rvu *rvu, struct msg_req *req,
        struct msg_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_pf_cgxmapped(rvu, pf))
  return LMAC_AF_ERR_PF_NOT_MAPPED;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 return cgx_get_phy_fec_stats(rvu_cgx_pdata(cgx_id, rvu), lmac_id);
}

/* Finds cumulative status of NIX rx/tx counters from LF of a PF and those
 * from its VFs as well. ie. NIX rx/tx counters at the CGX port level
 */
int rvu_cgx_nix_cuml_stats(struct rvu *rvu, void *cgxd, int lmac_id,
      int index, int rxtxflag, u64 *stat)
{
 struct rvu_block *block;
 int blkaddr;
 u16 pcifunc;
 int pf, lf;

 *stat = 0;

 if (!cgxd || !rvu)
  return -EINVAL;

 pf = cgxlmac_to_pf(rvu, cgx_get_cgxid(cgxd), lmac_id);
 if (pf < 0)
  return pf;

 /* Assumes LF of a PF and all of its VF belongs to the same
 * NIX block
 */
 pcifunc = rvu_make_pcifunc(rvu->pdev, pf, 0);
 blkaddr = rvu_get_blkaddr(rvu, BLKTYPE_NIX, pcifunc);
 if (blkaddr < 0)
  return 0;
 block = &rvu->hw->block[blkaddr];

 for (lf = 0; lf < block->lf.max; lf++) {
  /* Check if a lf is attached to this PF or one of its VFs */
  if (!((block->fn_map[lf] & ~RVU_PFVF_FUNC_MASK) == (pcifunc &
    ~RVU_PFVF_FUNC_MASK)))
   continue;
  if (rxtxflag == NIX_STATS_RX)
   *stat += rvu_read64(rvu, blkaddr,
         NIX_AF_LFX_RX_STATX(lf, index));
  else
   *stat += rvu_read64(rvu, blkaddr,
         NIX_AF_LFX_TX_STATX(lf, index));
 }

 return 0;
}

int rvu_cgx_start_stop_io(struct rvu *rvu, u16 pcifunc, bool start)
{
 struct rvu_pfvf *parent_pf, *pfvf;
 int cgx_users, err = 0;

 if (!is_pf_cgxmapped(rvu, rvu_get_pf(rvu->pdev, pcifunc)))
  return 0;

 parent_pf = &rvu->pf[rvu_get_pf(rvu->pdev, pcifunc)];
 pfvf = rvu_get_pfvf(rvu, pcifunc);

 mutex_lock(&rvu->cgx_cfg_lock);

 if (start && pfvf->cgx_in_use)
  goto exit;  /* CGX is already started hence nothing to do */
 if (!start && !pfvf->cgx_in_use)
  goto exit; /* CGX is already stopped hence nothing to do */

 if (start) {
  cgx_users = parent_pf->cgx_users;
  parent_pf->cgx_users++;
 } else {
  parent_pf->cgx_users--;
  cgx_users = parent_pf->cgx_users;
 }

 /* Start CGX when first of all NIXLFs is started.
 * Stop CGX when last of all NIXLFs is stopped.
 */
 if (!cgx_users) {
  err = rvu_cgx_config_rxtx(rvu, pcifunc & ~RVU_PFVF_FUNC_MASK,
       start);
  if (err) {
   dev_err(rvu->dev, "Unable to %s CGX\n",
    start ? "start" : "stop");
   /* Revert the usage count in case of error */
   parent_pf->cgx_users = start ? parent_pf->cgx_users  - 1
            : parent_pf->cgx_users  + 1;
   goto exit;
  }
 }
 pfvf->cgx_in_use = start;
exit:
 mutex_unlock(&rvu->cgx_cfg_lock);
 return err;
}

int rvu_mbox_handler_cgx_set_fec_param(struct rvu *rvu,
           struct fec_mode *req,
           struct fec_mode *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_pf_cgxmapped(rvu, pf))
  return -EPERM;

 if (req->fec == OTX2_FEC_OFF)
  req->fec = OTX2_FEC_NONE;
 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 rsp->fec = cgx_set_fec(req->fec, cgx_id, lmac_id);
 return 0;
}

int rvu_mbox_handler_cgx_get_aux_link_info(struct rvu *rvu, struct msg_req *req,
        struct cgx_fw_data *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!rvu->fwdata)
  return LMAC_AF_ERR_FIRMWARE_DATA_NOT_MAPPED;

 if (!is_pf_cgxmapped(rvu, pf))
  return -EPERM;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 if (rvu->hw->lmac_per_cgx == CGX_LMACS_USX)
  memcpy(&rsp->fwdata,
         &rvu->fwdata->cgx_fw_data_usx[cgx_id][lmac_id],
         sizeof(struct cgx_lmac_fwdata_s));
 else
  memcpy(&rsp->fwdata,
         &rvu->fwdata->cgx_fw_data[cgx_id][lmac_id],
         sizeof(struct cgx_lmac_fwdata_s));

 return 0;
}

int rvu_mbox_handler_cgx_set_link_mode(struct rvu *rvu,
           struct cgx_set_link_mode_req *req,
           struct cgx_set_link_mode_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct cgx_lmac_fwdata_s *linkmodes;
 u8 cgx_idx, lmac;
 void *cgxd;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return -EPERM;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac);
 cgxd = rvu_cgx_pdata(cgx_idx, rvu);
 if (rvu->hw->lmac_per_cgx == CGX_LMACS_USX)
  linkmodes = &rvu->fwdata->cgx_fw_data_usx[cgx_idx][lmac];
 else
  linkmodes = &rvu->fwdata->cgx_fw_data[cgx_idx][lmac];

 rsp->status = cgx_set_link_mode(cgxd, req->args, linkmodes,
     cgx_idx, lmac);
 return 0;
}

int rvu_mbox_handler_cgx_mac_addr_reset(struct rvu *rvu, struct cgx_mac_addr_reset_req *req,
     struct msg_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);

 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_mac_addr_reset(rvu, req, rsp);

 return cgx_lmac_addr_reset(cgx_id, lmac_id);
}

int rvu_mbox_handler_cgx_mac_addr_update(struct rvu *rvu,
      struct cgx_mac_addr_update_req *req,
      struct cgx_mac_addr_update_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 u8 cgx_id, lmac_id;

 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc))
  return LMAC_AF_ERR_PERM_DENIED;

 if (rvu_npc_exact_has_match_table(rvu))
  return rvu_npc_exact_mac_addr_update(rvu, req, rsp);

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 return cgx_lmac_addr_update(cgx_id, lmac_id, req->mac_addr, req->index);
}

int rvu_cgx_prio_flow_ctrl_cfg(struct rvu *rvu, u16 pcifunc, u8 tx_pause,
          u8 rx_pause, u16 pfc_en)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 u8 rx_8023 = 0, tx_8023 = 0;
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;

 /* This msg is expected only from PF/VFs that are mapped to CGX LMACs,
 * if received from other PF/VF simply ACK, nothing to do.
 */
 if (!is_pf_cgxmapped(rvu, pf))
  return -ENODEV;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);
 mac_ops = get_mac_ops(cgxd);

 mac_ops->mac_get_pause_frm_status(cgxd, lmac_id, &tx_8023, &rx_8023);
 if (tx_8023 || rx_8023) {
  dev_warn(rvu->dev,
    "Can not configure PFC as 802.3X pause frames are enabled");
  return LMAC_AF_ERR_PFC_ENADIS_PERM_DENIED;
 }

 mutex_lock(&rvu->rsrc_lock);
 if (verify_lmac_fc_cfg(cgxd, lmac_id, tx_pause, rx_pause,
          pcifunc & RVU_PFVF_FUNC_MASK)) {
  mutex_unlock(&rvu->rsrc_lock);
  return LMAC_AF_ERR_PERM_DENIED;
 }
 mutex_unlock(&rvu->rsrc_lock);

 return mac_ops->pfc_config(cgxd, lmac_id, tx_pause, rx_pause, pfc_en);
}

int rvu_mbox_handler_cgx_prio_flow_ctrl_cfg(struct rvu *rvu,
         struct cgx_pfc_cfg *req,
         struct cgx_pfc_rsp *rsp)
{
 int pf = rvu_get_pf(rvu->pdev, req->hdr.pcifunc);
 struct mac_ops *mac_ops;
 u8 cgx_id, lmac_id;
 void *cgxd;
 int err;

 /* This msg is expected only from PF/VFs that are mapped to CGX LMACs,
 * if received from other PF/VF simply ACK, nothing to do.
 */
 if (!is_pf_cgxmapped(rvu, pf))
  return -ENODEV;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id);
 cgxd = rvu_cgx_pdata(cgx_id, rvu);
 mac_ops = get_mac_ops(cgxd);

 err = rvu_cgx_prio_flow_ctrl_cfg(rvu, req->hdr.pcifunc, req->tx_pause,
      req->rx_pause, req->pfc_en);

 mac_ops->mac_get_pfc_frm_cfg(cgxd, lmac_id, &rsp->tx_pause, &rsp->rx_pause);
 return err;
}

void rvu_mac_reset(struct rvu *rvu, u16 pcifunc)
{
 int pf = rvu_get_pf(rvu->pdev, pcifunc);
 struct mac_ops *mac_ops;
 struct cgx *cgxd;
 u8 cgx, lmac;

 if (!is_pf_cgxmapped(rvu, pf))
  return;

 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx, &lmac);
 cgxd = rvu_cgx_pdata(cgx, rvu);
 mac_ops = get_mac_ops(cgxd);

 if (mac_ops->mac_reset(cgxd, lmac, !is_vf(pcifunc)))
  dev_err(rvu->dev, "Failed to reset MAC\n");
}