自学教程：C++ FW_CMD_OP函数代码示例

/** *	t4vf_port_init - initialize port hardware/software state *	@adapter: the adapter *	@pidx: the adapter port index */int t4vf_port_init(struct adapter *adapter, int pidx){	struct port_info *pi = adap2pinfo(adapter, pidx);	struct fw_vi_cmd vi_cmd, vi_rpl;	struct fw_port_cmd port_cmd, port_rpl;	int v;	u32 word;	/*	 * Execute a VI Read command to get our Virtual Interface information	 * like MAC address, etc.	 */	memset(&vi_cmd, 0, sizeof(vi_cmd));	vi_cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_VI_CMD) |				       FW_CMD_REQUEST |				       FW_CMD_READ);	vi_cmd.alloc_to_len16 = cpu_to_be32(FW_LEN16(vi_cmd));	vi_cmd.type_viid = cpu_to_be16(FW_VI_CMD_VIID(pi->viid));	v = t4vf_wr_mbox(adapter, &vi_cmd, sizeof(vi_cmd), &vi_rpl);	if (v)		return v;	BUG_ON(pi->port_id != FW_VI_CMD_PORTID_GET(vi_rpl.portid_pkd));	pi->rss_size = FW_VI_CMD_RSSSIZE_GET(be16_to_cpu(vi_rpl.rsssize_pkd));	t4_os_set_hw_addr(adapter, pidx, vi_rpl.mac);	/*	 * If we don't have read access to our port information, we're done	 * now.  Otherwise, execute a PORT Read command to get it ...	 */	if (!(adapter->params.vfres.r_caps & FW_CMD_CAP_PORT))		return 0;	memset(&port_cmd, 0, sizeof(port_cmd));	port_cmd.op_to_portid = cpu_to_be32(FW_CMD_OP(FW_PORT_CMD) |					    FW_CMD_REQUEST |					    FW_CMD_READ |					    FW_PORT_CMD_PORTID(pi->port_id));	port_cmd.action_to_len16 =		cpu_to_be32(FW_PORT_CMD_ACTION(FW_PORT_ACTION_GET_PORT_INFO) |			    FW_LEN16(port_cmd));	v = t4vf_wr_mbox(adapter, &port_cmd, sizeof(port_cmd), &port_rpl);	if (v)		return v;	v = 0;	word = be16_to_cpu(port_rpl.u.info.pcap);	if (word & FW_PORT_CAP_SPEED_100M)		v |= SUPPORTED_100baseT_Full;	if (word & FW_PORT_CAP_SPEED_1G)		v |= SUPPORTED_1000baseT_Full;	if (word & FW_PORT_CAP_SPEED_10G)		v |= SUPPORTED_10000baseT_Full;	if (word & FW_PORT_CAP_ANEG)		v |= SUPPORTED_Autoneg;	init_link_config(&pi->link_cfg, v);	return 0;}

