numam-dpdk/drivers/net/bnx2x/bnx2x_vfpf.c

/* SPDX-License-Identifier: BSD-3-Clause
 * Copyright (c) 2013-2015 Brocade Communications Systems, Inc.
 * Copyright (c) 2015-2018 Cavium Inc.
 * All rights reserved.
 * www.cavium.com
 */

#include "bnx2x.h"

/* calculate the crc in the bulletin board */
static inline uint32_t
bnx2x_vf_crc(struct bnx2x_vf_bulletin *bull)
{
	uint32_t crc_sz = sizeof(bull->crc), length = bull->length - crc_sz;

	return ECORE_CRC32_LE(0, (uint8_t *)bull + crc_sz, length);
}

/* Checks are there mac/channel updates for VF
 * returns TRUE if something was updated
*/
int
bnx2x_check_bull(struct bnx2x_softc *sc)
{
	struct bnx2x_vf_bulletin *bull;
	uint8_t tries = 0;
	uint16_t old_version = sc->old_bulletin.version;
	uint64_t valid_bitmap;

	bull = sc->pf2vf_bulletin;
	if (old_version == bull->version) {
		return FALSE;
	} else {
		/* Check the crc until we get the correct data */
		while (tries < BNX2X_VF_BULLETIN_TRIES) {
			bull = sc->pf2vf_bulletin;
			if (bull->crc == bnx2x_vf_crc(bull))
				break;

			PMD_DRV_LOG(ERR, sc, "bad crc on bulletin board. contained %x computed %x",
					bull->crc, bnx2x_vf_crc(bull));
			++tries;
		}
		if (tries == BNX2X_VF_BULLETIN_TRIES) {
			PMD_DRV_LOG(ERR, sc, "pf to vf bulletin board crc was wrong %d consecutive times. Aborting",
					tries);
			return FALSE;
		}
	}

	valid_bitmap = bull->valid_bitmap;

	/* check the mac address and VLAN and allocate memory if valid */
	if (valid_bitmap & (1 << MAC_ADDR_VALID) && memcmp(bull->mac, sc->old_bulletin.mac, ETH_ALEN))
		rte_memcpy(&sc->link_params.mac_addr, bull->mac, ETH_ALEN);
	if (valid_bitmap & (1 << VLAN_VALID))
		rte_memcpy(&bull->vlan, &sc->old_bulletin.vlan, VLAN_HLEN);

	sc->old_bulletin = *bull;

	return TRUE;
}

/* place a given tlv on the tlv buffer at a given offset */
static void
bnx2x_add_tlv(__rte_unused struct bnx2x_softc *sc, void *tlvs_list,
	      uint16_t offset, uint16_t type, uint16_t length)
{
	struct channel_tlv *tl = (struct channel_tlv *)
					((unsigned long)tlvs_list + offset);

	tl->type = type;
	tl->length = length;
}

/* Initiliaze header of the first tlv and clear mailbox*/
static void
bnx2x_vf_prep(struct bnx2x_softc *sc, struct vf_first_tlv *first_tlv,
	      uint16_t type, uint16_t length)
{
	struct bnx2x_vf_mbx_msg *mbox = sc->vf2pf_mbox;

	rte_spinlock_lock(&sc->vf2pf_lock);

	PMD_DRV_LOG(DEBUG, sc, "Preparing %d tlv for sending", type);

	memset(mbox, 0, sizeof(struct bnx2x_vf_mbx_msg));

	bnx2x_add_tlv(sc, &first_tlv->tl, 0, type, length);

	/* Initialize header of the first tlv */
	first_tlv->reply_offset = sizeof(mbox->query);
}

/* releases the mailbox */
static void
bnx2x_vf_finalize(struct bnx2x_softc *sc,
		  __rte_unused struct vf_first_tlv *first_tlv)
{
	PMD_DRV_LOG(DEBUG, sc, "done sending [%d] tlv over vf pf channel",
		    first_tlv->tl.type);

	rte_spinlock_unlock(&sc->vf2pf_lock);
}

