diff options
| author | David S. Miller <davem@davemloft.net> | 2013-04-19 16:16:42 -0400 | 
|---|---|---|
| committer | David S. Miller <davem@davemloft.net> | 2013-04-19 16:16:42 -0400 | 
| commit | 92352df1dbc5fa2dacfa3b16d57b4641d26be880 (patch) | |
| tree | 0078d9ad099b27e4f15efe0ca3ec3dfa9b817f5b /drivers/net/ethernet | |
| parent | 42bbcb780307d85e6585971242f32bd4f6401c99 (diff) | |
| parent | c63762782076765433b602b215ee394af54d1066 (diff) | |
| download | olio-linux-3.10-92352df1dbc5fa2dacfa3b16d57b4641d26be880.tar.xz olio-linux-3.10-92352df1dbc5fa2dacfa3b16d57b4641d26be880.zip  | |
Merge branch 'qlcnic'
Rajesh Borundia says:
====================
* "qlcnic: Change 82xx adapter VLAN id endian type".
  - Adapter requires VLAN id in little endian. VLAN id was being
    converted to __le16 and then passed as a parameter. Pass VLAN id
    as u16 and then use cpu_to_le16 at appropriate places. It is
    appropriate for net-next as SR-IOV patches have a dependency on it.
* "qlcnic: Fix loopback test for SR-IOV PF".
  - It is appropriate for net-next as change is needed for SRIOV PF
    only.
* Remaining patches add enhancements to SR-IOV functionality like
  - FLR handling
  - Adapter reset recovery handling
  - iproute2 tool support for configuring MAC address, Tx rate and
    VLAN id.
  - Mailbox polling support for SR-IOV PF in case mailbox interrupts
    are disabled.