/** *	t4vf_set_params - sets FW or device parameters *	@adapter: the adapter *	@nparams: the number of parameters *	@params: the parameter names *	@vals: the parameter values * *	Sets the values of firmware or device parameters.  Up to 7 parameters *	can be specified at once. */int t4vf_set_params(struct adapter *adapter, unsigned int nparams,		    const u32 *params, const u32 *vals){	int i;	struct fw_params_cmd cmd;	struct fw_params_param *p;	size_t len16;	if (nparams > 7)		return -EINVAL;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_PARAMS_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_WRITE);	len16 = DIV_ROUND_UP(offsetof(struct fw_params_cmd,				      param[nparams]), 16);	cmd.retval_len16 = cpu_to_be32(FW_CMD_LEN16(len16));	for (i = 0, p = &cmd.param[0]; i < nparams; i++, p++) {		p->mnem = cpu_to_be32(*params++);		p->val = cpu_to_be32(*vals++);	}	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_set_rxmode - set Rx properties of a virtual interface *	@adapter: the adapter *	@viid: the VI id *	@mtu: the new MTU or -1 for no change *	@promisc: 1 to enable promiscuous mode, 0 to disable it, -1 no change *	@all_multi: 1 to enable all-multi mode, 0 to disable it, -1 no change *	@bcast: 1 to enable broadcast Rx, 0 to disable it, -1 no change *	@vlanex: 1 to enable hardware VLAN Tag extraction, 0 to disable it, *		-1 no change * *	Sets Rx properties of a virtual interface. */int t4vf_set_rxmode(struct adapter *adapter, unsigned int viid,		    int mtu, int promisc, int all_multi, int bcast, int vlanex,		    bool sleep_ok){	struct fw_vi_rxmode_cmd cmd;	/* convert to FW values */	if (mtu < 0)		mtu = FW_VI_RXMODE_CMD_MTU_MASK;	if (promisc < 0)		promisc = FW_VI_RXMODE_CMD_PROMISCEN_MASK;	if (all_multi < 0)		all_multi = FW_VI_RXMODE_CMD_ALLMULTIEN_MASK;	if (bcast < 0)		bcast = FW_VI_RXMODE_CMD_BROADCASTEN_MASK;	if (vlanex < 0)		vlanex = FW_VI_RXMODE_CMD_VLANEXEN_MASK;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_RXMODE_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_WRITE |				     FW_VI_RXMODE_CMD_VIID(viid));	cmd.retval_len16 = cpu_to_be32(FW_LEN16(cmd));	cmd.mtu_to_vlanexen =		cpu_to_be32(FW_VI_RXMODE_CMD_MTU(mtu) |			    FW_VI_RXMODE_CMD_PROMISCEN(promisc) |			    FW_VI_RXMODE_CMD_ALLMULTIEN(all_multi) |			    FW_VI_RXMODE_CMD_BROADCASTEN(bcast) |			    FW_VI_RXMODE_CMD_VLANEXEN(vlanex));	return t4vf_wr_mbox_core(adapter, &cmd, sizeof(cmd), NULL, sleep_ok);}

/** *	t4vf_change_mac - modifies the exact-match filter for a MAC address *	@adapter: the adapter *	@viid: the Virtual Interface ID *	@idx: index of existing filter for old value of MAC address, or -1 *	@addr: the new MAC address value *	@persist: if idx < 0, the new MAC allocation should be persistent * *	Modifies an exact-match filter and sets it to the new MAC address. *	Note that in general it is not possible to modify the value of a given *	filter so the generic way to modify an address filter is to free the *	one being used by the old address value and allocate a new filter for *	the new address value.  @idx can be -1 if the address is a new *	addition. * *	Returns a negative error number or the index of the filter with the new *	MAC value. */int t4vf_change_mac(struct adapter *adapter, unsigned int viid,		    int idx, const u8 *addr, bool persist){	int ret;	struct fw_vi_mac_cmd cmd, rpl;	struct fw_vi_mac_exact *p = &cmd.u.exact[0];	size_t len16 = DIV_ROUND_UP(offsetof(struct fw_vi_mac_cmd,					     u.exact[1]), 16);	/*	 * If this is a new allocation, determine whether it should be	 * persistent (across a "freemacs" operation) or not.	 */	if (idx < 0)		idx = persist ? FW_VI_MAC_ADD_PERSIST_MAC : FW_VI_MAC_ADD_MAC;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_MAC_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_WRITE |				     FW_VI_MAC_CMD_VIID(viid));	cmd.freemacs_to_len16 = cpu_to_be32(FW_CMD_LEN16(len16));	p->valid_to_idx = cpu_to_be16(FW_VI_MAC_CMD_VALID |				      FW_VI_MAC_CMD_IDX(idx));	memcpy(p->macaddr, addr, sizeof(p->macaddr));	ret = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), &rpl);	if (ret == 0) {		p = &rpl.u.exact[0];		ret = FW_VI_MAC_CMD_IDX_GET(be16_to_cpu(p->valid_to_idx));		if (ret >= FW_CLS_TCAM_NUM_ENTRIES)			ret = -ENOMEM;	}	return ret;}