#define BNX2X_VF_CMD_ADDR_LO PXP_VF_ADDR_CSDM_GLOBAL_START
#define BNX2X_VF_CMD_ADDR_HI BNX2X_VF_CMD_ADDR_LO + 4
#define BNX2X_VF_CMD_TRIGGER BNX2X_VF_CMD_ADDR_HI + 4
#define BNX2X_VF_CHANNEL_DELAY 100
#define BNX2X_VF_CHANNEL_TRIES 100

static int
bnx2x_do_req4pf(struct bnx2x_softc *sc, rte_iova_t phys_addr)
{
	uint8_t *status = &sc->vf2pf_mbox->resp.common_reply.status;
	uint8_t i;

	if (*status) {
		PMD_DRV_LOG(ERR, sc, "status should be zero before message"
				 " to pf was sent");
		return -EINVAL;
	}

	bnx2x_check_bull(sc);
	if (sc->old_bulletin.valid_bitmap & (1 << CHANNEL_DOWN)) {
		PMD_DRV_LOG(ERR, sc, "channel is down. Aborting message sending");
		return -EINVAL;
	}

	REG_WR(sc, BNX2X_VF_CMD_ADDR_LO, U64_LO(phys_addr));
	REG_WR(sc, BNX2X_VF_CMD_ADDR_HI, U64_HI(phys_addr));

	/* memory barrier to ensure that FW can read phys_addr */
	wmb();

	REG_WR8(sc, BNX2X_VF_CMD_TRIGGER, 1);

	/* Do several attempts until PF completes */
	for (i = 0; i < BNX2X_VF_CHANNEL_TRIES; i++) {
		DELAY_MS(BNX2X_VF_CHANNEL_DELAY);
		if (*status)
			break;
	}

	if (!*status) {
		PMD_DRV_LOG(ERR, sc, "Response from PF timed out");
		return -EAGAIN;
	}

	PMD_DRV_LOG(DEBUG, sc, "Response from PF was received");
	return 0;
}

static inline uint16_t bnx2x_check_me_flags(uint32_t val)
{
	if (((val) & ME_REG_VF_VALID) && (!((val) & ME_REG_VF_ERR)))
		return ME_REG_VF_VALID;
	else
		return 0;
}

#define BNX2X_ME_ANSWER_DELAY 100
#define BNX2X_ME_ANSWER_TRIES 10

static inline int bnx2x_read_vf_id(struct bnx2x_softc *sc, uint32_t *vf_id)
{
	uint32_t val;
	uint8_t i = 0;

	while (i <= BNX2X_ME_ANSWER_TRIES) {
		val = BNX2X_DB_READ(DOORBELL_ADDR(sc, 0));
		if (bnx2x_check_me_flags(val)) {
			PMD_DRV_LOG(DEBUG, sc,
				    "valid register value: 0x%08x", val);
			*vf_id = VF_ID(val);
			return 0;
		}

		DELAY_MS(BNX2X_ME_ANSWER_DELAY);
		i++;
	}

	PMD_DRV_LOG(ERR, sc, "Invalid register value: 0x%08x", val);

	return -EINVAL;
}

#define BNX2X_VF_OBTAIN_MAX_TRIES 3
#define BNX2X_VF_OBTAIN_MAC_FILTERS 1
#define BNX2X_VF_OBTAIN_MC_FILTERS 10

