mirror of
				https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
				synced 2025-10-31 16:18:51 +01:00 
			
		
		
		
	Fixed MTP to work with TWRP
This commit is contained in:
		
						commit
						f6dfaef42e
					
				
					 50820 changed files with 20846062 additions and 0 deletions
				
			
		
							
								
								
									
										619
									
								
								drivers/net/ethernet/intel/ixgbevf/vf.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										619
									
								
								drivers/net/ethernet/intel/ixgbevf/vf.c
									
										
									
									
									
										Normal file
									
								
							|  | @ -0,0 +1,619 @@ | |||
| /*******************************************************************************
 | ||||
| 
 | ||||
|   Intel 82599 Virtual Function driver | ||||
|   Copyright(c) 1999 - 2012 Intel Corporation. | ||||
| 
 | ||||
|   This program is free software; you can redistribute it and/or modify it | ||||
|   under the terms and conditions of the GNU General Public License, | ||||
|   version 2, as published by the Free Software Foundation. | ||||
| 
 | ||||
|   This program is distributed in the hope it will be useful, but WITHOUT | ||||
|   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | ||||
|   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for | ||||
|   more details. | ||||
| 
 | ||||
|   You should have received a copy of the GNU General Public License along with | ||||
|   this program; if not, write to the Free Software Foundation, Inc., | ||||
|   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | ||||
| 
 | ||||
|   The full GNU General Public License is included in this distribution in | ||||
|   the file called "COPYING". | ||||
| 
 | ||||
|   Contact Information: | ||||
|   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net> | ||||
|   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | ||||
| 
 | ||||
| *******************************************************************************/ | ||||
| 
 | ||||