/** *	t4vf_query_params - query FW or device parameters *	@adapter: the adapter *	@nparams: the number of parameters *	@params: the parameter names *	@vals: the parameter values * *	Reads the values of firmware or device parameters.  Up to 7 parameters *	can be queried at once. */static int t4vf_query_params(struct adapter *adapter, unsigned int nparams,			     const u32 *params, u32 *vals){	int i, ret;	struct fw_params_cmd cmd, rpl;	struct fw_params_param *p;	size_t len16;	if (nparams > 7)		return -EINVAL;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_PARAMS_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_READ);	len16 = DIV_ROUND_UP(offsetof(struct fw_params_cmd,				      param[nparams].mnem), 16);	cmd.retval_len16 = cpu_to_be32(FW_CMD_LEN16(len16));	for (i = 0, p = &cmd.param[0]; i < nparams; i++, p++)		p->mnem = htonl(*params++);	ret = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), &rpl);	if (ret == 0)		for (i = 0, p = &rpl.param[0]; i < nparams; i++, p++)			*vals++ = be32_to_cpu(p->val);	return ret;}

/** *      t4vf_fw_reset - issue a reset to FW *      @adapter: the adapter * *	Issues a reset command to FW.  For a Physical Function this would *	result in the Firmware reseting all of its state.  For a Virtual *	Function this just resets the state associated with the VF. */int t4vf_fw_reset(struct adapter *adapter){	struct fw_reset_cmd cmd;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_write = cpu_to_be32(FW_CMD_OP(FW_RESET_CMD) |				      FW_CMD_WRITE);	cmd.retval_len16 = cpu_to_be32(FW_LEN16(cmd));	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_eth_eq_free - free an Ethernet egress queue *	@adapter: the adapter *	@eqid: egress queue ID * *	Frees an Ethernet egress queue. */int t4vf_eth_eq_free(struct adapter *adapter, unsigned int eqid){	struct fw_eq_eth_cmd cmd;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_EQ_ETH_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_EXEC);	cmd.alloc_to_len16 = cpu_to_be32(FW_EQ_ETH_CMD_FREE |					 FW_LEN16(cmd));	cmd.eqid_pkd = cpu_to_be32(FW_EQ_ETH_CMD_EQID(eqid));	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_identify_port - identify a VI's port by blinking its LED *	@adapter: the adapter *	@viid: the Virtual Interface ID *	@nblinks: how many times to blink LED at 2.5 Hz * *	Identifies a VI's port by blinking its LED. */int t4vf_identify_port(struct adapter *adapter, unsigned int viid,		       unsigned int nblinks){	struct fw_vi_enable_cmd cmd;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_ENABLE_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_EXEC |				     FW_VI_ENABLE_CMD_VIID(viid));	cmd.ien_to_len16 = cpu_to_be32(FW_VI_ENABLE_CMD_LED |				       FW_LEN16(cmd));	cmd.blinkdur = cpu_to_be16(nblinks);	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_enable_vi - enable/disable a virtual interface *	@adapter: the adapter *	@viid: the Virtual Interface ID *	@rx_en: 1=enable Rx, 0=disable Rx *	@tx_en: 1=enable Tx, 0=disable Tx * *	Enables/disables a virtual interface. */int t4vf_enable_vi(struct adapter *adapter, unsigned int viid,		   bool rx_en, bool tx_en){	struct fw_vi_enable_cmd cmd;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_ENABLE_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_EXEC |				     FW_VI_ENABLE_CMD_VIID(viid));	cmd.ien_to_len16 = cpu_to_be32(FW_VI_ENABLE_CMD_IEN(rx_en) |				       FW_VI_ENABLE_CMD_EEN(tx_en) |				       FW_LEN16(cmd));	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_free_vi -- free a virtual interface *	@adapter: the adapter *	@viid: the virtual interface identifier * *	Free a previously allocated Virtual Interface.  Return an error on *	failure. */int t4vf_free_vi(struct adapter *adapter, int viid){	struct fw_vi_cmd cmd;	/*	 * Execute a VI command to free the Virtual Interface.	 */	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_VI_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_EXEC);	cmd.alloc_to_len16 = cpu_to_be32(FW_LEN16(cmd) |					 FW_VI_CMD_FREE);	cmd.type_viid = cpu_to_be16(FW_VI_CMD_VIID(viid));	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_set_addr_hash - program the MAC inexact-match hash filter *	@adapter: the adapter *	@viid: the Virtual Interface Identifier *	@ucast: whether the hash filter should also match unicast addresses *	@vec: the value to be written to the hash filter *	@sleep_ok: call is allowed to sleep * *	Sets the 64-bit inexact-match hash filter for a virtual interface. */int t4vf_set_addr_hash(struct adapter *adapter, unsigned int viid,		       bool ucast, u64 vec, bool sleep_ok){	struct fw_vi_mac_cmd cmd;	size_t len16 = DIV_ROUND_UP(offsetof(struct fw_vi_mac_cmd,					     u.exact[0]), 16);	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_MAC_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_WRITE |				     FW_VI_ENABLE_CMD_VIID(viid));	cmd.freemacs_to_len16 = cpu_to_be32(FW_VI_MAC_CMD_HASHVECEN |					    FW_VI_MAC_CMD_HASHUNIEN(ucast) |					    FW_CMD_LEN16(len16));	cmd.u.hash.hashvec = cpu_to_be64(vec);	return t4vf_wr_mbox_core(adapter, &cmd, sizeof(cmd), NULL, sleep_ok);}