static
int bnx2x_loop_obtain_resources(struct bnx2x_softc *sc)
{
	struct vf_acquire_resp_tlv *resp = &sc->vf2pf_mbox->resp.acquire_resp,
				   *sc_resp = &sc->acquire_resp;
	struct vf_resource_query   *res_query;
	struct vf_resc		   *resc;
	int res_obtained = false;
	int tries = 0;
	int rc;

	do {
		PMD_DRV_LOG(DEBUG, sc, "trying to get resources");

		rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
		if (rc)
			return rc;

		memcpy(sc_resp, resp, sizeof(sc->acquire_resp));

		tries++;

		/* check PF to request acceptance */
		if (sc_resp->status == BNX2X_VF_STATUS_SUCCESS) {
			PMD_DRV_LOG(DEBUG, sc, "resources obtained successfully");
			res_obtained = true;
		} else if (sc_resp->status == BNX2X_VF_STATUS_NO_RESOURCES &&
			   tries < BNX2X_VF_OBTAIN_MAX_TRIES) {
			PMD_DRV_LOG(DEBUG, sc,
			   "PF cannot allocate requested amount of resources");

			res_query = &sc->vf2pf_mbox->query[0].acquire.res_query;
			resc      = &sc_resp->resc;

			/* PF refused our request. Try to decrease request params */
			res_query->num_txqs         = min(res_query->num_txqs, resc->num_txqs);
			res_query->num_rxqs         = min(res_query->num_rxqs, resc->num_rxqs);
			res_query->num_sbs          = min(res_query->num_sbs, resc->num_sbs);
			res_query->num_mac_filters  = min(res_query->num_mac_filters, resc->num_mac_filters);
			res_query->num_vlan_filters = min(res_query->num_vlan_filters, resc->num_vlan_filters);
			res_query->num_mc_filters   = min(res_query->num_mc_filters, resc->num_mc_filters);

			memset(&sc->vf2pf_mbox->resp, 0, sizeof(union resp_tlvs));
		} else {
			PMD_DRV_LOG(ERR, sc, "Failed to get the requested "
					 "amount of resources: %d.",
					 sc_resp->status);
			return -EINVAL;
		}
	} while (!res_obtained);

	return 0;
}

int bnx2x_vf_get_resources(struct bnx2x_softc *sc, uint8_t tx_count, uint8_t rx_count)
{
	struct vf_acquire_tlv *acq = &sc->vf2pf_mbox->query[0].acquire;
	uint32_t vf_id;
	int rc;

	bnx2x_vf_close(sc);
	bnx2x_vf_prep(sc, &acq->first_tlv, BNX2X_VF_TLV_ACQUIRE, sizeof(*acq));

	if (bnx2x_read_vf_id(sc, &vf_id)) {
		rc = -EAGAIN;
		goto out;
	}

	acq->vf_id = vf_id;

	acq->res_query.num_rxqs = rx_count;
	acq->res_query.num_txqs = tx_count;
	acq->res_query.num_sbs = sc->igu_sb_cnt;
	acq->res_query.num_mac_filters = BNX2X_VF_OBTAIN_MAC_FILTERS;
	acq->res_query.num_mc_filters = BNX2X_VF_OBTAIN_MC_FILTERS;

	acq->bulletin_addr = sc->pf2vf_bulletin_mapping.paddr;

	/* Request physical port identifier */
	bnx2x_add_tlv(sc, acq, acq->first_tlv.tl.length,
		      BNX2X_VF_TLV_PHYS_PORT_ID,
		      sizeof(struct channel_tlv));

	bnx2x_add_tlv(sc, acq,
		      (acq->first_tlv.tl.length + sizeof(struct channel_tlv)),
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	/* requesting the resources in loop */
	rc = bnx2x_loop_obtain_resources(sc);
	if (rc)
		goto out;

	struct vf_acquire_resp_tlv sc_resp = sc->acquire_resp;

	sc->devinfo.chip_id        |= (sc_resp.chip_num & 0xFFFF);
	sc->devinfo.int_block       = INT_BLOCK_IGU;
	sc->devinfo.chip_port_mode  = CHIP_2_PORT_MODE;
	sc->devinfo.mf_info.mf_ov   = 0;
	sc->devinfo.mf_info.mf_mode = 0;
	sc->devinfo.flash_size      = 0;

	sc->igu_sb_cnt  = sc_resp.resc.num_sbs;
	sc->igu_base_sb = sc_resp.resc.hw_sbs[0] & 0xFF;
	sc->igu_dsb_id  = -1;
	sc->max_tx_queues = sc_resp.resc.num_txqs;
	sc->max_rx_queues = sc_resp.resc.num_rxqs;

	sc->link_params.chip_id = sc->devinfo.chip_id;
	sc->doorbell_size = sc_resp.db_size;
	sc->flags |= BNX2X_NO_WOL_FLAG | BNX2X_NO_ISCSI_OOO_FLAG | BNX2X_NO_ISCSI_FLAG | BNX2X_NO_FCOE_FLAG;

	PMD_DRV_LOG(DEBUG, sc, "status block count = %d, base status block = %x",
		sc->igu_sb_cnt, sc->igu_base_sb);
	strncpy(sc->fw_ver, sc_resp.fw_ver, sizeof(sc->fw_ver));

	if (rte_is_valid_assigned_ether_addr(&sc_resp.resc.current_mac_addr))
		rte_ether_addr_copy(&sc_resp.resc.current_mac_addr,
			(struct rte_ether_addr *)sc->link_params.mac_addr);
	else
		rte_eth_random_addr(sc->link_params.mac_addr);

out:
	bnx2x_vf_finalize(sc, &acq->first_tlv);

	return rc;
}

/* Ask PF to release VF's resources */
void
bnx2x_vf_close(struct bnx2x_softc *sc)
{
	struct vf_release_tlv *query;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	uint32_t vf_id;
	int rc;

	query = &sc->vf2pf_mbox->query[0].release;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_RELEASE,
		      sizeof(*query));

	if (bnx2x_read_vf_id(sc, &vf_id)) {
		rc = -EAGAIN;
		goto out;
	}

	query->vf_id = vf_id;

	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc || reply->status != BNX2X_VF_STATUS_SUCCESS)
		PMD_DRV_LOG(ERR, sc, "Failed to release VF");