====================
Signed-off-by: David S. Miller <davem@davemloft.net>
Diffstat (limited to 'drivers/net/ethernet')
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic.h | 38 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.c | 107 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.h | 21 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_init.c | 27 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_ethtool.c | 34 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_hdr.h | 2 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.c | 22 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.h | 4 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_io.c | 28 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_main.c | 57 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov.h | 49 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_common.c | 715 | ||||
| -rw-r--r-- | drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_pf.c | 645 | 
13 files changed, 1604 insertions, 145 deletions
diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic.h b/drivers/net/ethernet/qlogic/qlcnic/qlcnic.h index ef55718d06b..8d02dd75c9a 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic.h +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic.h @@ -38,8 +38,8 @@  #define _QLCNIC_LINUX_MAJOR 5  #define _QLCNIC_LINUX_MINOR 2 -#define _QLCNIC_LINUX_SUBVERSION 40 -#define QLCNIC_LINUX_VERSIONID  "5.2.40" +#define _QLCNIC_LINUX_SUBVERSION 41 +#define QLCNIC_LINUX_VERSIONID  "5.2.41"  #define QLCNIC_DRV_IDC_VER  0x01  #define QLCNIC_DRIVER_VERSION  ((_QLCNIC_LINUX_MAJOR << 16) |\  		 (_QLCNIC_LINUX_MINOR << 8) | (_QLCNIC_LINUX_SUBVERSION)) @@ -919,6 +919,7 @@ struct qlcnic_ipaddr {  #define __QLCNIC_ELB_INPROGRESS		8  #define __QLCNIC_SRIOV_ENABLE		10  #define __QLCNIC_SRIOV_CAPABLE		11 +#define __QLCNIC_MBX_POLL_ENABLE	12  #define QLCNIC_INTERRUPT_TEST		1  #define QLCNIC_LOOPBACK_TEST		2 @@ -939,7 +940,7 @@ struct qlcnic_ipaddr {  struct qlcnic_filter {  	struct hlist_node fnode;  	u8 faddr[ETH_ALEN]; -	__le16 vlan_id; +	u16 vlan_id;  	unsigned long ftime;  }; @@ -976,9 +977,11 @@ struct qlcnic_adapter {  	u8 fw_fail_cnt;  	u8 tx_timeo_cnt;  	u8 need_fw_reset; +	u8 reset_ctx_cnt;  	u16 is_up; -	u16 pvid; +	u16 rx_pvid; +	u16 tx_pvid;  	u32 irq;  	u32 heartbeat; @@ -1010,6 +1013,7 @@ struct qlcnic_adapter {  	struct workqueue_struct *qlcnic_wq;  	struct delayed_work fw_work;  	struct delayed_work idc_aen_work; +	struct delayed_work mbx_poll_work;  	struct qlcnic_filter_hash fhash;  	struct qlcnic_filter_hash rx_fhash; @@ -1444,10 +1448,10 @@ void qlcnic_post_rx_buffers(struct qlcnic_adapter *adapter,  		struct qlcnic_host_rds_ring *rds_ring, u8 ring_id);  int qlcnic_process_rcv_ring(struct qlcnic_host_sds_ring *sds_ring, int max);  void qlcnic_set_multi(struct net_device *netdev); -void __qlcnic_set_multi(struct net_device *netdev); -int qlcnic_nic_add_mac(struct qlcnic_adapter *, const u8 *); +void __qlcnic_set_multi(struct net_device *, u16); +int qlcnic_nic_add_mac(struct qlcnic_adapter *, const u8 *, u16);  int qlcnic_nic_del_mac(struct qlcnic_adapter *, const u8 *); -void qlcnic_free_mac_list(struct qlcnic_adapter *adapter); +void qlcnic_82xx_free_mac_list(struct qlcnic_adapter *adapter);  int qlcnic_fw_cmd_set_mtu(struct qlcnic_adapter *adapter, int mtu);  int qlcnic_fw_cmd_set_drv_version(struct qlcnic_adapter *); @@ -1524,13 +1528,12 @@ int qlcnic_init_pci_info(struct qlcnic_adapter *);  int qlcnic_set_default_offload_settings(struct qlcnic_adapter *);  int qlcnic_reset_npar_config(struct qlcnic_adapter *);  int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *); -void qlcnic_add_lb_filter(struct qlcnic_adapter *, struct sk_buff *, int, -			  __le16); +void qlcnic_add_lb_filter(struct qlcnic_adapter *, struct sk_buff *, int, u16);  int qlcnic_83xx_configure_opmode(struct qlcnic_adapter *adapter);  int qlcnic_read_mac_addr(struct qlcnic_adapter *);  int qlcnic_setup_netdev(struct qlcnic_adapter *, struct net_device *, int);  void qlcnic_sriov_vf_schedule_multi(struct net_device *); -void qlcnic_vf_add_mc_list(struct net_device *); +void qlcnic_vf_add_mc_list(struct net_device *, u16);  /*   * QLOGIC Board information @@ -1595,7 +1598,7 @@ struct qlcnic_hardware_ops {  	int (*get_nic_info) (struct qlcnic_adapter *, struct qlcnic_info *, u8);  	int (*get_pci_info) (struct qlcnic_adapter *, struct qlcnic_pci_info *);  	int (*set_nic_info) (struct qlcnic_adapter *, struct qlcnic_info *); -	int (*change_macvlan) (struct qlcnic_adapter *, u8*, __le16, u8); +	int (*change_macvlan) (struct qlcnic_adapter *, u8*, u16, u8);  	void (*napi_enable) (struct qlcnic_adapter *);  	void (*napi_disable) (struct qlcnic_adapter *);  	void (*config_intr_coal) (struct qlcnic_adapter *); @@ -1604,8 +1607,9 @@ struct qlcnic_hardware_ops {  	int (*config_loopback) (struct qlcnic_adapter *, u8);  	int (*clear_loopback) (struct qlcnic_adapter *, u8);  	int (*config_promisc_mode) (struct qlcnic_adapter *, u32); -	void (*change_l2_filter) (struct qlcnic_adapter *, u64 *, __le16); +	void (*change_l2_filter) (struct qlcnic_adapter *, u64 *, u16);  	int (*get_board_info) (struct qlcnic_adapter *); +	void (*free_mac_list) (struct qlcnic_adapter *);  };  extern struct qlcnic_nic_template qlcnic_vf_ops; @@ -1746,7 +1750,7 @@ static inline int qlcnic_set_nic_info(struct qlcnic_adapter *adapter,  }  static inline int qlcnic_sre_macaddr_change(struct qlcnic_adapter *adapter, -					    u8 *addr, __le16 id, u8 cmd) +					    u8 *addr, u16 id, u8 cmd)  {  	return adapter->ahw->hw_ops->change_macvlan(adapter, addr, id, cmd);  } @@ -1805,7 +1809,7 @@ static inline int qlcnic_nic_set_promisc(struct qlcnic_adapter *adapter,  }  static inline void qlcnic_change_filter(struct qlcnic_adapter *adapter, -					u64 *addr, __le16 id) +					u64 *addr, u16 id)  {  	adapter->ahw->hw_ops->change_l2_filter(adapter, addr, id);  } @@ -1815,6 +1819,11 @@ static inline int qlcnic_get_board_info(struct qlcnic_adapter *adapter)  	return adapter->ahw->hw_ops->get_board_info(adapter);  } +static inline void qlcnic_free_mac_list(struct qlcnic_adapter *adapter) +{ +	return adapter->ahw->hw_ops->free_mac_list(adapter); +} +  static inline void qlcnic_dev_request_reset(struct qlcnic_adapter *adapter,  					    u32 key)  { @@ -1861,6 +1870,7 @@ static inline void qlcnic_enable_int(struct qlcnic_host_sds_ring *sds_ring)  		writel(0xfbff, adapter->tgt_mask_reg);  } +extern const struct ethtool_ops qlcnic_sriov_vf_ethtool_ops;  extern const struct ethtool_ops qlcnic_ethtool_ops;  extern const struct ethtool_ops qlcnic_ethtool_failed_ops; diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.c index 374fa8a3791..32a95c105e4 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.c @@ -172,6 +172,7 @@ static struct qlcnic_hardware_ops qlcnic_83xx_hw_ops = {  	.config_promisc_mode		= qlcnic_83xx_nic_set_promisc,  	.change_l2_filter		= qlcnic_83xx_change_l2_filter,  	.get_board_info			= qlcnic_83xx_get_port_info, +	.free_mac_list			= qlcnic_82xx_free_mac_list,  };  static struct qlcnic_nic_template qlcnic_83xx_ops = { @@ -339,12 +340,13 @@ inline void qlcnic_83xx_enable_legacy_msix_mbx_intr(struct qlcnic_adapter  	writel(0, adapter->ahw->pci_base0 + mask);  } -inline void qlcnic_83xx_disable_mbx_intr(struct qlcnic_adapter *adapter) +void qlcnic_83xx_disable_mbx_intr(struct qlcnic_adapter *adapter)  {  	u32 mask;  	mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);  	writel(1, adapter->ahw->pci_base0 + mask); +	QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, 0);  }  static inline void qlcnic_83xx_get_mbx_data(struct qlcnic_adapter *adapter, @@ -400,7 +402,8 @@ static void qlcnic_83xx_poll_process_aen(struct qlcnic_adapter *adapter)  	event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));  	if (event &  QLCNIC_MBX_ASYNC_EVENT) -		qlcnic_83xx_process_aen(adapter); +		__qlcnic_83xx_process_aen(adapter); +  out:  	qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);  	spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags); @@ -453,17 +456,15 @@ done:  void qlcnic_83xx_free_mbx_intr(struct qlcnic_adapter *adapter)  { -	u32 val = 0, num_msix = adapter->ahw->num_msix - 1; +	u32 num_msix; + +	qlcnic_83xx_disable_mbx_intr(adapter);  	if (adapter->flags & QLCNIC_MSIX_ENABLED)  		num_msix = adapter->ahw->num_msix - 1;  	else  		num_msix = 0; -	QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, val); - -	qlcnic_83xx_disable_mbx_intr(adapter); -  	msleep(20);  	synchronize_irq(adapter->msix_entries[num_msix].vector);  	free_irq(adapter->msix_entries[num_msix].vector, adapter); @@ -758,7 +759,7 @@ poll:  		/* Get the FW response data */  		fw_data = readl(QLCNIC_MBX_FW(ahw, 0));  		if (fw_data &  QLCNIC_MBX_ASYNC_EVENT) { -			qlcnic_83xx_process_aen(adapter); +			__qlcnic_83xx_process_aen(adapter);  			mbx_val = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);  			if (mbx_val)  				goto poll; @@ -862,7 +863,7 @@ static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,  	return;  } -void qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter) +void __qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)  {  	u32 event[QLC_83XX_MBX_AEN_CNT];  	int i; @@ -907,6 +908,53 @@ void qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)  	QLCWRX(ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);  } +static void qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	u32 resp, event; +	unsigned long flags; + +	spin_lock_irqsave(&ahw->mbx_lock, flags); + +	resp = QLCRDX(ahw, QLCNIC_FW_MBX_CTRL); +	if (resp & QLCNIC_SET_OWNER) { +		event = readl(QLCNIC_MBX_FW(ahw, 0)); +		if (event &  QLCNIC_MBX_ASYNC_EVENT) +			__qlcnic_83xx_process_aen(adapter); +	} + +	spin_unlock_irqrestore(&ahw->mbx_lock, flags); +} + +static void qlcnic_83xx_mbx_poll_work(struct work_struct *work) +{ +	struct qlcnic_adapter *adapter; + +	adapter = container_of(work, struct qlcnic_adapter, mbx_poll_work.work); + +	if (!test_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state)) +		return; + +	qlcnic_83xx_process_aen(adapter); +	queue_delayed_work(adapter->qlcnic_wq, &adapter->mbx_poll_work, +			   (HZ / 10)); +} + +void qlcnic_83xx_enable_mbx_poll(struct qlcnic_adapter *adapter) +{ +	if (test_and_set_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state)) +		return; + +	INIT_DELAYED_WORK(&adapter->mbx_poll_work, qlcnic_83xx_mbx_poll_work); +} + +void qlcnic_83xx_disable_mbx_poll(struct qlcnic_adapter *adapter) +{ +	if (!test_and_clear_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state)) +		return; +	cancel_delayed_work_sync(&adapter->mbx_poll_work); +} +  static int qlcnic_83xx_add_rings(struct qlcnic_adapter *adapter)  {  	int index, i, err, sds_mbx_size; @@ -1274,7 +1322,8 @@ static int qlcnic_83xx_diag_alloc_res(struct net_device *netdev, int test)  	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {  		/* disable and free mailbox interrupt */ -		qlcnic_83xx_free_mbx_intr(adapter); +		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) +			qlcnic_83xx_free_mbx_intr(adapter);  		adapter->ahw->loopback_state = 0;  		adapter->ahw->hw_ops->setup_link_event(adapter, 1);  	} @@ -1302,12 +1351,14 @@ static void qlcnic_83xx_diag_free_res(struct net_device *netdev,  	qlcnic_detach(adapter);  	if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) { -		err = qlcnic_83xx_setup_mbx_intr(adapter); -		if (err) { -			dev_err(&adapter->pdev->dev, -				"%s: failed to setup mbx interrupt\n", -				__func__); -			goto out; +		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) { +			err = qlcnic_83xx_setup_mbx_intr(adapter); +			if (err) { +				dev_err(&adapter->pdev->dev, +					"%s: failed to setup mbx interrupt\n", +					__func__); +				goto out; +			}  		}  	}  	adapter->ahw->diag_test = 0; @@ -1556,7 +1607,9 @@ int qlcnic_83xx_loopback_test(struct net_device *netdev, u8 mode)  	/* Poll for link up event before running traffic */  	do {  		msleep(500); -		qlcnic_83xx_process_aen(adapter); +		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) +			qlcnic_83xx_process_aen(adapter); +  		if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {  			dev_info(&adapter->pdev->dev,  				 "Firmware didn't sent link up event to loopback request\n"); @@ -1610,7 +1663,9 @@ int qlcnic_83xx_set_lb_mode(struct qlcnic_adapter *adapter, u8 mode)  	/* Wait for Link and IDC Completion AEN */  	do {  		msleep(300); -		qlcnic_83xx_process_aen(adapter); +		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) +			qlcnic_83xx_process_aen(adapter); +  		if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {  			dev_err(&adapter->pdev->dev,  				"FW did not generate IDC completion AEN\n"); @@ -1650,7 +1705,9 @@ int qlcnic_83xx_clear_lb_mode(struct qlcnic_adapter *adapter, u8 mode)  	/* Wait for Link and IDC Completion AEN */  	do {  		msleep(300); -		qlcnic_83xx_process_aen(adapter); +		if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) +			qlcnic_83xx_process_aen(adapter); +  		if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {  			dev_err(&adapter->pdev->dev,  				"Firmware didn't sent IDC completion AEN\n"); @@ -1784,7 +1841,7 @@ static void qlcnic_83xx_set_interface_id_macaddr(struct qlcnic_adapter *adapter,  }  int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr, -				   __le16 vlan_id, u8 op) +				   u16 vlan_id, u8 op)  {  	int err;  	u32 *buf, temp = 0; @@ -1798,10 +1855,14 @@ int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr,  	if (err)  		return err; +	if (vlan_id) +		op = (op == QLCNIC_MAC_ADD || op == QLCNIC_MAC_VLAN_ADD) ? +		     QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_VLAN_DEL; +  	cmd.req.arg[1] = op | (1 << 8);  	qlcnic_83xx_set_interface_id_macaddr(adapter, &temp);  	cmd.req.arg[1] |= temp; -	mv.vlan = le16_to_cpu(vlan_id); +	mv.vlan = vlan_id;  	mv.mac_addr0 = addr[0];  	mv.mac_addr1 = addr[1];  	mv.mac_addr2 = addr[2]; @@ -1820,7 +1881,7 @@ int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr,  }  void qlcnic_83xx_change_l2_filter(struct qlcnic_adapter *adapter, u64 *addr, -				  __le16 vlan_id) +				  u16 vlan_id)  {  	u8 mac[ETH_ALEN];  	memcpy(&mac, addr, ETH_ALEN); @@ -1920,7 +1981,7 @@ irqreturn_t qlcnic_83xx_handle_aen(int irq, void *data)  	event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));  	if (event &  QLCNIC_MBX_ASYNC_EVENT) -		qlcnic_83xx_process_aen(adapter); +		__qlcnic_83xx_process_aen(adapter);  out:  	mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);  	writel(0, adapter->ahw->pci_base0 + mask); diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.h b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.h index 32ed4b4c497..4be411c2628 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.h +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_hw.h @@ -317,6 +317,18 @@ struct qlc_83xx_idc {  	char		**name;  }; +/* Device States */ +enum qlcnic_83xx_states { +	QLC_83XX_IDC_DEV_UNKNOWN, +	QLC_83XX_IDC_DEV_COLD, +	QLC_83XX_IDC_DEV_INIT, +	QLC_83XX_IDC_DEV_READY, +	QLC_83XX_IDC_DEV_NEED_RESET, +	QLC_83XX_IDC_DEV_NEED_QUISCENT, +	QLC_83XX_IDC_DEV_FAILED, +	QLC_83XX_IDC_DEV_QUISCENT +}; +  #define QLCNIC_MBX_RSP(reg)		LSW(reg)  #define QLCNIC_MBX_NUM_REGS(reg)	(MSW(reg) & 0x1FF)  #define QLCNIC_MBX_STATUS(reg)		(((reg) >> 25) & 0x7F) @@ -501,7 +513,7 @@ int qlcnic_83xx_clear_lb_mode(struct qlcnic_adapter *, u8);  int qlcnic_83xx_config_hw_lro(struct qlcnic_adapter *, int);  int qlcnic_83xx_config_rss(struct qlcnic_adapter *, int);  int qlcnic_83xx_config_intr_coalesce(struct qlcnic_adapter *); -void qlcnic_83xx_change_l2_filter(struct qlcnic_adapter *, u64 *, __le16); +void qlcnic_83xx_change_l2_filter(struct qlcnic_adapter *, u64 *, u16);  int qlcnic_83xx_get_pci_info(struct qlcnic_adapter *, struct qlcnic_pci_info *);  int qlcnic_83xx_set_nic_info(struct qlcnic_adapter *, struct qlcnic_info *);  void qlcnic_83xx_register_nic_idc_func(struct qlcnic_adapter *, int); @@ -523,7 +535,7 @@ int qlcnic_83xx_get_nic_info(struct qlcnic_adapter *, struct qlcnic_info *, u8);  int qlcnic_83xx_setup_link_event(struct qlcnic_adapter *, int);  void qlcnic_83xx_process_rcv_ring_diag(struct qlcnic_host_sds_ring *);  int qlcnic_83xx_config_intrpt(struct qlcnic_adapter *, bool); -int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *, u8 *, __le16, u8); +int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *, u8 *, u16, u8);  int qlcnic_83xx_get_mac_address(struct qlcnic_adapter *, u8 *);  void qlcnic_83xx_configure_mac(struct qlcnic_adapter *, u8 *, u8,  			       struct qlcnic_cmd_args *); @@ -536,6 +548,7 @@ void qlcnic_83xx_config_intr_coal(struct qlcnic_adapter *);  irqreturn_t qlcnic_83xx_handle_aen(int, void *);  int qlcnic_83xx_get_port_info(struct qlcnic_adapter *);  void qlcnic_83xx_enable_mbx_intrpt(struct qlcnic_adapter *); +void qlcnic_83xx_disable_mbx_intr(struct qlcnic_adapter *);  irqreturn_t qlcnic_83xx_clear_legacy_intr(struct qlcnic_adapter *);  irqreturn_t qlcnic_83xx_intr(int, void *);  irqreturn_t qlcnic_83xx_tmp_intr(int, void *); @@ -545,7 +558,7 @@ void qlcnic_83xx_disable_intr(struct qlcnic_adapter *,  			     struct qlcnic_host_sds_ring *);  void qlcnic_83xx_check_vf(struct qlcnic_adapter *,  			  const struct pci_device_id *); -void qlcnic_83xx_process_aen(struct qlcnic_adapter *); +void __qlcnic_83xx_process_aen(struct qlcnic_adapter *);  int qlcnic_83xx_get_port_config(struct qlcnic_adapter *);  int qlcnic_83xx_set_port_config(struct qlcnic_adapter *);  int qlcnic_enable_eswitch(struct qlcnic_adapter *, u8, u8); @@ -608,4 +621,6 @@ int qlcnic_83xx_enable_flash_write(struct qlcnic_adapter *);  int qlcnic_83xx_disable_flash_write(struct qlcnic_adapter *);  u32 qlcnic_83xx_mac_rcode(struct qlcnic_adapter *);  u32 qlcnic_83xx_mbx_poll(struct qlcnic_adapter *); +void qlcnic_83xx_enable_mbx_poll(struct qlcnic_adapter *); +void qlcnic_83xx_disable_mbx_poll(struct qlcnic_adapter *);  #endif diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_init.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_init.c index c302d118a0d..6ea3a096054 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_init.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_83xx_init.c @@ -115,18 +115,6 @@ static const char *const qlc_83xx_idc_states[] = {  	"Quiesce"  }; -/* Device States */ -enum qlcnic_83xx_states { -	QLC_83XX_IDC_DEV_UNKNOWN, -	QLC_83XX_IDC_DEV_COLD, -	QLC_83XX_IDC_DEV_INIT, -	QLC_83XX_IDC_DEV_READY, -	QLC_83XX_IDC_DEV_NEED_RESET, -	QLC_83XX_IDC_DEV_NEED_QUISCENT, -	QLC_83XX_IDC_DEV_FAILED, -	QLC_83XX_IDC_DEV_QUISCENT -}; -  static int  qlcnic_83xx_idc_check_driver_presence_reg(struct qlcnic_adapter *adapter)  { @@ -162,7 +150,8 @@ static int qlcnic_83xx_idc_update_audit_reg(struct qlcnic_adapter *adapter,  			return -EBUSY;  	} -	val = adapter->portnum & 0xf; +	val = QLCRDX(adapter->ahw, QLC_83XX_IDC_DRV_AUDIT); +	val |= (adapter->portnum & 0xf);  	val |= mode << 7;  	if (mode)  		seconds = jiffies / HZ - adapter->ahw->idc.sec_counter; @@ -401,14 +390,18 @@ static void qlcnic_83xx_idc_detach_driver(struct qlcnic_adapter *adapter)  	struct net_device *netdev = adapter->netdev;  	netif_device_detach(netdev); +  	/* Disable mailbox interrupt */ -	QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, 0); +	qlcnic_83xx_disable_mbx_intr(adapter);  	qlcnic_down(adapter, netdev);  	for (i = 0; i < adapter->ahw->num_msix; i++) {  		adapter->ahw->intr_tbl[i].id = i;  		adapter->ahw->intr_tbl[i].enabled = 0;  		adapter->ahw->intr_tbl[i].src = 0;  	} + +	if (qlcnic_sriov_pf_check(adapter)) +		qlcnic_sriov_pf_reset(adapter);  }  /** @@ -610,9 +603,15 @@ static int qlcnic_83xx_idc_check_fan_failure(struct qlcnic_adapter *adapter)  static int qlcnic_83xx_idc_reattach_driver(struct qlcnic_adapter *adapter)  { +	int err; +  	/* register for NIC IDC AEN Events */  	qlcnic_83xx_register_nic_idc_func(adapter, 1); +	err = qlcnic_sriov_pf_reinit(adapter); +	if (err) +		return err; +  	qlcnic_83xx_enable_mbx_intrpt(adapter);  	if (qlcnic_83xx_configure_opmode(adapter)) { diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ethtool.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ethtool.c index f4f279d5cba..9f7aade4667 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ethtool.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_ethtool.c @@ -859,9 +859,11 @@ clear_diag_irq:  	return ret;  } -#define QLCNIC_ILB_PKT_SIZE 64 -#define QLCNIC_NUM_ILB_PKT	16 -#define QLCNIC_ILB_MAX_RCV_LOOP 10 +#define QLCNIC_ILB_PKT_SIZE		64 +#define QLCNIC_NUM_ILB_PKT		16 +#define QLCNIC_ILB_MAX_RCV_LOOP		10 +#define QLCNIC_LB_PKT_POLL_DELAY_MSEC	1 +#define QLCNIC_LB_PKT_POLL_COUNT	20  static void qlcnic_create_loopback_buff(unsigned char *data, u8 mac[])  { @@ -898,9 +900,9 @@ int qlcnic_do_lb_test(struct qlcnic_adapter *adapter, u8 mode)  		loop = 0;  		do { -			msleep(1); +			msleep(QLCNIC_LB_PKT_POLL_DELAY_MSEC);  			qlcnic_process_rcv_ring_diag(sds_ring); -			if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) +			if (loop++ > QLCNIC_LB_PKT_POLL_COUNT)  				break;  		} while (!adapter->ahw->diag_cnt); @@ -1539,3 +1541,25 @@ const struct ethtool_ops qlcnic_ethtool_ops = {  	.get_dump_data = qlcnic_get_dump_data,  	.set_dump = qlcnic_set_dump,  }; + +const struct ethtool_ops qlcnic_sriov_vf_ethtool_ops = { +	.get_settings		= qlcnic_get_settings, +	.get_drvinfo		= qlcnic_get_drvinfo, +	.get_regs_len		= qlcnic_get_regs_len, +	.get_regs		= qlcnic_get_regs, +	.get_link		= ethtool_op_get_link, +	.get_eeprom_len		= qlcnic_get_eeprom_len, +	.get_eeprom		= qlcnic_get_eeprom, +	.get_ringparam		= qlcnic_get_ringparam, +	.set_ringparam		= qlcnic_set_ringparam, +	.get_channels		= qlcnic_get_channels, +	.get_pauseparam		= qlcnic_get_pauseparam, +	.get_wol		= qlcnic_get_wol, +	.get_strings		= qlcnic_get_strings, +	.get_ethtool_stats	= qlcnic_get_ethtool_stats, +	.get_sset_count		= qlcnic_get_sset_count, +	.get_coalesce		= qlcnic_get_intr_coalesce, +	.set_coalesce		= qlcnic_set_intr_coalesce, +	.set_msglevel		= qlcnic_set_msglevel, +	.get_msglevel		= qlcnic_get_msglevel, +}; diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hdr.h b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hdr.h index 1cebd8900cf..c0f0c0d0a79 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hdr.h +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hdr.h @@ -669,7 +669,7 @@ enum {  #define QLCNIC_CMDPEG_CHECK_RETRY_COUNT	60  #define QLCNIC_CMDPEG_CHECK_DELAY	500  #define QLCNIC_HEARTBEAT_PERIOD_MSECS	200 -#define QLCNIC_HEARTBEAT_CHECK_RETRY_COUNT	45 +#define QLCNIC_HEARTBEAT_CHECK_RETRY_COUNT	10  #define QLCNIC_MAX_MC_COUNT		38  #define QLCNIC_WATCHDOG_TIMEOUTVALUE	5 diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.c index 253b3ac1604..6a6512ba9f3 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.c @@ -423,7 +423,7 @@ qlcnic_send_cmd_descs(struct qlcnic_adapter *adapter,  }  int qlcnic_82xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr, -				   __le16 vlan_id, u8 op) +				   u16 vlan_id, u8 op)  {  	struct qlcnic_nic_req req;  	struct qlcnic_mac_req *mac_req; @@ -441,7 +441,7 @@ int qlcnic_82xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr,  	memcpy(mac_req->mac_addr, addr, 6);  	vlan_req = (struct qlcnic_vlan_req *)&req.words[1]; -	vlan_req->vlan_id = vlan_id; +	vlan_req->vlan_id = cpu_to_le16(vlan_id);  	return qlcnic_send_cmd_descs(adapter, (struct cmd_desc_type0 *)&req, 1);  } @@ -468,7 +468,7 @@ int qlcnic_nic_del_mac(struct qlcnic_adapter *adapter, const u8 *addr)  	return err;  } -int qlcnic_nic_add_mac(struct qlcnic_adapter *adapter, const u8 *addr) +int qlcnic_nic_add_mac(struct qlcnic_adapter *adapter, const u8 *addr, u16 vlan)  {  	struct list_head *head;  	struct qlcnic_mac_list_s *cur; @@ -487,7 +487,7 @@ int qlcnic_nic_add_mac(struct qlcnic_adapter *adapter, const u8 *addr)  	memcpy(cur->mac_addr, addr, ETH_ALEN);  	if (qlcnic_sre_macaddr_change(adapter, -				cur->mac_addr, 0, QLCNIC_MAC_ADD)) { +				cur->mac_addr, vlan, QLCNIC_MAC_ADD)) {  		kfree(cur);  		return -EIO;  	} @@ -496,7 +496,7 @@ int qlcnic_nic_add_mac(struct qlcnic_adapter *adapter, const u8 *addr)  	return 0;  } -void __qlcnic_set_multi(struct net_device *netdev) +void __qlcnic_set_multi(struct net_device *netdev, u16 vlan)  {  	struct qlcnic_adapter *adapter = netdev_priv(netdev);  	struct netdev_hw_addr *ha; @@ -509,8 +509,8 @@ void __qlcnic_set_multi(struct net_device *netdev)  		return;  	if (!qlcnic_sriov_vf_check(adapter)) -		qlcnic_nic_add_mac(adapter, adapter->mac_addr); -	qlcnic_nic_add_mac(adapter, bcast_addr); +		qlcnic_nic_add_mac(adapter, adapter->mac_addr, vlan); +	qlcnic_nic_add_mac(adapter, bcast_addr, vlan);  	if (netdev->flags & IFF_PROMISC) {  		if (!(adapter->flags & QLCNIC_PROMISC_DISABLED)) @@ -526,12 +526,12 @@ void __qlcnic_set_multi(struct net_device *netdev)  	if (!netdev_mc_empty(netdev) && !qlcnic_sriov_vf_check(adapter)) {  		netdev_for_each_mc_addr(ha, netdev) { -			qlcnic_nic_add_mac(adapter, ha->addr); +			qlcnic_nic_add_mac(adapter, ha->addr, vlan);  		}  	}  	if (qlcnic_sriov_vf_check(adapter)) -		qlcnic_vf_add_mc_list(netdev); +		qlcnic_vf_add_mc_list(netdev, vlan);  send_fw_cmd:  	if (!qlcnic_sriov_vf_check(adapter)) { @@ -570,7 +570,7 @@ void qlcnic_set_multi(struct net_device *netdev)  		qlcnic_sriov_vf_schedule_multi(adapter->netdev);  		return;  	} -	__qlcnic_set_multi(netdev); +	__qlcnic_set_multi(netdev, 0);  }  int qlcnic_82xx_nic_set_promisc(struct qlcnic_adapter *adapter, u32 mode) @@ -592,7 +592,7 @@ int qlcnic_82xx_nic_set_promisc(struct qlcnic_adapter *adapter, u32 mode)  				(struct cmd_desc_type0 *)&req, 1);  } -void qlcnic_free_mac_list(struct qlcnic_adapter *adapter) +void qlcnic_82xx_free_mac_list(struct qlcnic_adapter *adapter)  {  	struct qlcnic_mac_list_s *cur;  	struct list_head *head = &adapter->mac_list; diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.h b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.h index e862a77a626..95b1b573283 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.h +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_hw.h @@ -159,7 +159,7 @@ int qlcnic_82xx_nic_set_promisc(struct qlcnic_adapter *adapter, u32);  int qlcnic_82xx_napi_add(struct qlcnic_adapter *adapter,  			 struct net_device *netdev);  void qlcnic_82xx_change_filter(struct qlcnic_adapter *adapter, -			       u64 *uaddr, __le16 vlan_id); +			       u64 *uaddr, u16 vlan_id);  void qlcnic_82xx_config_intr_coalesce(struct qlcnic_adapter *adapter);  int qlcnic_82xx_config_rss(struct qlcnic_adapter *adapter, int);  void qlcnic_82xx_config_ipaddr(struct qlcnic_adapter *adapter, @@ -181,7 +181,7 @@ int qlcnic_82xx_fw_cmd_create_tx_ctx(struct qlcnic_adapter *,  void qlcnic_82xx_fw_cmd_del_rx_ctx(struct qlcnic_adapter *);  void qlcnic_82xx_fw_cmd_del_tx_ctx(struct qlcnic_adapter *,  				   struct qlcnic_host_tx_ring *); -int qlcnic_82xx_sre_macaddr_change(struct qlcnic_adapter *, u8 *, __le16, u8); +int qlcnic_82xx_sre_macaddr_change(struct qlcnic_adapter *, u8 *, u16, u8);  int qlcnic_82xx_get_mac_address(struct qlcnic_adapter *, u8*);  int qlcnic_82xx_get_nic_info(struct qlcnic_adapter *, struct qlcnic_info *, u8);  int qlcnic_82xx_set_nic_info(struct qlcnic_adapter *, struct qlcnic_info *); diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_io.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_io.c index 56223a6aa40..356859b9f21 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_io.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_io.c @@ -162,7 +162,7 @@ static inline int qlcnic_82xx_is_lb_pkt(u64 sts_data)  }  void qlcnic_add_lb_filter(struct qlcnic_adapter *adapter, struct sk_buff *skb, -			  int loopback_pkt, __le16 vlan_id) +			  int loopback_pkt, u16 vlan_id)  {  	struct ethhdr *phdr = (struct ethhdr *)(skb->data);  	struct qlcnic_filter *fil, *tmp_fil; @@ -240,7 +240,7 @@ void qlcnic_add_lb_filter(struct qlcnic_adapter *adapter, struct sk_buff *skb,  }  void qlcnic_82xx_change_filter(struct qlcnic_adapter *adapter, u64 *uaddr, -			       __le16 vlan_id) +			       u16 vlan_id)  {  	struct cmd_desc_type0 *hwdesc;  	struct qlcnic_nic_req *req; @@ -265,7 +265,7 @@ void qlcnic_82xx_change_filter(struct qlcnic_adapter *adapter, u64 *uaddr,  	memcpy(mac_req->mac_addr, &uaddr, ETH_ALEN);  	vlan_req = (struct qlcnic_vlan_req *)&req->words[1]; -	vlan_req->vlan_id = vlan_id; +	vlan_req->vlan_id = cpu_to_le16(vlan_id);  	tx_ring->producer = get_next_index(producer, tx_ring->num_desc);  	smp_mb(); @@ -281,7 +281,7 @@ static void qlcnic_send_filter(struct qlcnic_adapter *adapter,  	struct net_device *netdev = adapter->netdev;  	struct ethhdr *phdr = (struct ethhdr *)(skb->data);  	u64 src_addr = 0; -	__le16 vlan_id = 0; +	u16 vlan_id = 0;  	u8 hindex;  	if (ether_addr_equal(phdr->h_source, adapter->mac_addr)) @@ -344,14 +344,14 @@ static int qlcnic_tx_pkt(struct qlcnic_adapter *adapter,  		flags = FLAGS_VLAN_OOB;  		vlan_tci = vlan_tx_tag_get(skb);  	} -	if (unlikely(adapter->pvid)) { +	if (unlikely(adapter->tx_pvid)) {  		if (vlan_tci && !(adapter->flags & QLCNIC_TAGGING_ENABLED))  			return -EIO;  		if (vlan_tci && (adapter->flags & QLCNIC_TAGGING_ENABLED))  			goto set_flags;  		flags = FLAGS_VLAN_OOB; -		vlan_tci = adapter->pvid; +		vlan_tci = adapter->tx_pvid;  	}  set_flags:  	qlcnic_set_tx_vlan_tci(first_desc, vlan_tci); @@ -980,10 +980,10 @@ static inline int qlcnic_check_rx_tagging(struct qlcnic_adapter *adapter,  		memmove(skb->data + VLAN_HLEN, eth_hdr, ETH_ALEN * 2);  		skb_pull(skb, VLAN_HLEN);  	} -	if (!adapter->pvid) +	if (!adapter->rx_pvid)  		return 0; -	if (*vlan_tag == adapter->pvid) { +	if (*vlan_tag == adapter->rx_pvid) {  		/* Outer vlan tag. Packet should follow non-vlan path */  		*vlan_tag = 0xffff;  		return 0; @@ -1029,8 +1029,7 @@ qlcnic_process_rcv(struct qlcnic_adapter *adapter,  	    (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {  		t_vid = 0;  		is_lb_pkt = qlcnic_82xx_is_lb_pkt(sts_data0); -		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, -				     cpu_to_le16(t_vid)); +		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, t_vid);  	}  	if (length > rds_ring->skb_size) @@ -1107,8 +1106,7 @@ qlcnic_process_lro(struct qlcnic_adapter *adapter,  	    (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {  		t_vid = 0;  		is_lb_pkt = qlcnic_82xx_is_lb_pkt(sts_data0); -		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, -				     cpu_to_le16(t_vid)); +		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, t_vid);  	}  	if (timestamp) @@ -1500,8 +1498,7 @@ qlcnic_83xx_process_rcv(struct qlcnic_adapter *adapter,  	    (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {  		t_vid = 0;  		is_lb_pkt = qlcnic_83xx_is_lb_pkt(sts_data[1], 0); -		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, -				     cpu_to_le16(t_vid)); +		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, t_vid);  	}  	if (length > rds_ring->skb_size) @@ -1570,8 +1567,7 @@ qlcnic_83xx_process_lro(struct qlcnic_adapter *adapter,  	    (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {  		t_vid = 0;  		is_lb_pkt = qlcnic_83xx_is_lb_pkt(sts_data[1], 1); -		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, -				     cpu_to_le16(t_vid)); +		qlcnic_add_lb_filter(adapter, skb, is_lb_pkt, t_vid);  	}  	if (qlcnic_83xx_is_tstamp(sts_data[1]))  		data_offset = l4_hdr_offset + QLCNIC_TCP_TS_HDR_SIZE; diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_main.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_main.c index d132765f92a..247a9f9b7bd 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_main.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_main.c @@ -290,7 +290,7 @@ static int qlcnic_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],  		return err;  	if (is_unicast_ether_addr(addr)) -		err = qlcnic_nic_add_mac(adapter, addr); +		err = qlcnic_nic_add_mac(adapter, addr, 0);  	else if (is_multicast_ether_addr(addr))  		err = dev_mc_add_excl(netdev, addr);  	else @@ -341,6 +341,12 @@ static const struct net_device_ops qlcnic_netdev_ops = {  #ifdef CONFIG_NET_POLL_CONTROLLER  	.ndo_poll_controller = qlcnic_poll_controller,  #endif +#ifdef CONFIG_QLCNIC_SRIOV +	.ndo_set_vf_mac		= qlcnic_sriov_set_vf_mac, +	.ndo_set_vf_tx_rate	= qlcnic_sriov_set_vf_tx_rate, +	.ndo_get_vf_config	= qlcnic_sriov_get_vf_config, +	.ndo_set_vf_vlan	= qlcnic_sriov_set_vf_vlan, +#endif  };  static const struct net_device_ops qlcnic_netdev_failed_ops = { @@ -399,6 +405,7 @@ static struct qlcnic_hardware_ops qlcnic_hw_ops = {  	.config_promisc_mode		= qlcnic_82xx_nic_set_promisc,  	.change_l2_filter		= qlcnic_82xx_change_filter,  	.get_board_info			= qlcnic_82xx_get_board_info, +	.free_mac_list			= qlcnic_82xx_free_mac_list,  };  int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix) @@ -895,16 +902,31 @@ void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,  	else  		adapter->flags |= QLCNIC_TAGGING_ENABLED; -	if (esw_cfg->vlan_id) -		adapter->pvid = esw_cfg->vlan_id; -	else -		adapter->pvid = 0; +	if (esw_cfg->vlan_id) { +		adapter->rx_pvid = esw_cfg->vlan_id; +		adapter->tx_pvid = esw_cfg->vlan_id; +	} else { +		adapter->rx_pvid = 0; +		adapter->tx_pvid = 0; +	}  }  static int  qlcnic_vlan_rx_add(struct net_device *netdev, __be16 proto, u16 vid)  {  	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	int err; + +	if (qlcnic_sriov_vf_check(adapter)) { +		err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 1); +		if (err) { +			netdev_err(netdev, +				   "Cannot add VLAN filter for VLAN id %d, err=%d", +				   vid, err); +			return err; +		} +	} +  	set_bit(vid, adapter->vlans);  	return 0;  } @@ -913,6 +935,17 @@ static int  qlcnic_vlan_rx_del(struct net_device *netdev, __be16 proto, u16 vid)  {  	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	int err; + +	if (qlcnic_sriov_vf_check(adapter)) { +		err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 0); +		if (err) { +			netdev_err(netdev, +				   "Cannot delete VLAN filter for VLAN id %d, err=%d", +				   vid, err); +			return err; +		} +	}  	qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);  	clear_bit(vid, adapter->vlans); @@ -1710,7 +1743,10 @@ qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,  	qlcnic_change_mtu(netdev, netdev->mtu); -	SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops); +	if (qlcnic_sriov_vf_check(adapter)) +		SET_ETHTOOL_OPS(netdev, &qlcnic_sriov_vf_ethtool_ops); +	else +		SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);  	netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |  			     NETIF_F_IPV6_CSUM | NETIF_F_GRO | @@ -1731,6 +1767,9 @@ qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,  	if (qlcnic_vlan_tx_check(adapter))  		netdev->features |= (NETIF_F_HW_VLAN_CTAG_TX); +	if (qlcnic_sriov_vf_check(adapter)) +		netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; +  	if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)  		netdev->features |= NETIF_F_LRO; @@ -2112,6 +2151,7 @@ static int __qlcnic_shutdown(struct pci_dev *pdev)  	if (netif_running(netdev))  		qlcnic_down(adapter, netdev); +	qlcnic_sriov_cleanup(adapter);  	if (qlcnic_82xx_check(adapter))  		qlcnic_clr_all_drv_state(adapter, 0); @@ -3266,8 +3306,10 @@ int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data, size_t len)  	qlcnic_detach(adapter); -	if (qlcnic_83xx_check(adapter)) +	if (qlcnic_83xx_check(adapter)) {  		qlcnic_83xx_free_mbx_intr(adapter); +		qlcnic_83xx_enable_mbx_poll(adapter); +	}  	qlcnic_teardown_intr(adapter);  	err = qlcnic_setup_intr(adapter, data); @@ -3281,6 +3323,7 @@ int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data, size_t len)  		/* register for NIC IDC AEN Events */  		qlcnic_83xx_register_nic_idc_func(adapter, 1);  		err = qlcnic_83xx_setup_mbx_intr(adapter); +		qlcnic_83xx_disable_mbx_poll(adapter);  		if (err) {  			dev_err(&adapter->pdev->dev,  				"failed to setup mbx interrupt\n"); diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov.h b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov.h index b476ebac243..d85fbb57c25 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov.h +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov.h @@ -48,6 +48,8 @@ struct qlcnic_bc_hdr {  enum qlcnic_bc_commands {  	QLCNIC_BC_CMD_CHANNEL_INIT = 0x0,  	QLCNIC_BC_CMD_CHANNEL_TERM = 0x1, +	QLCNIC_BC_CMD_GET_ACL = 0x2, +	QLCNIC_BC_CMD_CFG_GUEST_VLAN = 0x3,  };  #define QLC_BC_CMD 1 @@ -91,6 +93,14 @@ enum qlcnic_vf_state {  	QLC_BC_VF_RECV,  	QLC_BC_VF_CHANNEL,  	QLC_BC_VF_STATE, +	QLC_BC_VF_FLR, +	QLC_BC_VF_SOFT_FLR, +}; + +enum qlcnic_vlan_mode { +	QLC_NO_VLAN_MODE = 0, +	QLC_PVID_MODE, +	QLC_GUEST_VLAN_MODE,  };  struct qlcnic_resources { @@ -114,6 +124,11 @@ struct qlcnic_resources {  struct qlcnic_vport {  	u16			handle; +	u16			max_tx_bw; +	u16			min_tx_bw; +	u8			vlan_mode; +	u16			vlan; +	u8			qos;  	u8			mac[6];  }; @@ -124,9 +139,11 @@ struct qlcnic_vf_info {  	unsigned long			state;  	struct completion		ch_free_cmpl;  	struct work_struct		trans_work; +	struct work_struct		flr_work;  	/* It synchronizes commands sent from VF */  	struct mutex			send_cmd_lock;  	struct qlcnic_bc_trans		*send_cmd; +	struct qlcnic_bc_trans		*flr_trans;  	struct qlcnic_trans_list	rcv_act;  	struct qlcnic_trans_list	rcv_pend;  	struct qlcnic_adapter		*adapter; @@ -143,12 +160,18 @@ struct qlcnic_back_channel {  	u16			trans_counter;  	struct workqueue_struct *bc_trans_wq;  	struct workqueue_struct *bc_async_wq; +	struct workqueue_struct *bc_flr_wq;  	struct list_head	async_list;  };  struct qlcnic_sriov {  	u16				vp_handle;  	u8				num_vfs; +	u8				any_vlan; +	u8				vlan_mode; +	u16				num_allowed_vlans; +	u16				*allowed_vlans; +	u16				vlan;  	struct qlcnic_resources		ff_max;  	struct qlcnic_back_channel	bc;  	struct qlcnic_vf_info		*vf_info; @@ -165,6 +188,12 @@ int qlcnic_sriov_channel_cfg_cmd(struct qlcnic_adapter *, u8);  void qlcnic_sriov_handle_bc_event(struct qlcnic_adapter *, u32);  int qlcnic_sriov_cfg_bc_intr(struct qlcnic_adapter *, u8);  void qlcnic_sriov_cleanup_async_list(struct qlcnic_back_channel *); +void qlcnic_sriov_cleanup_list(struct qlcnic_trans_list *); +int __qlcnic_sriov_add_act_list(struct qlcnic_sriov *, struct qlcnic_vf_info *, +				struct qlcnic_bc_trans *); +int qlcnic_sriov_get_vf_vport_info(struct qlcnic_adapter *, +				   struct qlcnic_info *, u16); +int qlcnic_sriov_cfg_vf_guest_vlan(struct qlcnic_adapter *, u16, u8);  static inline bool qlcnic_sriov_enable_check(struct qlcnic_adapter *adapter)  { @@ -185,6 +214,17 @@ void qlcnic_pf_set_interface_id_del_tx_ctx(struct qlcnic_adapter *, u32 *);  void qlcnic_pf_set_interface_id_promisc(struct qlcnic_adapter *, u32 *);  void qlcnic_pf_set_interface_id_ipaddr(struct qlcnic_adapter *, u32 *);  void qlcnic_pf_set_interface_id_macaddr(struct qlcnic_adapter *, u32 *); +void qlcnic_sriov_pf_handle_flr(struct qlcnic_sriov *, struct qlcnic_vf_info *); +bool qlcnic_sriov_soft_flr_check(struct qlcnic_adapter *, +				 struct qlcnic_bc_trans *, +				 struct qlcnic_vf_info *); +void qlcnic_sriov_pf_reset(struct qlcnic_adapter *); +int qlcnic_sriov_pf_reinit(struct qlcnic_adapter *); +int qlcnic_sriov_set_vf_mac(struct net_device *, int, u8 *); +int qlcnic_sriov_set_vf_tx_rate(struct net_device *, int, int); +int qlcnic_sriov_get_vf_config(struct net_device *, int , +			       struct ifla_vf_info *); +int qlcnic_sriov_set_vf_vlan(struct net_device *, int, u16, u8);  #else  static inline void qlcnic_sriov_pf_disable(struct qlcnic_adapter *adapter) {}  static inline void qlcnic_sriov_pf_cleanup(struct qlcnic_adapter *adapter) {} @@ -209,6 +249,15 @@ qlcnic_pf_set_interface_id_macaddr(struct qlcnic_adapter *adapter, u32 *int_id)  static inline void  qlcnic_pf_set_interface_id_promisc(struct qlcnic_adapter *adapter, u32 *int_id)  {} +static inline void qlcnic_sriov_pf_handle_flr(struct qlcnic_sriov *sriov, +					      struct qlcnic_vf_info *vf) {} +static inline bool qlcnic_sriov_soft_flr_check(struct qlcnic_adapter *adapter, +					       struct qlcnic_bc_trans *trans, +					       struct qlcnic_vf_info *vf) +{ return false; } +static inline void qlcnic_sriov_pf_reset(struct qlcnic_adapter *adapter) {} +static inline int qlcnic_sriov_pf_reinit(struct qlcnic_adapter *adapter) +{ return 0; }  #endif  #endif diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_common.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_common.c index 14e9ebd3b73..44d547d78b8 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_common.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_common.c @@ -18,12 +18,21 @@  #define QLC_BC_MSG		0  #define QLC_BC_CFREE		1 +#define QLC_BC_FLR		2  #define QLC_BC_HDR_SZ		16  #define QLC_BC_PAYLOAD_SZ	(1024 - QLC_BC_HDR_SZ)  #define QLC_DEFAULT_RCV_DESCRIPTORS_SRIOV_VF		2048  #define QLC_DEFAULT_JUMBO_RCV_DESCRIPTORS_SRIOV_VF	512 +#define QLC_83XX_VF_RESET_FAIL_THRESH	8 +#define QLC_BC_CMD_MAX_RETRY_CNT	5 + +static void qlcnic_sriov_vf_free_mac_list(struct qlcnic_adapter *); +static int qlcnic_sriov_alloc_bc_mbx_args(struct qlcnic_cmd_args *, u32); +static void qlcnic_sriov_vf_poll_dev_state(struct work_struct *); +static void qlcnic_sriov_vf_cancel_fw_work(struct qlcnic_adapter *); +static void qlcnic_sriov_cleanup_transaction(struct qlcnic_bc_trans *);  static int qlcnic_sriov_vf_mbx_op(struct qlcnic_adapter *,  				  struct qlcnic_cmd_args *); @@ -57,12 +66,13 @@ static struct qlcnic_hardware_ops qlcnic_sriov_vf_hw_ops = {  	.config_promisc_mode		= qlcnic_83xx_nic_set_promisc,  	.change_l2_filter		= qlcnic_83xx_change_l2_filter,  	.get_board_info			= qlcnic_83xx_get_port_info, +	.free_mac_list			= qlcnic_sriov_vf_free_mac_list,  };  static struct qlcnic_nic_template qlcnic_sriov_vf_ops = {  	.config_bridged_mode	= qlcnic_config_bridged_mode,  	.config_led		= qlcnic_config_led, -	.cancel_idc_work        = qlcnic_83xx_idc_exit, +	.cancel_idc_work        = qlcnic_sriov_vf_cancel_fw_work,  	.napi_add		= qlcnic_83xx_napi_add,  	.napi_del		= qlcnic_83xx_napi_del,  	.config_ipaddr		= qlcnic_83xx_config_ipaddr, @@ -72,6 +82,8 @@ static struct qlcnic_nic_template qlcnic_sriov_vf_ops = {  static const struct qlcnic_mailbox_metadata qlcnic_sriov_bc_mbx_tbl[] = {  	{QLCNIC_BC_CMD_CHANNEL_INIT, 2, 2},  	{QLCNIC_BC_CMD_CHANNEL_TERM, 2, 2}, +	{QLCNIC_BC_CMD_GET_ACL, 3, 14}, +	{QLCNIC_BC_CMD_CFG_GUEST_VLAN, 2, 2},  };  static inline bool qlcnic_sriov_bc_msg_check(u32 val) @@ -84,6 +96,11 @@ static inline bool qlcnic_sriov_channel_free_check(u32 val)  	return (val & (1 << QLC_BC_CFREE)) ? true : false;  } +static inline bool qlcnic_sriov_flr_check(u32 val) +{ +	return (val & (1 << QLC_BC_FLR)) ? true : false; +} +  static inline u8 qlcnic_sriov_target_func_id(u32 val)  {  	return (val >> 4) & 0xff; @@ -169,6 +186,7 @@ int qlcnic_sriov_init(struct qlcnic_adapter *adapter, int num_vfs)  				goto qlcnic_destroy_async_wq;  			}  			sriov->vf_info[i].vp = vp; +			vp->max_tx_bw = MAX_BW;  			random_ether_addr(vp->mac);  			dev_info(&adapter->pdev->dev,  				 "MAC Address %pM is configured for VF %d\n", @@ -192,10 +210,33 @@ qlcnic_free_sriov:  	return err;  } +void qlcnic_sriov_cleanup_list(struct qlcnic_trans_list *t_list) +{ +	struct qlcnic_bc_trans *trans; +	struct qlcnic_cmd_args cmd; +	unsigned long flags; + +	spin_lock_irqsave(&t_list->lock, flags); + +	while (!list_empty(&t_list->wait_list)) { +		trans = list_first_entry(&t_list->wait_list, +					 struct qlcnic_bc_trans, list); +		list_del(&trans->list); +		t_list->count--; +		cmd.req.arg = (u32 *)trans->req_pay; +		cmd.rsp.arg = (u32 *)trans->rsp_pay; +		qlcnic_free_mbx_args(&cmd); +		qlcnic_sriov_cleanup_transaction(trans); +	} + +	spin_unlock_irqrestore(&t_list->lock, flags); +} +  void __qlcnic_sriov_cleanup(struct qlcnic_adapter *adapter)  {  	struct qlcnic_sriov *sriov = adapter->ahw->sriov;  	struct qlcnic_back_channel *bc = &sriov->bc; +	struct qlcnic_vf_info *vf;  	int i;  	if (!qlcnic_sriov_enable_check(adapter)) @@ -203,6 +244,14 @@ void __qlcnic_sriov_cleanup(struct qlcnic_adapter *adapter)  	qlcnic_sriov_cleanup_async_list(bc);  	destroy_workqueue(bc->bc_async_wq); + +	for (i = 0; i < sriov->num_vfs; i++) { +		vf = &sriov->vf_info[i]; +		qlcnic_sriov_cleanup_list(&vf->rcv_pend); +		cancel_work_sync(&vf->trans_work); +		qlcnic_sriov_cleanup_list(&vf->rcv_act); +	} +  	destroy_workqueue(bc->bc_trans_wq);  	for (i = 0; i < sriov->num_vfs; i++) @@ -286,7 +335,7 @@ poll:  		/* Get the FW response data */  		fw_data = readl(QLCNIC_MBX_FW(ahw, 0));  		if (fw_data &  QLCNIC_MBX_ASYNC_EVENT) { -			qlcnic_83xx_process_aen(adapter); +			__qlcnic_83xx_process_aen(adapter);  			mbx_val = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);  			if (mbx_val)  				goto poll; @@ -335,16 +384,156 @@ static void qlcnic_sriov_vf_cfg_buff_desc(struct qlcnic_adapter *adapter)  	adapter->max_rds_rings = MAX_RDS_RINGS;  } +int qlcnic_sriov_get_vf_vport_info(struct qlcnic_adapter *adapter, +				   struct qlcnic_info *npar_info, u16 vport_id) +{ +	struct device *dev = &adapter->pdev->dev; +	struct qlcnic_cmd_args cmd; +	int err; +	u32 status; + +	err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_NIC_INFO); +	if (err) +		return err; + +	cmd.req.arg[1] = vport_id << 16 | 0x1; +	err = qlcnic_issue_cmd(adapter, &cmd); +	if (err) { +		dev_err(&adapter->pdev->dev, +			"Failed to get vport info, err=%d\n", err); +		qlcnic_free_mbx_args(&cmd); +		return err; +	} + +	status = cmd.rsp.arg[2] & 0xffff; +	if (status & BIT_0) +		npar_info->min_tx_bw = MSW(cmd.rsp.arg[2]); +	if (status & BIT_1) +		npar_info->max_tx_bw = LSW(cmd.rsp.arg[3]); +	if (status & BIT_2) +		npar_info->max_tx_ques = MSW(cmd.rsp.arg[3]); +	if (status & BIT_3) +		npar_info->max_tx_mac_filters = LSW(cmd.rsp.arg[4]); +	if (status & BIT_4) +		npar_info->max_rx_mcast_mac_filters = MSW(cmd.rsp.arg[4]); +	if (status & BIT_5) +		npar_info->max_rx_ucast_mac_filters = LSW(cmd.rsp.arg[5]); +	if (status & BIT_6) +		npar_info->max_rx_ip_addr = MSW(cmd.rsp.arg[5]); +	if (status & BIT_7) +		npar_info->max_rx_lro_flow = LSW(cmd.rsp.arg[6]); +	if (status & BIT_8) +		npar_info->max_rx_status_rings = MSW(cmd.rsp.arg[6]); +	if (status & BIT_9) +		npar_info->max_rx_buf_rings = LSW(cmd.rsp.arg[7]); + +	npar_info->max_rx_ques = MSW(cmd.rsp.arg[7]); +	npar_info->max_tx_vlan_keys = LSW(cmd.rsp.arg[8]); +	npar_info->max_local_ipv6_addrs = MSW(cmd.rsp.arg[8]); +	npar_info->max_remote_ipv6_addrs = LSW(cmd.rsp.arg[9]); + +	dev_info(dev, "\n\tmin_tx_bw: %d, max_tx_bw: %d max_tx_ques: %d,\n" +		 "\tmax_tx_mac_filters: %d max_rx_mcast_mac_filters: %d,\n" +		 "\tmax_rx_ucast_mac_filters: 0x%x, max_rx_ip_addr: %d,\n" +		 "\tmax_rx_lro_flow: %d max_rx_status_rings: %d,\n" +		 "\tmax_rx_buf_rings: %d, max_rx_ques: %d, max_tx_vlan_keys %d\n" +		 "\tlocal_ipv6_addr: %d, remote_ipv6_addr: %d\n", +		 npar_info->min_tx_bw, npar_info->max_tx_bw, +		 npar_info->max_tx_ques, npar_info->max_tx_mac_filters, +		 npar_info->max_rx_mcast_mac_filters, +		 npar_info->max_rx_ucast_mac_filters, npar_info->max_rx_ip_addr, +		 npar_info->max_rx_lro_flow, npar_info->max_rx_status_rings, +		 npar_info->max_rx_buf_rings, npar_info->max_rx_ques, +		 npar_info->max_tx_vlan_keys, npar_info->max_local_ipv6_addrs, +		 npar_info->max_remote_ipv6_addrs); + +	qlcnic_free_mbx_args(&cmd); +	return err; +} + +static int qlcnic_sriov_set_pvid_mode(struct qlcnic_adapter *adapter, +				      struct qlcnic_cmd_args *cmd) +{ +	adapter->rx_pvid = (cmd->rsp.arg[1] >> 16) & 0xffff; +	adapter->flags &= ~QLCNIC_TAGGING_ENABLED; +	return 0; +} + +static int qlcnic_sriov_set_guest_vlan_mode(struct qlcnic_adapter *adapter, +					    struct qlcnic_cmd_args *cmd) +{ +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	int i, num_vlans; +	u16 *vlans; + +	if (sriov->allowed_vlans) +		return 0; + +	sriov->any_vlan = cmd->rsp.arg[2] & 0xf; +	if (!sriov->any_vlan) +		return 0; + +	sriov->num_allowed_vlans = cmd->rsp.arg[2] >> 16; +	num_vlans = sriov->num_allowed_vlans; +	sriov->allowed_vlans = kzalloc(sizeof(u16) * num_vlans, GFP_KERNEL); +	if (!sriov->allowed_vlans) +		return -ENOMEM; + +	vlans = (u16 *)&cmd->rsp.arg[3]; +	for (i = 0; i < num_vlans; i++) +		sriov->allowed_vlans[i] = vlans[i]; + +	return 0; +} + +static int qlcnic_sriov_get_vf_acl(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	struct qlcnic_cmd_args cmd; +	int ret; + +	ret = qlcnic_sriov_alloc_bc_mbx_args(&cmd, QLCNIC_BC_CMD_GET_ACL); +	if (ret) +		return ret; + +	ret = qlcnic_issue_cmd(adapter, &cmd); +	if (ret) { +		dev_err(&adapter->pdev->dev, "Failed to get ACL, err=%d\n", +			ret); +	} else { +		sriov->vlan_mode = cmd.rsp.arg[1] & 0x3; +		switch (sriov->vlan_mode) { +		case QLC_GUEST_VLAN_MODE: +			ret = qlcnic_sriov_set_guest_vlan_mode(adapter, &cmd); +			break; +		case QLC_PVID_MODE: +			ret = qlcnic_sriov_set_pvid_mode(adapter, &cmd); +			break; +		} +	} + +	qlcnic_free_mbx_args(&cmd); +	return ret; +} +  static int qlcnic_sriov_vf_init_driver(struct qlcnic_adapter *adapter)  {  	struct qlcnic_info nic_info;  	struct qlcnic_hardware_context *ahw = adapter->ahw;  	int err; +	err = qlcnic_sriov_get_vf_vport_info(adapter, &nic_info, 0); +	if (err) +		return err; +  	err = qlcnic_get_nic_info(adapter, &nic_info, ahw->pci_func);  	if (err)  		return -EIO; +	err = qlcnic_sriov_get_vf_acl(adapter); +	if (err) +		return err; +  	if (qlcnic_83xx_get_port_info(adapter))  		return -EIO; @@ -404,6 +593,8 @@ static int qlcnic_sriov_setup_vf(struct qlcnic_adapter *adapter,  	pci_set_drvdata(adapter->pdev, adapter);  	dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",  		 adapter->netdev->name); +	qlcnic_schedule_work(adapter, qlcnic_sriov_vf_poll_dev_state, +			     adapter->ahw->idc.delay);  	return 0;  err_out_send_channel_term: @@ -423,27 +614,47 @@ err_out_disable_msi:  	return err;  } +static int qlcnic_sriov_check_dev_ready(struct qlcnic_adapter *adapter) +{ +	u32 state; + +	do { +		msleep(20); +		if (++adapter->fw_fail_cnt > QLC_BC_CMD_MAX_RETRY_CNT) +			return -EIO; +		state = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_STATE); +	} while (state != QLC_83XX_IDC_DEV_READY); + +	return 0; +} +  int qlcnic_sriov_vf_init(struct qlcnic_adapter *adapter, int pci_using_dac)  {  	struct qlcnic_hardware_context *ahw = adapter->ahw; +	int err;  	spin_lock_init(&ahw->mbx_lock); -	set_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status); +	set_bit(QLC_83XX_MBX_READY, &ahw->idc.status); +	set_bit(QLC_83XX_MODULE_LOADED, &ahw->idc.status); +	ahw->idc.delay = QLC_83XX_IDC_FW_POLL_DELAY; +	ahw->reset_context = 0; +	adapter->fw_fail_cnt = 0;  	ahw->msix_supported = 1; +	adapter->need_fw_reset = 0;  	adapter->flags |= QLCNIC_TX_INTR_SHARED; -	if (qlcnic_sriov_setup_vf(adapter, pci_using_dac)) -		return -EIO; +	err = qlcnic_sriov_check_dev_ready(adapter); +	if (err) +		return err; + +	err = qlcnic_sriov_setup_vf(adapter, pci_using_dac); +	if (err) +		return err;  	if (qlcnic_read_mac_addr(adapter))  		dev_warn(&adapter->pdev->dev, "failed to read mac addr\n"); -	set_bit(QLC_83XX_MODULE_LOADED, &adapter->ahw->idc.status); -	adapter->ahw->idc.delay = QLC_83XX_IDC_FW_POLL_DELAY; -	adapter->ahw->reset_context = 0; -	adapter->fw_fail_cnt = 0;  	clear_bit(__QLCNIC_RESETTING, &adapter->state); -	adapter->need_fw_reset = 0;  	return 0;  } @@ -651,6 +862,10 @@ static void qlcnic_sriov_schedule_bc_cmd(struct qlcnic_sriov *sriov,  					 struct qlcnic_vf_info *vf,  					 work_func_t func)  { +	if (test_bit(QLC_BC_VF_FLR, &vf->state) || +	    vf->adapter->need_fw_reset) +		return; +  	INIT_WORK(&vf->trans_work, func);  	queue_work(sriov->bc.bc_trans_wq, &vf->trans_work);  } @@ -768,10 +983,14 @@ static int qlcnic_sriov_issue_bc_post(struct qlcnic_bc_trans *trans, u8 type)  static int __qlcnic_sriov_send_bc_msg(struct qlcnic_bc_trans *trans,  				      struct qlcnic_vf_info *vf, u8 type)  { -	int err;  	bool flag = true; +	int err = -EIO;  	while (flag) { +		if (test_bit(QLC_BC_VF_FLR, &vf->state) || +		    vf->adapter->need_fw_reset) +			trans->trans_state = QLC_ABORT; +  		switch (trans->trans_state) {  		case QLC_INIT:  			trans->trans_state = QLC_WAIT_FOR_CHANNEL_FREE; @@ -853,6 +1072,12 @@ static void qlcnic_sriov_process_bc_cmd(struct work_struct *work)  	struct qlcnic_cmd_args cmd;  	u8 req; +	if (adapter->need_fw_reset) +		return; + +	if (test_bit(QLC_BC_VF_FLR, &vf->state)) +		return; +  	trans = list_first_entry(&vf->rcv_act.wait_list,  				 struct qlcnic_bc_trans, list);  	adapter = vf->adapter; @@ -906,18 +1131,30 @@ clear_send:  	clear_bit(QLC_BC_VF_SEND, &vf->state);  } -static int qlcnic_sriov_add_act_list(struct qlcnic_sriov *sriov, -				     struct qlcnic_vf_info *vf, -				     struct qlcnic_bc_trans *trans) +int __qlcnic_sriov_add_act_list(struct qlcnic_sriov *sriov, +				struct qlcnic_vf_info *vf, +				struct qlcnic_bc_trans *trans)  {  	struct qlcnic_trans_list *t_list = &vf->rcv_act; -	spin_lock(&t_list->lock);  	t_list->count++;  	list_add_tail(&trans->list, &t_list->wait_list);  	if (t_list->count == 1)  		qlcnic_sriov_schedule_bc_cmd(sriov, vf,  					     qlcnic_sriov_process_bc_cmd); +	return 0; +} + +static int qlcnic_sriov_add_act_list(struct qlcnic_sriov *sriov, +				     struct qlcnic_vf_info *vf, +				     struct qlcnic_bc_trans *trans) +{ +	struct qlcnic_trans_list *t_list = &vf->rcv_act; + +	spin_lock(&t_list->lock); + +	__qlcnic_sriov_add_act_list(sriov, vf, trans); +  	spin_unlock(&t_list->lock);  	return 0;  } @@ -977,6 +1214,9 @@ static void qlcnic_sriov_handle_bc_cmd(struct qlcnic_sriov *sriov,  	int err;  	u8 cmd_op; +	if (adapter->need_fw_reset) +		return; +  	if (!test_bit(QLC_BC_VF_STATE, &vf->state) &&  	    hdr->op_type != QLC_BC_CMD &&  	    hdr->cmd_op != QLCNIC_BC_CMD_CHANNEL_INIT) @@ -1019,6 +1259,10 @@ static void qlcnic_sriov_handle_bc_cmd(struct qlcnic_sriov *sriov,  	trans->vf = vf;  	trans->trans_id = hdr->seq_id;  	trans->curr_req_frag++; + +	if (qlcnic_sriov_soft_flr_check(adapter, trans, vf)) +		return; +  	if (trans->curr_req_frag == trans->req_hdr->num_frags) {  		if (qlcnic_sriov_add_act_list(sriov, vf, trans)) {  			qlcnic_free_mbx_args(&cmd); @@ -1053,6 +1297,18 @@ static void qlcnic_sriov_handle_msg_event(struct qlcnic_sriov *sriov,  	}  } +static void qlcnic_sriov_handle_flr_event(struct qlcnic_sriov *sriov, +					  struct qlcnic_vf_info *vf) +{ +	struct qlcnic_adapter *adapter = vf->adapter; + +	if (qlcnic_sriov_pf_check(adapter)) +		qlcnic_sriov_pf_handle_flr(sriov, vf); +	else +		dev_err(&adapter->pdev->dev, +			"Invalid event to VF. VF should not get FLR event\n"); +} +  void qlcnic_sriov_handle_bc_event(struct qlcnic_adapter *adapter, u32 event)  {  	struct qlcnic_vf_info *vf; @@ -1073,6 +1329,11 @@ void qlcnic_sriov_handle_bc_event(struct qlcnic_adapter *adapter, u32 event)  	if (qlcnic_sriov_channel_free_check(event))  		complete(&vf->ch_free_cmpl); +	if (qlcnic_sriov_flr_check(event)) { +		qlcnic_sriov_handle_flr_event(sriov, vf); +		return; +	} +  	if (qlcnic_sriov_bc_msg_check(event))  		qlcnic_sriov_handle_msg_event(sriov, vf);  } @@ -1103,33 +1364,66 @@ int qlcnic_sriov_cfg_bc_intr(struct qlcnic_adapter *adapter, u8 enable)  	return err;  } +static int qlcnic_sriov_retry_bc_cmd(struct qlcnic_adapter *adapter, +				     struct qlcnic_bc_trans *trans) +{ +	u8 max = QLC_BC_CMD_MAX_RETRY_CNT; +	u32 state; + +	state = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_STATE); +	if (state == QLC_83XX_IDC_DEV_READY) { +		msleep(20); +		clear_bit(QLC_BC_VF_CHANNEL, &trans->vf->state); +		trans->trans_state = QLC_INIT; +		if (++adapter->fw_fail_cnt > max) +			return -EIO; +		else +			return 0; +	} + +	return -EIO; +} +  static int qlcnic_sriov_vf_mbx_op(struct qlcnic_adapter *adapter,  				  struct qlcnic_cmd_args *cmd)  { +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	struct device *dev = &adapter->pdev->dev;  	struct qlcnic_bc_trans *trans;  	int err;  	u32 rsp_data, opcode, mbx_err_code, rsp;  	u16 seq = ++adapter->ahw->sriov->bc.trans_counter; +	u8 func = ahw->pci_func; -	if (qlcnic_sriov_alloc_bc_trans(&trans)) -		return -ENOMEM; +	rsp = qlcnic_sriov_alloc_bc_trans(&trans); +	if (rsp) +		return rsp; -	if (qlcnic_sriov_prepare_bc_hdr(trans, cmd, seq, QLC_BC_COMMAND)) -		return -ENOMEM; +	rsp = qlcnic_sriov_prepare_bc_hdr(trans, cmd, seq, QLC_BC_COMMAND); +	if (rsp) +		goto cleanup_transaction; +retry:  	if (!test_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status)) {  		rsp = -EIO;  		QLCDB(adapter, DRV, "MBX not Ready!(cmd 0x%x) for VF 0x%x\n", -		      QLCNIC_MBX_RSP(cmd->req.arg[0]), adapter->ahw->pci_func); +		      QLCNIC_MBX_RSP(cmd->req.arg[0]), func);  		goto err_out;  	} -	err = qlcnic_sriov_send_bc_cmd(adapter, trans, adapter->ahw->pci_func); +	err = qlcnic_sriov_send_bc_cmd(adapter, trans, func);  	if (err) { -		dev_err(&adapter->pdev->dev, -			"MBX command 0x%x timed out for VF %d\n", -			(cmd->req.arg[0] & 0xffff), adapter->ahw->pci_func); +		dev_err(dev, "MBX command 0x%x timed out for VF %d\n", +			(cmd->req.arg[0] & 0xffff), func);  		rsp = QLCNIC_RCODE_TIMEOUT; + +		/* After adapter reset PF driver may take some time to +		 * respond to VF's request. Retry request till maximum retries. +		 */ +		if ((trans->req_hdr->cmd_op == QLCNIC_BC_CMD_CHANNEL_INIT) && +		    !qlcnic_sriov_retry_bc_cmd(adapter, trans)) +			goto retry; +  		goto err_out;  	} @@ -1144,12 +1438,19 @@ static int qlcnic_sriov_vf_mbx_op(struct qlcnic_adapter *adapter,  		rsp = mbx_err_code;  		if (!rsp)  			rsp = 1; -		dev_err(&adapter->pdev->dev, +		dev_err(dev,  			"MBX command 0x%x failed with err:0x%x for VF %d\n", -			opcode, mbx_err_code, adapter->ahw->pci_func); +			opcode, mbx_err_code, func);  	}  err_out: +	if (rsp == QLCNIC_RCODE_TIMEOUT) { +		ahw->reset_context = 1; +		adapter->need_fw_reset = 1; +		clear_bit(QLC_83XX_MBX_READY, &ahw->idc.status); +	} + +cleanup_transaction:  	qlcnic_sriov_cleanup_transaction(trans);  	return rsp;  } @@ -1184,7 +1485,7 @@ out:  	return ret;  } -void qlcnic_vf_add_mc_list(struct net_device *netdev) +void qlcnic_vf_add_mc_list(struct net_device *netdev, u16 vlan)  {  	struct qlcnic_adapter *adapter = netdev_priv(netdev);  	struct qlcnic_mac_list_s *cur; @@ -1204,7 +1505,7 @@ void qlcnic_vf_add_mc_list(struct net_device *netdev)  	while (!list_empty(&tmp_list)) {  		cur = list_entry((&tmp_list)->next,  				 struct qlcnic_mac_list_s, list); -		qlcnic_nic_add_mac(adapter, cur->mac_addr); +		qlcnic_nic_add_mac(adapter, cur->mac_addr, vlan);  		list_del(&cur->list);  		kfree(cur);  	} @@ -1227,11 +1528,13 @@ void qlcnic_sriov_cleanup_async_list(struct qlcnic_back_channel *bc)  static void qlcnic_sriov_vf_set_multi(struct net_device *netdev)  {  	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	u16 vlan;  	if (!test_bit(__QLCNIC_FW_ATTACHED, &adapter->state))  		return; -	__qlcnic_set_multi(netdev); +	vlan = adapter->ahw->sriov->vlan; +	__qlcnic_set_multi(netdev, vlan);  }  static void qlcnic_sriov_handle_async_multi(struct work_struct *work) @@ -1292,6 +1595,360 @@ void qlcnic_sriov_vf_schedule_multi(struct net_device *netdev)  	struct qlcnic_adapter *adapter = netdev_priv(netdev);  	struct qlcnic_back_channel *bc = &adapter->ahw->sriov->bc; +	if (adapter->need_fw_reset) +		return; +  	qlcnic_sriov_schedule_bc_async_work(bc, qlcnic_sriov_handle_async_multi,  					    netdev);  } + +static int qlcnic_sriov_vf_reinit_driver(struct qlcnic_adapter *adapter) +{ +	int err; + +	set_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status); +	qlcnic_83xx_enable_mbx_intrpt(adapter); + +	err = qlcnic_sriov_cfg_bc_intr(adapter, 1); +	if (err) +		return err; + +	err = qlcnic_sriov_channel_cfg_cmd(adapter, QLCNIC_BC_CMD_CHANNEL_INIT); +	if (err) +		goto err_out_cleanup_bc_intr; + +	err = qlcnic_sriov_vf_init_driver(adapter); +	if (err) +		goto err_out_term_channel; + +	return 0; + +err_out_term_channel: +	qlcnic_sriov_channel_cfg_cmd(adapter, QLCNIC_BC_CMD_CHANNEL_TERM); + +err_out_cleanup_bc_intr: +	qlcnic_sriov_cfg_bc_intr(adapter, 0); +	return err; +} + +static void qlcnic_sriov_vf_attach(struct qlcnic_adapter *adapter) +{ +	struct net_device *netdev = adapter->netdev; + +	if (netif_running(netdev)) { +		if (!qlcnic_up(adapter, netdev)) +			qlcnic_restore_indev_addr(netdev, NETDEV_UP); +	} + +	netif_device_attach(netdev); +} + +static void qlcnic_sriov_vf_detach(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	struct qlcnic_intrpt_config *intr_tbl = ahw->intr_tbl; +	struct net_device *netdev = adapter->netdev; +	u8 i, max_ints = ahw->num_msix - 1; + +	qlcnic_83xx_disable_mbx_intr(adapter); +	netif_device_detach(netdev); +	if (netif_running(netdev)) +		qlcnic_down(adapter, netdev); + +	for (i = 0; i < max_ints; i++) { +		intr_tbl[i].id = i; +		intr_tbl[i].enabled = 0; +		intr_tbl[i].src = 0; +	} +	ahw->reset_context = 0; +} + +static int qlcnic_sriov_vf_handle_dev_ready(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	struct device *dev = &adapter->pdev->dev; +	struct qlc_83xx_idc *idc = &ahw->idc; +	u8 func = ahw->pci_func; +	u32 state; + +	if ((idc->prev_state == QLC_83XX_IDC_DEV_NEED_RESET) || +	    (idc->prev_state == QLC_83XX_IDC_DEV_INIT)) { +		if (!qlcnic_sriov_vf_reinit_driver(adapter)) { +			qlcnic_sriov_vf_attach(adapter); +			adapter->fw_fail_cnt = 0; +			dev_info(dev, +				 "%s: Reinitalization of VF 0x%x done after FW reset\n", +				 __func__, func); +		} else { +			dev_err(dev, +				"%s: Reinitialization of VF 0x%x failed after FW reset\n", +				__func__, func); +			state = QLCRDX(ahw, QLC_83XX_IDC_DEV_STATE); +			dev_info(dev, "Current state 0x%x after FW reset\n", +				 state); +		} +	} + +	return 0; +} + +static int qlcnic_sriov_vf_handle_context_reset(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	struct device *dev = &adapter->pdev->dev; +	struct qlc_83xx_idc *idc = &ahw->idc; +	u8 func = ahw->pci_func; +	u32 state; + +	adapter->reset_ctx_cnt++; + +	/* Skip the context reset and check if FW is hung */ +	if (adapter->reset_ctx_cnt < 3) { +		adapter->need_fw_reset = 1; +		clear_bit(QLC_83XX_MBX_READY, &idc->status); +		dev_info(dev, +			 "Resetting context, wait here to check if FW is in failed state\n"); +		return 0; +	} + +	/* Check if number of resets exceed the threshold. +	 * If it exceeds the threshold just fail the VF. +	 */ +	if (adapter->reset_ctx_cnt > QLC_83XX_VF_RESET_FAIL_THRESH) { +		clear_bit(QLC_83XX_MODULE_LOADED, &idc->status); +		adapter->tx_timeo_cnt = 0; +		adapter->fw_fail_cnt = 0; +		adapter->reset_ctx_cnt = 0; +		qlcnic_sriov_vf_detach(adapter); +		dev_err(dev, +			"Device context resets have exceeded the threshold, device interface will be shutdown\n"); +		return -EIO; +	} + +	dev_info(dev, "Resetting context of VF 0x%x\n", func); +	dev_info(dev, "%s: Context reset count %d for VF 0x%x\n", +		 __func__, adapter->reset_ctx_cnt, func); +	set_bit(__QLCNIC_RESETTING, &adapter->state); +	adapter->need_fw_reset = 1; +	clear_bit(QLC_83XX_MBX_READY, &idc->status); +	qlcnic_sriov_vf_detach(adapter); +	adapter->need_fw_reset = 0; + +	if (!qlcnic_sriov_vf_reinit_driver(adapter)) { +		qlcnic_sriov_vf_attach(adapter); +		adapter->netdev->trans_start = jiffies; +		adapter->tx_timeo_cnt = 0; +		adapter->reset_ctx_cnt = 0; +		adapter->fw_fail_cnt = 0; +		dev_info(dev, "Done resetting context for VF 0x%x\n", func); +	} else { +		dev_err(dev, "%s: Reinitialization of VF 0x%x failed\n", +			__func__, func); +		state = QLCRDX(ahw, QLC_83XX_IDC_DEV_STATE); +		dev_info(dev, "%s: Current state 0x%x\n", __func__, state); +	} + +	return 0; +} + +static int qlcnic_sriov_vf_idc_ready_state(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	int ret = 0; + +	if (ahw->idc.prev_state != QLC_83XX_IDC_DEV_READY) +		ret = qlcnic_sriov_vf_handle_dev_ready(adapter); +	else if (ahw->reset_context) +		ret = qlcnic_sriov_vf_handle_context_reset(adapter); + +	clear_bit(__QLCNIC_RESETTING, &adapter->state); +	return ret; +} + +static int qlcnic_sriov_vf_idc_failed_state(struct qlcnic_adapter *adapter) +{ +	struct qlc_83xx_idc *idc = &adapter->ahw->idc; + +	dev_err(&adapter->pdev->dev, "Device is in failed state\n"); +	if (idc->prev_state == QLC_83XX_IDC_DEV_READY) +		qlcnic_sriov_vf_detach(adapter); + +	clear_bit(QLC_83XX_MODULE_LOADED, &idc->status); +	clear_bit(__QLCNIC_RESETTING, &adapter->state); +	return -EIO; +} + +static int +qlcnic_sriov_vf_idc_need_quiescent_state(struct qlcnic_adapter *adapter) +{ +	struct qlc_83xx_idc *idc = &adapter->ahw->idc; + +	dev_info(&adapter->pdev->dev, "Device is in quiescent state\n"); +	if (idc->prev_state == QLC_83XX_IDC_DEV_READY) { +		set_bit(__QLCNIC_RESETTING, &adapter->state); +		adapter->tx_timeo_cnt = 0; +		adapter->reset_ctx_cnt = 0; +		clear_bit(QLC_83XX_MBX_READY, &idc->status); +		qlcnic_sriov_vf_detach(adapter); +	} + +	return 0; +} + +static int qlcnic_sriov_vf_idc_init_reset_state(struct qlcnic_adapter *adapter) +{ +	struct qlc_83xx_idc *idc = &adapter->ahw->idc; +	u8 func = adapter->ahw->pci_func; + +	if (idc->prev_state == QLC_83XX_IDC_DEV_READY) { +		dev_err(&adapter->pdev->dev, +			"Firmware hang detected by VF 0x%x\n", func); +		set_bit(__QLCNIC_RESETTING, &adapter->state); +		adapter->tx_timeo_cnt = 0; +		adapter->reset_ctx_cnt = 0; +		clear_bit(QLC_83XX_MBX_READY, &idc->status); +		qlcnic_sriov_vf_detach(adapter); +	} +	return 0; +} + +static int qlcnic_sriov_vf_idc_unknown_state(struct qlcnic_adapter *adapter) +{ +	dev_err(&adapter->pdev->dev, "%s: Device in unknown state\n", __func__); +	return 0; +} + +static void qlcnic_sriov_vf_poll_dev_state(struct work_struct *work) +{ +	struct qlcnic_adapter *adapter; +	struct qlc_83xx_idc *idc; +	int ret = 0; + +	adapter = container_of(work, struct qlcnic_adapter, fw_work.work); +	idc = &adapter->ahw->idc; +	idc->curr_state = QLCRDX(adapter->ahw, QLC_83XX_IDC_DEV_STATE); + +	switch (idc->curr_state) { +	case QLC_83XX_IDC_DEV_READY: +		ret = qlcnic_sriov_vf_idc_ready_state(adapter); +		break; +	case QLC_83XX_IDC_DEV_NEED_RESET: +	case QLC_83XX_IDC_DEV_INIT: +		ret = qlcnic_sriov_vf_idc_init_reset_state(adapter); +		break; +	case QLC_83XX_IDC_DEV_NEED_QUISCENT: +		ret = qlcnic_sriov_vf_idc_need_quiescent_state(adapter); +		break; +	case QLC_83XX_IDC_DEV_FAILED: +		ret = qlcnic_sriov_vf_idc_failed_state(adapter); +		break; +	case QLC_83XX_IDC_DEV_QUISCENT: +		break; +	default: +		ret = qlcnic_sriov_vf_idc_unknown_state(adapter); +	} + +	idc->prev_state = idc->curr_state; +	if (!ret && test_bit(QLC_83XX_MODULE_LOADED, &idc->status)) +		qlcnic_schedule_work(adapter, qlcnic_sriov_vf_poll_dev_state, +				     idc->delay); +} + +static void qlcnic_sriov_vf_cancel_fw_work(struct qlcnic_adapter *adapter) +{ +	while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state)) +		msleep(20); + +	clear_bit(QLC_83XX_MODULE_LOADED, &adapter->ahw->idc.status); +	clear_bit(__QLCNIC_RESETTING, &adapter->state); +	cancel_delayed_work_sync(&adapter->fw_work); +} + +static int qlcnic_sriov_validate_vlan_cfg(struct qlcnic_sriov *sriov, +					  u16 vid, u8 enable) +{ +	u16 vlan = sriov->vlan; +	u8 allowed = 0; +	int i; + +	if (sriov->vlan_mode != QLC_GUEST_VLAN_MODE) +		return -EINVAL; + +	if (enable) { +		if (vlan) +			return -EINVAL; + +		if (sriov->any_vlan) { +			for (i = 0; i < sriov->num_allowed_vlans; i++) { +				if (sriov->allowed_vlans[i] == vid) +					allowed = 1; +			} + +			if (!allowed) +				return -EINVAL; +		} +	} else { +		if (!vlan || vlan != vid) +			return -EINVAL; +	} + +	return 0; +} + +int qlcnic_sriov_cfg_vf_guest_vlan(struct qlcnic_adapter *adapter, +				   u16 vid, u8 enable) +{ +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	struct qlcnic_cmd_args cmd; +	int ret; + +	if (vid == 0) +		return 0; + +	ret = qlcnic_sriov_validate_vlan_cfg(sriov, vid, enable); +	if (ret) +		return ret; + +	ret = qlcnic_sriov_alloc_bc_mbx_args(&cmd, +					     QLCNIC_BC_CMD_CFG_GUEST_VLAN); +	if (ret) +		return ret; + +	cmd.req.arg[1] = (enable & 1) | vid << 16; + +	qlcnic_sriov_cleanup_async_list(&sriov->bc); +	ret = qlcnic_issue_cmd(adapter, &cmd); +	if (ret) { +		dev_err(&adapter->pdev->dev, +			"Failed to configure guest VLAN, err=%d\n", ret); +	} else { +		qlcnic_free_mac_list(adapter); + +		if (enable) +			sriov->vlan = vid; +		else +			sriov->vlan = 0; + +		qlcnic_sriov_vf_set_multi(adapter->netdev); +	} + +	qlcnic_free_mbx_args(&cmd); +	return ret; +} + +static void qlcnic_sriov_vf_free_mac_list(struct qlcnic_adapter *adapter) +{ +	struct list_head *head = &adapter->mac_list; +	struct qlcnic_mac_list_s *cur; +	u16 vlan; + +	vlan = adapter->ahw->sriov->vlan; + +	while (!list_empty(head)) { +		cur = list_entry(head->next, struct qlcnic_mac_list_s, list); +		qlcnic_sre_macaddr_change(adapter, cur->mac_addr, +					  vlan, QLCNIC_MAC_DEL); +		list_del(&cur->list); +		kfree(cur); +	} +} diff --git a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_pf.c b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_pf.c index bed505606a2..c81be2da119 100644 --- a/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_pf.c +++ b/drivers/net/ethernet/qlogic/qlcnic/qlcnic_sriov_pf.c @@ -10,6 +10,8 @@  #include <linux/types.h>  #define QLCNIC_SRIOV_VF_MAX_MAC 1 +#define QLC_VF_MIN_TX_RATE	100 +#define QLC_VF_MAX_TX_RATE	9999  static int qlcnic_sriov_pf_get_vport_handle(struct qlcnic_adapter *, u8); @@ -62,8 +64,9 @@ static int qlcnic_sriov_pf_cal_res_limit(struct qlcnic_adapter *adapter,  {  	struct qlcnic_sriov *sriov = adapter->ahw->sriov;  	struct qlcnic_resources *res = &sriov->ff_max; -	int ret = -EIO, vpid;  	u32 temp, num_vf_macs, num_vfs, max; +	int ret = -EIO, vpid, id; +	struct qlcnic_vport *vp;  	vpid = qlcnic_sriov_pf_get_vport_handle(adapter, func);  	if (vpid < 0) @@ -72,8 +75,6 @@ static int qlcnic_sriov_pf_cal_res_limit(struct qlcnic_adapter *adapter,  	num_vfs = sriov->num_vfs;  	max = num_vfs + 1;  	info->bit_offsets = 0xffff; -	info->min_tx_bw = 0; -	info->max_tx_bw = MAX_BW;  	info->max_tx_ques = res->num_tx_queues / max;  	info->max_rx_mcast_mac_filters = res->num_rx_mcast_mac_filters;  	num_vf_macs = QLCNIC_SRIOV_VF_MAX_MAC; @@ -83,7 +84,15 @@ static int qlcnic_sriov_pf_cal_res_limit(struct qlcnic_adapter *adapter,  		info->max_rx_ucast_mac_filters = temp;  		temp = res->num_tx_mac_filters - (num_vfs * num_vf_macs);  		info->max_tx_mac_filters = temp; +		info->min_tx_bw = 0; +		info->max_tx_bw = MAX_BW;  	} else { +		id = qlcnic_sriov_func_to_index(adapter, func); +		if (id < 0) +			return id; +		vp = sriov->vf_info[id].vp; +		info->min_tx_bw = vp->min_tx_bw; +		info->max_tx_bw = vp->max_tx_bw;  		info->max_rx_ucast_mac_filters = num_vf_macs;  		info->max_tx_mac_filters = num_vf_macs;  	} @@ -277,6 +286,29 @@ out:  	return ret;  } +static int qlcnic_sriov_pf_cfg_vlan_filtering(struct qlcnic_adapter *adapter, +					      u8 enable) +{ +	struct qlcnic_cmd_args cmd; +	int err; + +	err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_NIC_INFO); +	if (err) +		return err; + +	cmd.req.arg[1] = 0x4; +	if (enable) +		cmd.req.arg[1] |= BIT_16; + +	err = qlcnic_issue_cmd(adapter, &cmd); +	if (err) +		dev_err(&adapter->pdev->dev, +			"Failed to configure VLAN filtering, err=%d\n", err); + +	qlcnic_free_mbx_args(&cmd); +	return err; +} +  static int qlcnic_sriov_pf_cfg_eswitch(struct qlcnic_adapter *adapter,  				       u8 func, u8 enable)  { @@ -303,6 +335,33 @@ static int qlcnic_sriov_pf_cfg_eswitch(struct qlcnic_adapter *adapter,  	return err;  } +static void qlcnic_sriov_pf_del_flr_queue(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	struct qlcnic_back_channel *bc = &sriov->bc; +	int i; + +	for (i = 0; i < sriov->num_vfs; i++) +		cancel_work_sync(&sriov->vf_info[i].flr_work); + +	destroy_workqueue(bc->bc_flr_wq); +} + +static int qlcnic_sriov_pf_create_flr_queue(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_back_channel *bc = &adapter->ahw->sriov->bc; +	struct workqueue_struct *wq; + +	wq = create_singlethread_workqueue("qlcnic-flr"); +	if (wq == NULL) { +		dev_err(&adapter->pdev->dev, "Cannot create FLR workqueue\n"); +		return -ENOMEM; +	} + +	bc->bc_flr_wq =  wq; +	return 0; +} +  void qlcnic_sriov_pf_cleanup(struct qlcnic_adapter *adapter)  {  	u8 func = adapter->ahw->pci_func; @@ -310,9 +369,11 @@ void qlcnic_sriov_pf_cleanup(struct qlcnic_adapter *adapter)  	if (!qlcnic_sriov_enable_check(adapter))  		return; +	qlcnic_sriov_pf_del_flr_queue(adapter);  	qlcnic_sriov_cfg_bc_intr(adapter, 0);  	qlcnic_sriov_pf_config_vport(adapter, 0, func);  	qlcnic_sriov_pf_cfg_eswitch(adapter, func, 0); +	qlcnic_sriov_pf_cfg_vlan_filtering(adapter, 0);  	__qlcnic_sriov_cleanup(adapter);  	adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;  	clear_bit(__QLCNIC_SRIOV_ENABLE, &adapter->state); @@ -365,9 +426,13 @@ static int qlcnic_sriov_pf_init(struct qlcnic_adapter *adapter)  	if (!qlcnic_sriov_enable_check(adapter))  		return 0; +	err = qlcnic_sriov_pf_cfg_vlan_filtering(adapter, 1); +	if (err) +		return err; +  	err = qlcnic_sriov_pf_cfg_eswitch(adapter, func, 1);  	if (err) -		goto clear_sriov_enable; +		goto disable_vlan_filtering;  	err = qlcnic_sriov_pf_config_vport(adapter, 1, func);  	if (err) @@ -402,10 +467,9 @@ delete_vport:  disable_eswitch:  	qlcnic_sriov_pf_cfg_eswitch(adapter, func, 0); -clear_sriov_enable: -	__qlcnic_sriov_cleanup(adapter); -	adapter->ahw->op_mode = QLCNIC_MGMT_FUNC; -	clear_bit(__QLCNIC_SRIOV_ENABLE, &adapter->state); +disable_vlan_filtering: +	qlcnic_sriov_pf_cfg_vlan_filtering(adapter, 0); +  	return err;  } @@ -431,17 +495,31 @@ static int __qlcnic_pci_sriov_enable(struct qlcnic_adapter *adapter,  	set_bit(__QLCNIC_SRIOV_ENABLE, &adapter->state);  	adapter->ahw->op_mode = QLCNIC_SRIOV_PF_FUNC; -	if (qlcnic_sriov_init(adapter, num_vfs)) { -		clear_bit(__QLCNIC_SRIOV_ENABLE, &adapter->state); -		adapter->ahw->op_mode = QLCNIC_MGMT_FUNC; -		return -EIO; -	} +	err = qlcnic_sriov_init(adapter, num_vfs); +	if (err) +		goto clear_op_mode; -	if (qlcnic_sriov_pf_init(adapter)) -		return -EIO; +	err = qlcnic_sriov_pf_create_flr_queue(adapter); +	if (err) +		goto sriov_cleanup; + +	err = qlcnic_sriov_pf_init(adapter); +	if (err) +		goto del_flr_queue;  	err = qlcnic_sriov_pf_enable(adapter, num_vfs);  	return err; + +del_flr_queue: +	qlcnic_sriov_pf_del_flr_queue(adapter); + +sriov_cleanup: +	__qlcnic_sriov_cleanup(adapter); + +clear_op_mode: +	clear_bit(__QLCNIC_SRIOV_ENABLE, &adapter->state); +	adapter->ahw->op_mode = QLCNIC_MGMT_FUNC; +	return err;  }  static int qlcnic_pci_sriov_enable(struct qlcnic_adapter *adapter, int num_vfs) @@ -463,12 +541,15 @@ static int qlcnic_pci_sriov_enable(struct qlcnic_adapter *adapter, int num_vfs)  		netdev_info(netdev, "Failed to enable SR-IOV on port %d\n",  			    adapter->portnum); +		err = -EIO;  		if (qlcnic_83xx_configure_opmode(adapter))  			goto error;  	} else { -		netdev_info(adapter->netdev, +		netdev_info(netdev,  			    "SR-IOV is enabled successfully on port %d\n",  			    adapter->portnum); +		/* Return number of vfs enabled */ +		err = num_vfs;  	}  	if (netif_running(netdev))  		__qlcnic_up(adapter, netdev); @@ -494,6 +575,36 @@ int qlcnic_pci_sriov_configure(struct pci_dev *dev, int num_vfs)  	return err;  } +static int qlcnic_sriov_set_vf_acl(struct qlcnic_adapter *adapter, u8 func) +{ +	struct qlcnic_cmd_args cmd; +	struct qlcnic_vport *vp; +	int err, id; + +	id = qlcnic_sriov_func_to_index(adapter, func); +	if (id < 0) +		return id; + +	vp = adapter->ahw->sriov->vf_info[id].vp; +	err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_NIC_INFO); +	if (err) +		return err; + +	cmd.req.arg[1] = 0x3 | func << 16; +	if (vp->vlan_mode == QLC_PVID_MODE) { +		cmd.req.arg[2] |= BIT_6; +		cmd.req.arg[3] |= vp->vlan << 8; +	} + +	err = qlcnic_issue_cmd(adapter, &cmd); +	if (err) +		dev_err(&adapter->pdev->dev, "Failed to set ACL, err=%d\n", +			err); + +	qlcnic_free_mbx_args(&cmd); +	return err; +} +  static int qlcnic_sriov_set_vf_vport_info(struct qlcnic_adapter *adapter,  					  u16 func)  { @@ -504,6 +615,10 @@ static int qlcnic_sriov_set_vf_vport_info(struct qlcnic_adapter *adapter,  	if (err)  		return -EIO; +	err = qlcnic_sriov_set_vf_acl(adapter, func); +	if (err) +		return err; +  	return 0;  } @@ -548,7 +663,7 @@ err_out:  static int qlcnic_sriov_cfg_vf_def_mac(struct qlcnic_adapter *adapter,  				       struct qlcnic_vport *vp, -				       u16 func, __le16 vlan, u8 op) +				       u16 func, u16 vlan, u8 op)  {  	struct qlcnic_cmd_args cmd;  	struct qlcnic_macvlan_mbx mv; @@ -574,7 +689,7 @@ static int qlcnic_sriov_cfg_vf_def_mac(struct qlcnic_adapter *adapter,  	cmd.req.arg[1] |= ((vpid & 0xffff) << 16) | BIT_31;  	addr = vp->mac; -	mv.vlan = le16_to_cpu(vlan); +	mv.vlan = vlan;  	mv.mac_addr0 = addr[0];  	mv.mac_addr1 = addr[1];  	mv.mac_addr2 = addr[2]; @@ -611,6 +726,7 @@ static int qlcnic_sriov_pf_create_rx_ctx_cmd(struct qlcnic_bc_trans *tran,  	struct qlcnic_adapter *adapter = vf->adapter;  	struct qlcnic_rcv_mbx_out *mbx_out;  	int err; +	u16 vlan;  	err = qlcnic_sriov_validate_create_rx_ctx(cmd);  	if (err) { @@ -621,11 +737,12 @@ static int qlcnic_sriov_pf_create_rx_ctx_cmd(struct qlcnic_bc_trans *tran,  	cmd->req.arg[6] = vf->vp->handle;  	err = qlcnic_issue_cmd(adapter, cmd); +	vlan = vf->vp->vlan;  	if (!err) {  		mbx_out = (struct qlcnic_rcv_mbx_out *)&cmd->rsp.arg[1];  		vf->rx_ctx_id = mbx_out->ctx_id;  		qlcnic_sriov_cfg_vf_def_mac(adapter, vf->vp, vf->pci_func, -					    0, QLCNIC_MAC_ADD); +					    vlan, QLCNIC_MAC_ADD);  	} else {  		vf->rx_ctx_id = 0;  	} @@ -709,6 +826,7 @@ static int qlcnic_sriov_pf_del_rx_ctx_cmd(struct qlcnic_bc_trans *trans,  	struct qlcnic_vf_info *vf = trans->vf;  	struct qlcnic_adapter *adapter = vf->adapter;  	int err; +	u16 vlan;  	err = qlcnic_sriov_validate_del_rx_ctx(vf, cmd);  	if (err) { @@ -716,8 +834,9 @@ static int qlcnic_sriov_pf_del_rx_ctx_cmd(struct qlcnic_bc_trans *trans,  		return err;  	} +	vlan = vf->vp->vlan;  	qlcnic_sriov_cfg_vf_def_mac(adapter, vf->vp, vf->pci_func, -				    0, QLCNIC_MAC_DEL); +				    vlan, QLCNIC_MAC_DEL);  	cmd->req.arg[1] |= vf->vp->handle << 16;  	err = qlcnic_issue_cmd(adapter, cmd); @@ -962,6 +1081,8 @@ static int qlcnic_sriov_validate_cfg_macvlan(struct qlcnic_adapter *adapter,  					     struct qlcnic_cmd_args *cmd)  {  	struct qlcnic_macvlan_mbx *macvlan; +	struct qlcnic_vport *vp = vf->vp; +	u8 op, new_op;  	if (!(cmd->req.arg[1] & BIT_8))  		return -EINVAL; @@ -977,6 +1098,15 @@ static int qlcnic_sriov_validate_cfg_macvlan(struct qlcnic_adapter *adapter,  		return -EINVAL;  	} +	if (vp->vlan_mode == QLC_PVID_MODE) { +		op = cmd->req.arg[1] & 0x7; +		cmd->req.arg[1] &= ~0x7; +		new_op = (op == QLCNIC_MAC_ADD || op == QLCNIC_MAC_VLAN_ADD) ? +			 QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_VLAN_DEL; +		cmd->req.arg[3] |= vp->vlan << 16; +		cmd->req.arg[1] |= new_op; +	} +  	return 0;  } @@ -1039,6 +1169,109 @@ static int qlcnic_sriov_pf_cfg_promisc_cmd(struct qlcnic_bc_trans *trans,  	return err;  } +static int qlcnic_sriov_pf_get_acl_cmd(struct qlcnic_bc_trans *trans, +				       struct qlcnic_cmd_args *cmd) +{ +	struct qlcnic_vf_info *vf = trans->vf; +	struct qlcnic_vport *vp = vf->vp; +	u8 cmd_op, mode = vp->vlan_mode; + +	cmd_op = trans->req_hdr->cmd_op; +	cmd->rsp.arg[0] = (cmd_op & 0xffff) | 14 << 16 | 1 << 25; + +	switch (mode) { +	case QLC_GUEST_VLAN_MODE: +		cmd->rsp.arg[1] = mode | 1 << 8; +		cmd->rsp.arg[2] = 1 << 16; +		break; +	case QLC_PVID_MODE: +		cmd->rsp.arg[1] = mode | 1 << 8 | vp->vlan << 16; +		break; +	} + +	return 0; +} + +static int qlcnic_sriov_pf_del_guest_vlan(struct qlcnic_adapter *adapter, +					  struct qlcnic_vf_info *vf) + +{ +	struct qlcnic_vport *vp = vf->vp; + +	if (!vp->vlan) +		return -EINVAL; + +	if (!vf->rx_ctx_id) { +		vp->vlan = 0; +		return 0; +	} + +	qlcnic_sriov_cfg_vf_def_mac(adapter, vp, vf->pci_func, +				    vp->vlan, QLCNIC_MAC_DEL); +	vp->vlan = 0; +	qlcnic_sriov_cfg_vf_def_mac(adapter, vp, vf->pci_func, +				    0, QLCNIC_MAC_ADD); +	return 0; +} + +static int qlcnic_sriov_pf_add_guest_vlan(struct qlcnic_adapter *adapter, +					  struct qlcnic_vf_info *vf, +					  struct qlcnic_cmd_args *cmd) +{ +	struct qlcnic_vport *vp = vf->vp; +	int err = -EIO; + +	if (vp->vlan) +		return err; + +	if (!vf->rx_ctx_id) { +		vp->vlan = cmd->req.arg[1] >> 16; +		return 0; +	} + +	err = qlcnic_sriov_cfg_vf_def_mac(adapter, vp, vf->pci_func, +					  0, QLCNIC_MAC_DEL); +	if (err) +		return err; + +	vp->vlan = cmd->req.arg[1] >> 16; +	err = qlcnic_sriov_cfg_vf_def_mac(adapter, vp, vf->pci_func, +					  vp->vlan, QLCNIC_MAC_ADD); + +	if (err) { +		qlcnic_sriov_cfg_vf_def_mac(adapter, vp, vf->pci_func, +					    0, QLCNIC_MAC_ADD); +		vp->vlan = 0; +	} + +	return err; +} + +static int qlcnic_sriov_pf_cfg_guest_vlan_cmd(struct qlcnic_bc_trans *tran, +					      struct qlcnic_cmd_args *cmd) +{ +	struct qlcnic_vf_info  *vf = tran->vf; +	struct qlcnic_adapter *adapter =  vf->adapter; +	struct qlcnic_vport *vp = vf->vp; +	int err = -EIO; +	u8 op; + +	if (vp->vlan_mode != QLC_GUEST_VLAN_MODE) { +		cmd->rsp.arg[0] |= 2 << 25; +		return err; +	} + +	op = cmd->req.arg[1] & 0xf; + +	if (op) +		err = qlcnic_sriov_pf_add_guest_vlan(adapter, vf, cmd); +	else +		err = qlcnic_sriov_pf_del_guest_vlan(adapter, vf); + +	cmd->rsp.arg[0] |= err ? 2 << 25 : 1 << 25; +	return err; +} +  static const int qlcnic_pf_passthru_supp_cmds[] = {  	QLCNIC_CMD_GET_STATISTICS,  	QLCNIC_CMD_GET_PORT_CONFIG, @@ -1048,6 +1281,8 @@ static const int qlcnic_pf_passthru_supp_cmds[] = {  static const struct qlcnic_sriov_cmd_handler qlcnic_pf_bc_cmd_hdlr[] = {  	[QLCNIC_BC_CMD_CHANNEL_INIT] = {&qlcnic_sriov_pf_channel_cfg_cmd},  	[QLCNIC_BC_CMD_CHANNEL_TERM] = {&qlcnic_sriov_pf_channel_cfg_cmd}, +	[QLCNIC_BC_CMD_GET_ACL]	= {&qlcnic_sriov_pf_get_acl_cmd}, +	[QLCNIC_BC_CMD_CFG_GUEST_VLAN]	= {&qlcnic_sriov_pf_cfg_guest_vlan_cmd},  };  static const struct qlcnic_sriov_fw_cmd_handler qlcnic_pf_fw_cmd_hdlr[] = { @@ -1173,3 +1408,373 @@ void qlcnic_pf_set_interface_id_macaddr(struct qlcnic_adapter *adapter,  						adapter->ahw->pci_func);  	*int_id |= (vpid << 16) | BIT_31;  } + +static void qlcnic_sriov_del_rx_ctx(struct qlcnic_adapter *adapter, +				    struct qlcnic_vf_info *vf) +{ +	struct qlcnic_cmd_args cmd; +	int vpid; + +	if (!vf->rx_ctx_id) +		return; + +	if (qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_DESTROY_RX_CTX)) +		return; + +	vpid = qlcnic_sriov_pf_get_vport_handle(adapter, vf->pci_func); +	if (vpid >= 0) { +		cmd.req.arg[1] = vf->rx_ctx_id | (vpid & 0xffff) << 16; +		if (qlcnic_issue_cmd(adapter, &cmd)) +			dev_err(&adapter->pdev->dev, +				"Failed to delete Tx ctx in firmware for func 0x%x\n", +				vf->pci_func); +		else +			vf->rx_ctx_id = 0; +	} + +	qlcnic_free_mbx_args(&cmd); +} + +static void qlcnic_sriov_del_tx_ctx(struct qlcnic_adapter *adapter, +				    struct qlcnic_vf_info *vf) +{ +	struct qlcnic_cmd_args cmd; +	int vpid; + +	if (!vf->tx_ctx_id) +		return; + +	if (qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_DESTROY_TX_CTX)) +		return; + +	vpid = qlcnic_sriov_pf_get_vport_handle(adapter, vf->pci_func); +	if (vpid >= 0) { +		cmd.req.arg[1] |= vf->tx_ctx_id | (vpid & 0xffff) << 16; +		if (qlcnic_issue_cmd(adapter, &cmd)) +			dev_err(&adapter->pdev->dev, +				"Failed to delete Tx ctx in firmware for func 0x%x\n", +				vf->pci_func); +		else +			vf->tx_ctx_id = 0; +	} + +	qlcnic_free_mbx_args(&cmd); +} + +static int qlcnic_sriov_add_act_list_irqsave(struct qlcnic_sriov *sriov, +					     struct qlcnic_vf_info *vf, +					     struct qlcnic_bc_trans *trans) +{ +	struct qlcnic_trans_list *t_list = &vf->rcv_act; +	unsigned long flag; + +	spin_lock_irqsave(&t_list->lock, flag); + +	__qlcnic_sriov_add_act_list(sriov, vf, trans); + +	spin_unlock_irqrestore(&t_list->lock, flag); +	return 0; +} + +static void __qlcnic_sriov_process_flr(struct qlcnic_vf_info *vf) +{ +	struct qlcnic_adapter *adapter = vf->adapter; + +	qlcnic_sriov_cleanup_list(&vf->rcv_pend); +	cancel_work_sync(&vf->trans_work); +	qlcnic_sriov_cleanup_list(&vf->rcv_act); + +	if (test_bit(QLC_BC_VF_SOFT_FLR, &vf->state)) { +		qlcnic_sriov_del_tx_ctx(adapter, vf); +		qlcnic_sriov_del_rx_ctx(adapter, vf); +	} + +	qlcnic_sriov_pf_config_vport(adapter, 0, vf->pci_func); + +	clear_bit(QLC_BC_VF_FLR, &vf->state); +	if (test_bit(QLC_BC_VF_SOFT_FLR, &vf->state)) { +		qlcnic_sriov_add_act_list_irqsave(adapter->ahw->sriov, vf, +						  vf->flr_trans); +		clear_bit(QLC_BC_VF_SOFT_FLR, &vf->state); +		vf->flr_trans = NULL; +	} +} + +static void qlcnic_sriov_pf_process_flr(struct work_struct *work) +{ +	struct qlcnic_vf_info *vf; + +	vf = container_of(work, struct qlcnic_vf_info, flr_work); +	__qlcnic_sriov_process_flr(vf); +	return; +} + +static void qlcnic_sriov_schedule_flr(struct qlcnic_sriov *sriov, +				      struct qlcnic_vf_info *vf, +				      work_func_t func) +{ +	if (test_bit(__QLCNIC_RESETTING, &vf->adapter->state)) +		return; + +	INIT_WORK(&vf->flr_work, func); +	queue_work(sriov->bc.bc_flr_wq, &vf->flr_work); +} + +static void qlcnic_sriov_handle_soft_flr(struct qlcnic_adapter *adapter, +					 struct qlcnic_bc_trans *trans, +					 struct qlcnic_vf_info *vf) +{ +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; + +	set_bit(QLC_BC_VF_FLR, &vf->state); +	clear_bit(QLC_BC_VF_STATE, &vf->state); +	set_bit(QLC_BC_VF_SOFT_FLR, &vf->state); +	vf->flr_trans = trans; +	qlcnic_sriov_schedule_flr(sriov, vf, qlcnic_sriov_pf_process_flr); +	netdev_info(adapter->netdev, "Software FLR for PCI func %d\n", +		    vf->pci_func); +} + +bool qlcnic_sriov_soft_flr_check(struct qlcnic_adapter *adapter, +				 struct qlcnic_bc_trans *trans, +				 struct qlcnic_vf_info *vf) +{ +	struct qlcnic_bc_hdr *hdr = trans->req_hdr; + +	if ((hdr->cmd_op == QLCNIC_BC_CMD_CHANNEL_INIT) && +	    (hdr->op_type == QLC_BC_CMD) && +	     test_bit(QLC_BC_VF_STATE, &vf->state)) { +		qlcnic_sriov_handle_soft_flr(adapter, trans, vf); +		return true; +	} + +	return false; +} + +void qlcnic_sriov_pf_handle_flr(struct qlcnic_sriov *sriov, +				struct qlcnic_vf_info *vf) +{ +	struct net_device *dev = vf->adapter->netdev; + +	if (!test_and_clear_bit(QLC_BC_VF_STATE, &vf->state)) { +		clear_bit(QLC_BC_VF_FLR, &vf->state); +		return; +	} + +	if (test_and_set_bit(QLC_BC_VF_FLR, &vf->state)) { +		netdev_info(dev, "FLR for PCI func %d in progress\n", +			    vf->pci_func); +		return; +	} + +	qlcnic_sriov_schedule_flr(sriov, vf, qlcnic_sriov_pf_process_flr); +	netdev_info(dev, "FLR received for PCI func %d\n", vf->pci_func); +} + +void qlcnic_sriov_pf_reset(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	struct qlcnic_sriov *sriov = ahw->sriov; +	struct qlcnic_vf_info *vf; +	u16 num_vfs = sriov->num_vfs; +	int i; + +	for (i = 0; i < num_vfs; i++) { +		vf = &sriov->vf_info[i]; +		vf->rx_ctx_id = 0; +		vf->tx_ctx_id = 0; +		cancel_work_sync(&vf->flr_work); +		__qlcnic_sriov_process_flr(vf); +		clear_bit(QLC_BC_VF_STATE, &vf->state); +	} + +	qlcnic_sriov_pf_reset_vport_handle(adapter, ahw->pci_func); +	QLCWRX(ahw, QLCNIC_MBX_INTR_ENBL, (ahw->num_msix - 1) << 8); +} + +int qlcnic_sriov_pf_reinit(struct qlcnic_adapter *adapter) +{ +	struct qlcnic_hardware_context *ahw = adapter->ahw; +	int err; + +	if (!qlcnic_sriov_enable_check(adapter)) +		return 0; + +	ahw->op_mode = QLCNIC_SRIOV_PF_FUNC; + +	err = qlcnic_sriov_pf_init(adapter); +	if (err) +		return err; + +	dev_info(&adapter->pdev->dev, "%s: op_mode %d\n", +		 __func__, ahw->op_mode); +	return err; +} + +int qlcnic_sriov_set_vf_mac(struct net_device *netdev, int vf, u8 *mac) +{ +	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	int i, num_vfs = sriov->num_vfs; +	struct qlcnic_vf_info *vf_info; +	u8 *curr_mac; + +	if (!qlcnic_sriov_pf_check(adapter)) +		return -EOPNOTSUPP; + +	if (!is_valid_ether_addr(mac) || vf >= num_vfs) +		return -EINVAL; + +	if (!compare_ether_addr(adapter->mac_addr, mac)) { +		netdev_err(netdev, "MAC address is already in use by the PF\n"); +		return -EINVAL; +	} + +	for (i = 0; i < num_vfs; i++) { +		vf_info = &sriov->vf_info[i]; +		if (!compare_ether_addr(vf_info->vp->mac, mac)) { +			netdev_err(netdev, +				   "MAC address is already in use by VF %d\n", +				   i); +			return -EINVAL; +		} +	} + +	vf_info = &sriov->vf_info[vf]; +	curr_mac = vf_info->vp->mac; + +	if (test_bit(QLC_BC_VF_STATE, &vf_info->state)) { +		netdev_err(netdev, +			   "MAC address change failed for VF %d, as VF driver is loaded. Please unload VF driver and retry the operation\n", +			   vf); +		return -EOPNOTSUPP; +	} + +	memcpy(curr_mac, mac, netdev->addr_len); +	netdev_info(netdev, "MAC Address %pM  is configured for VF %d\n", +		    mac, vf); +	return 0; +} + +int qlcnic_sriov_set_vf_tx_rate(struct net_device *netdev, int vf, int tx_rate) +{ +	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	struct qlcnic_vf_info *vf_info; +	struct qlcnic_info nic_info; +	struct qlcnic_vport *vp; +	u16 vpid; + +	if (!qlcnic_sriov_pf_check(adapter)) +		return -EOPNOTSUPP; + +	if (vf >= sriov->num_vfs) +		return -EINVAL; + +	if (tx_rate >= 10000 || tx_rate < 100) { +		netdev_err(netdev, +			   "Invalid Tx rate, allowed range is [%d - %d]", +			   QLC_VF_MIN_TX_RATE, QLC_VF_MAX_TX_RATE); +		return -EINVAL; +	} + +	if (tx_rate == 0) +		tx_rate = 10000; + +	vf_info = &sriov->vf_info[vf]; +	vp = vf_info->vp; +	vpid = vp->handle; + +	if (test_bit(QLC_BC_VF_STATE, &vf_info->state)) { +		if (qlcnic_sriov_get_vf_vport_info(adapter, &nic_info, vpid)) +			return -EIO; + +		nic_info.max_tx_bw = tx_rate / 100; +		nic_info.bit_offsets = BIT_0; + +		if (qlcnic_sriov_pf_set_vport_info(adapter, &nic_info, vpid)) +			return -EIO; +	} + +	vp->max_tx_bw = tx_rate / 100; +	netdev_info(netdev, +		    "Setting Tx rate %d (Mbps), %d %% of PF bandwidth, for VF %d\n", +		    tx_rate, vp->max_tx_bw, vf); +	return 0; +} + +int qlcnic_sriov_set_vf_vlan(struct net_device *netdev, int vf, +			     u16 vlan, u8 qos) +{ +	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	struct qlcnic_vf_info *vf_info; +	struct qlcnic_vport *vp; + +	if (!qlcnic_sriov_pf_check(adapter)) +		return -EOPNOTSUPP; + +	if (vf >= sriov->num_vfs || qos > 7) +		return -EINVAL; + +	if (vlan > MAX_VLAN_ID) { +		netdev_err(netdev, +			   "Invalid VLAN ID, allowed range is [0 - %d]\n", +			   MAX_VLAN_ID); +		return -EINVAL; +	} + +	vf_info = &sriov->vf_info[vf]; +	vp = vf_info->vp; +	if (test_bit(QLC_BC_VF_STATE, &vf_info->state)) { +		netdev_err(netdev, +			   "VLAN change failed for VF %d, as VF driver is loaded. Please unload VF driver and retry the operation\n", +			   vf); +		return -EOPNOTSUPP; +	} + +	switch (vlan) { +	case 4095: +		vp->vlan_mode = QLC_GUEST_VLAN_MODE; +		break; +	case 0: +		vp->vlan_mode = QLC_NO_VLAN_MODE; +		vp->vlan = 0; +		vp->qos = 0; +		break; +	default: +		vp->vlan_mode = QLC_PVID_MODE; +		vp->vlan = vlan; +		vp->qos = qos; +	} + +	netdev_info(netdev, "Setting VLAN %d, QoS %d, for VF %d\n", +		    vlan, qos, vf); +	return 0; +} + +int qlcnic_sriov_get_vf_config(struct net_device *netdev, +			       int vf, struct ifla_vf_info *ivi) +{ +	struct qlcnic_adapter *adapter = netdev_priv(netdev); +	struct qlcnic_sriov *sriov = adapter->ahw->sriov; +	struct qlcnic_vport *vp; + +	if (!qlcnic_sriov_pf_check(adapter)) +		return -EOPNOTSUPP; + +	if (vf >= sriov->num_vfs) +		return -EINVAL; + +	vp = sriov->vf_info[vf].vp; +	memcpy(&ivi->mac, vp->mac, ETH_ALEN); +	ivi->vlan = vp->vlan; +	ivi->qos = vp->qos; +	if (vp->max_tx_bw == MAX_BW) +		ivi->tx_rate = 0; +	else +		ivi->tx_rate = vp->max_tx_bw * 100; + +	ivi->vf = vf; +	return 0; +}  |