/** *	t4vf_get_vfres - retrieve VF resource limits *	@adapter: the adapter * *	Retrieves configured resource limits and capabilities for a virtual *	function.  The results are stored in @adapter->vfres. */int t4vf_get_vfres(struct adapter *adapter){	struct vf_resources *vfres = &adapter->params.vfres;	struct fw_pfvf_cmd cmd, rpl;	int v;	u32 word;	/*	 * Execute PFVF Read command to get VF resource limits; bail out early	 * with error on command failure.	 */	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_PFVF_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_READ);	cmd.retval_len16 = cpu_to_be32(FW_LEN16(cmd));	v = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), &rpl);	if (v)		return v;	/*	 * Extract VF resource limits and return success.	 */	word = be32_to_cpu(rpl.niqflint_niq);	vfres->niqflint = FW_PFVF_CMD_NIQFLINT_GET(word);	vfres->niq = FW_PFVF_CMD_NIQ_GET(word);	word = be32_to_cpu(rpl.type_to_neq);	vfres->neq = FW_PFVF_CMD_NEQ_GET(word);	vfres->pmask = FW_PFVF_CMD_PMASK_GET(word);	word = be32_to_cpu(rpl.tc_to_nexactf);	vfres->tc = FW_PFVF_CMD_TC_GET(word);	vfres->nvi = FW_PFVF_CMD_NVI_GET(word);	vfres->nexactf = FW_PFVF_CMD_NEXACTF_GET(word);	word = be32_to_cpu(rpl.r_caps_to_nethctrl);	vfres->r_caps = FW_PFVF_CMD_R_CAPS_GET(word);	vfres->wx_caps = FW_PFVF_CMD_WX_CAPS_GET(word);	vfres->nethctrl = FW_PFVF_CMD_NETHCTRL_GET(word);	return 0;}

/** *	t4vf_iq_free - free an ingress queue and its free lists *	@adapter: the adapter *	@iqtype: the ingress queue type (FW_IQ_TYPE_FL_INT_CAP, etc.) *	@iqid: ingress queue ID *	@fl0id: FL0 queue ID or 0xffff if no attached FL0 *	@fl1id: FL1 queue ID or 0xffff if no attached FL1 * *	Frees an ingress queue and its associated free lists, if any. */int t4vf_iq_free(struct adapter *adapter, unsigned int iqtype,		 unsigned int iqid, unsigned int fl0id, unsigned int fl1id){	struct fw_iq_cmd cmd;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_IQ_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_EXEC);	cmd.alloc_to_len16 = cpu_to_be32(FW_IQ_CMD_FREE |					 FW_LEN16(cmd));	cmd.type_to_iqandstindex =		cpu_to_be32(FW_IQ_CMD_TYPE(iqtype));	cmd.iqid = cpu_to_be16(iqid);	cmd.fl0id = cpu_to_be16(fl0id);	cmd.fl1id = cpu_to_be16(fl1id);	return t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);}