out:
	bnx2x_vf_finalize(sc, &query->first_tlv);
}

/* Let PF know the VF status blocks phys_addrs */
int
bnx2x_vf_init(struct bnx2x_softc *sc)
{
	struct vf_init_tlv *query;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	int i, rc;

	PMD_INIT_FUNC_TRACE(sc);

	query = &sc->vf2pf_mbox->query[0].init;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_INIT,
		      sizeof(*query));

	FOR_EACH_QUEUE(sc, i) {
		query->sb_addr[i] = (unsigned long)(sc->fp[i].sb_dma.paddr);
	}

	query->stats_step = sizeof(struct per_queue_stats);
	query->stats_addr = sc->fw_stats_data_mapping +
		offsetof(struct bnx2x_fw_stats_data, queue_stats);

	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc)
		goto out;
	if (reply->status != BNX2X_VF_STATUS_SUCCESS) {
		PMD_DRV_LOG(ERR, sc, "Failed to init VF");
		rc = -EINVAL;
		goto out;
	}

	PMD_DRV_LOG(DEBUG, sc, "VF was initialized");
out:
	bnx2x_vf_finalize(sc, &query->first_tlv);
	return rc;
}

void
bnx2x_vf_unload(struct bnx2x_softc *sc)
{
	struct vf_close_tlv *query;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	uint32_t vf_id;
	int i, rc;

	PMD_INIT_FUNC_TRACE(sc);

	FOR_EACH_QUEUE(sc, i)
		bnx2x_vf_teardown_queue(sc, i);

	bnx2x_vf_set_mac(sc, false);

	query = &sc->vf2pf_mbox->query[0].close;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_CLOSE,
		      sizeof(*query));

	if (bnx2x_read_vf_id(sc, &vf_id)) {
		rc = -EAGAIN;
		goto out;
	}

	query->vf_id = vf_id;

	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc || reply->status != BNX2X_VF_STATUS_SUCCESS)
		PMD_DRV_LOG(ERR, sc,
			    "Bad reply from PF for close message");

out:
	bnx2x_vf_finalize(sc, &query->first_tlv);
}

