xref: /f-stack/dpdk/drivers/net/avp/avp_ethdev.c (revision 2d9fd380)
1d30ea906Sjfb8856606 /* SPDX-License-Identifier: BSD-3-Clause
2d30ea906Sjfb8856606  * Copyright(c) 2013-2017 Wind River Systems, Inc.
32bfe3f2eSlogwang  */
42bfe3f2eSlogwang 
52bfe3f2eSlogwang #include <stdint.h>
62bfe3f2eSlogwang #include <string.h>
72bfe3f2eSlogwang #include <stdio.h>
82bfe3f2eSlogwang #include <errno.h>
92bfe3f2eSlogwang #include <unistd.h>
102bfe3f2eSlogwang 
11d30ea906Sjfb8856606 #include <rte_ethdev_driver.h>
122bfe3f2eSlogwang #include <rte_ethdev_pci.h>
132bfe3f2eSlogwang #include <rte_memcpy.h>
142bfe3f2eSlogwang #include <rte_string_fns.h>
152bfe3f2eSlogwang #include <rte_malloc.h>
162bfe3f2eSlogwang #include <rte_atomic.h>
172bfe3f2eSlogwang #include <rte_branch_prediction.h>
182bfe3f2eSlogwang #include <rte_pci.h>
192bfe3f2eSlogwang #include <rte_bus_pci.h>
202bfe3f2eSlogwang #include <rte_ether.h>
212bfe3f2eSlogwang #include <rte_common.h>
222bfe3f2eSlogwang #include <rte_cycles.h>
232bfe3f2eSlogwang #include <rte_spinlock.h>
242bfe3f2eSlogwang #include <rte_byteorder.h>
252bfe3f2eSlogwang #include <rte_dev.h>
262bfe3f2eSlogwang #include <rte_memory.h>
272bfe3f2eSlogwang #include <rte_eal.h>
282bfe3f2eSlogwang #include <rte_io.h>
292bfe3f2eSlogwang 
302bfe3f2eSlogwang #include "rte_avp_common.h"
312bfe3f2eSlogwang #include "rte_avp_fifo.h"
322bfe3f2eSlogwang 
332bfe3f2eSlogwang #include "avp_logs.h"
342bfe3f2eSlogwang 
352bfe3f2eSlogwang static int avp_dev_create(struct rte_pci_device *pci_dev,
362bfe3f2eSlogwang 			  struct rte_eth_dev *eth_dev);
372bfe3f2eSlogwang 
382bfe3f2eSlogwang static int avp_dev_configure(struct rte_eth_dev *dev);
392bfe3f2eSlogwang static int avp_dev_start(struct rte_eth_dev *dev);
40*2d9fd380Sjfb8856606 static int avp_dev_stop(struct rte_eth_dev *dev);
41*2d9fd380Sjfb8856606 static int avp_dev_close(struct rte_eth_dev *dev);
424418919fSjohnjiang static int avp_dev_info_get(struct rte_eth_dev *dev,
432bfe3f2eSlogwang 			    struct rte_eth_dev_info *dev_info);
442bfe3f2eSlogwang static int avp_vlan_offload_set(struct rte_eth_dev *dev, int mask);
452bfe3f2eSlogwang static int avp_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete);
464418919fSjohnjiang static int avp_dev_promiscuous_enable(struct rte_eth_dev *dev);
474418919fSjohnjiang static int avp_dev_promiscuous_disable(struct rte_eth_dev *dev);
482bfe3f2eSlogwang 
492bfe3f2eSlogwang static int avp_dev_rx_queue_setup(struct rte_eth_dev *dev,
502bfe3f2eSlogwang 				  uint16_t rx_queue_id,
512bfe3f2eSlogwang 				  uint16_t nb_rx_desc,
522bfe3f2eSlogwang 				  unsigned int socket_id,
532bfe3f2eSlogwang 				  const struct rte_eth_rxconf *rx_conf,
542bfe3f2eSlogwang 				  struct rte_mempool *pool);
552bfe3f2eSlogwang 
562bfe3f2eSlogwang static int avp_dev_tx_queue_setup(struct rte_eth_dev *dev,
572bfe3f2eSlogwang 				  uint16_t tx_queue_id,
582bfe3f2eSlogwang 				  uint16_t nb_tx_desc,
592bfe3f2eSlogwang 				  unsigned int socket_id,
602bfe3f2eSlogwang 				  const struct rte_eth_txconf *tx_conf);
612bfe3f2eSlogwang 
622bfe3f2eSlogwang static uint16_t avp_recv_scattered_pkts(void *rx_queue,
632bfe3f2eSlogwang 					struct rte_mbuf **rx_pkts,
642bfe3f2eSlogwang 					uint16_t nb_pkts);
652bfe3f2eSlogwang 
662bfe3f2eSlogwang static uint16_t avp_recv_pkts(void *rx_queue,
672bfe3f2eSlogwang 			      struct rte_mbuf **rx_pkts,
682bfe3f2eSlogwang 			      uint16_t nb_pkts);
692bfe3f2eSlogwang 
702bfe3f2eSlogwang static uint16_t avp_xmit_scattered_pkts(void *tx_queue,
712bfe3f2eSlogwang 					struct rte_mbuf **tx_pkts,
722bfe3f2eSlogwang 					uint16_t nb_pkts);
732bfe3f2eSlogwang 
742bfe3f2eSlogwang static uint16_t avp_xmit_pkts(void *tx_queue,
752bfe3f2eSlogwang 			      struct rte_mbuf **tx_pkts,
762bfe3f2eSlogwang 			      uint16_t nb_pkts);
772bfe3f2eSlogwang 
782bfe3f2eSlogwang static void avp_dev_rx_queue_release(void *rxq);
792bfe3f2eSlogwang static void avp_dev_tx_queue_release(void *txq);
802bfe3f2eSlogwang 
812bfe3f2eSlogwang static int avp_dev_stats_get(struct rte_eth_dev *dev,
822bfe3f2eSlogwang 			      struct rte_eth_stats *stats);
834418919fSjohnjiang static int avp_dev_stats_reset(struct rte_eth_dev *dev);
842bfe3f2eSlogwang 
852bfe3f2eSlogwang 
862bfe3f2eSlogwang #define AVP_MAX_RX_BURST 64
872bfe3f2eSlogwang #define AVP_MAX_TX_BURST 64
882bfe3f2eSlogwang #define AVP_MAX_MAC_ADDRS 1
894418919fSjohnjiang #define AVP_MIN_RX_BUFSIZE RTE_ETHER_MIN_LEN
902bfe3f2eSlogwang 
912bfe3f2eSlogwang 
922bfe3f2eSlogwang /*
932bfe3f2eSlogwang  * Defines the number of microseconds to wait before checking the response
942bfe3f2eSlogwang  * queue for completion.
952bfe3f2eSlogwang  */
962bfe3f2eSlogwang #define AVP_REQUEST_DELAY_USECS (5000)
972bfe3f2eSlogwang 
982bfe3f2eSlogwang /*
992bfe3f2eSlogwang  * Defines the number times to check the response queue for completion before
1002bfe3f2eSlogwang  * declaring a timeout.
1012bfe3f2eSlogwang  */
1022bfe3f2eSlogwang #define AVP_MAX_REQUEST_RETRY (100)
1032bfe3f2eSlogwang 
1042bfe3f2eSlogwang /* Defines the current PCI driver version number */
1052bfe3f2eSlogwang #define AVP_DPDK_DRIVER_VERSION RTE_AVP_CURRENT_GUEST_VERSION
1062bfe3f2eSlogwang 
1072bfe3f2eSlogwang /*
1082bfe3f2eSlogwang  * The set of PCI devices this driver supports
1092bfe3f2eSlogwang  */
1102bfe3f2eSlogwang static const struct rte_pci_id pci_id_avp_map[] = {
1112bfe3f2eSlogwang 	{ .vendor_id = RTE_AVP_PCI_VENDOR_ID,
1122bfe3f2eSlogwang 	  .device_id = RTE_AVP_PCI_DEVICE_ID,
1132bfe3f2eSlogwang 	  .subsystem_vendor_id = RTE_AVP_PCI_SUB_VENDOR_ID,
1142bfe3f2eSlogwang 	  .subsystem_device_id = RTE_AVP_PCI_SUB_DEVICE_ID,
1152bfe3f2eSlogwang 	  .class_id = RTE_CLASS_ANY_ID,
1162bfe3f2eSlogwang 	},
1172bfe3f2eSlogwang 
1182bfe3f2eSlogwang 	{ .vendor_id = 0, /* sentinel */
1192bfe3f2eSlogwang 	},
1202bfe3f2eSlogwang };
1212bfe3f2eSlogwang 
1222bfe3f2eSlogwang /*
1232bfe3f2eSlogwang  * dev_ops for avp, bare necessities for basic operation
1242bfe3f2eSlogwang  */
1252bfe3f2eSlogwang static const struct eth_dev_ops avp_eth_dev_ops = {
1262bfe3f2eSlogwang 	.dev_configure       = avp_dev_configure,
1272bfe3f2eSlogwang 	.dev_start           = avp_dev_start,
1282bfe3f2eSlogwang 	.dev_stop            = avp_dev_stop,
1292bfe3f2eSlogwang 	.dev_close           = avp_dev_close,
1302bfe3f2eSlogwang 	.dev_infos_get       = avp_dev_info_get,
1312bfe3f2eSlogwang 	.vlan_offload_set    = avp_vlan_offload_set,
1322bfe3f2eSlogwang 	.stats_get           = avp_dev_stats_get,
1332bfe3f2eSlogwang 	.stats_reset         = avp_dev_stats_reset,
1342bfe3f2eSlogwang 	.link_update         = avp_dev_link_update,
1352bfe3f2eSlogwang 	.promiscuous_enable  = avp_dev_promiscuous_enable,
1362bfe3f2eSlogwang 	.promiscuous_disable = avp_dev_promiscuous_disable,
1372bfe3f2eSlogwang 	.rx_queue_setup      = avp_dev_rx_queue_setup,
1382bfe3f2eSlogwang 	.rx_queue_release    = avp_dev_rx_queue_release,
1392bfe3f2eSlogwang 	.tx_queue_setup      = avp_dev_tx_queue_setup,
1402bfe3f2eSlogwang 	.tx_queue_release    = avp_dev_tx_queue_release,
1412bfe3f2eSlogwang };
1422bfe3f2eSlogwang 
1432bfe3f2eSlogwang /**@{ AVP device flags */
1442bfe3f2eSlogwang #define AVP_F_PROMISC (1 << 1)
1452bfe3f2eSlogwang #define AVP_F_CONFIGURED (1 << 2)
1462bfe3f2eSlogwang #define AVP_F_LINKUP (1 << 3)
1472bfe3f2eSlogwang #define AVP_F_DETACHED (1 << 4)
1482bfe3f2eSlogwang /**@} */
1492bfe3f2eSlogwang 
1502bfe3f2eSlogwang /* Ethernet device validation marker */
1512bfe3f2eSlogwang #define AVP_ETHDEV_MAGIC 0x92972862
1522bfe3f2eSlogwang 
1532bfe3f2eSlogwang /*
1542bfe3f2eSlogwang  * Defines the AVP device attributes which are attached to an RTE ethernet
1552bfe3f2eSlogwang  * device
1562bfe3f2eSlogwang  */
1572bfe3f2eSlogwang struct avp_dev {
1582bfe3f2eSlogwang 	uint32_t magic; /**< Memory validation marker */
1592bfe3f2eSlogwang 	uint64_t device_id; /**< Unique system identifier */
1604418919fSjohnjiang 	struct rte_ether_addr ethaddr; /**< Host specified MAC address */
1612bfe3f2eSlogwang 	struct rte_eth_dev_data *dev_data;
1622bfe3f2eSlogwang 	/**< Back pointer to ethernet device data */
1632bfe3f2eSlogwang 	volatile uint32_t flags; /**< Device operational flags */
1642bfe3f2eSlogwang 	uint16_t port_id; /**< Ethernet port identifier */
1652bfe3f2eSlogwang 	struct rte_mempool *pool; /**< pkt mbuf mempool */
1662bfe3f2eSlogwang 	unsigned int guest_mbuf_size; /**< local pool mbuf size */
1672bfe3f2eSlogwang 	unsigned int host_mbuf_size; /**< host mbuf size */
1682bfe3f2eSlogwang 	unsigned int max_rx_pkt_len; /**< maximum receive unit */
1692bfe3f2eSlogwang 	uint32_t host_features; /**< Supported feature bitmap */
1702bfe3f2eSlogwang 	uint32_t features; /**< Enabled feature bitmap */
1712bfe3f2eSlogwang 	unsigned int num_tx_queues; /**< Negotiated number of transmit queues */
1722bfe3f2eSlogwang 	unsigned int max_tx_queues; /**< Maximum number of transmit queues */
1732bfe3f2eSlogwang 	unsigned int num_rx_queues; /**< Negotiated number of receive queues */
1742bfe3f2eSlogwang 	unsigned int max_rx_queues; /**< Maximum number of receive queues */
1752bfe3f2eSlogwang 
1762bfe3f2eSlogwang 	struct rte_avp_fifo *tx_q[RTE_AVP_MAX_QUEUES]; /**< TX queue */
1772bfe3f2eSlogwang 	struct rte_avp_fifo *rx_q[RTE_AVP_MAX_QUEUES]; /**< RX queue */
1782bfe3f2eSlogwang 	struct rte_avp_fifo *alloc_q[RTE_AVP_MAX_QUEUES];
1792bfe3f2eSlogwang 	/**< Allocated mbufs queue */
1802bfe3f2eSlogwang 	struct rte_avp_fifo *free_q[RTE_AVP_MAX_QUEUES];
1812bfe3f2eSlogwang 	/**< To be freed mbufs queue */
1822bfe3f2eSlogwang 
1832bfe3f2eSlogwang 	/* mutual exclusion over the 'flag' and 'resp_q/req_q' fields */
1842bfe3f2eSlogwang 	rte_spinlock_t lock;
1852bfe3f2eSlogwang 
1862bfe3f2eSlogwang 	/* For request & response */
1872bfe3f2eSlogwang 	struct rte_avp_fifo *req_q; /**< Request queue */
1882bfe3f2eSlogwang 	struct rte_avp_fifo *resp_q; /**< Response queue */
1892bfe3f2eSlogwang 	void *host_sync_addr; /**< (host) Req/Resp Mem address */
1902bfe3f2eSlogwang 	void *sync_addr; /**< Req/Resp Mem address */
1912bfe3f2eSlogwang 	void *host_mbuf_addr; /**< (host) MBUF pool start address */
1922bfe3f2eSlogwang 	void *mbuf_addr; /**< MBUF pool start address */
1932bfe3f2eSlogwang } __rte_cache_aligned;
1942bfe3f2eSlogwang 
1952bfe3f2eSlogwang /* RTE ethernet private data */
1962bfe3f2eSlogwang struct avp_adapter {
1972bfe3f2eSlogwang 	struct avp_dev avp;
1982bfe3f2eSlogwang } __rte_cache_aligned;
1992bfe3f2eSlogwang 
2002bfe3f2eSlogwang 
2012bfe3f2eSlogwang /* 32-bit MMIO register write */
2022bfe3f2eSlogwang #define AVP_WRITE32(_value, _addr) rte_write32_relaxed((_value), (_addr))
2032bfe3f2eSlogwang 
2042bfe3f2eSlogwang /* 32-bit MMIO register read */
2052bfe3f2eSlogwang #define AVP_READ32(_addr) rte_read32_relaxed((_addr))
2062bfe3f2eSlogwang 
2072bfe3f2eSlogwang /* Macro to cast the ethernet device private data to a AVP object */
2082bfe3f2eSlogwang #define AVP_DEV_PRIVATE_TO_HW(adapter) \
2092bfe3f2eSlogwang 	(&((struct avp_adapter *)adapter)->avp)
2102bfe3f2eSlogwang 
2112bfe3f2eSlogwang /*
2122bfe3f2eSlogwang  * Defines the structure of a AVP device queue for the purpose of handling the
2132bfe3f2eSlogwang  * receive and transmit burst callback functions
2142bfe3f2eSlogwang  */
2152bfe3f2eSlogwang struct avp_queue {
2162bfe3f2eSlogwang 	struct rte_eth_dev_data *dev_data;
2172bfe3f2eSlogwang 	/**< Backpointer to ethernet device data */
2182bfe3f2eSlogwang 	struct avp_dev *avp; /**< Backpointer to AVP device */
2192bfe3f2eSlogwang 	uint16_t queue_id;
2202bfe3f2eSlogwang 	/**< Queue identifier used for indexing current queue */
2212bfe3f2eSlogwang 	uint16_t queue_base;
2222bfe3f2eSlogwang 	/**< Base queue identifier for queue servicing */
2232bfe3f2eSlogwang 	uint16_t queue_limit;
2242bfe3f2eSlogwang 	/**< Maximum queue identifier for queue servicing */
2252bfe3f2eSlogwang 
2262bfe3f2eSlogwang 	uint64_t packets;
2272bfe3f2eSlogwang 	uint64_t bytes;
2282bfe3f2eSlogwang 	uint64_t errors;
2292bfe3f2eSlogwang };
2302bfe3f2eSlogwang 
2312bfe3f2eSlogwang /* send a request and wait for a response
2322bfe3f2eSlogwang  *
2332bfe3f2eSlogwang  * @warning must be called while holding the avp->lock spinlock.
2342bfe3f2eSlogwang  */
2352bfe3f2eSlogwang static int
avp_dev_process_request(struct avp_dev * avp,struct rte_avp_request * request)2362bfe3f2eSlogwang avp_dev_process_request(struct avp_dev *avp, struct rte_avp_request *request)
2372bfe3f2eSlogwang {
2382bfe3f2eSlogwang 	unsigned int retry = AVP_MAX_REQUEST_RETRY;
2392bfe3f2eSlogwang 	void *resp_addr = NULL;
2402bfe3f2eSlogwang 	unsigned int count;
2412bfe3f2eSlogwang 	int ret;
2422bfe3f2eSlogwang 
2432bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "Sending request %u to host\n", request->req_id);
2442bfe3f2eSlogwang 
2452bfe3f2eSlogwang 	request->result = -ENOTSUP;
2462bfe3f2eSlogwang 
2472bfe3f2eSlogwang 	/* Discard any stale responses before starting a new request */
2482bfe3f2eSlogwang 	while (avp_fifo_get(avp->resp_q, (void **)&resp_addr, 1))
2492bfe3f2eSlogwang 		PMD_DRV_LOG(DEBUG, "Discarding stale response\n");
2502bfe3f2eSlogwang 
2512bfe3f2eSlogwang 	rte_memcpy(avp->sync_addr, request, sizeof(*request));
2522bfe3f2eSlogwang 	count = avp_fifo_put(avp->req_q, &avp->host_sync_addr, 1);
2532bfe3f2eSlogwang 	if (count < 1) {
2542bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Cannot send request %u to host\n",
2552bfe3f2eSlogwang 			    request->req_id);
2562bfe3f2eSlogwang 		ret = -EBUSY;
2572bfe3f2eSlogwang 		goto done;
2582bfe3f2eSlogwang 	}
2592bfe3f2eSlogwang 
2602bfe3f2eSlogwang 	while (retry--) {
2612bfe3f2eSlogwang 		/* wait for a response */
2622bfe3f2eSlogwang 		usleep(AVP_REQUEST_DELAY_USECS);
2632bfe3f2eSlogwang 
2642bfe3f2eSlogwang 		count = avp_fifo_count(avp->resp_q);
2652bfe3f2eSlogwang 		if (count >= 1) {
2662bfe3f2eSlogwang 			/* response received */
2672bfe3f2eSlogwang 			break;
2682bfe3f2eSlogwang 		}
2692bfe3f2eSlogwang 
2702bfe3f2eSlogwang 		if ((count < 1) && (retry == 0)) {
2712bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "Timeout while waiting for a response for %u\n",
2722bfe3f2eSlogwang 				    request->req_id);
2732bfe3f2eSlogwang 			ret = -ETIME;
2742bfe3f2eSlogwang 			goto done;
2752bfe3f2eSlogwang 		}
2762bfe3f2eSlogwang 	}
2772bfe3f2eSlogwang 
2782bfe3f2eSlogwang 	/* retrieve the response */
2792bfe3f2eSlogwang 	count = avp_fifo_get(avp->resp_q, (void **)&resp_addr, 1);
2802bfe3f2eSlogwang 	if ((count != 1) || (resp_addr != avp->host_sync_addr)) {
2812bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Invalid response from host, count=%u resp=%p host_sync_addr=%p\n",
2822bfe3f2eSlogwang 			    count, resp_addr, avp->host_sync_addr);
2832bfe3f2eSlogwang 		ret = -ENODATA;
2842bfe3f2eSlogwang 		goto done;
2852bfe3f2eSlogwang 	}
2862bfe3f2eSlogwang 
2872bfe3f2eSlogwang 	/* copy to user buffer */
2882bfe3f2eSlogwang 	rte_memcpy(request, avp->sync_addr, sizeof(*request));
2892bfe3f2eSlogwang 	ret = 0;
2902bfe3f2eSlogwang 
2912bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "Result %d received for request %u\n",
2922bfe3f2eSlogwang 		    request->result, request->req_id);
2932bfe3f2eSlogwang 
2942bfe3f2eSlogwang done:
2952bfe3f2eSlogwang 	return ret;
2962bfe3f2eSlogwang }
2972bfe3f2eSlogwang 
2982bfe3f2eSlogwang static int
avp_dev_ctrl_set_link_state(struct rte_eth_dev * eth_dev,unsigned int state)2992bfe3f2eSlogwang avp_dev_ctrl_set_link_state(struct rte_eth_dev *eth_dev, unsigned int state)
3002bfe3f2eSlogwang {
3012bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
3022bfe3f2eSlogwang 	struct rte_avp_request request;
3032bfe3f2eSlogwang 	int ret;
3042bfe3f2eSlogwang 
3052bfe3f2eSlogwang 	/* setup a link state change request */
3062bfe3f2eSlogwang 	memset(&request, 0, sizeof(request));
3072bfe3f2eSlogwang 	request.req_id = RTE_AVP_REQ_CFG_NETWORK_IF;
3082bfe3f2eSlogwang 	request.if_up = state;
3092bfe3f2eSlogwang 
3102bfe3f2eSlogwang 	ret = avp_dev_process_request(avp, &request);
3112bfe3f2eSlogwang 
3122bfe3f2eSlogwang 	return ret == 0 ? request.result : ret;
3132bfe3f2eSlogwang }
3142bfe3f2eSlogwang 
3152bfe3f2eSlogwang static int
avp_dev_ctrl_set_config(struct rte_eth_dev * eth_dev,struct rte_avp_device_config * config)3162bfe3f2eSlogwang avp_dev_ctrl_set_config(struct rte_eth_dev *eth_dev,
3172bfe3f2eSlogwang 			struct rte_avp_device_config *config)
3182bfe3f2eSlogwang {
3192bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
3202bfe3f2eSlogwang 	struct rte_avp_request request;
3212bfe3f2eSlogwang 	int ret;
3222bfe3f2eSlogwang 
3232bfe3f2eSlogwang 	/* setup a configure request */
3242bfe3f2eSlogwang 	memset(&request, 0, sizeof(request));
3252bfe3f2eSlogwang 	request.req_id = RTE_AVP_REQ_CFG_DEVICE;
3262bfe3f2eSlogwang 	memcpy(&request.config, config, sizeof(request.config));
3272bfe3f2eSlogwang 
3282bfe3f2eSlogwang 	ret = avp_dev_process_request(avp, &request);
3292bfe3f2eSlogwang 
3302bfe3f2eSlogwang 	return ret == 0 ? request.result : ret;
3312bfe3f2eSlogwang }
3322bfe3f2eSlogwang 
3332bfe3f2eSlogwang static int
avp_dev_ctrl_shutdown(struct rte_eth_dev * eth_dev)3342bfe3f2eSlogwang avp_dev_ctrl_shutdown(struct rte_eth_dev *eth_dev)
3352bfe3f2eSlogwang {
3362bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
3372bfe3f2eSlogwang 	struct rte_avp_request request;
3382bfe3f2eSlogwang 	int ret;
3392bfe3f2eSlogwang 
3402bfe3f2eSlogwang 	/* setup a shutdown request */
3412bfe3f2eSlogwang 	memset(&request, 0, sizeof(request));
3422bfe3f2eSlogwang 	request.req_id = RTE_AVP_REQ_SHUTDOWN_DEVICE;
3432bfe3f2eSlogwang 
3442bfe3f2eSlogwang 	ret = avp_dev_process_request(avp, &request);
3452bfe3f2eSlogwang 
3462bfe3f2eSlogwang 	return ret == 0 ? request.result : ret;
3472bfe3f2eSlogwang }
3482bfe3f2eSlogwang 
3492bfe3f2eSlogwang /* translate from host mbuf virtual address to guest virtual address */
3502bfe3f2eSlogwang static inline void *
avp_dev_translate_buffer(struct avp_dev * avp,void * host_mbuf_address)3512bfe3f2eSlogwang avp_dev_translate_buffer(struct avp_dev *avp, void *host_mbuf_address)
3522bfe3f2eSlogwang {
3532bfe3f2eSlogwang 	return RTE_PTR_ADD(RTE_PTR_SUB(host_mbuf_address,
3542bfe3f2eSlogwang 				       (uintptr_t)avp->host_mbuf_addr),
3552bfe3f2eSlogwang 			   (uintptr_t)avp->mbuf_addr);
3562bfe3f2eSlogwang }
3572bfe3f2eSlogwang 
3582bfe3f2eSlogwang /* translate from host physical address to guest virtual address */
3592bfe3f2eSlogwang static void *
avp_dev_translate_address(struct rte_eth_dev * eth_dev,rte_iova_t host_phys_addr)3602bfe3f2eSlogwang avp_dev_translate_address(struct rte_eth_dev *eth_dev,
3612bfe3f2eSlogwang 			  rte_iova_t host_phys_addr)
3622bfe3f2eSlogwang {
3632bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
3642bfe3f2eSlogwang 	struct rte_mem_resource *resource;
3652bfe3f2eSlogwang 	struct rte_avp_memmap_info *info;
3662bfe3f2eSlogwang 	struct rte_avp_memmap *map;
3672bfe3f2eSlogwang 	off_t offset;
3682bfe3f2eSlogwang 	void *addr;
3692bfe3f2eSlogwang 	unsigned int i;
3702bfe3f2eSlogwang 
3712bfe3f2eSlogwang 	addr = pci_dev->mem_resource[RTE_AVP_PCI_MEMORY_BAR].addr;
3722bfe3f2eSlogwang 	resource = &pci_dev->mem_resource[RTE_AVP_PCI_MEMMAP_BAR];
3732bfe3f2eSlogwang 	info = (struct rte_avp_memmap_info *)resource->addr;
3742bfe3f2eSlogwang 
3752bfe3f2eSlogwang 	offset = 0;
3762bfe3f2eSlogwang 	for (i = 0; i < info->nb_maps; i++) {
3772bfe3f2eSlogwang 		/* search all segments looking for a matching address */
3782bfe3f2eSlogwang 		map = &info->maps[i];
3792bfe3f2eSlogwang 
3802bfe3f2eSlogwang 		if ((host_phys_addr >= map->phys_addr) &&
3812bfe3f2eSlogwang 			(host_phys_addr < (map->phys_addr + map->length))) {
3822bfe3f2eSlogwang 			/* address is within this segment */
3832bfe3f2eSlogwang 			offset += (host_phys_addr - map->phys_addr);
384d30ea906Sjfb8856606 			addr = RTE_PTR_ADD(addr, (uintptr_t)offset);
3852bfe3f2eSlogwang 
3862bfe3f2eSlogwang 			PMD_DRV_LOG(DEBUG, "Translating host physical 0x%" PRIx64 " to guest virtual 0x%p\n",
3872bfe3f2eSlogwang 				    host_phys_addr, addr);
3882bfe3f2eSlogwang 
3892bfe3f2eSlogwang 			return addr;
3902bfe3f2eSlogwang 		}
3912bfe3f2eSlogwang 		offset += map->length;
3922bfe3f2eSlogwang 	}
3932bfe3f2eSlogwang 
3942bfe3f2eSlogwang 	return NULL;
3952bfe3f2eSlogwang }
3962bfe3f2eSlogwang 
3972bfe3f2eSlogwang /* verify that the incoming device version is compatible with our version */
3982bfe3f2eSlogwang static int
avp_dev_version_check(uint32_t version)3992bfe3f2eSlogwang avp_dev_version_check(uint32_t version)
4002bfe3f2eSlogwang {
4012bfe3f2eSlogwang 	uint32_t driver = RTE_AVP_STRIP_MINOR_VERSION(AVP_DPDK_DRIVER_VERSION);
4022bfe3f2eSlogwang 	uint32_t device = RTE_AVP_STRIP_MINOR_VERSION(version);
4032bfe3f2eSlogwang 
4042bfe3f2eSlogwang 	if (device <= driver) {
4052bfe3f2eSlogwang 		/* the host driver version is less than or equal to ours */
4062bfe3f2eSlogwang 		return 0;
4072bfe3f2eSlogwang 	}
4082bfe3f2eSlogwang 
4092bfe3f2eSlogwang 	return 1;
4102bfe3f2eSlogwang }
4112bfe3f2eSlogwang 
4122bfe3f2eSlogwang /* verify that memory regions have expected version and validation markers */
4132bfe3f2eSlogwang static int
avp_dev_check_regions(struct rte_eth_dev * eth_dev)4142bfe3f2eSlogwang avp_dev_check_regions(struct rte_eth_dev *eth_dev)
4152bfe3f2eSlogwang {
4162bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
4172bfe3f2eSlogwang 	struct rte_avp_memmap_info *memmap;
4182bfe3f2eSlogwang 	struct rte_avp_device_info *info;
4192bfe3f2eSlogwang 	struct rte_mem_resource *resource;
4202bfe3f2eSlogwang 	unsigned int i;
4212bfe3f2eSlogwang 
4222bfe3f2eSlogwang 	/* Dump resource info for debug */
4232bfe3f2eSlogwang 	for (i = 0; i < PCI_MAX_RESOURCE; i++) {
4242bfe3f2eSlogwang 		resource = &pci_dev->mem_resource[i];
4252bfe3f2eSlogwang 		if ((resource->phys_addr == 0) || (resource->len == 0))
4262bfe3f2eSlogwang 			continue;
4272bfe3f2eSlogwang 
4282bfe3f2eSlogwang 		PMD_DRV_LOG(DEBUG, "resource[%u]: phys=0x%" PRIx64 " len=%" PRIu64 " addr=%p\n",
4292bfe3f2eSlogwang 			    i, resource->phys_addr,
4302bfe3f2eSlogwang 			    resource->len, resource->addr);
4312bfe3f2eSlogwang 
4322bfe3f2eSlogwang 		switch (i) {
4332bfe3f2eSlogwang 		case RTE_AVP_PCI_MEMMAP_BAR:
4342bfe3f2eSlogwang 			memmap = (struct rte_avp_memmap_info *)resource->addr;
4352bfe3f2eSlogwang 			if ((memmap->magic != RTE_AVP_MEMMAP_MAGIC) ||
4362bfe3f2eSlogwang 			    (memmap->version != RTE_AVP_MEMMAP_VERSION)) {
4372bfe3f2eSlogwang 				PMD_DRV_LOG(ERR, "Invalid memmap magic 0x%08x and version %u\n",
4382bfe3f2eSlogwang 					    memmap->magic, memmap->version);
4392bfe3f2eSlogwang 				return -EINVAL;
4402bfe3f2eSlogwang 			}
4412bfe3f2eSlogwang 			break;
4422bfe3f2eSlogwang 
4432bfe3f2eSlogwang 		case RTE_AVP_PCI_DEVICE_BAR:
4442bfe3f2eSlogwang 			info = (struct rte_avp_device_info *)resource->addr;
4452bfe3f2eSlogwang 			if ((info->magic != RTE_AVP_DEVICE_MAGIC) ||
4462bfe3f2eSlogwang 			    avp_dev_version_check(info->version)) {
4472bfe3f2eSlogwang 				PMD_DRV_LOG(ERR, "Invalid device info magic 0x%08x or version 0x%08x > 0x%08x\n",
4482bfe3f2eSlogwang 					    info->magic, info->version,
4492bfe3f2eSlogwang 					    AVP_DPDK_DRIVER_VERSION);
4502bfe3f2eSlogwang 				return -EINVAL;
4512bfe3f2eSlogwang 			}
4522bfe3f2eSlogwang 			break;
4532bfe3f2eSlogwang 
4542bfe3f2eSlogwang 		case RTE_AVP_PCI_MEMORY_BAR:
4552bfe3f2eSlogwang 		case RTE_AVP_PCI_MMIO_BAR:
4562bfe3f2eSlogwang 			if (resource->addr == NULL) {
4572bfe3f2eSlogwang 				PMD_DRV_LOG(ERR, "Missing address space for BAR%u\n",
4582bfe3f2eSlogwang 					    i);
4592bfe3f2eSlogwang 				return -EINVAL;
4602bfe3f2eSlogwang 			}
4612bfe3f2eSlogwang 			break;
4622bfe3f2eSlogwang 
4632bfe3f2eSlogwang 		case RTE_AVP_PCI_MSIX_BAR:
4642bfe3f2eSlogwang 		default:
4652bfe3f2eSlogwang 			/* no validation required */
4662bfe3f2eSlogwang 			break;
4672bfe3f2eSlogwang 		}
4682bfe3f2eSlogwang 	}
4692bfe3f2eSlogwang 
4702bfe3f2eSlogwang 	return 0;
4712bfe3f2eSlogwang }
4722bfe3f2eSlogwang 
4732bfe3f2eSlogwang static int
avp_dev_detach(struct rte_eth_dev * eth_dev)4742bfe3f2eSlogwang avp_dev_detach(struct rte_eth_dev *eth_dev)
4752bfe3f2eSlogwang {
4762bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
4772bfe3f2eSlogwang 	int ret;
4782bfe3f2eSlogwang 
4792bfe3f2eSlogwang 	PMD_DRV_LOG(NOTICE, "Detaching port %u from AVP device 0x%" PRIx64 "\n",
4802bfe3f2eSlogwang 		    eth_dev->data->port_id, avp->device_id);
4812bfe3f2eSlogwang 
4822bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
4832bfe3f2eSlogwang 
4842bfe3f2eSlogwang 	if (avp->flags & AVP_F_DETACHED) {
4852bfe3f2eSlogwang 		PMD_DRV_LOG(NOTICE, "port %u already detached\n",
4862bfe3f2eSlogwang 			    eth_dev->data->port_id);
4872bfe3f2eSlogwang 		ret = 0;
4882bfe3f2eSlogwang 		goto unlock;
4892bfe3f2eSlogwang 	}
4902bfe3f2eSlogwang 
4912bfe3f2eSlogwang 	/* shutdown the device first so the host stops sending us packets. */
4922bfe3f2eSlogwang 	ret = avp_dev_ctrl_shutdown(eth_dev);
4932bfe3f2eSlogwang 	if (ret < 0) {
4942bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to send/recv shutdown to host, ret=%d\n",
4952bfe3f2eSlogwang 			    ret);
4962bfe3f2eSlogwang 		avp->flags &= ~AVP_F_DETACHED;
4972bfe3f2eSlogwang 		goto unlock;
4982bfe3f2eSlogwang 	}
4992bfe3f2eSlogwang 
5002bfe3f2eSlogwang 	avp->flags |= AVP_F_DETACHED;
5012bfe3f2eSlogwang 	rte_wmb();
5022bfe3f2eSlogwang 
5032bfe3f2eSlogwang 	/* wait for queues to acknowledge the presence of the detach flag */
5042bfe3f2eSlogwang 	rte_delay_ms(1);
5052bfe3f2eSlogwang 
5062bfe3f2eSlogwang 	ret = 0;
5072bfe3f2eSlogwang 
5082bfe3f2eSlogwang unlock:
5092bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
5102bfe3f2eSlogwang 	return ret;
5112bfe3f2eSlogwang }
5122bfe3f2eSlogwang 
5132bfe3f2eSlogwang static void
_avp_set_rx_queue_mappings(struct rte_eth_dev * eth_dev,uint16_t rx_queue_id)5142bfe3f2eSlogwang _avp_set_rx_queue_mappings(struct rte_eth_dev *eth_dev, uint16_t rx_queue_id)
5152bfe3f2eSlogwang {
5162bfe3f2eSlogwang 	struct avp_dev *avp =
5172bfe3f2eSlogwang 		AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
5182bfe3f2eSlogwang 	struct avp_queue *rxq;
5192bfe3f2eSlogwang 	uint16_t queue_count;
5202bfe3f2eSlogwang 	uint16_t remainder;
5212bfe3f2eSlogwang 
5222bfe3f2eSlogwang 	rxq = (struct avp_queue *)eth_dev->data->rx_queues[rx_queue_id];
5232bfe3f2eSlogwang 
5242bfe3f2eSlogwang 	/*
5252bfe3f2eSlogwang 	 * Must map all AVP fifos as evenly as possible between the configured
5262bfe3f2eSlogwang 	 * device queues.  Each device queue will service a subset of the AVP
5272bfe3f2eSlogwang 	 * fifos. If there is an odd number of device queues the first set of
5282bfe3f2eSlogwang 	 * device queues will get the extra AVP fifos.
5292bfe3f2eSlogwang 	 */
5302bfe3f2eSlogwang 	queue_count = avp->num_rx_queues / eth_dev->data->nb_rx_queues;
5312bfe3f2eSlogwang 	remainder = avp->num_rx_queues % eth_dev->data->nb_rx_queues;
5322bfe3f2eSlogwang 	if (rx_queue_id < remainder) {
5332bfe3f2eSlogwang 		/* these queues must service one extra FIFO */
5342bfe3f2eSlogwang 		rxq->queue_base = rx_queue_id * (queue_count + 1);
5352bfe3f2eSlogwang 		rxq->queue_limit = rxq->queue_base + (queue_count + 1) - 1;
5362bfe3f2eSlogwang 	} else {
5372bfe3f2eSlogwang 		/* these queues service the regular number of FIFO */
5382bfe3f2eSlogwang 		rxq->queue_base = ((remainder * (queue_count + 1)) +
5392bfe3f2eSlogwang 				   ((rx_queue_id - remainder) * queue_count));
5402bfe3f2eSlogwang 		rxq->queue_limit = rxq->queue_base + queue_count - 1;
5412bfe3f2eSlogwang 	}
5422bfe3f2eSlogwang 
5432bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "rxq %u at %p base %u limit %u\n",
5442bfe3f2eSlogwang 		    rx_queue_id, rxq, rxq->queue_base, rxq->queue_limit);
5452bfe3f2eSlogwang 
5462bfe3f2eSlogwang 	rxq->queue_id = rxq->queue_base;
5472bfe3f2eSlogwang }
5482bfe3f2eSlogwang 
5492bfe3f2eSlogwang static void
_avp_set_queue_counts(struct rte_eth_dev * eth_dev)5502bfe3f2eSlogwang _avp_set_queue_counts(struct rte_eth_dev *eth_dev)
5512bfe3f2eSlogwang {
5522bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
5532bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
5542bfe3f2eSlogwang 	struct rte_avp_device_info *host_info;
5552bfe3f2eSlogwang 	void *addr;
5562bfe3f2eSlogwang 
5572bfe3f2eSlogwang 	addr = pci_dev->mem_resource[RTE_AVP_PCI_DEVICE_BAR].addr;
5582bfe3f2eSlogwang 	host_info = (struct rte_avp_device_info *)addr;
5592bfe3f2eSlogwang 
5602bfe3f2eSlogwang 	/*
5612bfe3f2eSlogwang 	 * the transmit direction is not negotiated beyond respecting the max
5622bfe3f2eSlogwang 	 * number of queues because the host can handle arbitrary guest tx
5632bfe3f2eSlogwang 	 * queues (host rx queues).
5642bfe3f2eSlogwang 	 */
5652bfe3f2eSlogwang 	avp->num_tx_queues = eth_dev->data->nb_tx_queues;
5662bfe3f2eSlogwang 
5672bfe3f2eSlogwang 	/*
5682bfe3f2eSlogwang 	 * the receive direction is more restrictive.  The host requires a
5692bfe3f2eSlogwang 	 * minimum number of guest rx queues (host tx queues) therefore
5702bfe3f2eSlogwang 	 * negotiate a value that is at least as large as the host minimum
5712bfe3f2eSlogwang 	 * requirement.  If the host and guest values are not identical then a
5722bfe3f2eSlogwang 	 * mapping will be established in the receive_queue_setup function.
5732bfe3f2eSlogwang 	 */
5742bfe3f2eSlogwang 	avp->num_rx_queues = RTE_MAX(host_info->min_rx_queues,
5752bfe3f2eSlogwang 				     eth_dev->data->nb_rx_queues);
5762bfe3f2eSlogwang 
5772bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "Requesting %u Tx and %u Rx queues from host\n",
5782bfe3f2eSlogwang 		    avp->num_tx_queues, avp->num_rx_queues);
5792bfe3f2eSlogwang }
5802bfe3f2eSlogwang 
5812bfe3f2eSlogwang static int
avp_dev_attach(struct rte_eth_dev * eth_dev)5822bfe3f2eSlogwang avp_dev_attach(struct rte_eth_dev *eth_dev)
5832bfe3f2eSlogwang {
5842bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
5852bfe3f2eSlogwang 	struct rte_avp_device_config config;
5862bfe3f2eSlogwang 	unsigned int i;
5872bfe3f2eSlogwang 	int ret;
5882bfe3f2eSlogwang 
5892bfe3f2eSlogwang 	PMD_DRV_LOG(NOTICE, "Attaching port %u to AVP device 0x%" PRIx64 "\n",
5902bfe3f2eSlogwang 		    eth_dev->data->port_id, avp->device_id);
5912bfe3f2eSlogwang 
5922bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
5932bfe3f2eSlogwang 
5942bfe3f2eSlogwang 	if (!(avp->flags & AVP_F_DETACHED)) {
5952bfe3f2eSlogwang 		PMD_DRV_LOG(NOTICE, "port %u already attached\n",
5962bfe3f2eSlogwang 			    eth_dev->data->port_id);
5972bfe3f2eSlogwang 		ret = 0;
5982bfe3f2eSlogwang 		goto unlock;
5992bfe3f2eSlogwang 	}
6002bfe3f2eSlogwang 
6012bfe3f2eSlogwang 	/*
6022bfe3f2eSlogwang 	 * make sure that the detached flag is set prior to reconfiguring the
6032bfe3f2eSlogwang 	 * queues.
6042bfe3f2eSlogwang 	 */
6052bfe3f2eSlogwang 	avp->flags |= AVP_F_DETACHED;
6062bfe3f2eSlogwang 	rte_wmb();
6072bfe3f2eSlogwang 
6082bfe3f2eSlogwang 	/*
6092bfe3f2eSlogwang 	 * re-run the device create utility which will parse the new host info
6102bfe3f2eSlogwang 	 * and setup the AVP device queue pointers.
6112bfe3f2eSlogwang 	 */
6122bfe3f2eSlogwang 	ret = avp_dev_create(RTE_ETH_DEV_TO_PCI(eth_dev), eth_dev);
6132bfe3f2eSlogwang 	if (ret < 0) {
6142bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to re-create AVP device, ret=%d\n",
6152bfe3f2eSlogwang 			    ret);
6162bfe3f2eSlogwang 		goto unlock;
6172bfe3f2eSlogwang 	}
6182bfe3f2eSlogwang 
6192bfe3f2eSlogwang 	if (avp->flags & AVP_F_CONFIGURED) {
6202bfe3f2eSlogwang 		/*
6212bfe3f2eSlogwang 		 * Update the receive queue mapping to handle cases where the
6222bfe3f2eSlogwang 		 * source and destination hosts have different queue
6232bfe3f2eSlogwang 		 * requirements.  As long as the DETACHED flag is asserted the
6242bfe3f2eSlogwang 		 * queue table should not be referenced so it should be safe to
6252bfe3f2eSlogwang 		 * update it.
6262bfe3f2eSlogwang 		 */
6272bfe3f2eSlogwang 		_avp_set_queue_counts(eth_dev);
6282bfe3f2eSlogwang 		for (i = 0; i < eth_dev->data->nb_rx_queues; i++)
6292bfe3f2eSlogwang 			_avp_set_rx_queue_mappings(eth_dev, i);
6302bfe3f2eSlogwang 
6312bfe3f2eSlogwang 		/*
6322bfe3f2eSlogwang 		 * Update the host with our config details so that it knows the
6332bfe3f2eSlogwang 		 * device is active.
6342bfe3f2eSlogwang 		 */
6352bfe3f2eSlogwang 		memset(&config, 0, sizeof(config));
6362bfe3f2eSlogwang 		config.device_id = avp->device_id;
6372bfe3f2eSlogwang 		config.driver_type = RTE_AVP_DRIVER_TYPE_DPDK;
6382bfe3f2eSlogwang 		config.driver_version = AVP_DPDK_DRIVER_VERSION;
6392bfe3f2eSlogwang 		config.features = avp->features;
6402bfe3f2eSlogwang 		config.num_tx_queues = avp->num_tx_queues;
6412bfe3f2eSlogwang 		config.num_rx_queues = avp->num_rx_queues;
6422bfe3f2eSlogwang 		config.if_up = !!(avp->flags & AVP_F_LINKUP);
6432bfe3f2eSlogwang 
6442bfe3f2eSlogwang 		ret = avp_dev_ctrl_set_config(eth_dev, &config);
6452bfe3f2eSlogwang 		if (ret < 0) {
6462bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "Config request failed by host, ret=%d\n",
6472bfe3f2eSlogwang 				    ret);
6482bfe3f2eSlogwang 			goto unlock;
6492bfe3f2eSlogwang 		}
6502bfe3f2eSlogwang 	}
6512bfe3f2eSlogwang 
6522bfe3f2eSlogwang 	rte_wmb();
6532bfe3f2eSlogwang 	avp->flags &= ~AVP_F_DETACHED;
6542bfe3f2eSlogwang 
6552bfe3f2eSlogwang 	ret = 0;
6562bfe3f2eSlogwang 
6572bfe3f2eSlogwang unlock:
6582bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
6592bfe3f2eSlogwang 	return ret;
6602bfe3f2eSlogwang }
6612bfe3f2eSlogwang 
6622bfe3f2eSlogwang static void
avp_dev_interrupt_handler(void * data)6632bfe3f2eSlogwang avp_dev_interrupt_handler(void *data)
6642bfe3f2eSlogwang {
6652bfe3f2eSlogwang 	struct rte_eth_dev *eth_dev = data;
6662bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
6672bfe3f2eSlogwang 	void *registers = pci_dev->mem_resource[RTE_AVP_PCI_MMIO_BAR].addr;
6682bfe3f2eSlogwang 	uint32_t status, value;
6692bfe3f2eSlogwang 	int ret;
6702bfe3f2eSlogwang 
6712bfe3f2eSlogwang 	if (registers == NULL)
6722bfe3f2eSlogwang 		rte_panic("no mapped MMIO register space\n");
6732bfe3f2eSlogwang 
6742bfe3f2eSlogwang 	/* read the interrupt status register
6752bfe3f2eSlogwang 	 * note: this register clears on read so all raised interrupts must be
6762bfe3f2eSlogwang 	 *    handled or remembered for later processing
6772bfe3f2eSlogwang 	 */
6782bfe3f2eSlogwang 	status = AVP_READ32(
6792bfe3f2eSlogwang 		RTE_PTR_ADD(registers,
6802bfe3f2eSlogwang 			    RTE_AVP_INTERRUPT_STATUS_OFFSET));
6812bfe3f2eSlogwang 
6822bfe3f2eSlogwang 	if (status & RTE_AVP_MIGRATION_INTERRUPT_MASK) {
6832bfe3f2eSlogwang 		/* handle interrupt based on current status */
6842bfe3f2eSlogwang 		value = AVP_READ32(
6852bfe3f2eSlogwang 			RTE_PTR_ADD(registers,
6862bfe3f2eSlogwang 				    RTE_AVP_MIGRATION_STATUS_OFFSET));
6872bfe3f2eSlogwang 		switch (value) {
6882bfe3f2eSlogwang 		case RTE_AVP_MIGRATION_DETACHED:
6892bfe3f2eSlogwang 			ret = avp_dev_detach(eth_dev);
6902bfe3f2eSlogwang 			break;
6912bfe3f2eSlogwang 		case RTE_AVP_MIGRATION_ATTACHED:
6922bfe3f2eSlogwang 			ret = avp_dev_attach(eth_dev);
6932bfe3f2eSlogwang 			break;
6942bfe3f2eSlogwang 		default:
6952bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "unexpected migration status, status=%u\n",
6962bfe3f2eSlogwang 				    value);
6972bfe3f2eSlogwang 			ret = -EINVAL;
6982bfe3f2eSlogwang 		}
6992bfe3f2eSlogwang 
7002bfe3f2eSlogwang 		/* acknowledge the request by writing out our current status */
7012bfe3f2eSlogwang 		value = (ret == 0 ? value : RTE_AVP_MIGRATION_ERROR);
7022bfe3f2eSlogwang 		AVP_WRITE32(value,
7032bfe3f2eSlogwang 			    RTE_PTR_ADD(registers,
7042bfe3f2eSlogwang 					RTE_AVP_MIGRATION_ACK_OFFSET));
7052bfe3f2eSlogwang 
7062bfe3f2eSlogwang 		PMD_DRV_LOG(NOTICE, "AVP migration interrupt handled\n");
7072bfe3f2eSlogwang 	}
7082bfe3f2eSlogwang 
7092bfe3f2eSlogwang 	if (status & ~RTE_AVP_MIGRATION_INTERRUPT_MASK)
7102bfe3f2eSlogwang 		PMD_DRV_LOG(WARNING, "AVP unexpected interrupt, status=0x%08x\n",
7112bfe3f2eSlogwang 			    status);
7122bfe3f2eSlogwang 
7132bfe3f2eSlogwang 	/* re-enable UIO interrupt handling */
7144418919fSjohnjiang 	ret = rte_intr_ack(&pci_dev->intr_handle);
7152bfe3f2eSlogwang 	if (ret < 0) {
7162bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to re-enable UIO interrupts, ret=%d\n",
7172bfe3f2eSlogwang 			    ret);
7182bfe3f2eSlogwang 		/* continue */
7192bfe3f2eSlogwang 	}
7202bfe3f2eSlogwang }
7212bfe3f2eSlogwang 
7222bfe3f2eSlogwang static int
avp_dev_enable_interrupts(struct rte_eth_dev * eth_dev)7232bfe3f2eSlogwang avp_dev_enable_interrupts(struct rte_eth_dev *eth_dev)
7242bfe3f2eSlogwang {
7252bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
7262bfe3f2eSlogwang 	void *registers = pci_dev->mem_resource[RTE_AVP_PCI_MMIO_BAR].addr;
7272bfe3f2eSlogwang 	int ret;
7282bfe3f2eSlogwang 
7292bfe3f2eSlogwang 	if (registers == NULL)
7302bfe3f2eSlogwang 		return -EINVAL;
7312bfe3f2eSlogwang 
7322bfe3f2eSlogwang 	/* enable UIO interrupt handling */
7332bfe3f2eSlogwang 	ret = rte_intr_enable(&pci_dev->intr_handle);
7342bfe3f2eSlogwang 	if (ret < 0) {
7352bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to enable UIO interrupts, ret=%d\n",
7362bfe3f2eSlogwang 			    ret);
7372bfe3f2eSlogwang 		return ret;
7382bfe3f2eSlogwang 	}
7392bfe3f2eSlogwang 
7402bfe3f2eSlogwang 	/* inform the device that all interrupts are enabled */
7412bfe3f2eSlogwang 	AVP_WRITE32(RTE_AVP_APP_INTERRUPTS_MASK,
7422bfe3f2eSlogwang 		    RTE_PTR_ADD(registers, RTE_AVP_INTERRUPT_MASK_OFFSET));
7432bfe3f2eSlogwang 
7442bfe3f2eSlogwang 	return 0;
7452bfe3f2eSlogwang }
7462bfe3f2eSlogwang 
7472bfe3f2eSlogwang static int
avp_dev_disable_interrupts(struct rte_eth_dev * eth_dev)7482bfe3f2eSlogwang avp_dev_disable_interrupts(struct rte_eth_dev *eth_dev)
7492bfe3f2eSlogwang {
7502bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
7512bfe3f2eSlogwang 	void *registers = pci_dev->mem_resource[RTE_AVP_PCI_MMIO_BAR].addr;
7522bfe3f2eSlogwang 	int ret;
7532bfe3f2eSlogwang 
7542bfe3f2eSlogwang 	if (registers == NULL)
7552bfe3f2eSlogwang 		return 0;
7562bfe3f2eSlogwang 
7572bfe3f2eSlogwang 	/* inform the device that all interrupts are disabled */
7582bfe3f2eSlogwang 	AVP_WRITE32(RTE_AVP_NO_INTERRUPTS_MASK,
7592bfe3f2eSlogwang 		    RTE_PTR_ADD(registers, RTE_AVP_INTERRUPT_MASK_OFFSET));
7602bfe3f2eSlogwang 
7612bfe3f2eSlogwang 	/* enable UIO interrupt handling */
7622bfe3f2eSlogwang 	ret = rte_intr_disable(&pci_dev->intr_handle);
7632bfe3f2eSlogwang 	if (ret < 0) {
7642bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to disable UIO interrupts, ret=%d\n",
7652bfe3f2eSlogwang 			    ret);
7662bfe3f2eSlogwang 		return ret;
7672bfe3f2eSlogwang 	}
7682bfe3f2eSlogwang 
7692bfe3f2eSlogwang 	return 0;
7702bfe3f2eSlogwang }
7712bfe3f2eSlogwang 
7722bfe3f2eSlogwang static int
avp_dev_setup_interrupts(struct rte_eth_dev * eth_dev)7732bfe3f2eSlogwang avp_dev_setup_interrupts(struct rte_eth_dev *eth_dev)
7742bfe3f2eSlogwang {
7752bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
7762bfe3f2eSlogwang 	int ret;
7772bfe3f2eSlogwang 
7782bfe3f2eSlogwang 	/* register a callback handler with UIO for interrupt notifications */
7792bfe3f2eSlogwang 	ret = rte_intr_callback_register(&pci_dev->intr_handle,
7802bfe3f2eSlogwang 					 avp_dev_interrupt_handler,
7812bfe3f2eSlogwang 					 (void *)eth_dev);
7822bfe3f2eSlogwang 	if (ret < 0) {
7832bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to register UIO interrupt callback, ret=%d\n",
7842bfe3f2eSlogwang 			    ret);
7852bfe3f2eSlogwang 		return ret;
7862bfe3f2eSlogwang 	}
7872bfe3f2eSlogwang 
7882bfe3f2eSlogwang 	/* enable interrupt processing */
7892bfe3f2eSlogwang 	return avp_dev_enable_interrupts(eth_dev);
7902bfe3f2eSlogwang }
7912bfe3f2eSlogwang 
7922bfe3f2eSlogwang static int
avp_dev_migration_pending(struct rte_eth_dev * eth_dev)7932bfe3f2eSlogwang avp_dev_migration_pending(struct rte_eth_dev *eth_dev)
7942bfe3f2eSlogwang {
7952bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
7962bfe3f2eSlogwang 	void *registers = pci_dev->mem_resource[RTE_AVP_PCI_MMIO_BAR].addr;
7972bfe3f2eSlogwang 	uint32_t value;
7982bfe3f2eSlogwang 
7992bfe3f2eSlogwang 	if (registers == NULL)
8002bfe3f2eSlogwang 		return 0;
8012bfe3f2eSlogwang 
8022bfe3f2eSlogwang 	value = AVP_READ32(RTE_PTR_ADD(registers,
8032bfe3f2eSlogwang 				       RTE_AVP_MIGRATION_STATUS_OFFSET));
8042bfe3f2eSlogwang 	if (value == RTE_AVP_MIGRATION_DETACHED) {
8052bfe3f2eSlogwang 		/* migration is in progress; ack it if we have not already */
8062bfe3f2eSlogwang 		AVP_WRITE32(value,
8072bfe3f2eSlogwang 			    RTE_PTR_ADD(registers,
8082bfe3f2eSlogwang 					RTE_AVP_MIGRATION_ACK_OFFSET));
8092bfe3f2eSlogwang 		return 1;
8102bfe3f2eSlogwang 	}
8112bfe3f2eSlogwang 	return 0;
8122bfe3f2eSlogwang }
8132bfe3f2eSlogwang 
8142bfe3f2eSlogwang /*
8152bfe3f2eSlogwang  * create a AVP device using the supplied device info by first translating it
8162bfe3f2eSlogwang  * to guest address space(s).
8172bfe3f2eSlogwang  */
8182bfe3f2eSlogwang static int
avp_dev_create(struct rte_pci_device * pci_dev,struct rte_eth_dev * eth_dev)8192bfe3f2eSlogwang avp_dev_create(struct rte_pci_device *pci_dev,
8202bfe3f2eSlogwang 	       struct rte_eth_dev *eth_dev)
8212bfe3f2eSlogwang {
8222bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
8232bfe3f2eSlogwang 	struct rte_avp_device_info *host_info;
8242bfe3f2eSlogwang 	struct rte_mem_resource *resource;
8252bfe3f2eSlogwang 	unsigned int i;
8262bfe3f2eSlogwang 
8272bfe3f2eSlogwang 	resource = &pci_dev->mem_resource[RTE_AVP_PCI_DEVICE_BAR];
8282bfe3f2eSlogwang 	if (resource->addr == NULL) {
8292bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "BAR%u is not mapped\n",
8302bfe3f2eSlogwang 			    RTE_AVP_PCI_DEVICE_BAR);
8312bfe3f2eSlogwang 		return -EFAULT;
8322bfe3f2eSlogwang 	}
8332bfe3f2eSlogwang 	host_info = (struct rte_avp_device_info *)resource->addr;
8342bfe3f2eSlogwang 
8352bfe3f2eSlogwang 	if ((host_info->magic != RTE_AVP_DEVICE_MAGIC) ||
8362bfe3f2eSlogwang 		avp_dev_version_check(host_info->version)) {
8372bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Invalid AVP PCI device, magic 0x%08x version 0x%08x > 0x%08x\n",
8382bfe3f2eSlogwang 			    host_info->magic, host_info->version,
8392bfe3f2eSlogwang 			    AVP_DPDK_DRIVER_VERSION);
8402bfe3f2eSlogwang 		return -EINVAL;
8412bfe3f2eSlogwang 	}
8422bfe3f2eSlogwang 
8432bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host device is v%u.%u.%u\n",
8442bfe3f2eSlogwang 		    RTE_AVP_GET_RELEASE_VERSION(host_info->version),
8452bfe3f2eSlogwang 		    RTE_AVP_GET_MAJOR_VERSION(host_info->version),
8462bfe3f2eSlogwang 		    RTE_AVP_GET_MINOR_VERSION(host_info->version));
8472bfe3f2eSlogwang 
8482bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host supports %u to %u TX queue(s)\n",
8492bfe3f2eSlogwang 		    host_info->min_tx_queues, host_info->max_tx_queues);
8502bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host supports %u to %u RX queue(s)\n",
8512bfe3f2eSlogwang 		    host_info->min_rx_queues, host_info->max_rx_queues);
8522bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host supports features 0x%08x\n",
8532bfe3f2eSlogwang 		    host_info->features);
8542bfe3f2eSlogwang 
8552bfe3f2eSlogwang 	if (avp->magic != AVP_ETHDEV_MAGIC) {
8562bfe3f2eSlogwang 		/*
8572bfe3f2eSlogwang 		 * First time initialization (i.e., not during a VM
8582bfe3f2eSlogwang 		 * migration)
8592bfe3f2eSlogwang 		 */
8602bfe3f2eSlogwang 		memset(avp, 0, sizeof(*avp));
8612bfe3f2eSlogwang 		avp->magic = AVP_ETHDEV_MAGIC;
8622bfe3f2eSlogwang 		avp->dev_data = eth_dev->data;
8632bfe3f2eSlogwang 		avp->port_id = eth_dev->data->port_id;
8642bfe3f2eSlogwang 		avp->host_mbuf_size = host_info->mbuf_size;
8652bfe3f2eSlogwang 		avp->host_features = host_info->features;
8662bfe3f2eSlogwang 		rte_spinlock_init(&avp->lock);
8672bfe3f2eSlogwang 		memcpy(&avp->ethaddr.addr_bytes[0],
8684418919fSjohnjiang 		       host_info->ethaddr, RTE_ETHER_ADDR_LEN);
8692bfe3f2eSlogwang 		/* adjust max values to not exceed our max */
8702bfe3f2eSlogwang 		avp->max_tx_queues =
8712bfe3f2eSlogwang 			RTE_MIN(host_info->max_tx_queues, RTE_AVP_MAX_QUEUES);
8722bfe3f2eSlogwang 		avp->max_rx_queues =
8732bfe3f2eSlogwang 			RTE_MIN(host_info->max_rx_queues, RTE_AVP_MAX_QUEUES);
8742bfe3f2eSlogwang 	} else {
8752bfe3f2eSlogwang 		/* Re-attaching during migration */
8762bfe3f2eSlogwang 
8772bfe3f2eSlogwang 		/* TODO... requires validation of host values */
8782bfe3f2eSlogwang 		if ((host_info->features & avp->features) != avp->features) {
8792bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "AVP host features mismatched; 0x%08x, host=0x%08x\n",
8802bfe3f2eSlogwang 				    avp->features, host_info->features);
8812bfe3f2eSlogwang 			/* this should not be possible; continue for now */
8822bfe3f2eSlogwang 		}
8832bfe3f2eSlogwang 	}
8842bfe3f2eSlogwang 
8852bfe3f2eSlogwang 	/* the device id is allowed to change over migrations */
8862bfe3f2eSlogwang 	avp->device_id = host_info->device_id;
8872bfe3f2eSlogwang 
8882bfe3f2eSlogwang 	/* translate incoming host addresses to guest address space */
8892bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP first host tx queue at 0x%" PRIx64 "\n",
8902bfe3f2eSlogwang 		    host_info->tx_phys);
8912bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP first host alloc queue at 0x%" PRIx64 "\n",
8922bfe3f2eSlogwang 		    host_info->alloc_phys);
8932bfe3f2eSlogwang 	for (i = 0; i < avp->max_tx_queues; i++) {
8942bfe3f2eSlogwang 		avp->tx_q[i] = avp_dev_translate_address(eth_dev,
8952bfe3f2eSlogwang 			host_info->tx_phys + (i * host_info->tx_size));
8962bfe3f2eSlogwang 
8972bfe3f2eSlogwang 		avp->alloc_q[i] = avp_dev_translate_address(eth_dev,
8982bfe3f2eSlogwang 			host_info->alloc_phys + (i * host_info->alloc_size));
8992bfe3f2eSlogwang 	}
9002bfe3f2eSlogwang 
9012bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP first host rx queue at 0x%" PRIx64 "\n",
9022bfe3f2eSlogwang 		    host_info->rx_phys);
9032bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP first host free queue at 0x%" PRIx64 "\n",
9042bfe3f2eSlogwang 		    host_info->free_phys);
9052bfe3f2eSlogwang 	for (i = 0; i < avp->max_rx_queues; i++) {
9062bfe3f2eSlogwang 		avp->rx_q[i] = avp_dev_translate_address(eth_dev,
9072bfe3f2eSlogwang 			host_info->rx_phys + (i * host_info->rx_size));
9082bfe3f2eSlogwang 		avp->free_q[i] = avp_dev_translate_address(eth_dev,
9092bfe3f2eSlogwang 			host_info->free_phys + (i * host_info->free_size));
9102bfe3f2eSlogwang 	}
9112bfe3f2eSlogwang 
9122bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host request queue at 0x%" PRIx64 "\n",
9132bfe3f2eSlogwang 		    host_info->req_phys);
9142bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host response queue at 0x%" PRIx64 "\n",
9152bfe3f2eSlogwang 		    host_info->resp_phys);
9162bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host sync address at 0x%" PRIx64 "\n",
9172bfe3f2eSlogwang 		    host_info->sync_phys);
9182bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host mbuf address at 0x%" PRIx64 "\n",
9192bfe3f2eSlogwang 		    host_info->mbuf_phys);
9202bfe3f2eSlogwang 	avp->req_q = avp_dev_translate_address(eth_dev, host_info->req_phys);
9212bfe3f2eSlogwang 	avp->resp_q = avp_dev_translate_address(eth_dev, host_info->resp_phys);
9222bfe3f2eSlogwang 	avp->sync_addr =
9232bfe3f2eSlogwang 		avp_dev_translate_address(eth_dev, host_info->sync_phys);
9242bfe3f2eSlogwang 	avp->mbuf_addr =
9252bfe3f2eSlogwang 		avp_dev_translate_address(eth_dev, host_info->mbuf_phys);
9262bfe3f2eSlogwang 
9272bfe3f2eSlogwang 	/*
9282bfe3f2eSlogwang 	 * store the host mbuf virtual address so that we can calculate
9292bfe3f2eSlogwang 	 * relative offsets for each mbuf as they are processed
9302bfe3f2eSlogwang 	 */
9312bfe3f2eSlogwang 	avp->host_mbuf_addr = host_info->mbuf_va;
9322bfe3f2eSlogwang 	avp->host_sync_addr = host_info->sync_va;
9332bfe3f2eSlogwang 
9342bfe3f2eSlogwang 	/*
9352bfe3f2eSlogwang 	 * store the maximum packet length that is supported by the host.
9362bfe3f2eSlogwang 	 */
9372bfe3f2eSlogwang 	avp->max_rx_pkt_len = host_info->max_rx_pkt_len;
9382bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP host max receive packet length is %u\n",
9392bfe3f2eSlogwang 				host_info->max_rx_pkt_len);
9402bfe3f2eSlogwang 
9412bfe3f2eSlogwang 	return 0;
9422bfe3f2eSlogwang }
9432bfe3f2eSlogwang 
9442bfe3f2eSlogwang /*
9452bfe3f2eSlogwang  * This function is based on probe() function in avp_pci.c
9462bfe3f2eSlogwang  * It returns 0 on success.
9472bfe3f2eSlogwang  */
9482bfe3f2eSlogwang static int
eth_avp_dev_init(struct rte_eth_dev * eth_dev)9492bfe3f2eSlogwang eth_avp_dev_init(struct rte_eth_dev *eth_dev)
9502bfe3f2eSlogwang {
9512bfe3f2eSlogwang 	struct avp_dev *avp =
9522bfe3f2eSlogwang 		AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
9532bfe3f2eSlogwang 	struct rte_pci_device *pci_dev;
9542bfe3f2eSlogwang 	int ret;
9552bfe3f2eSlogwang 
9562bfe3f2eSlogwang 	pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
9572bfe3f2eSlogwang 	eth_dev->dev_ops = &avp_eth_dev_ops;
9582bfe3f2eSlogwang 	eth_dev->rx_pkt_burst = &avp_recv_pkts;
9592bfe3f2eSlogwang 	eth_dev->tx_pkt_burst = &avp_xmit_pkts;
9602bfe3f2eSlogwang 
9612bfe3f2eSlogwang 	if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
9622bfe3f2eSlogwang 		/*
9632bfe3f2eSlogwang 		 * no setup required on secondary processes.  All data is saved
9642bfe3f2eSlogwang 		 * in dev_private by the primary process. All resource should
9652bfe3f2eSlogwang 		 * be mapped to the same virtual address so all pointers should
9662bfe3f2eSlogwang 		 * be valid.
9672bfe3f2eSlogwang 		 */
9682bfe3f2eSlogwang 		if (eth_dev->data->scattered_rx) {
9692bfe3f2eSlogwang 			PMD_DRV_LOG(NOTICE, "AVP device configured for chained mbufs\n");
9702bfe3f2eSlogwang 			eth_dev->rx_pkt_burst = avp_recv_scattered_pkts;
9712bfe3f2eSlogwang 			eth_dev->tx_pkt_burst = avp_xmit_scattered_pkts;
9722bfe3f2eSlogwang 		}
9732bfe3f2eSlogwang 		return 0;
9742bfe3f2eSlogwang 	}
9752bfe3f2eSlogwang 
9762bfe3f2eSlogwang 	rte_eth_copy_pci_info(eth_dev, pci_dev);
977*2d9fd380Sjfb8856606 	eth_dev->data->dev_flags |= RTE_ETH_DEV_AUTOFILL_QUEUE_XSTATS;
9782bfe3f2eSlogwang 
9792bfe3f2eSlogwang 	/* Check current migration status */
9802bfe3f2eSlogwang 	if (avp_dev_migration_pending(eth_dev)) {
9812bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "VM live migration operation in progress\n");
9822bfe3f2eSlogwang 		return -EBUSY;
9832bfe3f2eSlogwang 	}
9842bfe3f2eSlogwang 
9852bfe3f2eSlogwang 	/* Check BAR resources */
9862bfe3f2eSlogwang 	ret = avp_dev_check_regions(eth_dev);
9872bfe3f2eSlogwang 	if (ret < 0) {
9882bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to validate BAR resources, ret=%d\n",
9892bfe3f2eSlogwang 			    ret);
9902bfe3f2eSlogwang 		return ret;
9912bfe3f2eSlogwang 	}
9922bfe3f2eSlogwang 
9932bfe3f2eSlogwang 	/* Enable interrupts */
9942bfe3f2eSlogwang 	ret = avp_dev_setup_interrupts(eth_dev);
9952bfe3f2eSlogwang 	if (ret < 0) {
9962bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to enable interrupts, ret=%d\n", ret);
9972bfe3f2eSlogwang 		return ret;
9982bfe3f2eSlogwang 	}
9992bfe3f2eSlogwang 
10002bfe3f2eSlogwang 	/* Handle each subtype */
10012bfe3f2eSlogwang 	ret = avp_dev_create(pci_dev, eth_dev);
10022bfe3f2eSlogwang 	if (ret < 0) {
10032bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to create device, ret=%d\n", ret);
10042bfe3f2eSlogwang 		return ret;
10052bfe3f2eSlogwang 	}
10062bfe3f2eSlogwang 
10072bfe3f2eSlogwang 	/* Allocate memory for storing MAC addresses */
10084418919fSjohnjiang 	eth_dev->data->mac_addrs = rte_zmalloc("avp_ethdev",
10094418919fSjohnjiang 					RTE_ETHER_ADDR_LEN, 0);
10102bfe3f2eSlogwang 	if (eth_dev->data->mac_addrs == NULL) {
10112bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to allocate %d bytes needed to store MAC addresses\n",
10124418919fSjohnjiang 			    RTE_ETHER_ADDR_LEN);
10132bfe3f2eSlogwang 		return -ENOMEM;
10142bfe3f2eSlogwang 	}
10152bfe3f2eSlogwang 
10162bfe3f2eSlogwang 	/* Get a mac from device config */
10174418919fSjohnjiang 	rte_ether_addr_copy(&avp->ethaddr, &eth_dev->data->mac_addrs[0]);
10182bfe3f2eSlogwang 
10192bfe3f2eSlogwang 	return 0;
10202bfe3f2eSlogwang }
10212bfe3f2eSlogwang 
10222bfe3f2eSlogwang static int
eth_avp_dev_uninit(struct rte_eth_dev * eth_dev)10232bfe3f2eSlogwang eth_avp_dev_uninit(struct rte_eth_dev *eth_dev)
10242bfe3f2eSlogwang {
10252bfe3f2eSlogwang 	if (rte_eal_process_type() != RTE_PROC_PRIMARY)
10262bfe3f2eSlogwang 		return -EPERM;
10272bfe3f2eSlogwang 
10282bfe3f2eSlogwang 	if (eth_dev->data == NULL)
10292bfe3f2eSlogwang 		return 0;
10302bfe3f2eSlogwang 
10314418919fSjohnjiang 	avp_dev_close(eth_dev);
10322bfe3f2eSlogwang 
10332bfe3f2eSlogwang 	return 0;
10342bfe3f2eSlogwang }
10352bfe3f2eSlogwang 
10362bfe3f2eSlogwang static int
eth_avp_pci_probe(struct rte_pci_driver * pci_drv __rte_unused,struct rte_pci_device * pci_dev)10372bfe3f2eSlogwang eth_avp_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
10382bfe3f2eSlogwang 		  struct rte_pci_device *pci_dev)
10392bfe3f2eSlogwang {
1040d30ea906Sjfb8856606 	return rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct avp_adapter),
1041d30ea906Sjfb8856606 			eth_avp_dev_init);
10422bfe3f2eSlogwang }
10432bfe3f2eSlogwang 
10442bfe3f2eSlogwang static int
eth_avp_pci_remove(struct rte_pci_device * pci_dev)10452bfe3f2eSlogwang eth_avp_pci_remove(struct rte_pci_device *pci_dev)
10462bfe3f2eSlogwang {
10472bfe3f2eSlogwang 	return rte_eth_dev_pci_generic_remove(pci_dev,
10482bfe3f2eSlogwang 					      eth_avp_dev_uninit);
10492bfe3f2eSlogwang }
10502bfe3f2eSlogwang 
10512bfe3f2eSlogwang static struct rte_pci_driver rte_avp_pmd = {
10522bfe3f2eSlogwang 	.id_table = pci_id_avp_map,
10532bfe3f2eSlogwang 	.drv_flags = RTE_PCI_DRV_NEED_MAPPING,
10542bfe3f2eSlogwang 	.probe = eth_avp_pci_probe,
10552bfe3f2eSlogwang 	.remove = eth_avp_pci_remove,
10562bfe3f2eSlogwang };
10572bfe3f2eSlogwang 
10582bfe3f2eSlogwang static int
avp_dev_enable_scattered(struct rte_eth_dev * eth_dev,struct avp_dev * avp)10592bfe3f2eSlogwang avp_dev_enable_scattered(struct rte_eth_dev *eth_dev,
10602bfe3f2eSlogwang 			 struct avp_dev *avp)
10612bfe3f2eSlogwang {
10622bfe3f2eSlogwang 	unsigned int max_rx_pkt_len;
10632bfe3f2eSlogwang 
10642bfe3f2eSlogwang 	max_rx_pkt_len = eth_dev->data->dev_conf.rxmode.max_rx_pkt_len;
10652bfe3f2eSlogwang 
10662bfe3f2eSlogwang 	if ((max_rx_pkt_len > avp->guest_mbuf_size) ||
10672bfe3f2eSlogwang 	    (max_rx_pkt_len > avp->host_mbuf_size)) {
10682bfe3f2eSlogwang 		/*
10692bfe3f2eSlogwang 		 * If the guest MTU is greater than either the host or guest
10702bfe3f2eSlogwang 		 * buffers then chained mbufs have to be enabled in the TX
10712bfe3f2eSlogwang 		 * direction.  It is assumed that the application will not need
10722bfe3f2eSlogwang 		 * to send packets larger than their max_rx_pkt_len (MRU).
10732bfe3f2eSlogwang 		 */
10742bfe3f2eSlogwang 		return 1;
10752bfe3f2eSlogwang 	}
10762bfe3f2eSlogwang 
10772bfe3f2eSlogwang 	if ((avp->max_rx_pkt_len > avp->guest_mbuf_size) ||
10782bfe3f2eSlogwang 	    (avp->max_rx_pkt_len > avp->host_mbuf_size)) {
10792bfe3f2eSlogwang 		/*
10802bfe3f2eSlogwang 		 * If the host MRU is greater than its own mbuf size or the
10812bfe3f2eSlogwang 		 * guest mbuf size then chained mbufs have to be enabled in the
10822bfe3f2eSlogwang 		 * RX direction.
10832bfe3f2eSlogwang 		 */
10842bfe3f2eSlogwang 		return 1;
10852bfe3f2eSlogwang 	}
10862bfe3f2eSlogwang 
10872bfe3f2eSlogwang 	return 0;
10882bfe3f2eSlogwang }
10892bfe3f2eSlogwang 
10902bfe3f2eSlogwang static int
avp_dev_rx_queue_setup(struct rte_eth_dev * eth_dev,uint16_t rx_queue_id,uint16_t nb_rx_desc,unsigned int socket_id,const struct rte_eth_rxconf * rx_conf,struct rte_mempool * pool)10912bfe3f2eSlogwang avp_dev_rx_queue_setup(struct rte_eth_dev *eth_dev,
10922bfe3f2eSlogwang 		       uint16_t rx_queue_id,
10932bfe3f2eSlogwang 		       uint16_t nb_rx_desc,
10942bfe3f2eSlogwang 		       unsigned int socket_id,
10952bfe3f2eSlogwang 		       const struct rte_eth_rxconf *rx_conf,
10962bfe3f2eSlogwang 		       struct rte_mempool *pool)
10972bfe3f2eSlogwang {
10982bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
10992bfe3f2eSlogwang 	struct rte_pktmbuf_pool_private *mbp_priv;
11002bfe3f2eSlogwang 	struct avp_queue *rxq;
11012bfe3f2eSlogwang 
11022bfe3f2eSlogwang 	if (rx_queue_id >= eth_dev->data->nb_rx_queues) {
11032bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "RX queue id is out of range: rx_queue_id=%u, nb_rx_queues=%u\n",
11042bfe3f2eSlogwang 			    rx_queue_id, eth_dev->data->nb_rx_queues);
11052bfe3f2eSlogwang 		return -EINVAL;
11062bfe3f2eSlogwang 	}
11072bfe3f2eSlogwang 
11082bfe3f2eSlogwang 	/* Save mbuf pool pointer */
11092bfe3f2eSlogwang 	avp->pool = pool;
11102bfe3f2eSlogwang 
11112bfe3f2eSlogwang 	/* Save the local mbuf size */
11122bfe3f2eSlogwang 	mbp_priv = rte_mempool_get_priv(pool);
11132bfe3f2eSlogwang 	avp->guest_mbuf_size = (uint16_t)(mbp_priv->mbuf_data_room_size);
11142bfe3f2eSlogwang 	avp->guest_mbuf_size -= RTE_PKTMBUF_HEADROOM;
11152bfe3f2eSlogwang 
11162bfe3f2eSlogwang 	if (avp_dev_enable_scattered(eth_dev, avp)) {
11172bfe3f2eSlogwang 		if (!eth_dev->data->scattered_rx) {
11182bfe3f2eSlogwang 			PMD_DRV_LOG(NOTICE, "AVP device configured for chained mbufs\n");
11192bfe3f2eSlogwang 			eth_dev->data->scattered_rx = 1;
11202bfe3f2eSlogwang 			eth_dev->rx_pkt_burst = avp_recv_scattered_pkts;
11212bfe3f2eSlogwang 			eth_dev->tx_pkt_burst = avp_xmit_scattered_pkts;
11222bfe3f2eSlogwang 		}
11232bfe3f2eSlogwang 	}
11242bfe3f2eSlogwang 
11252bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "AVP max_rx_pkt_len=(%u,%u) mbuf_size=(%u,%u)\n",
11262bfe3f2eSlogwang 		    avp->max_rx_pkt_len,
11272bfe3f2eSlogwang 		    eth_dev->data->dev_conf.rxmode.max_rx_pkt_len,
11282bfe3f2eSlogwang 		    avp->host_mbuf_size,
11292bfe3f2eSlogwang 		    avp->guest_mbuf_size);
11302bfe3f2eSlogwang 
11312bfe3f2eSlogwang 	/* allocate a queue object */
11322bfe3f2eSlogwang 	rxq = rte_zmalloc_socket("ethdev RX queue", sizeof(struct avp_queue),
11332bfe3f2eSlogwang 				 RTE_CACHE_LINE_SIZE, socket_id);
11342bfe3f2eSlogwang 	if (rxq == NULL) {
11352bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to allocate new Rx queue object\n");
11362bfe3f2eSlogwang 		return -ENOMEM;
11372bfe3f2eSlogwang 	}
11382bfe3f2eSlogwang 
11392bfe3f2eSlogwang 	/* save back pointers to AVP and Ethernet devices */
11402bfe3f2eSlogwang 	rxq->avp = avp;
11412bfe3f2eSlogwang 	rxq->dev_data = eth_dev->data;
11422bfe3f2eSlogwang 	eth_dev->data->rx_queues[rx_queue_id] = (void *)rxq;
11432bfe3f2eSlogwang 
11442bfe3f2eSlogwang 	/* setup the queue receive mapping for the current queue. */
11452bfe3f2eSlogwang 	_avp_set_rx_queue_mappings(eth_dev, rx_queue_id);
11462bfe3f2eSlogwang 
11472bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "Rx queue %u setup at %p\n", rx_queue_id, rxq);
11482bfe3f2eSlogwang 
11492bfe3f2eSlogwang 	(void)nb_rx_desc;
11502bfe3f2eSlogwang 	(void)rx_conf;
11512bfe3f2eSlogwang 	return 0;
11522bfe3f2eSlogwang }
11532bfe3f2eSlogwang 
11542bfe3f2eSlogwang static int
avp_dev_tx_queue_setup(struct rte_eth_dev * eth_dev,uint16_t tx_queue_id,uint16_t nb_tx_desc,unsigned int socket_id,const struct rte_eth_txconf * tx_conf)11552bfe3f2eSlogwang avp_dev_tx_queue_setup(struct rte_eth_dev *eth_dev,
11562bfe3f2eSlogwang 		       uint16_t tx_queue_id,
11572bfe3f2eSlogwang 		       uint16_t nb_tx_desc,
11582bfe3f2eSlogwang 		       unsigned int socket_id,
11592bfe3f2eSlogwang 		       const struct rte_eth_txconf *tx_conf)
11602bfe3f2eSlogwang {
11612bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
11622bfe3f2eSlogwang 	struct avp_queue *txq;
11632bfe3f2eSlogwang 
11642bfe3f2eSlogwang 	if (tx_queue_id >= eth_dev->data->nb_tx_queues) {
11652bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "TX queue id is out of range: tx_queue_id=%u, nb_tx_queues=%u\n",
11662bfe3f2eSlogwang 			    tx_queue_id, eth_dev->data->nb_tx_queues);
11672bfe3f2eSlogwang 		return -EINVAL;
11682bfe3f2eSlogwang 	}
11692bfe3f2eSlogwang 
11702bfe3f2eSlogwang 	/* allocate a queue object */
11712bfe3f2eSlogwang 	txq = rte_zmalloc_socket("ethdev TX queue", sizeof(struct avp_queue),
11722bfe3f2eSlogwang 				 RTE_CACHE_LINE_SIZE, socket_id);
11732bfe3f2eSlogwang 	if (txq == NULL) {
11742bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to allocate new Tx queue object\n");
11752bfe3f2eSlogwang 		return -ENOMEM;
11762bfe3f2eSlogwang 	}
11772bfe3f2eSlogwang 
11782bfe3f2eSlogwang 	/* only the configured set of transmit queues are used */
11792bfe3f2eSlogwang 	txq->queue_id = tx_queue_id;
11802bfe3f2eSlogwang 	txq->queue_base = tx_queue_id;
11812bfe3f2eSlogwang 	txq->queue_limit = tx_queue_id;
11822bfe3f2eSlogwang 
11832bfe3f2eSlogwang 	/* save back pointers to AVP and Ethernet devices */
11842bfe3f2eSlogwang 	txq->avp = avp;
11852bfe3f2eSlogwang 	txq->dev_data = eth_dev->data;
11862bfe3f2eSlogwang 	eth_dev->data->tx_queues[tx_queue_id] = (void *)txq;
11872bfe3f2eSlogwang 
11882bfe3f2eSlogwang 	PMD_DRV_LOG(DEBUG, "Tx queue %u setup at %p\n", tx_queue_id, txq);
11892bfe3f2eSlogwang 
11902bfe3f2eSlogwang 	(void)nb_tx_desc;
11912bfe3f2eSlogwang 	(void)tx_conf;
11922bfe3f2eSlogwang 	return 0;
11932bfe3f2eSlogwang }
11942bfe3f2eSlogwang 
11952bfe3f2eSlogwang static inline int
_avp_cmp_ether_addr(struct rte_ether_addr * a,struct rte_ether_addr * b)11964418919fSjohnjiang _avp_cmp_ether_addr(struct rte_ether_addr *a, struct rte_ether_addr *b)
11972bfe3f2eSlogwang {
11982bfe3f2eSlogwang 	uint16_t *_a = (uint16_t *)&a->addr_bytes[0];
11992bfe3f2eSlogwang 	uint16_t *_b = (uint16_t *)&b->addr_bytes[0];
12002bfe3f2eSlogwang 	return (_a[0] ^ _b[0]) | (_a[1] ^ _b[1]) | (_a[2] ^ _b[2]);
12012bfe3f2eSlogwang }
12022bfe3f2eSlogwang 
12032bfe3f2eSlogwang static inline int
_avp_mac_filter(struct avp_dev * avp,struct rte_mbuf * m)12042bfe3f2eSlogwang _avp_mac_filter(struct avp_dev *avp, struct rte_mbuf *m)
12052bfe3f2eSlogwang {
12064418919fSjohnjiang 	struct rte_ether_hdr *eth = rte_pktmbuf_mtod(m, struct rte_ether_hdr *);
12072bfe3f2eSlogwang 
12082bfe3f2eSlogwang 	if (likely(_avp_cmp_ether_addr(&avp->ethaddr, &eth->d_addr) == 0)) {
12092bfe3f2eSlogwang 		/* allow all packets destined to our address */
12102bfe3f2eSlogwang 		return 0;
12112bfe3f2eSlogwang 	}
12122bfe3f2eSlogwang 
12134418919fSjohnjiang 	if (likely(rte_is_broadcast_ether_addr(&eth->d_addr))) {
12142bfe3f2eSlogwang 		/* allow all broadcast packets */
12152bfe3f2eSlogwang 		return 0;
12162bfe3f2eSlogwang 	}
12172bfe3f2eSlogwang 
12184418919fSjohnjiang 	if (likely(rte_is_multicast_ether_addr(&eth->d_addr))) {
12192bfe3f2eSlogwang 		/* allow all multicast packets */
12202bfe3f2eSlogwang 		return 0;
12212bfe3f2eSlogwang 	}
12222bfe3f2eSlogwang 
12232bfe3f2eSlogwang 	if (avp->flags & AVP_F_PROMISC) {
12242bfe3f2eSlogwang 		/* allow all packets when in promiscuous mode */
12252bfe3f2eSlogwang 		return 0;
12262bfe3f2eSlogwang 	}
12272bfe3f2eSlogwang 
12282bfe3f2eSlogwang 	return -1;
12292bfe3f2eSlogwang }
12302bfe3f2eSlogwang 
12312bfe3f2eSlogwang #ifdef RTE_LIBRTE_AVP_DEBUG_BUFFERS
12322bfe3f2eSlogwang static inline void
__avp_dev_buffer_sanity_check(struct avp_dev * avp,struct rte_avp_desc * buf)12332bfe3f2eSlogwang __avp_dev_buffer_sanity_check(struct avp_dev *avp, struct rte_avp_desc *buf)
12342bfe3f2eSlogwang {
12352bfe3f2eSlogwang 	struct rte_avp_desc *first_buf;
12362bfe3f2eSlogwang 	struct rte_avp_desc *pkt_buf;
12372bfe3f2eSlogwang 	unsigned int pkt_len;
12382bfe3f2eSlogwang 	unsigned int nb_segs;
12392bfe3f2eSlogwang 	void *pkt_data;
12402bfe3f2eSlogwang 	unsigned int i;
12412bfe3f2eSlogwang 
12422bfe3f2eSlogwang 	first_buf = avp_dev_translate_buffer(avp, buf);
12432bfe3f2eSlogwang 
12442bfe3f2eSlogwang 	i = 0;
12452bfe3f2eSlogwang 	pkt_len = 0;
12462bfe3f2eSlogwang 	nb_segs = first_buf->nb_segs;
12472bfe3f2eSlogwang 	do {
12482bfe3f2eSlogwang 		/* Adjust pointers for guest addressing */
12492bfe3f2eSlogwang 		pkt_buf = avp_dev_translate_buffer(avp, buf);
12502bfe3f2eSlogwang 		if (pkt_buf == NULL)
12512bfe3f2eSlogwang 			rte_panic("bad buffer: segment %u has an invalid address %p\n",
12522bfe3f2eSlogwang 				  i, buf);
12532bfe3f2eSlogwang 		pkt_data = avp_dev_translate_buffer(avp, pkt_buf->data);
12542bfe3f2eSlogwang 		if (pkt_data == NULL)
12552bfe3f2eSlogwang 			rte_panic("bad buffer: segment %u has a NULL data pointer\n",
12562bfe3f2eSlogwang 				  i);
12572bfe3f2eSlogwang 		if (pkt_buf->data_len == 0)
12582bfe3f2eSlogwang 			rte_panic("bad buffer: segment %u has 0 data length\n",
12592bfe3f2eSlogwang 				  i);
12602bfe3f2eSlogwang 		pkt_len += pkt_buf->data_len;
12612bfe3f2eSlogwang 		nb_segs--;
12622bfe3f2eSlogwang 		i++;
12632bfe3f2eSlogwang 
12642bfe3f2eSlogwang 	} while (nb_segs && (buf = pkt_buf->next) != NULL);
12652bfe3f2eSlogwang 
12662bfe3f2eSlogwang 	if (nb_segs != 0)
12672bfe3f2eSlogwang 		rte_panic("bad buffer: expected %u segments found %u\n",
12682bfe3f2eSlogwang 			  first_buf->nb_segs, (first_buf->nb_segs - nb_segs));
12692bfe3f2eSlogwang 	if (pkt_len != first_buf->pkt_len)
12702bfe3f2eSlogwang 		rte_panic("bad buffer: expected length %u found %u\n",
12712bfe3f2eSlogwang 			  first_buf->pkt_len, pkt_len);
12722bfe3f2eSlogwang }
12732bfe3f2eSlogwang 
12742bfe3f2eSlogwang #define avp_dev_buffer_sanity_check(a, b) \
12752bfe3f2eSlogwang 	__avp_dev_buffer_sanity_check((a), (b))
12762bfe3f2eSlogwang 
12772bfe3f2eSlogwang #else /* RTE_LIBRTE_AVP_DEBUG_BUFFERS */
12782bfe3f2eSlogwang 
12792bfe3f2eSlogwang #define avp_dev_buffer_sanity_check(a, b) do {} while (0)
12802bfe3f2eSlogwang 
12812bfe3f2eSlogwang #endif
12822bfe3f2eSlogwang 
12832bfe3f2eSlogwang /*
12842bfe3f2eSlogwang  * Copy a host buffer chain to a set of mbufs.	This function assumes that
12852bfe3f2eSlogwang  * there exactly the required number of mbufs to copy all source bytes.
12862bfe3f2eSlogwang  */
12872bfe3f2eSlogwang static inline struct rte_mbuf *
avp_dev_copy_from_buffers(struct avp_dev * avp,struct rte_avp_desc * buf,struct rte_mbuf ** mbufs,unsigned int count)12882bfe3f2eSlogwang avp_dev_copy_from_buffers(struct avp_dev *avp,
12892bfe3f2eSlogwang 			  struct rte_avp_desc *buf,
12902bfe3f2eSlogwang 			  struct rte_mbuf **mbufs,
12912bfe3f2eSlogwang 			  unsigned int count)
12922bfe3f2eSlogwang {
12932bfe3f2eSlogwang 	struct rte_mbuf *m_previous = NULL;
12942bfe3f2eSlogwang 	struct rte_avp_desc *pkt_buf;
12952bfe3f2eSlogwang 	unsigned int total_length = 0;
12962bfe3f2eSlogwang 	unsigned int copy_length;
12972bfe3f2eSlogwang 	unsigned int src_offset;
12982bfe3f2eSlogwang 	struct rte_mbuf *m;
12992bfe3f2eSlogwang 	uint16_t ol_flags;
13002bfe3f2eSlogwang 	uint16_t vlan_tci;
13012bfe3f2eSlogwang 	void *pkt_data;
13022bfe3f2eSlogwang 	unsigned int i;
13032bfe3f2eSlogwang 
13042bfe3f2eSlogwang 	avp_dev_buffer_sanity_check(avp, buf);
13052bfe3f2eSlogwang 
13062bfe3f2eSlogwang 	/* setup the first source buffer */
13072bfe3f2eSlogwang 	pkt_buf = avp_dev_translate_buffer(avp, buf);
13082bfe3f2eSlogwang 	pkt_data = avp_dev_translate_buffer(avp, pkt_buf->data);
13092bfe3f2eSlogwang 	total_length = pkt_buf->pkt_len;
13102bfe3f2eSlogwang 	src_offset = 0;
13112bfe3f2eSlogwang 
13122bfe3f2eSlogwang 	if (pkt_buf->ol_flags & RTE_AVP_RX_VLAN_PKT) {
13132bfe3f2eSlogwang 		ol_flags = PKT_RX_VLAN;
13142bfe3f2eSlogwang 		vlan_tci = pkt_buf->vlan_tci;
13152bfe3f2eSlogwang 	} else {
13162bfe3f2eSlogwang 		ol_flags = 0;
13172bfe3f2eSlogwang 		vlan_tci = 0;
13182bfe3f2eSlogwang 	}
13192bfe3f2eSlogwang 
13202bfe3f2eSlogwang 	for (i = 0; (i < count) && (buf != NULL); i++) {
13212bfe3f2eSlogwang 		/* fill each destination buffer */
13222bfe3f2eSlogwang 		m = mbufs[i];
13232bfe3f2eSlogwang 
13242bfe3f2eSlogwang 		if (m_previous != NULL)
13252bfe3f2eSlogwang 			m_previous->next = m;
13262bfe3f2eSlogwang 
13272bfe3f2eSlogwang 		m_previous = m;
13282bfe3f2eSlogwang 
13292bfe3f2eSlogwang 		do {
13302bfe3f2eSlogwang 			/*
13312bfe3f2eSlogwang 			 * Copy as many source buffers as will fit in the
13322bfe3f2eSlogwang 			 * destination buffer.
13332bfe3f2eSlogwang 			 */
13342bfe3f2eSlogwang 			copy_length = RTE_MIN((avp->guest_mbuf_size -
13352bfe3f2eSlogwang 					       rte_pktmbuf_data_len(m)),
13362bfe3f2eSlogwang 					      (pkt_buf->data_len -
13372bfe3f2eSlogwang 					       src_offset));
13382bfe3f2eSlogwang 			rte_memcpy(RTE_PTR_ADD(rte_pktmbuf_mtod(m, void *),
13392bfe3f2eSlogwang 					       rte_pktmbuf_data_len(m)),
13402bfe3f2eSlogwang 				   RTE_PTR_ADD(pkt_data, src_offset),
13412bfe3f2eSlogwang 				   copy_length);
13422bfe3f2eSlogwang 			rte_pktmbuf_data_len(m) += copy_length;
13432bfe3f2eSlogwang 			src_offset += copy_length;
13442bfe3f2eSlogwang 
13452bfe3f2eSlogwang 			if (likely(src_offset == pkt_buf->data_len)) {
13462bfe3f2eSlogwang 				/* need a new source buffer */
13472bfe3f2eSlogwang 				buf = pkt_buf->next;
13482bfe3f2eSlogwang 				if (buf != NULL) {
13492bfe3f2eSlogwang 					pkt_buf = avp_dev_translate_buffer(
13502bfe3f2eSlogwang 						avp, buf);
13512bfe3f2eSlogwang 					pkt_data = avp_dev_translate_buffer(
13522bfe3f2eSlogwang 						avp, pkt_buf->data);
13532bfe3f2eSlogwang 					src_offset = 0;
13542bfe3f2eSlogwang 				}
13552bfe3f2eSlogwang 			}
13562bfe3f2eSlogwang 
13572bfe3f2eSlogwang 			if (unlikely(rte_pktmbuf_data_len(m) ==
13582bfe3f2eSlogwang 				     avp->guest_mbuf_size)) {
13592bfe3f2eSlogwang 				/* need a new destination mbuf */
13602bfe3f2eSlogwang 				break;
13612bfe3f2eSlogwang 			}
13622bfe3f2eSlogwang 
13632bfe3f2eSlogwang 		} while (buf != NULL);
13642bfe3f2eSlogwang 	}
13652bfe3f2eSlogwang 
13662bfe3f2eSlogwang 	m = mbufs[0];
13672bfe3f2eSlogwang 	m->ol_flags = ol_flags;
13682bfe3f2eSlogwang 	m->nb_segs = count;
13692bfe3f2eSlogwang 	rte_pktmbuf_pkt_len(m) = total_length;
13702bfe3f2eSlogwang 	m->vlan_tci = vlan_tci;
13712bfe3f2eSlogwang 
13722bfe3f2eSlogwang 	__rte_mbuf_sanity_check(m, 1);
13732bfe3f2eSlogwang 
13742bfe3f2eSlogwang 	return m;
13752bfe3f2eSlogwang }
13762bfe3f2eSlogwang 
13772bfe3f2eSlogwang static uint16_t
avp_recv_scattered_pkts(void * rx_queue,struct rte_mbuf ** rx_pkts,uint16_t nb_pkts)13782bfe3f2eSlogwang avp_recv_scattered_pkts(void *rx_queue,
13792bfe3f2eSlogwang 			struct rte_mbuf **rx_pkts,
13802bfe3f2eSlogwang 			uint16_t nb_pkts)
13812bfe3f2eSlogwang {
13822bfe3f2eSlogwang 	struct avp_queue *rxq = (struct avp_queue *)rx_queue;
13832bfe3f2eSlogwang 	struct rte_avp_desc *avp_bufs[AVP_MAX_RX_BURST];
13842bfe3f2eSlogwang 	struct rte_mbuf *mbufs[RTE_AVP_MAX_MBUF_SEGMENTS];
13852bfe3f2eSlogwang 	struct avp_dev *avp = rxq->avp;
13862bfe3f2eSlogwang 	struct rte_avp_desc *pkt_buf;
13872bfe3f2eSlogwang 	struct rte_avp_fifo *free_q;
13882bfe3f2eSlogwang 	struct rte_avp_fifo *rx_q;
13892bfe3f2eSlogwang 	struct rte_avp_desc *buf;
13902bfe3f2eSlogwang 	unsigned int count, avail, n;
13912bfe3f2eSlogwang 	unsigned int guest_mbuf_size;
13922bfe3f2eSlogwang 	struct rte_mbuf *m;
13932bfe3f2eSlogwang 	unsigned int required;
13942bfe3f2eSlogwang 	unsigned int buf_len;
13952bfe3f2eSlogwang 	unsigned int port_id;
13962bfe3f2eSlogwang 	unsigned int i;
13972bfe3f2eSlogwang 
13982bfe3f2eSlogwang 	if (unlikely(avp->flags & AVP_F_DETACHED)) {
13992bfe3f2eSlogwang 		/* VM live migration in progress */
14002bfe3f2eSlogwang 		return 0;
14012bfe3f2eSlogwang 	}
14022bfe3f2eSlogwang 
14032bfe3f2eSlogwang 	guest_mbuf_size = avp->guest_mbuf_size;
14042bfe3f2eSlogwang 	port_id = avp->port_id;
14052bfe3f2eSlogwang 	rx_q = avp->rx_q[rxq->queue_id];
14062bfe3f2eSlogwang 	free_q = avp->free_q[rxq->queue_id];
14072bfe3f2eSlogwang 
14082bfe3f2eSlogwang 	/* setup next queue to service */
14092bfe3f2eSlogwang 	rxq->queue_id = (rxq->queue_id < rxq->queue_limit) ?
14102bfe3f2eSlogwang 		(rxq->queue_id + 1) : rxq->queue_base;
14112bfe3f2eSlogwang 
14122bfe3f2eSlogwang 	/* determine how many slots are available in the free queue */
14132bfe3f2eSlogwang 	count = avp_fifo_free_count(free_q);
14142bfe3f2eSlogwang 
14152bfe3f2eSlogwang 	/* determine how many packets are available in the rx queue */
14162bfe3f2eSlogwang 	avail = avp_fifo_count(rx_q);
14172bfe3f2eSlogwang 
14182bfe3f2eSlogwang 	/* determine how many packets can be received */
14192bfe3f2eSlogwang 	count = RTE_MIN(count, avail);
14202bfe3f2eSlogwang 	count = RTE_MIN(count, nb_pkts);
14212bfe3f2eSlogwang 	count = RTE_MIN(count, (unsigned int)AVP_MAX_RX_BURST);
14222bfe3f2eSlogwang 
14232bfe3f2eSlogwang 	if (unlikely(count == 0)) {
14242bfe3f2eSlogwang 		/* no free buffers, or no buffers on the rx queue */
14252bfe3f2eSlogwang 		return 0;
14262bfe3f2eSlogwang 	}
14272bfe3f2eSlogwang 
14282bfe3f2eSlogwang 	/* retrieve pending packets */
14292bfe3f2eSlogwang 	n = avp_fifo_get(rx_q, (void **)&avp_bufs, count);
14302bfe3f2eSlogwang 	PMD_RX_LOG(DEBUG, "Receiving %u packets from Rx queue at %p\n",
14312bfe3f2eSlogwang 		   count, rx_q);
14322bfe3f2eSlogwang 
14332bfe3f2eSlogwang 	count = 0;
14342bfe3f2eSlogwang 	for (i = 0; i < n; i++) {
14352bfe3f2eSlogwang 		/* prefetch next entry while processing current one */
14362bfe3f2eSlogwang 		if (i + 1 < n) {
14372bfe3f2eSlogwang 			pkt_buf = avp_dev_translate_buffer(avp,
14382bfe3f2eSlogwang 							   avp_bufs[i + 1]);
14392bfe3f2eSlogwang 			rte_prefetch0(pkt_buf);
14402bfe3f2eSlogwang 		}
14412bfe3f2eSlogwang 		buf = avp_bufs[i];
14422bfe3f2eSlogwang 
14432bfe3f2eSlogwang 		/* Peek into the first buffer to determine the total length */
14442bfe3f2eSlogwang 		pkt_buf = avp_dev_translate_buffer(avp, buf);
14452bfe3f2eSlogwang 		buf_len = pkt_buf->pkt_len;
14462bfe3f2eSlogwang 
14472bfe3f2eSlogwang 		/* Allocate enough mbufs to receive the entire packet */
14482bfe3f2eSlogwang 		required = (buf_len + guest_mbuf_size - 1) / guest_mbuf_size;
14492bfe3f2eSlogwang 		if (rte_pktmbuf_alloc_bulk(avp->pool, mbufs, required)) {
14502bfe3f2eSlogwang 			rxq->dev_data->rx_mbuf_alloc_failed++;
14512bfe3f2eSlogwang 			continue;
14522bfe3f2eSlogwang 		}
14532bfe3f2eSlogwang 
14542bfe3f2eSlogwang 		/* Copy the data from the buffers to our mbufs */
14552bfe3f2eSlogwang 		m = avp_dev_copy_from_buffers(avp, buf, mbufs, required);
14562bfe3f2eSlogwang 
14572bfe3f2eSlogwang 		/* finalize mbuf */
14582bfe3f2eSlogwang 		m->port = port_id;
14592bfe3f2eSlogwang 
14602bfe3f2eSlogwang 		if (_avp_mac_filter(avp, m) != 0) {
14612bfe3f2eSlogwang 			/* silently discard packets not destined to our MAC */
14622bfe3f2eSlogwang 			rte_pktmbuf_free(m);
14632bfe3f2eSlogwang 			continue;
14642bfe3f2eSlogwang 		}
14652bfe3f2eSlogwang 
14662bfe3f2eSlogwang 		/* return new mbuf to caller */
14672bfe3f2eSlogwang 		rx_pkts[count++] = m;
14682bfe3f2eSlogwang 		rxq->bytes += buf_len;
14692bfe3f2eSlogwang 	}
14702bfe3f2eSlogwang 
14712bfe3f2eSlogwang 	rxq->packets += count;
14722bfe3f2eSlogwang 
14732bfe3f2eSlogwang 	/* return the buffers to the free queue */
14742bfe3f2eSlogwang 	avp_fifo_put(free_q, (void **)&avp_bufs[0], n);
14752bfe3f2eSlogwang 
14762bfe3f2eSlogwang 	return count;
14772bfe3f2eSlogwang }
14782bfe3f2eSlogwang 
14792bfe3f2eSlogwang 
14802bfe3f2eSlogwang static uint16_t
avp_recv_pkts(void * rx_queue,struct rte_mbuf ** rx_pkts,uint16_t nb_pkts)14812bfe3f2eSlogwang avp_recv_pkts(void *rx_queue,
14822bfe3f2eSlogwang 	      struct rte_mbuf **rx_pkts,
14832bfe3f2eSlogwang 	      uint16_t nb_pkts)
14842bfe3f2eSlogwang {
14852bfe3f2eSlogwang 	struct avp_queue *rxq = (struct avp_queue *)rx_queue;
14862bfe3f2eSlogwang 	struct rte_avp_desc *avp_bufs[AVP_MAX_RX_BURST];
14872bfe3f2eSlogwang 	struct avp_dev *avp = rxq->avp;
14882bfe3f2eSlogwang 	struct rte_avp_desc *pkt_buf;
14892bfe3f2eSlogwang 	struct rte_avp_fifo *free_q;
14902bfe3f2eSlogwang 	struct rte_avp_fifo *rx_q;
14912bfe3f2eSlogwang 	unsigned int count, avail, n;
14922bfe3f2eSlogwang 	unsigned int pkt_len;
14932bfe3f2eSlogwang 	struct rte_mbuf *m;
14942bfe3f2eSlogwang 	char *pkt_data;
14952bfe3f2eSlogwang 	unsigned int i;
14962bfe3f2eSlogwang 
14972bfe3f2eSlogwang 	if (unlikely(avp->flags & AVP_F_DETACHED)) {
14982bfe3f2eSlogwang 		/* VM live migration in progress */
14992bfe3f2eSlogwang 		return 0;
15002bfe3f2eSlogwang 	}
15012bfe3f2eSlogwang 
15022bfe3f2eSlogwang 	rx_q = avp->rx_q[rxq->queue_id];
15032bfe3f2eSlogwang 	free_q = avp->free_q[rxq->queue_id];
15042bfe3f2eSlogwang 
15052bfe3f2eSlogwang 	/* setup next queue to service */
15062bfe3f2eSlogwang 	rxq->queue_id = (rxq->queue_id < rxq->queue_limit) ?
15072bfe3f2eSlogwang 		(rxq->queue_id + 1) : rxq->queue_base;
15082bfe3f2eSlogwang 
15092bfe3f2eSlogwang 	/* determine how many slots are available in the free queue */
15102bfe3f2eSlogwang 	count = avp_fifo_free_count(free_q);
15112bfe3f2eSlogwang 
15122bfe3f2eSlogwang 	/* determine how many packets are available in the rx queue */
15132bfe3f2eSlogwang 	avail = avp_fifo_count(rx_q);
15142bfe3f2eSlogwang 
15152bfe3f2eSlogwang 	/* determine how many packets can be received */
15162bfe3f2eSlogwang 	count = RTE_MIN(count, avail);
15172bfe3f2eSlogwang 	count = RTE_MIN(count, nb_pkts);
15182bfe3f2eSlogwang 	count = RTE_MIN(count, (unsigned int)AVP_MAX_RX_BURST);
15192bfe3f2eSlogwang 
15202bfe3f2eSlogwang 	if (unlikely(count == 0)) {
15212bfe3f2eSlogwang 		/* no free buffers, or no buffers on the rx queue */
15222bfe3f2eSlogwang 		return 0;
15232bfe3f2eSlogwang 	}
15242bfe3f2eSlogwang 
15252bfe3f2eSlogwang 	/* retrieve pending packets */
15262bfe3f2eSlogwang 	n = avp_fifo_get(rx_q, (void **)&avp_bufs, count);
15272bfe3f2eSlogwang 	PMD_RX_LOG(DEBUG, "Receiving %u packets from Rx queue at %p\n",
15282bfe3f2eSlogwang 		   count, rx_q);
15292bfe3f2eSlogwang 
15302bfe3f2eSlogwang 	count = 0;
15312bfe3f2eSlogwang 	for (i = 0; i < n; i++) {
15322bfe3f2eSlogwang 		/* prefetch next entry while processing current one */
15332bfe3f2eSlogwang 		if (i < n - 1) {
15342bfe3f2eSlogwang 			pkt_buf = avp_dev_translate_buffer(avp,
15352bfe3f2eSlogwang 							   avp_bufs[i + 1]);
15362bfe3f2eSlogwang 			rte_prefetch0(pkt_buf);
15372bfe3f2eSlogwang 		}
15382bfe3f2eSlogwang 
15392bfe3f2eSlogwang 		/* Adjust host pointers for guest addressing */
15402bfe3f2eSlogwang 		pkt_buf = avp_dev_translate_buffer(avp, avp_bufs[i]);
15412bfe3f2eSlogwang 		pkt_data = avp_dev_translate_buffer(avp, pkt_buf->data);
15422bfe3f2eSlogwang 		pkt_len = pkt_buf->pkt_len;
15432bfe3f2eSlogwang 
15442bfe3f2eSlogwang 		if (unlikely((pkt_len > avp->guest_mbuf_size) ||
15452bfe3f2eSlogwang 			     (pkt_buf->nb_segs > 1))) {
15462bfe3f2eSlogwang 			/*
15472bfe3f2eSlogwang 			 * application should be using the scattered receive
15482bfe3f2eSlogwang 			 * function
15492bfe3f2eSlogwang 			 */
15502bfe3f2eSlogwang 			rxq->errors++;
15512bfe3f2eSlogwang 			continue;
15522bfe3f2eSlogwang 		}
15532bfe3f2eSlogwang 
15542bfe3f2eSlogwang 		/* process each packet to be transmitted */
15552bfe3f2eSlogwang 		m = rte_pktmbuf_alloc(avp->pool);
15562bfe3f2eSlogwang 		if (unlikely(m == NULL)) {
15572bfe3f2eSlogwang 			rxq->dev_data->rx_mbuf_alloc_failed++;
15582bfe3f2eSlogwang 			continue;
15592bfe3f2eSlogwang 		}
15602bfe3f2eSlogwang 
15612bfe3f2eSlogwang 		/* copy data out of the host buffer to our buffer */
15622bfe3f2eSlogwang 		m->data_off = RTE_PKTMBUF_HEADROOM;
15632bfe3f2eSlogwang 		rte_memcpy(rte_pktmbuf_mtod(m, void *), pkt_data, pkt_len);
15642bfe3f2eSlogwang 
15652bfe3f2eSlogwang 		/* initialize the local mbuf */
15662bfe3f2eSlogwang 		rte_pktmbuf_data_len(m) = pkt_len;
15672bfe3f2eSlogwang 		rte_pktmbuf_pkt_len(m) = pkt_len;
15682bfe3f2eSlogwang 		m->port = avp->port_id;
15692bfe3f2eSlogwang 
15702bfe3f2eSlogwang 		if (pkt_buf->ol_flags & RTE_AVP_RX_VLAN_PKT) {
15712bfe3f2eSlogwang 			m->ol_flags = PKT_RX_VLAN;
15722bfe3f2eSlogwang 			m->vlan_tci = pkt_buf->vlan_tci;
15732bfe3f2eSlogwang 		}
15742bfe3f2eSlogwang 
15752bfe3f2eSlogwang 		if (_avp_mac_filter(avp, m) != 0) {
15762bfe3f2eSlogwang 			/* silently discard packets not destined to our MAC */
15772bfe3f2eSlogwang 			rte_pktmbuf_free(m);
15782bfe3f2eSlogwang 			continue;
15792bfe3f2eSlogwang 		}
15802bfe3f2eSlogwang 
15812bfe3f2eSlogwang 		/* return new mbuf to caller */
15822bfe3f2eSlogwang 		rx_pkts[count++] = m;
15832bfe3f2eSlogwang 		rxq->bytes += pkt_len;
15842bfe3f2eSlogwang 	}
15852bfe3f2eSlogwang 
15862bfe3f2eSlogwang 	rxq->packets += count;
15872bfe3f2eSlogwang 
15882bfe3f2eSlogwang 	/* return the buffers to the free queue */
15892bfe3f2eSlogwang 	avp_fifo_put(free_q, (void **)&avp_bufs[0], n);
15902bfe3f2eSlogwang 
15912bfe3f2eSlogwang 	return count;
15922bfe3f2eSlogwang }
15932bfe3f2eSlogwang 
15942bfe3f2eSlogwang /*
15952bfe3f2eSlogwang  * Copy a chained mbuf to a set of host buffers.  This function assumes that
15962bfe3f2eSlogwang  * there are sufficient destination buffers to contain the entire source
15972bfe3f2eSlogwang  * packet.
15982bfe3f2eSlogwang  */
15992bfe3f2eSlogwang static inline uint16_t
avp_dev_copy_to_buffers(struct avp_dev * avp,struct rte_mbuf * mbuf,struct rte_avp_desc ** buffers,unsigned int count)16002bfe3f2eSlogwang avp_dev_copy_to_buffers(struct avp_dev *avp,
16012bfe3f2eSlogwang 			struct rte_mbuf *mbuf,
16022bfe3f2eSlogwang 			struct rte_avp_desc **buffers,
16032bfe3f2eSlogwang 			unsigned int count)
16042bfe3f2eSlogwang {
16052bfe3f2eSlogwang 	struct rte_avp_desc *previous_buf = NULL;
16062bfe3f2eSlogwang 	struct rte_avp_desc *first_buf = NULL;
16072bfe3f2eSlogwang 	struct rte_avp_desc *pkt_buf;
16082bfe3f2eSlogwang 	struct rte_avp_desc *buf;
16092bfe3f2eSlogwang 	size_t total_length;
16102bfe3f2eSlogwang 	struct rte_mbuf *m;
16112bfe3f2eSlogwang 	size_t copy_length;
16122bfe3f2eSlogwang 	size_t src_offset;
16132bfe3f2eSlogwang 	char *pkt_data;
16142bfe3f2eSlogwang 	unsigned int i;
16152bfe3f2eSlogwang 
16162bfe3f2eSlogwang 	__rte_mbuf_sanity_check(mbuf, 1);
16172bfe3f2eSlogwang 
16182bfe3f2eSlogwang 	m = mbuf;
16192bfe3f2eSlogwang 	src_offset = 0;
16202bfe3f2eSlogwang 	total_length = rte_pktmbuf_pkt_len(m);
16212bfe3f2eSlogwang 	for (i = 0; (i < count) && (m != NULL); i++) {
16222bfe3f2eSlogwang 		/* fill each destination buffer */
16232bfe3f2eSlogwang 		buf = buffers[i];
16242bfe3f2eSlogwang 
16252bfe3f2eSlogwang 		if (i < count - 1) {
16262bfe3f2eSlogwang 			/* prefetch next entry while processing this one */
16272bfe3f2eSlogwang 			pkt_buf = avp_dev_translate_buffer(avp, buffers[i + 1]);
16282bfe3f2eSlogwang 			rte_prefetch0(pkt_buf);
16292bfe3f2eSlogwang 		}
16302bfe3f2eSlogwang 
16312bfe3f2eSlogwang 		/* Adjust pointers for guest addressing */
16322bfe3f2eSlogwang 		pkt_buf = avp_dev_translate_buffer(avp, buf);
16332bfe3f2eSlogwang 		pkt_data = avp_dev_translate_buffer(avp, pkt_buf->data);
16342bfe3f2eSlogwang 
16352bfe3f2eSlogwang 		/* setup the buffer chain */
16362bfe3f2eSlogwang 		if (previous_buf != NULL)
16372bfe3f2eSlogwang 			previous_buf->next = buf;
16382bfe3f2eSlogwang 		else
16392bfe3f2eSlogwang 			first_buf = pkt_buf;
16402bfe3f2eSlogwang 
16412bfe3f2eSlogwang 		previous_buf = pkt_buf;
16422bfe3f2eSlogwang 
16432bfe3f2eSlogwang 		do {
16442bfe3f2eSlogwang 			/*
16452bfe3f2eSlogwang 			 * copy as many source mbuf segments as will fit in the
16462bfe3f2eSlogwang 			 * destination buffer.
16472bfe3f2eSlogwang 			 */
16482bfe3f2eSlogwang 			copy_length = RTE_MIN((avp->host_mbuf_size -
16492bfe3f2eSlogwang 					       pkt_buf->data_len),
16502bfe3f2eSlogwang 					      (rte_pktmbuf_data_len(m) -
16512bfe3f2eSlogwang 					       src_offset));
16522bfe3f2eSlogwang 			rte_memcpy(RTE_PTR_ADD(pkt_data, pkt_buf->data_len),
16532bfe3f2eSlogwang 				   RTE_PTR_ADD(rte_pktmbuf_mtod(m, void *),
16542bfe3f2eSlogwang 					       src_offset),
16552bfe3f2eSlogwang 				   copy_length);
16562bfe3f2eSlogwang 			pkt_buf->data_len += copy_length;
16572bfe3f2eSlogwang 			src_offset += copy_length;
16582bfe3f2eSlogwang 
16592bfe3f2eSlogwang 			if (likely(src_offset == rte_pktmbuf_data_len(m))) {
16602bfe3f2eSlogwang 				/* need a new source buffer */
16612bfe3f2eSlogwang 				m = m->next;
16622bfe3f2eSlogwang 				src_offset = 0;
16632bfe3f2eSlogwang 			}
16642bfe3f2eSlogwang 
16652bfe3f2eSlogwang 			if (unlikely(pkt_buf->data_len ==
16662bfe3f2eSlogwang 				     avp->host_mbuf_size)) {
16672bfe3f2eSlogwang 				/* need a new destination buffer */
16682bfe3f2eSlogwang 				break;
16692bfe3f2eSlogwang 			}
16702bfe3f2eSlogwang 
16712bfe3f2eSlogwang 		} while (m != NULL);
16722bfe3f2eSlogwang 	}
16732bfe3f2eSlogwang 
16742bfe3f2eSlogwang 	first_buf->nb_segs = count;
16752bfe3f2eSlogwang 	first_buf->pkt_len = total_length;
16762bfe3f2eSlogwang 
16772bfe3f2eSlogwang 	if (mbuf->ol_flags & PKT_TX_VLAN_PKT) {
16782bfe3f2eSlogwang 		first_buf->ol_flags |= RTE_AVP_TX_VLAN_PKT;
16792bfe3f2eSlogwang 		first_buf->vlan_tci = mbuf->vlan_tci;
16802bfe3f2eSlogwang 	}
16812bfe3f2eSlogwang 
16822bfe3f2eSlogwang 	avp_dev_buffer_sanity_check(avp, buffers[0]);
16832bfe3f2eSlogwang 
16842bfe3f2eSlogwang 	return total_length;
16852bfe3f2eSlogwang }
16862bfe3f2eSlogwang 
16872bfe3f2eSlogwang 
16882bfe3f2eSlogwang static uint16_t
avp_xmit_scattered_pkts(void * tx_queue,struct rte_mbuf ** tx_pkts,uint16_t nb_pkts)16892bfe3f2eSlogwang avp_xmit_scattered_pkts(void *tx_queue,
16902bfe3f2eSlogwang 			struct rte_mbuf **tx_pkts,
16912bfe3f2eSlogwang 			uint16_t nb_pkts)
16922bfe3f2eSlogwang {
16932bfe3f2eSlogwang 	struct rte_avp_desc *avp_bufs[(AVP_MAX_TX_BURST *
16940c6bd470Sfengbojiang 				       RTE_AVP_MAX_MBUF_SEGMENTS)] = {};
16952bfe3f2eSlogwang 	struct avp_queue *txq = (struct avp_queue *)tx_queue;
16962bfe3f2eSlogwang 	struct rte_avp_desc *tx_bufs[AVP_MAX_TX_BURST];
16972bfe3f2eSlogwang 	struct avp_dev *avp = txq->avp;
16982bfe3f2eSlogwang 	struct rte_avp_fifo *alloc_q;
16992bfe3f2eSlogwang 	struct rte_avp_fifo *tx_q;
17002bfe3f2eSlogwang 	unsigned int count, avail, n;
17012bfe3f2eSlogwang 	unsigned int orig_nb_pkts;
17022bfe3f2eSlogwang 	struct rte_mbuf *m;
17032bfe3f2eSlogwang 	unsigned int required;
17042bfe3f2eSlogwang 	unsigned int segments;
17052bfe3f2eSlogwang 	unsigned int tx_bytes;
17062bfe3f2eSlogwang 	unsigned int i;
17072bfe3f2eSlogwang 
17082bfe3f2eSlogwang 	orig_nb_pkts = nb_pkts;
17092bfe3f2eSlogwang 	if (unlikely(avp->flags & AVP_F_DETACHED)) {
17102bfe3f2eSlogwang 		/* VM live migration in progress */
17112bfe3f2eSlogwang 		/* TODO ... buffer for X packets then drop? */
17122bfe3f2eSlogwang 		txq->errors += nb_pkts;
17132bfe3f2eSlogwang 		return 0;
17142bfe3f2eSlogwang 	}
17152bfe3f2eSlogwang 
17162bfe3f2eSlogwang 	tx_q = avp->tx_q[txq->queue_id];
17172bfe3f2eSlogwang 	alloc_q = avp->alloc_q[txq->queue_id];
17182bfe3f2eSlogwang 
17192bfe3f2eSlogwang 	/* limit the number of transmitted packets to the max burst size */
17202bfe3f2eSlogwang 	if (unlikely(nb_pkts > AVP_MAX_TX_BURST))
17212bfe3f2eSlogwang 		nb_pkts = AVP_MAX_TX_BURST;
17222bfe3f2eSlogwang 
17232bfe3f2eSlogwang 	/* determine how many buffers are available to copy into */
17242bfe3f2eSlogwang 	avail = avp_fifo_count(alloc_q);
17252bfe3f2eSlogwang 	if (unlikely(avail > (AVP_MAX_TX_BURST *
17262bfe3f2eSlogwang 			      RTE_AVP_MAX_MBUF_SEGMENTS)))
17272bfe3f2eSlogwang 		avail = AVP_MAX_TX_BURST * RTE_AVP_MAX_MBUF_SEGMENTS;
17282bfe3f2eSlogwang 
17292bfe3f2eSlogwang 	/* determine how many slots are available in the transmit queue */
17302bfe3f2eSlogwang 	count = avp_fifo_free_count(tx_q);
17312bfe3f2eSlogwang 
17322bfe3f2eSlogwang 	/* determine how many packets can be sent */
17332bfe3f2eSlogwang 	nb_pkts = RTE_MIN(count, nb_pkts);
17342bfe3f2eSlogwang 
17352bfe3f2eSlogwang 	/* determine how many packets will fit in the available buffers */
17362bfe3f2eSlogwang 	count = 0;
17372bfe3f2eSlogwang 	segments = 0;
17382bfe3f2eSlogwang 	for (i = 0; i < nb_pkts; i++) {
17392bfe3f2eSlogwang 		m = tx_pkts[i];
17402bfe3f2eSlogwang 		if (likely(i < (unsigned int)nb_pkts - 1)) {
17412bfe3f2eSlogwang 			/* prefetch next entry while processing this one */
17422bfe3f2eSlogwang 			rte_prefetch0(tx_pkts[i + 1]);
17432bfe3f2eSlogwang 		}
17442bfe3f2eSlogwang 		required = (rte_pktmbuf_pkt_len(m) + avp->host_mbuf_size - 1) /
17452bfe3f2eSlogwang 			avp->host_mbuf_size;
17462bfe3f2eSlogwang 
17472bfe3f2eSlogwang 		if (unlikely((required == 0) ||
17482bfe3f2eSlogwang 			     (required > RTE_AVP_MAX_MBUF_SEGMENTS)))
17492bfe3f2eSlogwang 			break;
17502bfe3f2eSlogwang 		else if (unlikely(required + segments > avail))
17512bfe3f2eSlogwang 			break;
17522bfe3f2eSlogwang 		segments += required;
17532bfe3f2eSlogwang 		count++;
17542bfe3f2eSlogwang 	}
17552bfe3f2eSlogwang 	nb_pkts = count;
17562bfe3f2eSlogwang 
17572bfe3f2eSlogwang 	if (unlikely(nb_pkts == 0)) {
17582bfe3f2eSlogwang 		/* no available buffers, or no space on the tx queue */
17592bfe3f2eSlogwang 		txq->errors += orig_nb_pkts;
17602bfe3f2eSlogwang 		return 0;
17612bfe3f2eSlogwang 	}
17622bfe3f2eSlogwang 
17632bfe3f2eSlogwang 	PMD_TX_LOG(DEBUG, "Sending %u packets on Tx queue at %p\n",
17642bfe3f2eSlogwang 		   nb_pkts, tx_q);
17652bfe3f2eSlogwang 
17662bfe3f2eSlogwang 	/* retrieve sufficient send buffers */
17672bfe3f2eSlogwang 	n = avp_fifo_get(alloc_q, (void **)&avp_bufs, segments);
17682bfe3f2eSlogwang 	if (unlikely(n != segments)) {
17692bfe3f2eSlogwang 		PMD_TX_LOG(DEBUG, "Failed to allocate buffers "
17702bfe3f2eSlogwang 			   "n=%u, segments=%u, orig=%u\n",
17712bfe3f2eSlogwang 			   n, segments, orig_nb_pkts);
17722bfe3f2eSlogwang 		txq->errors += orig_nb_pkts;
17732bfe3f2eSlogwang 		return 0;
17742bfe3f2eSlogwang 	}
17752bfe3f2eSlogwang 
17762bfe3f2eSlogwang 	tx_bytes = 0;
17772bfe3f2eSlogwang 	count = 0;
17782bfe3f2eSlogwang 	for (i = 0; i < nb_pkts; i++) {
17792bfe3f2eSlogwang 		/* process each packet to be transmitted */
17802bfe3f2eSlogwang 		m = tx_pkts[i];
17812bfe3f2eSlogwang 
17822bfe3f2eSlogwang 		/* determine how many buffers are required for this packet */
17832bfe3f2eSlogwang 		required = (rte_pktmbuf_pkt_len(m) + avp->host_mbuf_size - 1) /
17842bfe3f2eSlogwang 			avp->host_mbuf_size;
17852bfe3f2eSlogwang 
17862bfe3f2eSlogwang 		tx_bytes += avp_dev_copy_to_buffers(avp, m,
17872bfe3f2eSlogwang 						    &avp_bufs[count], required);
17882bfe3f2eSlogwang 		tx_bufs[i] = avp_bufs[count];
17892bfe3f2eSlogwang 		count += required;
17902bfe3f2eSlogwang 
17912bfe3f2eSlogwang 		/* free the original mbuf */
17922bfe3f2eSlogwang 		rte_pktmbuf_free(m);
17932bfe3f2eSlogwang 	}
17942bfe3f2eSlogwang 
17952bfe3f2eSlogwang 	txq->packets += nb_pkts;
17962bfe3f2eSlogwang 	txq->bytes += tx_bytes;
17972bfe3f2eSlogwang 
17982bfe3f2eSlogwang #ifdef RTE_LIBRTE_AVP_DEBUG_BUFFERS
17992bfe3f2eSlogwang 	for (i = 0; i < nb_pkts; i++)
18002bfe3f2eSlogwang 		avp_dev_buffer_sanity_check(avp, tx_bufs[i]);
18012bfe3f2eSlogwang #endif
18022bfe3f2eSlogwang 
18032bfe3f2eSlogwang 	/* send the packets */
18042bfe3f2eSlogwang 	n = avp_fifo_put(tx_q, (void **)&tx_bufs[0], nb_pkts);
18052bfe3f2eSlogwang 	if (unlikely(n != orig_nb_pkts))
18062bfe3f2eSlogwang 		txq->errors += (orig_nb_pkts - n);
18072bfe3f2eSlogwang 
18082bfe3f2eSlogwang 	return n;
18092bfe3f2eSlogwang }
18102bfe3f2eSlogwang 
18112bfe3f2eSlogwang 
18122bfe3f2eSlogwang static uint16_t
avp_xmit_pkts(void * tx_queue,struct rte_mbuf ** tx_pkts,uint16_t nb_pkts)18132bfe3f2eSlogwang avp_xmit_pkts(void *tx_queue, struct rte_mbuf **tx_pkts, uint16_t nb_pkts)
18142bfe3f2eSlogwang {
18152bfe3f2eSlogwang 	struct avp_queue *txq = (struct avp_queue *)tx_queue;
18162bfe3f2eSlogwang 	struct rte_avp_desc *avp_bufs[AVP_MAX_TX_BURST];
18172bfe3f2eSlogwang 	struct avp_dev *avp = txq->avp;
18182bfe3f2eSlogwang 	struct rte_avp_desc *pkt_buf;
18192bfe3f2eSlogwang 	struct rte_avp_fifo *alloc_q;
18202bfe3f2eSlogwang 	struct rte_avp_fifo *tx_q;
18212bfe3f2eSlogwang 	unsigned int count, avail, n;
18222bfe3f2eSlogwang 	struct rte_mbuf *m;
18232bfe3f2eSlogwang 	unsigned int pkt_len;
18242bfe3f2eSlogwang 	unsigned int tx_bytes;
18252bfe3f2eSlogwang 	char *pkt_data;
18262bfe3f2eSlogwang 	unsigned int i;
18272bfe3f2eSlogwang 
18282bfe3f2eSlogwang 	if (unlikely(avp->flags & AVP_F_DETACHED)) {
18292bfe3f2eSlogwang 		/* VM live migration in progress */
18302bfe3f2eSlogwang 		/* TODO ... buffer for X packets then drop?! */
18312bfe3f2eSlogwang 		txq->errors++;
18322bfe3f2eSlogwang 		return 0;
18332bfe3f2eSlogwang 	}
18342bfe3f2eSlogwang 
18352bfe3f2eSlogwang 	tx_q = avp->tx_q[txq->queue_id];
18362bfe3f2eSlogwang 	alloc_q = avp->alloc_q[txq->queue_id];
18372bfe3f2eSlogwang 
18382bfe3f2eSlogwang 	/* limit the number of transmitted packets to the max burst size */
18392bfe3f2eSlogwang 	if (unlikely(nb_pkts > AVP_MAX_TX_BURST))
18402bfe3f2eSlogwang 		nb_pkts = AVP_MAX_TX_BURST;
18412bfe3f2eSlogwang 
18422bfe3f2eSlogwang 	/* determine how many buffers are available to copy into */
18432bfe3f2eSlogwang 	avail = avp_fifo_count(alloc_q);
18442bfe3f2eSlogwang 
18452bfe3f2eSlogwang 	/* determine how many slots are available in the transmit queue */
18462bfe3f2eSlogwang 	count = avp_fifo_free_count(tx_q);
18472bfe3f2eSlogwang 
18482bfe3f2eSlogwang 	/* determine how many packets can be sent */
18492bfe3f2eSlogwang 	count = RTE_MIN(count, avail);
18502bfe3f2eSlogwang 	count = RTE_MIN(count, nb_pkts);
18512bfe3f2eSlogwang 
18522bfe3f2eSlogwang 	if (unlikely(count == 0)) {
18532bfe3f2eSlogwang 		/* no available buffers, or no space on the tx queue */
18542bfe3f2eSlogwang 		txq->errors += nb_pkts;
18552bfe3f2eSlogwang 		return 0;
18562bfe3f2eSlogwang 	}
18572bfe3f2eSlogwang 
18582bfe3f2eSlogwang 	PMD_TX_LOG(DEBUG, "Sending %u packets on Tx queue at %p\n",
18592bfe3f2eSlogwang 		   count, tx_q);
18602bfe3f2eSlogwang 
18612bfe3f2eSlogwang 	/* retrieve sufficient send buffers */
18622bfe3f2eSlogwang 	n = avp_fifo_get(alloc_q, (void **)&avp_bufs, count);
18632bfe3f2eSlogwang 	if (unlikely(n != count)) {
18642bfe3f2eSlogwang 		txq->errors++;
18652bfe3f2eSlogwang 		return 0;
18662bfe3f2eSlogwang 	}
18672bfe3f2eSlogwang 
18682bfe3f2eSlogwang 	tx_bytes = 0;
18692bfe3f2eSlogwang 	for (i = 0; i < count; i++) {
18702bfe3f2eSlogwang 		/* prefetch next entry while processing the current one */
18712bfe3f2eSlogwang 		if (i < count - 1) {
18722bfe3f2eSlogwang 			pkt_buf = avp_dev_translate_buffer(avp,
18732bfe3f2eSlogwang 							   avp_bufs[i + 1]);
18742bfe3f2eSlogwang 			rte_prefetch0(pkt_buf);
18752bfe3f2eSlogwang 		}
18762bfe3f2eSlogwang 
18772bfe3f2eSlogwang 		/* process each packet to be transmitted */
18782bfe3f2eSlogwang 		m = tx_pkts[i];
18792bfe3f2eSlogwang 
18802bfe3f2eSlogwang 		/* Adjust pointers for guest addressing */
18812bfe3f2eSlogwang 		pkt_buf = avp_dev_translate_buffer(avp, avp_bufs[i]);
18822bfe3f2eSlogwang 		pkt_data = avp_dev_translate_buffer(avp, pkt_buf->data);
18832bfe3f2eSlogwang 		pkt_len = rte_pktmbuf_pkt_len(m);
18842bfe3f2eSlogwang 
18852bfe3f2eSlogwang 		if (unlikely((pkt_len > avp->guest_mbuf_size) ||
18862bfe3f2eSlogwang 					 (pkt_len > avp->host_mbuf_size))) {
18872bfe3f2eSlogwang 			/*
18882bfe3f2eSlogwang 			 * application should be using the scattered transmit
18892bfe3f2eSlogwang 			 * function; send it truncated to avoid the performance
18902bfe3f2eSlogwang 			 * hit of having to manage returning the already
18912bfe3f2eSlogwang 			 * allocated buffer to the free list.  This should not
18922bfe3f2eSlogwang 			 * happen since the application should have set the
18932bfe3f2eSlogwang 			 * max_rx_pkt_len based on its MTU and it should be
18942bfe3f2eSlogwang 			 * policing its own packet sizes.
18952bfe3f2eSlogwang 			 */
18962bfe3f2eSlogwang 			txq->errors++;
18972bfe3f2eSlogwang 			pkt_len = RTE_MIN(avp->guest_mbuf_size,
18982bfe3f2eSlogwang 					  avp->host_mbuf_size);
18992bfe3f2eSlogwang 		}
19002bfe3f2eSlogwang 
19012bfe3f2eSlogwang 		/* copy data out of our mbuf and into the AVP buffer */
19022bfe3f2eSlogwang 		rte_memcpy(pkt_data, rte_pktmbuf_mtod(m, void *), pkt_len);
19032bfe3f2eSlogwang 		pkt_buf->pkt_len = pkt_len;
19042bfe3f2eSlogwang 		pkt_buf->data_len = pkt_len;
19052bfe3f2eSlogwang 		pkt_buf->nb_segs = 1;
19062bfe3f2eSlogwang 		pkt_buf->next = NULL;
19072bfe3f2eSlogwang 
19082bfe3f2eSlogwang 		if (m->ol_flags & PKT_TX_VLAN_PKT) {
19092bfe3f2eSlogwang 			pkt_buf->ol_flags |= RTE_AVP_TX_VLAN_PKT;
19102bfe3f2eSlogwang 			pkt_buf->vlan_tci = m->vlan_tci;
19112bfe3f2eSlogwang 		}
19122bfe3f2eSlogwang 
19132bfe3f2eSlogwang 		tx_bytes += pkt_len;
19142bfe3f2eSlogwang 
19152bfe3f2eSlogwang 		/* free the original mbuf */
19162bfe3f2eSlogwang 		rte_pktmbuf_free(m);
19172bfe3f2eSlogwang 	}
19182bfe3f2eSlogwang 
19192bfe3f2eSlogwang 	txq->packets += count;
19202bfe3f2eSlogwang 	txq->bytes += tx_bytes;
19212bfe3f2eSlogwang 
19222bfe3f2eSlogwang 	/* send the packets */
19232bfe3f2eSlogwang 	n = avp_fifo_put(tx_q, (void **)&avp_bufs[0], count);
19242bfe3f2eSlogwang 
19252bfe3f2eSlogwang 	return n;
19262bfe3f2eSlogwang }
19272bfe3f2eSlogwang 
19282bfe3f2eSlogwang static void
avp_dev_rx_queue_release(void * rx_queue)19292bfe3f2eSlogwang avp_dev_rx_queue_release(void *rx_queue)
19302bfe3f2eSlogwang {
19312bfe3f2eSlogwang 	struct avp_queue *rxq = (struct avp_queue *)rx_queue;
19322bfe3f2eSlogwang 	struct avp_dev *avp = rxq->avp;
19332bfe3f2eSlogwang 	struct rte_eth_dev_data *data = avp->dev_data;
19342bfe3f2eSlogwang 	unsigned int i;
19352bfe3f2eSlogwang 
19362bfe3f2eSlogwang 	for (i = 0; i < avp->num_rx_queues; i++) {
19374418919fSjohnjiang 		if (data->rx_queues[i] == rxq) {
19384418919fSjohnjiang 			rte_free(data->rx_queues[i]);
19392bfe3f2eSlogwang 			data->rx_queues[i] = NULL;
19402bfe3f2eSlogwang 		}
19412bfe3f2eSlogwang 	}
19424418919fSjohnjiang }
19434418919fSjohnjiang 
19444418919fSjohnjiang static void
avp_dev_rx_queue_release_all(struct rte_eth_dev * eth_dev)19454418919fSjohnjiang avp_dev_rx_queue_release_all(struct rte_eth_dev *eth_dev)
19464418919fSjohnjiang {
19474418919fSjohnjiang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
19484418919fSjohnjiang 	struct rte_eth_dev_data *data = avp->dev_data;
19494418919fSjohnjiang 	unsigned int i;
19504418919fSjohnjiang 
19514418919fSjohnjiang 	for (i = 0; i < avp->num_rx_queues; i++) {
19524418919fSjohnjiang 		if (data->rx_queues[i]) {
19534418919fSjohnjiang 			rte_free(data->rx_queues[i]);
19544418919fSjohnjiang 			data->rx_queues[i] = NULL;
19554418919fSjohnjiang 		}
19564418919fSjohnjiang 	}
19574418919fSjohnjiang }
19582bfe3f2eSlogwang 
19592bfe3f2eSlogwang static void
avp_dev_tx_queue_release(void * tx_queue)19602bfe3f2eSlogwang avp_dev_tx_queue_release(void *tx_queue)
19612bfe3f2eSlogwang {
19622bfe3f2eSlogwang 	struct avp_queue *txq = (struct avp_queue *)tx_queue;
19632bfe3f2eSlogwang 	struct avp_dev *avp = txq->avp;
19642bfe3f2eSlogwang 	struct rte_eth_dev_data *data = avp->dev_data;
19652bfe3f2eSlogwang 	unsigned int i;
19662bfe3f2eSlogwang 
19672bfe3f2eSlogwang 	for (i = 0; i < avp->num_tx_queues; i++) {
19684418919fSjohnjiang 		if (data->tx_queues[i] == txq) {
19694418919fSjohnjiang 			rte_free(data->tx_queues[i]);
19702bfe3f2eSlogwang 			data->tx_queues[i] = NULL;
19712bfe3f2eSlogwang 		}
19722bfe3f2eSlogwang 	}
19734418919fSjohnjiang }
19744418919fSjohnjiang 
19754418919fSjohnjiang static void
avp_dev_tx_queue_release_all(struct rte_eth_dev * eth_dev)19764418919fSjohnjiang avp_dev_tx_queue_release_all(struct rte_eth_dev *eth_dev)
19774418919fSjohnjiang {
19784418919fSjohnjiang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
19794418919fSjohnjiang 	struct rte_eth_dev_data *data = avp->dev_data;
19804418919fSjohnjiang 	unsigned int i;
19814418919fSjohnjiang 
19824418919fSjohnjiang 	for (i = 0; i < avp->num_tx_queues; i++) {
19834418919fSjohnjiang 		if (data->tx_queues[i]) {
19844418919fSjohnjiang 			rte_free(data->tx_queues[i]);
19854418919fSjohnjiang 			data->tx_queues[i] = NULL;
19864418919fSjohnjiang 		}
19874418919fSjohnjiang 	}
19884418919fSjohnjiang }
19892bfe3f2eSlogwang 
19902bfe3f2eSlogwang static int
avp_dev_configure(struct rte_eth_dev * eth_dev)19912bfe3f2eSlogwang avp_dev_configure(struct rte_eth_dev *eth_dev)
19922bfe3f2eSlogwang {
19932bfe3f2eSlogwang 	struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
19942bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
19952bfe3f2eSlogwang 	struct rte_avp_device_info *host_info;
19962bfe3f2eSlogwang 	struct rte_avp_device_config config;
19972bfe3f2eSlogwang 	int mask = 0;
19982bfe3f2eSlogwang 	void *addr;
19992bfe3f2eSlogwang 	int ret;
20002bfe3f2eSlogwang 
20012bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
20022bfe3f2eSlogwang 	if (avp->flags & AVP_F_DETACHED) {
20032bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Operation not supported during VM live migration\n");
20042bfe3f2eSlogwang 		ret = -ENOTSUP;
20052bfe3f2eSlogwang 		goto unlock;
20062bfe3f2eSlogwang 	}
20072bfe3f2eSlogwang 
20082bfe3f2eSlogwang 	addr = pci_dev->mem_resource[RTE_AVP_PCI_DEVICE_BAR].addr;
20092bfe3f2eSlogwang 	host_info = (struct rte_avp_device_info *)addr;
20102bfe3f2eSlogwang 
20112bfe3f2eSlogwang 	/* Setup required number of queues */
20122bfe3f2eSlogwang 	_avp_set_queue_counts(eth_dev);
20132bfe3f2eSlogwang 
20142bfe3f2eSlogwang 	mask = (ETH_VLAN_STRIP_MASK |
20152bfe3f2eSlogwang 		ETH_VLAN_FILTER_MASK |
20162bfe3f2eSlogwang 		ETH_VLAN_EXTEND_MASK);
20172bfe3f2eSlogwang 	ret = avp_vlan_offload_set(eth_dev, mask);
20182bfe3f2eSlogwang 	if (ret < 0) {
20192bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "VLAN offload set failed by host, ret=%d\n",
20202bfe3f2eSlogwang 			    ret);
20212bfe3f2eSlogwang 		goto unlock;
20222bfe3f2eSlogwang 	}
20232bfe3f2eSlogwang 
20242bfe3f2eSlogwang 	/* update device config */
20252bfe3f2eSlogwang 	memset(&config, 0, sizeof(config));
20262bfe3f2eSlogwang 	config.device_id = host_info->device_id;
20272bfe3f2eSlogwang 	config.driver_type = RTE_AVP_DRIVER_TYPE_DPDK;
20282bfe3f2eSlogwang 	config.driver_version = AVP_DPDK_DRIVER_VERSION;
20292bfe3f2eSlogwang 	config.features = avp->features;
20302bfe3f2eSlogwang 	config.num_tx_queues = avp->num_tx_queues;
20312bfe3f2eSlogwang 	config.num_rx_queues = avp->num_rx_queues;
20322bfe3f2eSlogwang 
20332bfe3f2eSlogwang 	ret = avp_dev_ctrl_set_config(eth_dev, &config);
20342bfe3f2eSlogwang 	if (ret < 0) {
20352bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Config request failed by host, ret=%d\n",
20362bfe3f2eSlogwang 			    ret);
20372bfe3f2eSlogwang 		goto unlock;
20382bfe3f2eSlogwang 	}
20392bfe3f2eSlogwang 
20402bfe3f2eSlogwang 	avp->flags |= AVP_F_CONFIGURED;
20412bfe3f2eSlogwang 	ret = 0;
20422bfe3f2eSlogwang 
20432bfe3f2eSlogwang unlock:
20442bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
20452bfe3f2eSlogwang 	return ret;
20462bfe3f2eSlogwang }
20472bfe3f2eSlogwang 
20482bfe3f2eSlogwang static int
avp_dev_start(struct rte_eth_dev * eth_dev)20492bfe3f2eSlogwang avp_dev_start(struct rte_eth_dev *eth_dev)
20502bfe3f2eSlogwang {
20512bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
20522bfe3f2eSlogwang 	int ret;
20532bfe3f2eSlogwang 
20542bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
20552bfe3f2eSlogwang 	if (avp->flags & AVP_F_DETACHED) {
20562bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Operation not supported during VM live migration\n");
20572bfe3f2eSlogwang 		ret = -ENOTSUP;
20582bfe3f2eSlogwang 		goto unlock;
20592bfe3f2eSlogwang 	}
20602bfe3f2eSlogwang 
20612bfe3f2eSlogwang 	/* update link state */
20622bfe3f2eSlogwang 	ret = avp_dev_ctrl_set_link_state(eth_dev, 1);
20632bfe3f2eSlogwang 	if (ret < 0) {
20642bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Link state change failed by host, ret=%d\n",
20652bfe3f2eSlogwang 			    ret);
20662bfe3f2eSlogwang 		goto unlock;
20672bfe3f2eSlogwang 	}
20682bfe3f2eSlogwang 
20692bfe3f2eSlogwang 	/* remember current link state */
20702bfe3f2eSlogwang 	avp->flags |= AVP_F_LINKUP;
20712bfe3f2eSlogwang 
20722bfe3f2eSlogwang 	ret = 0;
20732bfe3f2eSlogwang 
20742bfe3f2eSlogwang unlock:
20752bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
20762bfe3f2eSlogwang 	return ret;
20772bfe3f2eSlogwang }
20782bfe3f2eSlogwang 
2079*2d9fd380Sjfb8856606 static int
avp_dev_stop(struct rte_eth_dev * eth_dev)20802bfe3f2eSlogwang avp_dev_stop(struct rte_eth_dev *eth_dev)
20812bfe3f2eSlogwang {
20822bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
20832bfe3f2eSlogwang 	int ret;
20842bfe3f2eSlogwang 
20852bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
20862bfe3f2eSlogwang 	if (avp->flags & AVP_F_DETACHED) {
20872bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Operation not supported during VM live migration\n");
2088*2d9fd380Sjfb8856606 		ret = -ENOTSUP;
20892bfe3f2eSlogwang 		goto unlock;
20902bfe3f2eSlogwang 	}
20912bfe3f2eSlogwang 
20922bfe3f2eSlogwang 	/* remember current link state */
20932bfe3f2eSlogwang 	avp->flags &= ~AVP_F_LINKUP;
20942bfe3f2eSlogwang 
20952bfe3f2eSlogwang 	/* update link state */
20962bfe3f2eSlogwang 	ret = avp_dev_ctrl_set_link_state(eth_dev, 0);
20972bfe3f2eSlogwang 	if (ret < 0) {
20982bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Link state change failed by host, ret=%d\n",
20992bfe3f2eSlogwang 			    ret);
21002bfe3f2eSlogwang 	}
21012bfe3f2eSlogwang 
21022bfe3f2eSlogwang unlock:
21032bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
2104*2d9fd380Sjfb8856606 	return ret;
21052bfe3f2eSlogwang }
21062bfe3f2eSlogwang 
2107*2d9fd380Sjfb8856606 static int
avp_dev_close(struct rte_eth_dev * eth_dev)21082bfe3f2eSlogwang avp_dev_close(struct rte_eth_dev *eth_dev)
21092bfe3f2eSlogwang {
21102bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
21112bfe3f2eSlogwang 	int ret;
21122bfe3f2eSlogwang 
2113*2d9fd380Sjfb8856606 	if (rte_eal_process_type() != RTE_PROC_PRIMARY)
2114*2d9fd380Sjfb8856606 		return 0;
2115*2d9fd380Sjfb8856606 
21162bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
21172bfe3f2eSlogwang 	if (avp->flags & AVP_F_DETACHED) {
21182bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Operation not supported during VM live migration\n");
21192bfe3f2eSlogwang 		goto unlock;
21202bfe3f2eSlogwang 	}
21212bfe3f2eSlogwang 
21222bfe3f2eSlogwang 	/* remember current link state */
21232bfe3f2eSlogwang 	avp->flags &= ~AVP_F_LINKUP;
21242bfe3f2eSlogwang 	avp->flags &= ~AVP_F_CONFIGURED;
21252bfe3f2eSlogwang 
21262bfe3f2eSlogwang 	ret = avp_dev_disable_interrupts(eth_dev);
21272bfe3f2eSlogwang 	if (ret < 0) {
21282bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Failed to disable interrupts\n");
21292bfe3f2eSlogwang 		/* continue */
21302bfe3f2eSlogwang 	}
21312bfe3f2eSlogwang 
21322bfe3f2eSlogwang 	/* update device state */
21332bfe3f2eSlogwang 	ret = avp_dev_ctrl_shutdown(eth_dev);
21342bfe3f2eSlogwang 	if (ret < 0) {
21352bfe3f2eSlogwang 		PMD_DRV_LOG(ERR, "Device shutdown failed by host, ret=%d\n",
21362bfe3f2eSlogwang 			    ret);
21372bfe3f2eSlogwang 		/* continue */
21382bfe3f2eSlogwang 	}
21392bfe3f2eSlogwang 
21404418919fSjohnjiang 	/* release dynamic storage for rx/tx queues */
21414418919fSjohnjiang 	avp_dev_rx_queue_release_all(eth_dev);
21424418919fSjohnjiang 	avp_dev_tx_queue_release_all(eth_dev);
21434418919fSjohnjiang 
21442bfe3f2eSlogwang unlock:
21452bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
2146*2d9fd380Sjfb8856606 	return 0;
21472bfe3f2eSlogwang }
21482bfe3f2eSlogwang 
21492bfe3f2eSlogwang static int
avp_dev_link_update(struct rte_eth_dev * eth_dev,__rte_unused int wait_to_complete)21502bfe3f2eSlogwang avp_dev_link_update(struct rte_eth_dev *eth_dev,
21512bfe3f2eSlogwang 					__rte_unused int wait_to_complete)
21522bfe3f2eSlogwang {
21532bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
21542bfe3f2eSlogwang 	struct rte_eth_link *link = &eth_dev->data->dev_link;
21552bfe3f2eSlogwang 
21562bfe3f2eSlogwang 	link->link_speed = ETH_SPEED_NUM_10G;
21572bfe3f2eSlogwang 	link->link_duplex = ETH_LINK_FULL_DUPLEX;
21582bfe3f2eSlogwang 	link->link_status = !!(avp->flags & AVP_F_LINKUP);
21592bfe3f2eSlogwang 
21602bfe3f2eSlogwang 	return -1;
21612bfe3f2eSlogwang }
21622bfe3f2eSlogwang 
21634418919fSjohnjiang static int
avp_dev_promiscuous_enable(struct rte_eth_dev * eth_dev)21642bfe3f2eSlogwang avp_dev_promiscuous_enable(struct rte_eth_dev *eth_dev)
21652bfe3f2eSlogwang {
21662bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
21672bfe3f2eSlogwang 
21682bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
21692bfe3f2eSlogwang 	if ((avp->flags & AVP_F_PROMISC) == 0) {
21702bfe3f2eSlogwang 		avp->flags |= AVP_F_PROMISC;
21712bfe3f2eSlogwang 		PMD_DRV_LOG(DEBUG, "Promiscuous mode enabled on %u\n",
21722bfe3f2eSlogwang 			    eth_dev->data->port_id);
21732bfe3f2eSlogwang 	}
21742bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
21754418919fSjohnjiang 
21764418919fSjohnjiang 	return 0;
21772bfe3f2eSlogwang }
21782bfe3f2eSlogwang 
21794418919fSjohnjiang static int
avp_dev_promiscuous_disable(struct rte_eth_dev * eth_dev)21802bfe3f2eSlogwang avp_dev_promiscuous_disable(struct rte_eth_dev *eth_dev)
21812bfe3f2eSlogwang {
21822bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
21832bfe3f2eSlogwang 
21842bfe3f2eSlogwang 	rte_spinlock_lock(&avp->lock);
21852bfe3f2eSlogwang 	if ((avp->flags & AVP_F_PROMISC) != 0) {
21862bfe3f2eSlogwang 		avp->flags &= ~AVP_F_PROMISC;
21872bfe3f2eSlogwang 		PMD_DRV_LOG(DEBUG, "Promiscuous mode disabled on %u\n",
21882bfe3f2eSlogwang 			    eth_dev->data->port_id);
21892bfe3f2eSlogwang 	}
21902bfe3f2eSlogwang 	rte_spinlock_unlock(&avp->lock);
21914418919fSjohnjiang 
21924418919fSjohnjiang 	return 0;
21932bfe3f2eSlogwang }
21942bfe3f2eSlogwang 
21954418919fSjohnjiang static int
avp_dev_info_get(struct rte_eth_dev * eth_dev,struct rte_eth_dev_info * dev_info)21962bfe3f2eSlogwang avp_dev_info_get(struct rte_eth_dev *eth_dev,
21972bfe3f2eSlogwang 		 struct rte_eth_dev_info *dev_info)
21982bfe3f2eSlogwang {
21992bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
22002bfe3f2eSlogwang 
22012bfe3f2eSlogwang 	dev_info->max_rx_queues = avp->max_rx_queues;
22022bfe3f2eSlogwang 	dev_info->max_tx_queues = avp->max_tx_queues;
22032bfe3f2eSlogwang 	dev_info->min_rx_bufsize = AVP_MIN_RX_BUFSIZE;
22042bfe3f2eSlogwang 	dev_info->max_rx_pktlen = avp->max_rx_pkt_len;
22052bfe3f2eSlogwang 	dev_info->max_mac_addrs = AVP_MAX_MAC_ADDRS;
22062bfe3f2eSlogwang 	if (avp->host_features & RTE_AVP_FEATURE_VLAN_OFFLOAD) {
22072bfe3f2eSlogwang 		dev_info->rx_offload_capa = DEV_RX_OFFLOAD_VLAN_STRIP;
22082bfe3f2eSlogwang 		dev_info->tx_offload_capa = DEV_TX_OFFLOAD_VLAN_INSERT;
22092bfe3f2eSlogwang 	}
22104418919fSjohnjiang 
22114418919fSjohnjiang 	return 0;
22122bfe3f2eSlogwang }
22132bfe3f2eSlogwang 
22142bfe3f2eSlogwang static int
avp_vlan_offload_set(struct rte_eth_dev * eth_dev,int mask)22152bfe3f2eSlogwang avp_vlan_offload_set(struct rte_eth_dev *eth_dev, int mask)
22162bfe3f2eSlogwang {
22172bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
2218d30ea906Sjfb8856606 	struct rte_eth_conf *dev_conf = &eth_dev->data->dev_conf;
2219d30ea906Sjfb8856606 	uint64_t offloads = dev_conf->rxmode.offloads;
22202bfe3f2eSlogwang 
22212bfe3f2eSlogwang 	if (mask & ETH_VLAN_STRIP_MASK) {
22222bfe3f2eSlogwang 		if (avp->host_features & RTE_AVP_FEATURE_VLAN_OFFLOAD) {
2223d30ea906Sjfb8856606 			if (offloads & DEV_RX_OFFLOAD_VLAN_STRIP)
22242bfe3f2eSlogwang 				avp->features |= RTE_AVP_FEATURE_VLAN_OFFLOAD;
22252bfe3f2eSlogwang 			else
22262bfe3f2eSlogwang 				avp->features &= ~RTE_AVP_FEATURE_VLAN_OFFLOAD;
22272bfe3f2eSlogwang 		} else {
22282bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "VLAN strip offload not supported\n");
22292bfe3f2eSlogwang 		}
22302bfe3f2eSlogwang 	}
22312bfe3f2eSlogwang 
22322bfe3f2eSlogwang 	if (mask & ETH_VLAN_FILTER_MASK) {
2233d30ea906Sjfb8856606 		if (offloads & DEV_RX_OFFLOAD_VLAN_FILTER)
22342bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "VLAN filter offload not supported\n");
22352bfe3f2eSlogwang 	}
22362bfe3f2eSlogwang 
22372bfe3f2eSlogwang 	if (mask & ETH_VLAN_EXTEND_MASK) {
2238d30ea906Sjfb8856606 		if (offloads & DEV_RX_OFFLOAD_VLAN_EXTEND)
22392bfe3f2eSlogwang 			PMD_DRV_LOG(ERR, "VLAN extend offload not supported\n");
22402bfe3f2eSlogwang 	}
22412bfe3f2eSlogwang 
22422bfe3f2eSlogwang 	return 0;
22432bfe3f2eSlogwang }
22442bfe3f2eSlogwang 
22452bfe3f2eSlogwang static int
avp_dev_stats_get(struct rte_eth_dev * eth_dev,struct rte_eth_stats * stats)22462bfe3f2eSlogwang avp_dev_stats_get(struct rte_eth_dev *eth_dev, struct rte_eth_stats *stats)
22472bfe3f2eSlogwang {
22482bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
22492bfe3f2eSlogwang 	unsigned int i;
22502bfe3f2eSlogwang 
22512bfe3f2eSlogwang 	for (i = 0; i < avp->num_rx_queues; i++) {
22522bfe3f2eSlogwang 		struct avp_queue *rxq = avp->dev_data->rx_queues[i];
22532bfe3f2eSlogwang 
22542bfe3f2eSlogwang 		if (rxq) {
22552bfe3f2eSlogwang 			stats->ipackets += rxq->packets;
22562bfe3f2eSlogwang 			stats->ibytes += rxq->bytes;
22572bfe3f2eSlogwang 			stats->ierrors += rxq->errors;
22582bfe3f2eSlogwang 
22592bfe3f2eSlogwang 			stats->q_ipackets[i] += rxq->packets;
22602bfe3f2eSlogwang 			stats->q_ibytes[i] += rxq->bytes;
22612bfe3f2eSlogwang 			stats->q_errors[i] += rxq->errors;
22622bfe3f2eSlogwang 		}
22632bfe3f2eSlogwang 	}
22642bfe3f2eSlogwang 
22652bfe3f2eSlogwang 	for (i = 0; i < avp->num_tx_queues; i++) {
22662bfe3f2eSlogwang 		struct avp_queue *txq = avp->dev_data->tx_queues[i];
22672bfe3f2eSlogwang 
22682bfe3f2eSlogwang 		if (txq) {
22692bfe3f2eSlogwang 			stats->opackets += txq->packets;
22702bfe3f2eSlogwang 			stats->obytes += txq->bytes;
22712bfe3f2eSlogwang 			stats->oerrors += txq->errors;
22722bfe3f2eSlogwang 
22732bfe3f2eSlogwang 			stats->q_opackets[i] += txq->packets;
22742bfe3f2eSlogwang 			stats->q_obytes[i] += txq->bytes;
22752bfe3f2eSlogwang 		}
22762bfe3f2eSlogwang 	}
22772bfe3f2eSlogwang 
22782bfe3f2eSlogwang 	return 0;
22792bfe3f2eSlogwang }
22802bfe3f2eSlogwang 
22814418919fSjohnjiang static int
avp_dev_stats_reset(struct rte_eth_dev * eth_dev)22822bfe3f2eSlogwang avp_dev_stats_reset(struct rte_eth_dev *eth_dev)
22832bfe3f2eSlogwang {
22842bfe3f2eSlogwang 	struct avp_dev *avp = AVP_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
22852bfe3f2eSlogwang 	unsigned int i;
22862bfe3f2eSlogwang 
22872bfe3f2eSlogwang 	for (i = 0; i < avp->num_rx_queues; i++) {
22882bfe3f2eSlogwang 		struct avp_queue *rxq = avp->dev_data->rx_queues[i];
22892bfe3f2eSlogwang 
22902bfe3f2eSlogwang 		if (rxq) {
22912bfe3f2eSlogwang 			rxq->bytes = 0;
22922bfe3f2eSlogwang 			rxq->packets = 0;
22932bfe3f2eSlogwang 			rxq->errors = 0;
22942bfe3f2eSlogwang 		}
22952bfe3f2eSlogwang 	}
22962bfe3f2eSlogwang 
22972bfe3f2eSlogwang 	for (i = 0; i < avp->num_tx_queues; i++) {
22982bfe3f2eSlogwang 		struct avp_queue *txq = avp->dev_data->tx_queues[i];
22992bfe3f2eSlogwang 
23002bfe3f2eSlogwang 		if (txq) {
23012bfe3f2eSlogwang 			txq->bytes = 0;
23022bfe3f2eSlogwang 			txq->packets = 0;
23032bfe3f2eSlogwang 			txq->errors = 0;
23042bfe3f2eSlogwang 		}
23052bfe3f2eSlogwang 	}
23064418919fSjohnjiang 
23074418919fSjohnjiang 	return 0;
23082bfe3f2eSlogwang }
23092bfe3f2eSlogwang 
23102bfe3f2eSlogwang RTE_PMD_REGISTER_PCI(net_avp, rte_avp_pmd);
23112bfe3f2eSlogwang RTE_PMD_REGISTER_PCI_TABLE(net_avp, pci_id_avp_map);
2312*2d9fd380Sjfb8856606 RTE_LOG_REGISTER(avp_logtype_driver, pmd.net.avp.driver, NOTICE);
2313