| #include "vf.h" | ||||
| #include "ixgbevf.h" | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_start_hw_vf - Prepare hardware for Tx/Rx | ||||
|  *  @hw: pointer to hardware structure | ||||
|  * | ||||
|  *  Starts the hardware by filling the bus info structure and media type, clears | ||||
|  *  all on chip counters, initializes receive address registers, multicast | ||||
|  *  table, VLAN filter table, calls routine to set up link and flow control | ||||
|  *  settings, and leaves transmit and receive units disabled and uninitialized | ||||
|  **/ | ||||
| static s32 ixgbevf_start_hw_vf(struct ixgbe_hw *hw) | ||||
| { | ||||
| 	/* Clear adapter stopped flag */ | ||||
| 	hw->adapter_stopped = false; | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_init_hw_vf - virtual function hardware initialization | ||||
|  *  @hw: pointer to hardware structure | ||||
|  * | ||||
|  *  Initialize the hardware by resetting the hardware and then starting | ||||
|  *  the hardware | ||||
|  **/ | ||||
| static s32 ixgbevf_init_hw_vf(struct ixgbe_hw *hw) | ||||
| { | ||||
| 	s32 status = hw->mac.ops.start_hw(hw); | ||||
| 
 | ||||
| 	hw->mac.ops.get_mac_addr(hw, hw->mac.addr); | ||||
| 
 | ||||
| 	return status; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_reset_hw_vf - Performs hardware reset | ||||
|  *  @hw: pointer to hardware structure | ||||
|  * | ||||
|  *  Resets the hardware by reseting the transmit and receive units, masks and | ||||
|  *  clears all interrupts. | ||||
|  **/ | ||||
| static s32 ixgbevf_reset_hw_vf(struct ixgbe_hw *hw) | ||||
| { | ||||
| 	struct ixgbe_mbx_info *mbx = &hw->mbx; | ||||
| 	u32 timeout = IXGBE_VF_INIT_TIMEOUT; | ||||
| 	s32 ret_val = IXGBE_ERR_INVALID_MAC_ADDR; | ||||
| 	u32 msgbuf[IXGBE_VF_PERMADDR_MSG_LEN]; | ||||
| 	u8 *addr = (u8 *)(&msgbuf[1]); | ||||
| 
 | ||||
| 	/* Call adapter stop to disable tx/rx and clear interrupts */ | ||||
| 	hw->mac.ops.stop_adapter(hw); | ||||
| 
 | ||||
| 	/* reset the api version */ | ||||
| 	hw->api_version = ixgbe_mbox_api_10; | ||||
| 
 | ||||
| 	IXGBE_WRITE_REG(hw, IXGBE_VFCTRL, IXGBE_CTRL_RST); | ||||
| 	IXGBE_WRITE_FLUSH(hw); | ||||
| 
 | ||||
| 	/* we cannot reset while the RSTI / RSTD bits are asserted */ | ||||
| 	while (!mbx->ops.check_for_rst(hw) && timeout) { | ||||
| 		timeout--; | ||||
| 		udelay(5); | ||||
| 	} | ||||
| 
 | ||||
| 	if (!timeout) | ||||
| 		return IXGBE_ERR_RESET_FAILED; | ||||
| 
 | ||||
| 	/* mailbox timeout can now become active */ | ||||
| 	mbx->timeout = IXGBE_VF_MBX_INIT_TIMEOUT; | ||||
| 
 | ||||
| 	msgbuf[0] = IXGBE_VF_RESET; | ||||
| 	mbx->ops.write_posted(hw, msgbuf, 1); | ||||
| 
 | ||||
| 	mdelay(10); | ||||
| 
 | ||||
| 	/* set our "perm_addr" based on info provided by PF */ | ||||
| 	/* also set up the mc_filter_type which is piggy backed
 | ||||
| 	 * on the mac address in word 3 */ | ||||
| 	ret_val = mbx->ops.read_posted(hw, msgbuf, IXGBE_VF_PERMADDR_MSG_LEN); | ||||
| 	if (ret_val) | ||||
| 		return ret_val; | ||||
| 
 | ||||
| 	/* New versions of the PF may NACK the reset return message
 | ||||
| 	 * to indicate that no MAC address has yet been assigned for | ||||
| 	 * the VF. | ||||
| 	 */ | ||||
| 	if (msgbuf[0] != (IXGBE_VF_RESET | IXGBE_VT_MSGTYPE_ACK) && | ||||
| 	    msgbuf[0] != (IXGBE_VF_RESET | IXGBE_VT_MSGTYPE_NACK)) | ||||
| 		return IXGBE_ERR_INVALID_MAC_ADDR; | ||||
| 
 | ||||
| 	memcpy(hw->mac.perm_addr, addr, ETH_ALEN); | ||||
| 	hw->mac.mc_filter_type = msgbuf[IXGBE_VF_MC_TYPE_WORD]; | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_stop_hw_vf - Generic stop Tx/Rx units | ||||
|  *  @hw: pointer to hardware structure | ||||
|  * | ||||
|  *  Sets the adapter_stopped flag within ixgbe_hw struct. Clears interrupts, | ||||
|  *  disables transmit and receive units. The adapter_stopped flag is used by | ||||
|  *  the shared code and drivers to determine if the adapter is in a stopped | ||||
|  *  state and should not touch the hardware. | ||||
|  **/ | ||||
| static s32 ixgbevf_stop_hw_vf(struct ixgbe_hw *hw) | ||||
| { | ||||
| 	u32 number_of_queues; | ||||
| 	u32 reg_val; | ||||
| 	u16 i; | ||||
| 
 | ||||
| 	/*
 | ||||
| 	 * Set the adapter_stopped flag so other driver functions stop touching | ||||
| 	 * the hardware | ||||
| 	 */ | ||||
| 	hw->adapter_stopped = true; | ||||
| 
 | ||||
| 	/* Disable the receive unit by stopped each queue */ | ||||
| 	number_of_queues = hw->mac.max_rx_queues; | ||||
| 	for (i = 0; i < number_of_queues; i++) { | ||||
| 		reg_val = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(i)); | ||||
| 		if (reg_val & IXGBE_RXDCTL_ENABLE) { | ||||
| 			reg_val &= ~IXGBE_RXDCTL_ENABLE; | ||||
| 			IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(i), reg_val); | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| 	IXGBE_WRITE_FLUSH(hw); | ||||
| 
 | ||||
| 	/* Clear interrupt mask to stop from interrupts being generated */ | ||||
| 	IXGBE_WRITE_REG(hw, IXGBE_VTEIMC, IXGBE_VF_IRQ_CLEAR_MASK); | ||||
| 
 | ||||
| 	/* Clear any pending interrupts */ | ||||
| 	IXGBE_READ_REG(hw, IXGBE_VTEICR); | ||||
| 
 | ||||
| 	/* Disable the transmit unit.  Each queue must be disabled. */ | ||||
| 	number_of_queues = hw->mac.max_tx_queues; | ||||
| 	for (i = 0; i < number_of_queues; i++) { | ||||
| 		reg_val = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(i)); | ||||
| 		if (reg_val & IXGBE_TXDCTL_ENABLE) { | ||||
| 			reg_val &= ~IXGBE_TXDCTL_ENABLE; | ||||
| 			IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(i), reg_val); | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_mta_vector - Determines bit-vector in multicast table to set | ||||
|  *  @hw: pointer to hardware structure | ||||
|  *  @mc_addr: the multicast address | ||||
|  * | ||||
|  *  Extracts the 12 bits, from a multicast address, to determine which | ||||
|  *  bit-vector to set in the multicast table. The hardware uses 12 bits, from | ||||
|  *  incoming rx multicast addresses, to determine the bit-vector to check in | ||||
|  *  the MTA. Which of the 4 combination, of 12-bits, the hardware uses is set | ||||
|  *  by the MO field of the MCSTCTRL. The MO field is set during initialization | ||||
|  *  to mc_filter_type. | ||||
|  **/ | ||||
| static s32 ixgbevf_mta_vector(struct ixgbe_hw *hw, u8 *mc_addr) | ||||
| { | ||||
| 	u32 vector = 0; | ||||
| 
 | ||||
| 	switch (hw->mac.mc_filter_type) { | ||||
| 	case 0:   /* use bits [47:36] of the address */ | ||||
| 		vector = ((mc_addr[4] >> 4) | (((u16)mc_addr[5]) << 4)); | ||||
| 		break; | ||||
| 	case 1:   /* use bits [46:35] of the address */ | ||||
| 		vector = ((mc_addr[4] >> 3) | (((u16)mc_addr[5]) << 5)); | ||||
| 		break; | ||||
| 	case 2:   /* use bits [45:34] of the address */ | ||||
| 		vector = ((mc_addr[4] >> 2) | (((u16)mc_addr[5]) << 6)); | ||||
| 		break; | ||||
| 	case 3:   /* use bits [43:32] of the address */ | ||||
| 		vector = ((mc_addr[4]) | (((u16)mc_addr[5]) << 8)); | ||||
| 		break; | ||||
| 	default:  /* Invalid mc_filter_type */ | ||||
| 		break; | ||||
| 	} | ||||
| 
 | ||||
| 	/* vector can only be 12-bits or boundary will be exceeded */ | ||||
| 	vector &= 0xFFF; | ||||
| 	return vector; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_get_mac_addr_vf - Read device MAC address | ||||
|  *  @hw: pointer to the HW structure | ||||
|  *  @mac_addr: pointer to storage for retrieved MAC address | ||||
|  **/ | ||||
| static s32 ixgbevf_get_mac_addr_vf(struct ixgbe_hw *hw, u8 *mac_addr) | ||||
| { | ||||
| 	memcpy(mac_addr, hw->mac.perm_addr, ETH_ALEN); | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| static s32 ixgbevf_set_uc_addr_vf(struct ixgbe_hw *hw, u32 index, u8 *addr) | ||||
| { | ||||
| 	struct ixgbe_mbx_info *mbx = &hw->mbx; | ||||
| 	u32 msgbuf[3]; | ||||
| 	u8 *msg_addr = (u8 *)(&msgbuf[1]); | ||||
| 	s32 ret_val; | ||||
| 
 | ||||
| 	memset(msgbuf, 0, sizeof(msgbuf)); | ||||
| 	/*
 | ||||
| 	 * If index is one then this is the start of a new list and needs | ||||
| 	 * indication to the PF so it can do it's own list management. | ||||
| 	 * If it is zero then that tells the PF to just clear all of | ||||
| 	 * this VF's macvlans and there is no new list. | ||||
| 	 */ | ||||
| 	msgbuf[0] |= index << IXGBE_VT_MSGINFO_SHIFT; | ||||
| 	msgbuf[0] |= IXGBE_VF_SET_MACVLAN; | ||||
| 	if (addr) | ||||
| 		memcpy(msg_addr, addr, ETH_ALEN); | ||||
| 	ret_val = mbx->ops.write_posted(hw, msgbuf, 3); | ||||
| 
 | ||||
| 	if (!ret_val) | ||||
| 		ret_val = mbx->ops.read_posted(hw, msgbuf, 3); | ||||
| 
 | ||||
| 	msgbuf[0] &= ~IXGBE_VT_MSGTYPE_CTS; | ||||
| 
 | ||||
| 	if (!ret_val) | ||||
| 		if (msgbuf[0] == | ||||
| 		    (IXGBE_VF_SET_MACVLAN | IXGBE_VT_MSGTYPE_NACK)) | ||||
| 			ret_val = -ENOMEM; | ||||
| 
 | ||||
| 	return ret_val; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_set_rar_vf - set device MAC address | ||||
|  *  @hw: pointer to hardware structure | ||||
|  *  @index: Receive address register to write | ||||
|  *  @addr: Address to put into receive address register | ||||
|  *  @vmdq: Unused in this implementation | ||||
|  **/ | ||||
| static s32 ixgbevf_set_rar_vf(struct ixgbe_hw *hw, u32 index, u8 *addr, | ||||
| 			      u32 vmdq) | ||||
| { | ||||
| 	struct ixgbe_mbx_info *mbx = &hw->mbx; | ||||
| 	u32 msgbuf[3]; | ||||
| 	u8 *msg_addr = (u8 *)(&msgbuf[1]); | ||||
| 	s32 ret_val; | ||||
| 
 | ||||
| 	memset(msgbuf, 0, sizeof(msgbuf)); | ||||
| 	msgbuf[0] = IXGBE_VF_SET_MAC_ADDR; | ||||
| 	memcpy(msg_addr, addr, ETH_ALEN); | ||||
| 	ret_val = mbx->ops.write_posted(hw, msgbuf, 3); | ||||
| 
 | ||||
| 	if (!ret_val) | ||||
| 		ret_val = mbx->ops.read_posted(hw, msgbuf, 3); | ||||
| 
 | ||||
| 	msgbuf[0] &= ~IXGBE_VT_MSGTYPE_CTS; | ||||
| 
 | ||||
| 	/* if nacked the address was rejected, use "perm_addr" */ | ||||
| 	if (!ret_val && | ||||
| 	    (msgbuf[0] == (IXGBE_VF_SET_MAC_ADDR | IXGBE_VT_MSGTYPE_NACK))) | ||||
| 		ixgbevf_get_mac_addr_vf(hw, hw->mac.addr); | ||||
| 
 | ||||
| 	return ret_val; | ||||
| } | ||||
| 
 | ||||
| static void ixgbevf_write_msg_read_ack(struct ixgbe_hw *hw, | ||||
| 					u32 *msg, u16 size) | ||||
| { | ||||
| 	struct ixgbe_mbx_info *mbx = &hw->mbx; | ||||
| 	u32 retmsg[IXGBE_VFMAILBOX_SIZE]; | ||||
| 	s32 retval = mbx->ops.write_posted(hw, msg, size); | ||||
| 
 | ||||
| 	if (!retval) | ||||
| 		mbx->ops.read_posted(hw, retmsg, size); | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_update_mc_addr_list_vf - Update Multicast addresses | ||||
|  *  @hw: pointer to the HW structure | ||||
|  *  @netdev: pointer to net device structure | ||||
|  * | ||||
|  *  Updates the Multicast Table Array. | ||||
|  **/ | ||||
| static s32 ixgbevf_update_mc_addr_list_vf(struct ixgbe_hw *hw, | ||||
| 					  struct net_device *netdev) | ||||
| { | ||||
| 	struct netdev_hw_addr *ha; | ||||
| 	u32 msgbuf[IXGBE_VFMAILBOX_SIZE]; | ||||
| 	u16 *vector_list = (u16 *)&msgbuf[1]; | ||||
| 	u32 cnt, i; | ||||
| 
 | ||||
| 	/* Each entry in the list uses 1 16 bit word.  We have 30
 | ||||
| 	 * 16 bit words available in our HW msg buffer (minus 1 for the | ||||
| 	 * msg type).  That's 30 hash values if we pack 'em right.  If | ||||
| 	 * there are more than 30 MC addresses to add then punt the | ||||
| 	 * extras for now and then add code to handle more than 30 later. | ||||
| 	 * It would be unusual for a server to request that many multi-cast | ||||
| 	 * addresses except for in large enterprise network environments. | ||||
| 	 */ | ||||
| 
 | ||||
| 	cnt = netdev_mc_count(netdev); | ||||
| 	if (cnt > 30) | ||||
| 		cnt = 30; | ||||
| 	msgbuf[0] = IXGBE_VF_SET_MULTICAST; | ||||
| 	msgbuf[0] |= cnt << IXGBE_VT_MSGINFO_SHIFT; | ||||
| 
 | ||||
| 	i = 0; | ||||
| 	netdev_for_each_mc_addr(ha, netdev) { | ||||
| 		if (i == cnt) | ||||
| 			break; | ||||
| 		if (is_link_local_ether_addr(ha->addr)) | ||||
| 			continue; | ||||
| 
 | ||||
| 		vector_list[i++] = ixgbevf_mta_vector(hw, ha->addr); | ||||
| 	} | ||||
| 
 | ||||
| 	ixgbevf_write_msg_read_ack(hw, msgbuf, IXGBE_VFMAILBOX_SIZE); | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_set_vfta_vf - Set/Unset vlan filter table address | ||||
|  *  @hw: pointer to the HW structure | ||||
|  *  @vlan: 12 bit VLAN ID | ||||
|  *  @vind: unused by VF drivers | ||||
|  *  @vlan_on: if true then set bit, else clear bit | ||||
|  **/ | ||||
| static s32 ixgbevf_set_vfta_vf(struct ixgbe_hw *hw, u32 vlan, u32 vind, | ||||
| 			       bool vlan_on) | ||||
| { | ||||
| 	struct ixgbe_mbx_info *mbx = &hw->mbx; | ||||
| 	u32 msgbuf[2]; | ||||
| 	s32 err; | ||||
| 
 | ||||
| 	msgbuf[0] = IXGBE_VF_SET_VLAN; | ||||
| 	msgbuf[1] = vlan; | ||||
| 	/* Setting the 8 bit field MSG INFO to TRUE indicates "add" */ | ||||
| 	msgbuf[0] |= vlan_on << IXGBE_VT_MSGINFO_SHIFT; | ||||
| 
 | ||||
| 	err = mbx->ops.write_posted(hw, msgbuf, 2); | ||||
| 	if (err) | ||||
| 		goto mbx_err; | ||||
| 
 | ||||
| 	err = mbx->ops.read_posted(hw, msgbuf, 2); | ||||
| 	if (err) | ||||
| 		goto mbx_err; | ||||
| 
 | ||||
| 	/* remove extra bits from the message */ | ||||
| 	msgbuf[0] &= ~IXGBE_VT_MSGTYPE_CTS; | ||||
| 	msgbuf[0] &= ~(0xFF << IXGBE_VT_MSGINFO_SHIFT); | ||||
| 
 | ||||
| 	if (msgbuf[0] != (IXGBE_VF_SET_VLAN | IXGBE_VT_MSGTYPE_ACK)) | ||||
| 		err = IXGBE_ERR_INVALID_ARGUMENT; | ||||
| 
 | ||||
| mbx_err: | ||||
| 	return err; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_setup_mac_link_vf - Setup MAC link settings | ||||
|  *  @hw: pointer to hardware structure | ||||
|  *  @speed: Unused in this implementation | ||||
|  *  @autoneg: Unused in this implementation | ||||
|  *  @autoneg_wait_to_complete: Unused in this implementation | ||||
|  * | ||||
|  *  Do nothing and return success.  VF drivers are not allowed to change | ||||
|  *  global settings.  Maintained for driver compatibility. | ||||
|  **/ | ||||
| static s32 ixgbevf_setup_mac_link_vf(struct ixgbe_hw *hw, | ||||
| 				     ixgbe_link_speed speed, bool autoneg, | ||||
| 				     bool autoneg_wait_to_complete) | ||||
| { | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_check_mac_link_vf - Get link/speed status | ||||
|  *  @hw: pointer to hardware structure | ||||
|  *  @speed: pointer to link speed | ||||
|  *  @link_up: true is link is up, false otherwise | ||||
|  *  @autoneg_wait_to_complete: true when waiting for completion is needed | ||||
|  * | ||||
|  *  Reads the links register to determine if link is up and the current speed | ||||
|  **/ | ||||
| static s32 ixgbevf_check_mac_link_vf(struct ixgbe_hw *hw, | ||||
| 				     ixgbe_link_speed *speed, | ||||
| 				     bool *link_up, | ||||
| 				     bool autoneg_wait_to_complete) | ||||
| { | ||||
| 	struct ixgbe_mbx_info *mbx = &hw->mbx; | ||||
| 	struct ixgbe_mac_info *mac = &hw->mac; | ||||
| 	s32 ret_val = 0; | ||||
| 	u32 links_reg; | ||||
| 	u32 in_msg = 0; | ||||
| 
 | ||||
| 	/* If we were hit with a reset drop the link */ | ||||
| 	if (!mbx->ops.check_for_rst(hw) || !mbx->timeout) | ||||
| 		mac->get_link_status = true; | ||||
| 
 | ||||
| 	if (!mac->get_link_status) | ||||
| 		goto out; | ||||
| 
 | ||||
| 	/* if link status is down no point in checking to see if pf is up */ | ||||
| 	links_reg = IXGBE_READ_REG(hw, IXGBE_VFLINKS); | ||||
| 	if (!(links_reg & IXGBE_LINKS_UP)) | ||||
| 		goto out; | ||||
| 
 | ||||
| 	/* for SFP+ modules and DA cables on 82599 it can take up to 500usecs
 | ||||
| 	 * before the link status is correct | ||||
| 	 */ | ||||
| 	if (mac->type == ixgbe_mac_82599_vf) { | ||||
| 		int i; | ||||
| 
 | ||||
| 		for (i = 0; i < 5; i++) { | ||||
| 			udelay(100); | ||||
| 			links_reg = IXGBE_READ_REG(hw, IXGBE_VFLINKS); | ||||
| 
 | ||||
| 			if (!(links_reg & IXGBE_LINKS_UP)) | ||||
| 				goto out; | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| 	switch (links_reg & IXGBE_LINKS_SPEED_82599) { | ||||
| 	case IXGBE_LINKS_SPEED_10G_82599: | ||||
| 		*speed = IXGBE_LINK_SPEED_10GB_FULL; | ||||
| 		break; | ||||
| 	case IXGBE_LINKS_SPEED_1G_82599: | ||||
| 		*speed = IXGBE_LINK_SPEED_1GB_FULL; | ||||
| 		break; | ||||
| 	case IXGBE_LINKS_SPEED_100_82599: | ||||
| 		*speed = IXGBE_LINK_SPEED_100_FULL; | ||||
| 		break; | ||||
| 	} | ||||
| 
 | ||||
| 	/* if the read failed it could just be a mailbox collision, best wait
 | ||||
| 	 * until we are called again and don't report an error */ | ||||
| 	if (mbx->ops.read(hw, &in_msg, 1)) | ||||
| 		goto out; | ||||
| 
 | ||||
| 	if (!(in_msg & IXGBE_VT_MSGTYPE_CTS)) { | ||||
| 		/* msg is not CTS and is NACK we must have lost CTS status */ | ||||
| 		if (in_msg & IXGBE_VT_MSGTYPE_NACK) | ||||
| 			ret_val = -1; | ||||
| 		goto out; | ||||
| 	} | ||||
| 
 | ||||
| 	/* the pf is talking, if we timed out in the past we reinit */ | ||||
| 	if (!mbx->timeout) { | ||||
| 		ret_val = -1; | ||||
| 		goto out; | ||||
| 	} | ||||
| 
 | ||||
| 	/* if we passed all the tests above then the link is up and we no
 | ||||
| 	 * longer need to check for link */ | ||||
| 	mac->get_link_status = false; | ||||
| 
 | ||||
| out: | ||||
| 	*link_up = !mac->get_link_status; | ||||
| 	return ret_val; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_rlpml_set_vf - Set the maximum receive packet length | ||||
|  *  @hw: pointer to the HW structure | ||||
|  *  @max_size: value to assign to max frame size | ||||
|  **/ | ||||
| void ixgbevf_rlpml_set_vf(struct ixgbe_hw *hw, u16 max_size) | ||||
| { | ||||
| 	u32 msgbuf[2]; | ||||
| 
 | ||||
| 	msgbuf[0] = IXGBE_VF_SET_LPE; | ||||
| 	msgbuf[1] = max_size; | ||||
| 	ixgbevf_write_msg_read_ack(hw, msgbuf, 2); | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  *  ixgbevf_negotiate_api_version - Negotiate supported API version | ||||
|  *  @hw: pointer to the HW structure | ||||
|  *  @api: integer containing requested API version | ||||
|  **/ | ||||
| int ixgbevf_negotiate_api_version(struct ixgbe_hw *hw, int api) | ||||
| { | ||||
| 	int err; | ||||
| 	u32 msg[3]; | ||||
| 
 | ||||
| 	/* Negotiate the mailbox API version */ | ||||
| 	msg[0] = IXGBE_VF_API_NEGOTIATE; | ||||
| 	msg[1] = api; | ||||
| 	msg[2] = 0; | ||||
| 	err = hw->mbx.ops.write_posted(hw, msg, 3); | ||||
| 
 | ||||
| 	if (!err) | ||||
| 		err = hw->mbx.ops.read_posted(hw, msg, 3); | ||||
| 
 | ||||
| 	if (!err) { | ||||
| 		msg[0] &= ~IXGBE_VT_MSGTYPE_CTS; | ||||
| 
 | ||||
| 		/* Store value and return 0 on success */ | ||||
| 		if (msg[0] == (IXGBE_VF_API_NEGOTIATE | IXGBE_VT_MSGTYPE_ACK)) { | ||||
| 			hw->api_version = api; | ||||
| 			return 0; | ||||
| 		} | ||||
| 
 | ||||
| 		err = IXGBE_ERR_INVALID_ARGUMENT; | ||||
| 	} | ||||
| 
 | ||||
| 	return err; | ||||
| } | ||||
| 
 | ||||
| int ixgbevf_get_queues(struct ixgbe_hw *hw, unsigned int *num_tcs, | ||||
| 		       unsigned int *default_tc) | ||||
| { | ||||
| 	int err; | ||||
| 	u32 msg[5]; | ||||
| 
 | ||||
| 	/* do nothing if API doesn't support ixgbevf_get_queues */ | ||||
| 	switch (hw->api_version) { | ||||
| 	case ixgbe_mbox_api_11: | ||||
| 		break; | ||||
| 	default: | ||||
| 		return 0; | ||||
| 	} | ||||
| 
 | ||||
| 	/* Fetch queue configuration from the PF */ | ||||
| 	msg[0] = IXGBE_VF_GET_QUEUE; | ||||
| 	msg[1] = msg[2] = msg[3] = msg[4] = 0; | ||||
| 	err = hw->mbx.ops.write_posted(hw, msg, 5); | ||||
| 
 | ||||
| 	if (!err) | ||||
| 		err = hw->mbx.ops.read_posted(hw, msg, 5); | ||||
| 
 | ||||
| 	if (!err) { | ||||
| 		msg[0] &= ~IXGBE_VT_MSGTYPE_CTS; | ||||
| 
 | ||||
| 		/*
 | ||||
| 		 * if we we didn't get an ACK there must have been | ||||
| 		 * some sort of mailbox error so we should treat it | ||||
| 		 * as such | ||||
| 		 */ | ||||
| 		if (msg[0] != (IXGBE_VF_GET_QUEUE | IXGBE_VT_MSGTYPE_ACK)) | ||||
| 			return IXGBE_ERR_MBX; | ||||
| 
 | ||||
| 		/* record and validate values from message */ | ||||
| 		hw->mac.max_tx_queues = msg[IXGBE_VF_TX_QUEUES]; | ||||
| 		if (hw->mac.max_tx_queues == 0 || | ||||
| 		    hw->mac.max_tx_queues > IXGBE_VF_MAX_TX_QUEUES) | ||||
| 			hw->mac.max_tx_queues = IXGBE_VF_MAX_TX_QUEUES; | ||||
| 
 | ||||
| 		hw->mac.max_rx_queues = msg[IXGBE_VF_RX_QUEUES]; | ||||
| 		if (hw->mac.max_rx_queues == 0 || | ||||
| 		    hw->mac.max_rx_queues > IXGBE_VF_MAX_RX_QUEUES) | ||||
| 			hw->mac.max_rx_queues = IXGBE_VF_MAX_RX_QUEUES; | ||||
| 
 | ||||
| 		*num_tcs = msg[IXGBE_VF_TRANS_VLAN]; | ||||
| 		/* in case of unknown state assume we cannot tag frames */ | ||||
| 		if (*num_tcs > hw->mac.max_rx_queues) | ||||
| 			*num_tcs = 1; | ||||
| 
 | ||||
| 		*default_tc = msg[IXGBE_VF_DEF_QUEUE]; | ||||
| 		/* default to queue 0 on out-of-bounds queue number */ | ||||
| 		if (*default_tc >= hw->mac.max_tx_queues) | ||||
| 			*default_tc = 0; | ||||
| 	} | ||||
| 
 | ||||
| 	return err; | ||||
| } | ||||
| 
 | ||||
| static const struct ixgbe_mac_operations ixgbevf_mac_ops = { | ||||
| 	.init_hw             = ixgbevf_init_hw_vf, | ||||
| 	.reset_hw            = ixgbevf_reset_hw_vf, | ||||
| 	.start_hw            = ixgbevf_start_hw_vf, | ||||
| 	.get_mac_addr        = ixgbevf_get_mac_addr_vf, | ||||
| 	.stop_adapter        = ixgbevf_stop_hw_vf, | ||||
| 	.setup_link          = ixgbevf_setup_mac_link_vf, | ||||
| 	.check_link          = ixgbevf_check_mac_link_vf, | ||||
| 	.set_rar             = ixgbevf_set_rar_vf, | ||||
| 	.update_mc_addr_list = ixgbevf_update_mc_addr_list_vf, | ||||
| 	.set_uc_addr         = ixgbevf_set_uc_addr_vf, | ||||
| 	.set_vfta            = ixgbevf_set_vfta_vf, | ||||
| }; | ||||
| 
 | ||||
| const struct ixgbevf_info ixgbevf_82599_vf_info = { | ||||
| 	.mac = ixgbe_mac_82599_vf, | ||||
| 	.mac_ops = &ixgbevf_mac_ops, | ||||
| }; | ||||
| 
 | ||||
| const struct ixgbevf_info ixgbevf_X540_vf_info = { | ||||
| 	.mac = ixgbe_mac_X540_vf, | ||||
| 	.mac_ops = &ixgbevf_mac_ops, | ||||
| }; | ||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue
	
	 awab228
						awab228