static inline uint16_t
bnx2x_vf_q_flags(uint8_t leading)
{
	uint16_t flags = leading ? BNX2X_VF_Q_FLAG_LEADING_RSS : 0;

	flags |= BNX2X_VF_Q_FLAG_CACHE_ALIGN;
	flags |= BNX2X_VF_Q_FLAG_STATS;
	flags |= BNX2X_VF_Q_FLAG_VLAN;

	return flags;
}

static void
bnx2x_vf_rx_q_prep(struct bnx2x_softc *sc, struct bnx2x_fastpath *fp,
		struct vf_rxq_params *rxq_init, uint16_t flags)
{
	struct bnx2x_rx_queue *rxq;

	rxq = sc->rx_queues[fp->index];
	if (!rxq) {
		PMD_DRV_LOG(ERR, sc, "RX queue %d is NULL", fp->index);
		return;
	}

	rxq_init->rcq_addr = rxq->cq_ring_phys_addr;
	rxq_init->rcq_np_addr = rxq->cq_ring_phys_addr + BNX2X_PAGE_SIZE;
	rxq_init->rxq_addr = rxq->rx_ring_phys_addr;
	rxq_init->vf_sb_id = fp->index;
	rxq_init->sb_cq_index = HC_INDEX_ETH_RX_CQ_CONS;
	rxq_init->mtu = sc->mtu;
	rxq_init->buf_sz = fp->rx_buf_size;
	rxq_init->flags = flags;
	rxq_init->stat_id = -1;
	rxq_init->cache_line_log = BNX2X_RX_ALIGN_SHIFT;
}

static void
bnx2x_vf_tx_q_prep(struct bnx2x_softc *sc, struct bnx2x_fastpath *fp,
		struct vf_txq_params *txq_init, uint16_t flags)
{
	struct bnx2x_tx_queue *txq;

	txq = sc->tx_queues[fp->index];
	if (!txq) {
		PMD_DRV_LOG(ERR, sc, "TX queue %d is NULL", fp->index);
		return;
	}

	txq_init->txq_addr = txq->tx_ring_phys_addr;
	txq_init->sb_index = HC_INDEX_ETH_TX_CQ_CONS_COS0;
	txq_init->flags = flags;
	txq_init->traffic_type = LLFC_TRAFFIC_TYPE_NW;
	txq_init->vf_sb_id = fp->index;
}

int
bnx2x_vf_setup_queue(struct bnx2x_softc *sc, struct bnx2x_fastpath *fp, int leading)
{
	struct vf_setup_q_tlv *query;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	uint16_t flags = bnx2x_vf_q_flags(leading);
	int rc;

	query = &sc->vf2pf_mbox->query[0].setup_q;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_SETUP_Q,
		      sizeof(*query));

	query->vf_qid = fp->index;
	query->param_valid = VF_RXQ_VALID | VF_TXQ_VALID;

	bnx2x_vf_rx_q_prep(sc, fp, &query->rxq, flags);
	bnx2x_vf_tx_q_prep(sc, fp, &query->txq, flags);

	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc)
		goto out;
	if (reply->status != BNX2X_VF_STATUS_SUCCESS) {
		PMD_DRV_LOG(ERR, sc, "Failed to setup VF queue[%d]",
				 fp->index);
		rc = -EINVAL;
	}
out:
	bnx2x_vf_finalize(sc, &query->first_tlv);

	return rc;
}

int
bnx2x_vf_teardown_queue(struct bnx2x_softc *sc, int qid)
{
	struct vf_q_op_tlv *query_op;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	int rc;

	query_op = &sc->vf2pf_mbox->query[0].q_op;
	bnx2x_vf_prep(sc, &query_op->first_tlv,
		      BNX2X_VF_TLV_TEARDOWN_Q,
		      sizeof(*query_op));

	query_op->vf_qid = qid;

	bnx2x_add_tlv(sc, query_op,
		      query_op->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc || reply->status != BNX2X_VF_STATUS_SUCCESS)
		PMD_DRV_LOG(ERR, sc,
			    "Bad reply for vf_q %d teardown", qid);

	bnx2x_vf_finalize(sc, &query_op->first_tlv);

	return rc;
}