/** *	t4vf_read_rss_vi_config - read a VI's RSS configuration *	@adapter: the adapter *	@viid: Virtual Interface ID *	@config: pointer to host-native VI RSS Configuration buffer * *	Reads the Virtual Interface's RSS configuration information and *	translates it into CPU-native format. */int t4vf_read_rss_vi_config(struct adapter *adapter, unsigned int viid,			    union rss_vi_config *config){	struct fw_rss_vi_config_cmd cmd, rpl;	int v;	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_RSS_VI_CONFIG_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_READ |				     FW_RSS_VI_CONFIG_CMD_VIID(viid));	cmd.retval_len16 = cpu_to_be32(FW_LEN16(cmd));	v = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), &rpl);	if (v)		return v;	switch (adapter->params.rss.mode) {	case FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL: {		u32 word = be32_to_cpu(rpl.u.basicvirtual.defaultq_to_udpen);		config->basicvirtual.ip6fourtupen =			((word & FW_RSS_VI_CONFIG_CMD_IP6FOURTUPEN) != 0);		config->basicvirtual.ip6twotupen =			((word & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN) != 0);		config->basicvirtual.ip4fourtupen =			((word & FW_RSS_VI_CONFIG_CMD_IP4FOURTUPEN) != 0);		config->basicvirtual.ip4twotupen =			((word & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN) != 0);		config->basicvirtual.udpen =			((word & FW_RSS_VI_CONFIG_CMD_UDPEN) != 0);		config->basicvirtual.defaultq =			FW_RSS_VI_CONFIG_CMD_DEFAULTQ_GET(word);		break;	}	default:		return -EINVAL;	}	return 0;}

/** *	t4vf_alloc_vi - allocate a virtual interface on a port *	@adapter: the adapter *	@port_id: physical port associated with the VI * *	Allocate a new Virtual Interface and bind it to the indicated *	physical port.  Return the new Virtual Interface Identifier on *	success, or a [negative] error number on failure. */int t4vf_alloc_vi(struct adapter *adapter, int port_id){	struct fw_vi_cmd cmd, rpl;	int v;	/*	 * Execute a VI command to allocate Virtual Interface and return its	 * VIID.	 */	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_vfn = cpu_to_be32(FW_CMD_OP(FW_VI_CMD) |				    FW_CMD_REQUEST |				    FW_CMD_WRITE |				    FW_CMD_EXEC);	cmd.alloc_to_len16 = cpu_to_be32(FW_LEN16(cmd) |					 FW_VI_CMD_ALLOC);	cmd.portid_pkd = FW_VI_CMD_PORTID(port_id);	v = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), &rpl);	if (v)		return v;	return FW_VI_CMD_VIID_GET(be16_to_cpu(rpl.type_viid));}