int
bnx2x_vf_set_mac(struct bnx2x_softc *sc, int set)
{
	struct vf_set_q_filters_tlv *query;
	struct vf_common_reply_tlv *reply;
	int rc;

	query = &sc->vf2pf_mbox->query[0].set_q_filters;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_SET_Q_FILTERS,
			sizeof(*query));

	query->vf_qid = sc->fp->index;
	query->mac_filters_cnt = 1;
	query->flags = BNX2X_VF_MAC_VLAN_CHANGED;

	query->filters[0].flags = (set ? BNX2X_VF_Q_FILTER_SET_MAC : 0) |
		BNX2X_VF_Q_FILTER_DEST_MAC_VALID;

	bnx2x_check_bull(sc);

	rte_memcpy(query->filters[0].mac, sc->link_params.mac_addr, ETH_ALEN);

	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc)
		goto out;
	reply = &sc->vf2pf_mbox->resp.common_reply;

	while (BNX2X_VF_STATUS_FAILURE == reply->status &&
			bnx2x_check_bull(sc)) {
		/* A new mac was configured by PF for us */
		rte_memcpy(sc->link_params.mac_addr, sc->pf2vf_bulletin->mac,
				ETH_ALEN);
		rte_memcpy(query->filters[0].mac, sc->pf2vf_bulletin->mac,
				ETH_ALEN);

		rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
		if (rc)
			goto out;
	}

	if (BNX2X_VF_STATUS_SUCCESS != reply->status) {
		PMD_DRV_LOG(ERR, sc, "Bad reply from PF for SET MAC message: %d",
				reply->status);
		rc = -EINVAL;
	}
out:
	bnx2x_vf_finalize(sc, &query->first_tlv);

	return rc;
}

int
bnx2x_vf_config_rss(struct bnx2x_softc *sc,
			  struct ecore_config_rss_params *params)
{
	struct vf_rss_tlv *query;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	int rc;

	query = &sc->vf2pf_mbox->query[0].update_rss;

	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_UPDATE_RSS,
			sizeof(*query));

	/* add list termination tlv */
	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rte_memcpy(query->rss_key, params->rss_key, sizeof(params->rss_key));
	query->rss_key_size = T_ETH_RSS_KEY;

	rte_memcpy(query->ind_table, params->ind_table, T_ETH_INDIRECTION_TABLE_SIZE);
	query->ind_table_size = T_ETH_INDIRECTION_TABLE_SIZE;

	query->rss_result_mask = params->rss_result_mask;
	query->rss_flags = params->rss_flags;

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc)
		goto out;

	if (reply->status != BNX2X_VF_STATUS_SUCCESS) {
		PMD_DRV_LOG(ERR, sc, "Failed to configure RSS");
		rc = -EINVAL;
	}
out:
	bnx2x_vf_finalize(sc, &query->first_tlv);

	return rc;
}