/** *	t4vf_config_rss_range - configure a portion of the RSS mapping table *	@adapter: the adapter *	@viid: Virtual Interface of RSS Table Slice *	@start: starting entry in the table to write *	@n: how many table entries to write *	@rspq: values for the "Response Queue" (Ingress Queue) lookup table *	@nrspq: number of values in @rspq * *	Programs the selected part of the VI's RSS mapping table with the *	provided values.  If @nrspq < @n the supplied values are used repeatedly *	until the full table range is populated. * *	The caller must ensure the values in @rspq are in the range 0..1023. */int t4vf_config_rss_range(struct adapter *adapter, unsigned int viid,			  int start, int n, const u16 *rspq, int nrspq){	const u16 *rsp = rspq;	const u16 *rsp_end = rspq+nrspq;	struct fw_rss_ind_tbl_cmd cmd;	/*	 * Initialize firmware command template to write the RSS table.	 */	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_RSS_IND_TBL_CMD) |				     FW_CMD_REQUEST |				     FW_CMD_WRITE |				     FW_RSS_IND_TBL_CMD_VIID(viid));	cmd.retval_len16 = cpu_to_be32(FW_LEN16(cmd));	/*	 * Each firmware RSS command can accommodate up to 32 RSS Ingress	 * Queue Identifiers.  These Ingress Queue IDs are packed three to	 * a 32-bit word as 10-bit values with the upper remaining 2 bits	 * reserved.	 */	while (n > 0) {		__be32 *qp = &cmd.iq0_to_iq2;		int nq = min(n, 32);		int ret;		/*		 * Set up the firmware RSS command header to send the next		 * "nq" Ingress Queue IDs to the firmware.		 */		cmd.niqid = cpu_to_be16(nq);		cmd.startidx = cpu_to_be16(start);		/*		 * "nq" more done for the start of the next loop.		 */		start += nq;		n -= nq;		/*		 * While there are still Ingress Queue IDs to stuff into the		 * current firmware RSS command, retrieve them from the		 * Ingress Queue ID array and insert them into the command.		 */		while (nq > 0) {			/*			 * Grab up to the next 3 Ingress Queue IDs (wrapping			 * around the Ingress Queue ID array if necessary) and			 * insert them into the firmware RSS command at the			 * current 3-tuple position within the commad.			 */			u16 qbuf[3];			u16 *qbp = qbuf;			int nqbuf = min(3, nq);			nq -= nqbuf;			qbuf[0] = qbuf[1] = qbuf[2] = 0;			while (nqbuf) {				nqbuf--;				*qbp++ = *rsp++;				if (rsp >= rsp_end)					rsp = rspq;			}			*qp++ = cpu_to_be32(FW_RSS_IND_TBL_CMD_IQ0(qbuf[0]) |					    FW_RSS_IND_TBL_CMD_IQ1(qbuf[1]) |					    FW_RSS_IND_TBL_CMD_IQ2(qbuf[2]));		}		/*		 * Send this portion of the RRS table update to the firmware;		 * bail out on any errors.		 */		ret = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), NULL);		if (ret)			return ret;	}	return 0;}

/** *	t4vf_get_rss_glb_config - retrieve adapter RSS Global Configuration *	@adapter: the adapter * *	Retrieves global RSS mode and parameters with which we have to live *	and stores them in the @adapter's RSS parameters. */int t4vf_get_rss_glb_config(struct adapter *adapter){	struct rss_params *rss = &adapter->params.rss;	struct fw_rss_glb_config_cmd cmd, rpl;	int v;	/*	 * Execute an RSS Global Configuration read command to retrieve	 * our RSS configuration.	 */	memset(&cmd, 0, sizeof(cmd));	cmd.op_to_write = cpu_to_be32(FW_CMD_OP(FW_RSS_GLB_CONFIG_CMD) |				      FW_CMD_REQUEST |				      FW_CMD_READ);	cmd.retval_len16 = cpu_to_be32(FW_LEN16(cmd));	v = t4vf_wr_mbox(adapter, &cmd, sizeof(cmd), &rpl);	if (v)		return v;	/*	 * Transate the big-endian RSS Global Configuration into our	 * cpu-endian format based on the RSS mode.  We also do first level	 * filtering at this point to weed out modes which don't support	 * VF Drivers ...	 */	rss->mode = FW_RSS_GLB_CONFIG_CMD_MODE_GET(			be32_to_cpu(rpl.u.manual.mode_pkd));	switch (rss->mode) {	case FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL: {		u32 word = be32_to_cpu(				rpl.u.basicvirtual.synmapen_to_hashtoeplitz);		rss->u.basicvirtual.synmapen =			((word & FW_RSS_GLB_CONFIG_CMD_SYNMAPEN) != 0);		rss->u.basicvirtual.syn4tupenipv6 =			((word & FW_RSS_GLB_CONFIG_CMD_SYN4TUPENIPV6) != 0);		rss->u.basicvirtual.syn2tupenipv6 =			((word & FW_RSS_GLB_CONFIG_CMD_SYN2TUPENIPV6) != 0);		rss->u.basicvirtual.syn4tupenipv4 =			((word & FW_RSS_GLB_CONFIG_CMD_SYN4TUPENIPV4) != 0);		rss->u.basicvirtual.syn2tupenipv4 =			((word & FW_RSS_GLB_CONFIG_CMD_SYN2TUPENIPV4) != 0);		rss->u.basicvirtual.ofdmapen =			((word & FW_RSS_GLB_CONFIG_CMD_OFDMAPEN) != 0);		rss->u.basicvirtual.tnlmapen =			((word & FW_RSS_GLB_CONFIG_CMD_TNLMAPEN) != 0);		rss->u.basicvirtual.tnlalllookup =			((word  & FW_RSS_GLB_CONFIG_CMD_TNLALLLKP) != 0);		rss->u.basicvirtual.hashtoeplitz =			((word & FW_RSS_GLB_CONFIG_CMD_HASHTOEPLITZ) != 0);		/* we need at least Tunnel Map Enable to be set */		if (!rss->u.basicvirtual.tnlmapen)			return -EINVAL;		break;	}	default:		/* all unknown/unsupported RSS modes result in an error */		return -EINVAL;	}	return 0;}