int
bnx2x_vf_set_rx_mode(struct bnx2x_softc *sc)
{
	struct vf_set_q_filters_tlv *query;
	struct vf_common_reply_tlv *reply = &sc->vf2pf_mbox->resp.common_reply;
	int rc;

	query = &sc->vf2pf_mbox->query[0].set_q_filters;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_SET_Q_FILTERS,
			sizeof(*query));

	query->vf_qid = 0;
	query->flags = BNX2X_VF_RX_MASK_CHANGED;

	switch (sc->rx_mode) {
	case BNX2X_RX_MODE_NONE: /* no Rx */
		query->rx_mask = VFPF_RX_MASK_ACCEPT_NONE;
		break;
	case BNX2X_RX_MODE_NORMAL:
		query->rx_mask = VFPF_RX_MASK_ACCEPT_MATCHED_MULTICAST;
		query->rx_mask |= VFPF_RX_MASK_ACCEPT_MATCHED_UNICAST;
		query->rx_mask |= VFPF_RX_MASK_ACCEPT_BROADCAST;
		break;
	case BNX2X_RX_MODE_ALLMULTI:
		query->rx_mask = VFPF_RX_MASK_ACCEPT_ALL_MULTICAST;
		query->rx_mask |= VFPF_RX_MASK_ACCEPT_MATCHED_UNICAST;
		query->rx_mask |= VFPF_RX_MASK_ACCEPT_BROADCAST;
		break;
	case BNX2X_RX_MODE_ALLMULTI_PROMISC:
	case BNX2X_RX_MODE_PROMISC:
		query->rx_mask = VFPF_RX_MASK_ACCEPT_ALL_UNICAST;
		query->rx_mask |= VFPF_RX_MASK_ACCEPT_ALL_MULTICAST;
		query->rx_mask |= VFPF_RX_MASK_ACCEPT_BROADCAST;
		break;
	default:
		PMD_DRV_LOG(ERR, sc, "BAD rx mode (%d)", sc->rx_mode);
		rc = -EINVAL;
		goto out;
	}

	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
		      BNX2X_VF_TLV_LIST_END,
		      sizeof(struct channel_list_end_tlv));

	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc)
		goto out;

	if (reply->status != BNX2X_VF_STATUS_SUCCESS) {
		PMD_DRV_LOG(ERR, sc, "Failed to set RX mode");
		rc = -EINVAL;
	}

out:
	bnx2x_vf_finalize(sc, &query->first_tlv);

	return rc;
}

int
bnx2x_vfpf_set_mcast(struct bnx2x_softc *sc,
					struct rte_ether_addr *mc_addrs,
					uint32_t mc_addrs_num)
{
	struct vf_set_q_filters_tlv *query;
	struct vf_common_reply_tlv *reply =
			&sc->vf2pf_mbox->resp.common_reply;
	int rc = 0;
	uint32_t i = 0;
	query = &sc->vf2pf_mbox->query[0].set_q_filters;
	bnx2x_vf_prep(sc, &query->first_tlv, BNX2X_VF_TLV_SET_Q_FILTERS,
				sizeof(*query));
	/* We support PFVF_MAX_MULTICAST_PER_VF mcast addresses tops */
	if (mc_addrs_num > VF_MAX_MULTICAST_PER_VF) {
		PMD_DRV_LOG(ERR, sc,
		"VF supports not more than %d multicast MAC addresses",
		VF_MAX_MULTICAST_PER_VF);

		rc = -EINVAL;
		goto out;
	}

	for (i = 0; i < mc_addrs_num; i++) {
		PMD_DRV_LOG(DEBUG, sc, "Adding mcast MAC:%x:%x:%x:%x:%x:%x",
				mc_addrs[i].addr_bytes[0],
				mc_addrs[i].addr_bytes[1],
				mc_addrs[i].addr_bytes[2],
				mc_addrs[i].addr_bytes[3],
				mc_addrs[i].addr_bytes[4],
				mc_addrs[i].addr_bytes[5]);
		memcpy(query->multicast[i], mc_addrs[i].addr_bytes, ETH_ALEN);
	}

	query->vf_qid = 0;
	query->flags = BNX2X_VF_MULTICAST_CHANGED;
	query->multicast_cnt = i;

	/* add list termination tlv */
	bnx2x_add_tlv(sc, query, query->first_tlv.tl.length,
				BNX2X_VF_TLV_LIST_END,
				sizeof(struct channel_list_end_tlv));
	rc = bnx2x_do_req4pf(sc, sc->vf2pf_mbox_mapping.paddr);
	if (rc)
		goto out;

	if (reply->status != BNX2X_VF_STATUS_SUCCESS) {
		PMD_DRV_LOG(ERR, sc, "Set Rx mode/multicast failed: %d",
				reply->status);
		rc = -EINVAL;
	}

out:
	bnx2x_vf_finalize(sc, &query->first_tlv);

	return rc;
}