/** *	t4vf_alloc_mac_filt - allocates exact-match filters for MAC addresses *	@adapter: the adapter *	@viid: the Virtual Interface Identifier *	@free: if true any existing filters for this VI id are first removed *	@naddr: the number of MAC addresses to allocate filters for (up to 7) *	@addr: the MAC address(es) *	@idx: where to store the index of each allocated filter *	@hash: pointer to hash address filter bitmap *	@sleep_ok: call is allowed to sleep * *	Allocates an exact-match filter for each of the supplied addresses and *	sets it to the corresponding address.  If @idx is not %NULL it should *	have at least @naddr entries, each of which will be set to the index of *	the filter allocated for the corresponding MAC address.  If a filter *	could not be allocated for an address its index is set to 0xffff. *	If @hash is not %NULL addresses that fail to allocate an exact filter *	are hashed and update the hash filter bitmap pointed at by @hash. * *	Returns a negative error number or the number of filters allocated. */int t4vf_alloc_mac_filt(struct adapter *adapter, unsigned int viid, bool free,			unsigned int naddr, const u8 **addr, u16 *idx,			u64 *hash, bool sleep_ok){	int offset, ret = 0;	unsigned nfilters = 0;	unsigned int rem = naddr;	struct fw_vi_mac_cmd cmd, rpl;	unsigned int max_naddr = is_t4(adapter->params.chip) ?				 NUM_MPS_CLS_SRAM_L_INSTANCES :				 NUM_MPS_T5_CLS_SRAM_L_INSTANCES;	if (naddr > max_naddr)		return -EINVAL;	for (offset = 0; offset < naddr; /**/) {		unsigned int fw_naddr = (rem < ARRAY_SIZE(cmd.u.exact)					 ? rem					 : ARRAY_SIZE(cmd.u.exact));		size_t len16 = DIV_ROUND_UP(offsetof(struct fw_vi_mac_cmd,						     u.exact[fw_naddr]), 16);		struct fw_vi_mac_exact *p;		int i;		memset(&cmd, 0, sizeof(cmd));		cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_MAC_CMD) |					     FW_CMD_REQUEST |					     FW_CMD_WRITE |					     (free ? FW_CMD_EXEC : 0) |					     FW_VI_MAC_CMD_VIID(viid));		cmd.freemacs_to_len16 =			cpu_to_be32(FW_VI_MAC_CMD_FREEMACS(free) |				    FW_CMD_LEN16(len16));		for (i = 0, p = cmd.u.exact; i < fw_naddr; i++, p++) {			p->valid_to_idx = cpu_to_be16(				FW_VI_MAC_CMD_VALID |				FW_VI_MAC_CMD_IDX(FW_VI_MAC_ADD_MAC));			memcpy(p->macaddr, addr[offset+i], sizeof(p->macaddr));		}		ret = t4vf_wr_mbox_core(adapter, &cmd, sizeof(cmd), &rpl,					sleep_ok);		if (ret && ret != -ENOMEM)			break;		for (i = 0, p = rpl.u.exact; i < fw_naddr; i++, p++) {			u16 index = FW_VI_MAC_CMD_IDX_GET(				be16_to_cpu(p->valid_to_idx));			if (idx)				idx[offset+i] =					(index >= max_naddr					 ? 0xffff					 : index);			if (index < max_naddr)				nfilters++;			else if (hash)				*hash |= (1ULL << hash_mac_addr(addr[offset+i]));		}		free = false;		offset += fw_naddr;		rem -= fw_naddr;	}	/*	 * If there were no errors or we merely ran out of room in our MAC	 * address arena, return the number of filters actually written.	 */	if (ret == 0 || ret == -ENOMEM)		ret = nfilters;	return ret;}

/** *	t4vf_get_port_stats - collect "port" statistics *	@adapter: the adapter *	@pidx: the port index *	@s: the stats structure to fill * *	Collect statistics for the "port"'s Virtual Interface. */int t4vf_get_port_stats(struct adapter *adapter, int pidx,			struct t4vf_port_stats *s){	struct port_info *pi = adap2pinfo(adapter, pidx);	struct fw_vi_stats_vf fwstats;	unsigned int rem = VI_VF_NUM_STATS;	__be64 *fwsp = (__be64 *)&fwstats;	/*	 * Grab the Virtual Interface statistics a chunk at a time via mailbox	 * commands.  We could use a Work Request and get all of them at once	 * but that's an asynchronous interface which is awkward to use.	 */	while (rem) {		unsigned int ix = VI_VF_NUM_STATS - rem;		unsigned int nstats = min(6U, rem);		struct fw_vi_stats_cmd cmd, rpl;		size_t len = (offsetof(struct fw_vi_stats_cmd, u) +			      sizeof(struct fw_vi_stats_ctl));		size_t len16 = DIV_ROUND_UP(len, 16);		int ret;		memset(&cmd, 0, sizeof(cmd));		cmd.op_to_viid = cpu_to_be32(FW_CMD_OP(FW_VI_STATS_CMD) |					     FW_VI_STATS_CMD_VIID(pi->viid) |					     FW_CMD_REQUEST |					     FW_CMD_READ);		cmd.retval_len16 = cpu_to_be32(FW_CMD_LEN16(len16));		cmd.u.ctl.nstats_ix =			cpu_to_be16(FW_VI_STATS_CMD_IX(ix) |				    FW_VI_STATS_CMD_NSTATS(nstats));		ret = t4vf_wr_mbox_ns(adapter, &cmd, len, &rpl);		if (ret)			return ret;		memcpy(fwsp, &rpl.u.ctl.stat0, sizeof(__be64) * nstats);		rem -= nstats;		fwsp += nstats;	}	/*	 * Translate firmware statistics into host native statistics.	 */	s->tx_bcast_bytes = be64_to_cpu(fwstats.tx_bcast_bytes);	s->tx_bcast_frames = be64_to_cpu(fwstats.tx_bcast_frames);	s->tx_mcast_bytes = be64_to_cpu(fwstats.tx_mcast_bytes);	s->tx_mcast_frames = be64_to_cpu(fwstats.tx_mcast_frames);	s->tx_ucast_bytes = be64_to_cpu(fwstats.tx_ucast_bytes);	s->tx_ucast_frames = be64_to_cpu(fwstats.tx_ucast_frames);	s->tx_drop_frames = be64_to_cpu(fwstats.tx_drop_frames);	s->tx_offload_bytes = be64_to_cpu(fwstats.tx_offload_bytes);	s->tx_offload_frames = be64_to_cpu(fwstats.tx_offload_frames);	s->rx_bcast_bytes = be64_to_cpu(fwstats.rx_bcast_bytes);	s->rx_bcast_frames = be64_to_cpu(fwstats.rx_bcast_frames);	s->rx_mcast_bytes = be64_to_cpu(fwstats.rx_mcast_bytes);	s->rx_mcast_frames = be64_to_cpu(fwstats.rx_mcast_frames);	s->rx_ucast_bytes = be64_to_cpu(fwstats.rx_ucast_bytes);	s->rx_ucast_frames = be64_to_cpu(fwstats.rx_ucast_frames);	s->rx_err_frames = be64_to_cpu(fwstats.rx_err_frames);	return 0;}