xref: /dpdk/drivers/net/dpaa2/dpaa2_ethdev.c (revision c172f85ef2e5f3992ac32a2bbf6a9bc28bcc2261)
1131a75b6SHemant Agrawal /* * SPDX-License-Identifier: BSD-3-Clause
2c147eae0SHemant Agrawal  *
3c147eae0SHemant Agrawal  *   Copyright (c) 2016 Freescale Semiconductor, Inc. All rights reserved.
4131a75b6SHemant Agrawal  *   Copyright 2016 NXP
5c147eae0SHemant Agrawal  *
6c147eae0SHemant Agrawal  */
7c147eae0SHemant Agrawal 
8c147eae0SHemant Agrawal #include <time.h>
9c147eae0SHemant Agrawal #include <net/if.h>
10c147eae0SHemant Agrawal 
11c147eae0SHemant Agrawal #include <rte_mbuf.h>
12c147eae0SHemant Agrawal #include <rte_ethdev.h>
13c147eae0SHemant Agrawal #include <rte_malloc.h>
14c147eae0SHemant Agrawal #include <rte_memcpy.h>
15c147eae0SHemant Agrawal #include <rte_string_fns.h>
16c147eae0SHemant Agrawal #include <rte_cycles.h>
17c147eae0SHemant Agrawal #include <rte_kvargs.h>
18c147eae0SHemant Agrawal #include <rte_dev.h>
19c147eae0SHemant Agrawal #include <rte_fslmc.h>
20c147eae0SHemant Agrawal 
21d401ead1SHemant Agrawal #include <fslmc_logs.h>
22c147eae0SHemant Agrawal #include <fslmc_vfio.h>
233e5a335dSHemant Agrawal #include <dpaa2_hw_pvt.h>
24bee61d86SHemant Agrawal #include <dpaa2_hw_mempool.h>
253cf50ff5SHemant Agrawal #include <dpaa2_hw_dpio.h>
26748eccb9SHemant Agrawal #include <mc/fsl_dpmng.h>
27c147eae0SHemant Agrawal #include "dpaa2_ethdev.h"
28f40adb40SHemant Agrawal #include <fsl_qbman_debug.h>
29c147eae0SHemant Agrawal 
301d6329b2SHemant Agrawal struct rte_dpaa2_xstats_name_off {
311d6329b2SHemant Agrawal 	char name[RTE_ETH_XSTATS_NAME_SIZE];
321d6329b2SHemant Agrawal 	uint8_t page_id; /* dpni statistics page id */
331d6329b2SHemant Agrawal 	uint8_t stats_id; /* stats id in the given page */
341d6329b2SHemant Agrawal };
351d6329b2SHemant Agrawal 
361d6329b2SHemant Agrawal static const struct rte_dpaa2_xstats_name_off dpaa2_xstats_strings[] = {
371d6329b2SHemant Agrawal 	{"ingress_multicast_frames", 0, 2},
381d6329b2SHemant Agrawal 	{"ingress_multicast_bytes", 0, 3},
391d6329b2SHemant Agrawal 	{"ingress_broadcast_frames", 0, 4},
401d6329b2SHemant Agrawal 	{"ingress_broadcast_bytes", 0, 5},
411d6329b2SHemant Agrawal 	{"egress_multicast_frames", 1, 2},
421d6329b2SHemant Agrawal 	{"egress_multicast_bytes", 1, 3},
431d6329b2SHemant Agrawal 	{"egress_broadcast_frames", 1, 4},
441d6329b2SHemant Agrawal 	{"egress_broadcast_bytes", 1, 5},
451d6329b2SHemant Agrawal 	{"ingress_filtered_frames", 2, 0},
461d6329b2SHemant Agrawal 	{"ingress_discarded_frames", 2, 1},
471d6329b2SHemant Agrawal 	{"ingress_nobuffer_discards", 2, 2},
481d6329b2SHemant Agrawal 	{"egress_discarded_frames", 2, 3},
491d6329b2SHemant Agrawal 	{"egress_confirmed_frames", 2, 4},
501d6329b2SHemant Agrawal };
511d6329b2SHemant Agrawal 
52c147eae0SHemant Agrawal static struct rte_dpaa2_driver rte_dpaa2_pmd;
53d4984046SHemant Agrawal static int dpaa2_dev_uninit(struct rte_eth_dev *eth_dev);
54c5acbb5eSHemant Agrawal static int dpaa2_dev_link_update(struct rte_eth_dev *dev,
55c5acbb5eSHemant Agrawal 				 int wait_to_complete);
56a1f3a12cSHemant Agrawal static int dpaa2_dev_set_link_up(struct rte_eth_dev *dev);
57a1f3a12cSHemant Agrawal static int dpaa2_dev_set_link_down(struct rte_eth_dev *dev);
58e1640849SHemant Agrawal static int dpaa2_dev_mtu_set(struct rte_eth_dev *dev, uint16_t mtu);
59c147eae0SHemant Agrawal 
60c56c86ffSHemant Agrawal /**
61c56c86ffSHemant Agrawal  * Atomically reads the link status information from global
62c56c86ffSHemant Agrawal  * structure rte_eth_dev.
63c56c86ffSHemant Agrawal  *
64c56c86ffSHemant Agrawal  * @param dev
65c56c86ffSHemant Agrawal  *   - Pointer to the structure rte_eth_dev to read from.
66c56c86ffSHemant Agrawal  *   - Pointer to the buffer to be saved with the link status.
67c56c86ffSHemant Agrawal  *
68c56c86ffSHemant Agrawal  * @return
69c56c86ffSHemant Agrawal  *   - On success, zero.
70c56c86ffSHemant Agrawal  *   - On failure, negative value.
71c56c86ffSHemant Agrawal  */
72c56c86ffSHemant Agrawal static inline int
73c56c86ffSHemant Agrawal dpaa2_dev_atomic_read_link_status(struct rte_eth_dev *dev,
74c56c86ffSHemant Agrawal 				  struct rte_eth_link *link)
75c56c86ffSHemant Agrawal {
76c56c86ffSHemant Agrawal 	struct rte_eth_link *dst = link;
77c56c86ffSHemant Agrawal 	struct rte_eth_link *src = &dev->data->dev_link;
78c56c86ffSHemant Agrawal 
79c56c86ffSHemant Agrawal 	if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst,
80c56c86ffSHemant Agrawal 				*(uint64_t *)src) == 0)
81c56c86ffSHemant Agrawal 		return -1;
82c56c86ffSHemant Agrawal 
83c56c86ffSHemant Agrawal 	return 0;
84c56c86ffSHemant Agrawal }
85c56c86ffSHemant Agrawal 
86c56c86ffSHemant Agrawal /**
87c56c86ffSHemant Agrawal  * Atomically writes the link status information into global
88c56c86ffSHemant Agrawal  * structure rte_eth_dev.
89c56c86ffSHemant Agrawal  *
90c56c86ffSHemant Agrawal  * @param dev
91c56c86ffSHemant Agrawal  *   - Pointer to the structure rte_eth_dev to read from.
92c56c86ffSHemant Agrawal  *   - Pointer to the buffer to be saved with the link status.
93c56c86ffSHemant Agrawal  *
94c56c86ffSHemant Agrawal  * @return
95c56c86ffSHemant Agrawal  *   - On success, zero.
96c56c86ffSHemant Agrawal  *   - On failure, negative value.
97c56c86ffSHemant Agrawal  */
98c56c86ffSHemant Agrawal static inline int
99c56c86ffSHemant Agrawal dpaa2_dev_atomic_write_link_status(struct rte_eth_dev *dev,
100c56c86ffSHemant Agrawal 				   struct rte_eth_link *link)
101c56c86ffSHemant Agrawal {
102c56c86ffSHemant Agrawal 	struct rte_eth_link *dst = &dev->data->dev_link;
103c56c86ffSHemant Agrawal 	struct rte_eth_link *src = link;
104c56c86ffSHemant Agrawal 
105c56c86ffSHemant Agrawal 	if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst,
106c56c86ffSHemant Agrawal 				*(uint64_t *)src) == 0)
107c56c86ffSHemant Agrawal 		return -1;
108c56c86ffSHemant Agrawal 
109c56c86ffSHemant Agrawal 	return 0;
110c56c86ffSHemant Agrawal }
111c56c86ffSHemant Agrawal 
1123ce294f2SHemant Agrawal static int
1133ce294f2SHemant Agrawal dpaa2_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
1143ce294f2SHemant Agrawal {
1153ce294f2SHemant Agrawal 	int ret;
1163ce294f2SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1173ce294f2SHemant Agrawal 	struct fsl_mc_io *dpni = priv->hw;
1183ce294f2SHemant Agrawal 
1193ce294f2SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1203ce294f2SHemant Agrawal 
1213ce294f2SHemant Agrawal 	if (dpni == NULL) {
122645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1233ce294f2SHemant Agrawal 		return -1;
1243ce294f2SHemant Agrawal 	}
1253ce294f2SHemant Agrawal 
1263ce294f2SHemant Agrawal 	if (on)
1273ce294f2SHemant Agrawal 		ret = dpni_add_vlan_id(dpni, CMD_PRI_LOW,
1283ce294f2SHemant Agrawal 				       priv->token, vlan_id);
1293ce294f2SHemant Agrawal 	else
1303ce294f2SHemant Agrawal 		ret = dpni_remove_vlan_id(dpni, CMD_PRI_LOW,
1313ce294f2SHemant Agrawal 					  priv->token, vlan_id);
1323ce294f2SHemant Agrawal 
1333ce294f2SHemant Agrawal 	if (ret < 0)
1343ce294f2SHemant Agrawal 		PMD_DRV_LOG(ERR, "ret = %d Unable to add/rem vlan %d hwid =%d",
1353ce294f2SHemant Agrawal 			    ret, vlan_id, priv->hw_id);
1363ce294f2SHemant Agrawal 
1373ce294f2SHemant Agrawal 	return ret;
1383ce294f2SHemant Agrawal }
1393ce294f2SHemant Agrawal 
140289ba0c0SDavid Harton static int
1413ce294f2SHemant Agrawal dpaa2_vlan_offload_set(struct rte_eth_dev *dev, int mask)
1423ce294f2SHemant Agrawal {
1433ce294f2SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1443ce294f2SHemant Agrawal 	struct fsl_mc_io *dpni = priv->hw;
1453ce294f2SHemant Agrawal 	int ret;
1463ce294f2SHemant Agrawal 
1473ce294f2SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1483ce294f2SHemant Agrawal 
1493ce294f2SHemant Agrawal 	if (mask & ETH_VLAN_FILTER_MASK) {
150*c172f85eSHemant Agrawal 		/* VLAN Filter not avaialble */
151*c172f85eSHemant Agrawal 		if (!priv->max_vlan_filters) {
152*c172f85eSHemant Agrawal 			RTE_LOG(INFO, PMD, "VLAN filter not available\n");
153*c172f85eSHemant Agrawal 			goto next_mask;
154*c172f85eSHemant Agrawal 		}
155*c172f85eSHemant Agrawal 
1563ce294f2SHemant Agrawal 		if (dev->data->dev_conf.rxmode.hw_vlan_filter)
1573ce294f2SHemant Agrawal 			ret = dpni_enable_vlan_filter(dpni, CMD_PRI_LOW,
1583ce294f2SHemant Agrawal 						      priv->token, true);
1593ce294f2SHemant Agrawal 		else
1603ce294f2SHemant Agrawal 			ret = dpni_enable_vlan_filter(dpni, CMD_PRI_LOW,
1613ce294f2SHemant Agrawal 						      priv->token, false);
1623ce294f2SHemant Agrawal 		if (ret < 0)
163645bd25aSHemant Agrawal 			RTE_LOG(ERR, PMD, "Unable to set vlan filter = %d\n",
1643ce294f2SHemant Agrawal 				ret);
1653ce294f2SHemant Agrawal 	}
166*c172f85eSHemant Agrawal next_mask:
167acb95928SHemant Agrawal 	if (mask & ETH_VLAN_EXTEND_MASK) {
168acb95928SHemant Agrawal 		if (dev->data->dev_conf.rxmode.hw_vlan_extend)
169acb95928SHemant Agrawal 			RTE_LOG(INFO, PMD,
170acb95928SHemant Agrawal 				"VLAN extend offload not supported\n");
171acb95928SHemant Agrawal 	}
172289ba0c0SDavid Harton 
173289ba0c0SDavid Harton 	return 0;
1743ce294f2SHemant Agrawal }
1753ce294f2SHemant Agrawal 
176748eccb9SHemant Agrawal static int
177748eccb9SHemant Agrawal dpaa2_fw_version_get(struct rte_eth_dev *dev,
178748eccb9SHemant Agrawal 		     char *fw_version,
179748eccb9SHemant Agrawal 		     size_t fw_size)
180748eccb9SHemant Agrawal {
181748eccb9SHemant Agrawal 	int ret;
182748eccb9SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
183748eccb9SHemant Agrawal 	struct fsl_mc_io *dpni = priv->hw;
184748eccb9SHemant Agrawal 	struct mc_soc_version mc_plat_info = {0};
185748eccb9SHemant Agrawal 	struct mc_version mc_ver_info = {0};
186748eccb9SHemant Agrawal 
187748eccb9SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
188748eccb9SHemant Agrawal 
189748eccb9SHemant Agrawal 	if (mc_get_soc_version(dpni, CMD_PRI_LOW, &mc_plat_info))
190748eccb9SHemant Agrawal 		RTE_LOG(WARNING, PMD, "\tmc_get_soc_version failed\n");
191748eccb9SHemant Agrawal 
192748eccb9SHemant Agrawal 	if (mc_get_version(dpni, CMD_PRI_LOW, &mc_ver_info))
193748eccb9SHemant Agrawal 		RTE_LOG(WARNING, PMD, "\tmc_get_version failed\n");
194748eccb9SHemant Agrawal 
195748eccb9SHemant Agrawal 	ret = snprintf(fw_version, fw_size,
196748eccb9SHemant Agrawal 		       "%x-%d.%d.%d",
197748eccb9SHemant Agrawal 		       mc_plat_info.svr,
198748eccb9SHemant Agrawal 		       mc_ver_info.major,
199748eccb9SHemant Agrawal 		       mc_ver_info.minor,
200748eccb9SHemant Agrawal 		       mc_ver_info.revision);
201748eccb9SHemant Agrawal 
202748eccb9SHemant Agrawal 	ret += 1; /* add the size of '\0' */
203748eccb9SHemant Agrawal 	if (fw_size < (uint32_t)ret)
204748eccb9SHemant Agrawal 		return ret;
205748eccb9SHemant Agrawal 	else
206748eccb9SHemant Agrawal 		return 0;
207748eccb9SHemant Agrawal }
208748eccb9SHemant Agrawal 
2093e5a335dSHemant Agrawal static void
2103e5a335dSHemant Agrawal dpaa2_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
2113e5a335dSHemant Agrawal {
2123e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
2133e5a335dSHemant Agrawal 
2143e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
2153e5a335dSHemant Agrawal 
2163e5a335dSHemant Agrawal 	dev_info->if_index = priv->hw_id;
2173e5a335dSHemant Agrawal 
21833fad432SHemant Agrawal 	dev_info->max_mac_addrs = priv->max_mac_filters;
219bee61d86SHemant Agrawal 	dev_info->max_rx_pktlen = DPAA2_MAX_RX_PKT_LEN;
220bee61d86SHemant Agrawal 	dev_info->min_rx_bufsize = DPAA2_MIN_RX_BUF_SIZE;
2213e5a335dSHemant Agrawal 	dev_info->max_rx_queues = (uint16_t)priv->nb_rx_queues;
2223e5a335dSHemant Agrawal 	dev_info->max_tx_queues = (uint16_t)priv->nb_tx_queues;
223ef18dafeSHemant Agrawal 	dev_info->rx_offload_capa =
224ef18dafeSHemant Agrawal 		DEV_RX_OFFLOAD_IPV4_CKSUM |
225ef18dafeSHemant Agrawal 		DEV_RX_OFFLOAD_UDP_CKSUM |
226ef18dafeSHemant Agrawal 		DEV_RX_OFFLOAD_TCP_CKSUM |
227ef18dafeSHemant Agrawal 		DEV_RX_OFFLOAD_OUTER_IPV4_CKSUM;
228ef18dafeSHemant Agrawal 	dev_info->tx_offload_capa =
229ef18dafeSHemant Agrawal 		DEV_TX_OFFLOAD_IPV4_CKSUM |
230ef18dafeSHemant Agrawal 		DEV_TX_OFFLOAD_UDP_CKSUM |
231ef18dafeSHemant Agrawal 		DEV_TX_OFFLOAD_TCP_CKSUM |
232ef18dafeSHemant Agrawal 		DEV_TX_OFFLOAD_SCTP_CKSUM |
233ef18dafeSHemant Agrawal 		DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM;
2343e5a335dSHemant Agrawal 	dev_info->speed_capa = ETH_LINK_SPEED_1G |
2353e5a335dSHemant Agrawal 			ETH_LINK_SPEED_2_5G |
2363e5a335dSHemant Agrawal 			ETH_LINK_SPEED_10G;
2373e5a335dSHemant Agrawal }
2383e5a335dSHemant Agrawal 
2393e5a335dSHemant Agrawal static int
2403e5a335dSHemant Agrawal dpaa2_alloc_rx_tx_queues(struct rte_eth_dev *dev)
2413e5a335dSHemant Agrawal {
2423e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
2433e5a335dSHemant Agrawal 	uint16_t dist_idx;
2443e5a335dSHemant Agrawal 	uint32_t vq_id;
2453e5a335dSHemant Agrawal 	struct dpaa2_queue *mc_q, *mcq;
2463e5a335dSHemant Agrawal 	uint32_t tot_queues;
2473e5a335dSHemant Agrawal 	int i;
2483e5a335dSHemant Agrawal 	struct dpaa2_queue *dpaa2_q;
2493e5a335dSHemant Agrawal 
2503e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
2513e5a335dSHemant Agrawal 
2523e5a335dSHemant Agrawal 	tot_queues = priv->nb_rx_queues + priv->nb_tx_queues;
2533e5a335dSHemant Agrawal 	mc_q = rte_malloc(NULL, sizeof(struct dpaa2_queue) * tot_queues,
2543e5a335dSHemant Agrawal 			  RTE_CACHE_LINE_SIZE);
2553e5a335dSHemant Agrawal 	if (!mc_q) {
2563e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "malloc failed for rx/tx queues\n");
2573e5a335dSHemant Agrawal 		return -1;
2583e5a335dSHemant Agrawal 	}
2593e5a335dSHemant Agrawal 
2603e5a335dSHemant Agrawal 	for (i = 0; i < priv->nb_rx_queues; i++) {
2613e5a335dSHemant Agrawal 		mc_q->dev = dev;
2623e5a335dSHemant Agrawal 		priv->rx_vq[i] = mc_q++;
2633e5a335dSHemant Agrawal 		dpaa2_q = (struct dpaa2_queue *)priv->rx_vq[i];
2643e5a335dSHemant Agrawal 		dpaa2_q->q_storage = rte_malloc("dq_storage",
2653e5a335dSHemant Agrawal 					sizeof(struct queue_storage_info_t),
2663e5a335dSHemant Agrawal 					RTE_CACHE_LINE_SIZE);
2673e5a335dSHemant Agrawal 		if (!dpaa2_q->q_storage)
2683e5a335dSHemant Agrawal 			goto fail;
2693e5a335dSHemant Agrawal 
2703e5a335dSHemant Agrawal 		memset(dpaa2_q->q_storage, 0,
2713e5a335dSHemant Agrawal 		       sizeof(struct queue_storage_info_t));
2723cf50ff5SHemant Agrawal 		if (dpaa2_alloc_dq_storage(dpaa2_q->q_storage))
2733cf50ff5SHemant Agrawal 			goto fail;
2743e5a335dSHemant Agrawal 	}
2753e5a335dSHemant Agrawal 
2763e5a335dSHemant Agrawal 	for (i = 0; i < priv->nb_tx_queues; i++) {
2773e5a335dSHemant Agrawal 		mc_q->dev = dev;
2787ae777d0SHemant Agrawal 		mc_q->flow_id = 0xffff;
2793e5a335dSHemant Agrawal 		priv->tx_vq[i] = mc_q++;
2807ae777d0SHemant Agrawal 		dpaa2_q = (struct dpaa2_queue *)priv->tx_vq[i];
2817ae777d0SHemant Agrawal 		dpaa2_q->cscn = rte_malloc(NULL,
2827ae777d0SHemant Agrawal 					   sizeof(struct qbman_result), 16);
2837ae777d0SHemant Agrawal 		if (!dpaa2_q->cscn)
2847ae777d0SHemant Agrawal 			goto fail_tx;
2853e5a335dSHemant Agrawal 	}
2863e5a335dSHemant Agrawal 
2873e5a335dSHemant Agrawal 	vq_id = 0;
288599017a2SHemant Agrawal 	for (dist_idx = 0; dist_idx < priv->nb_rx_queues; dist_idx++) {
2893e5a335dSHemant Agrawal 		mcq = (struct dpaa2_queue *)priv->rx_vq[vq_id];
2903e5a335dSHemant Agrawal 		mcq->tc_index = DPAA2_DEF_TC;
2913e5a335dSHemant Agrawal 		mcq->flow_id = dist_idx;
2923e5a335dSHemant Agrawal 		vq_id++;
2933e5a335dSHemant Agrawal 	}
2943e5a335dSHemant Agrawal 
2953e5a335dSHemant Agrawal 	return 0;
2967ae777d0SHemant Agrawal fail_tx:
2977ae777d0SHemant Agrawal 	i -= 1;
2987ae777d0SHemant Agrawal 	while (i >= 0) {
2997ae777d0SHemant Agrawal 		dpaa2_q = (struct dpaa2_queue *)priv->tx_vq[i];
3007ae777d0SHemant Agrawal 		rte_free(dpaa2_q->cscn);
3017ae777d0SHemant Agrawal 		priv->tx_vq[i--] = NULL;
3027ae777d0SHemant Agrawal 	}
3037ae777d0SHemant Agrawal 	i = priv->nb_rx_queues;
3043e5a335dSHemant Agrawal fail:
3053e5a335dSHemant Agrawal 	i -= 1;
3063e5a335dSHemant Agrawal 	mc_q = priv->rx_vq[0];
3073e5a335dSHemant Agrawal 	while (i >= 0) {
3083e5a335dSHemant Agrawal 		dpaa2_q = (struct dpaa2_queue *)priv->rx_vq[i];
3093cf50ff5SHemant Agrawal 		dpaa2_free_dq_storage(dpaa2_q->q_storage);
3103e5a335dSHemant Agrawal 		rte_free(dpaa2_q->q_storage);
3113e5a335dSHemant Agrawal 		priv->rx_vq[i--] = NULL;
3123e5a335dSHemant Agrawal 	}
3133e5a335dSHemant Agrawal 	rte_free(mc_q);
3143e5a335dSHemant Agrawal 	return -1;
3153e5a335dSHemant Agrawal }
3163e5a335dSHemant Agrawal 
3173e5a335dSHemant Agrawal static int
3183e5a335dSHemant Agrawal dpaa2_eth_dev_configure(struct rte_eth_dev *dev)
3193e5a335dSHemant Agrawal {
32021ce788cSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
32121ce788cSHemant Agrawal 	struct fsl_mc_io *dpni = priv->hw;
32221ce788cSHemant Agrawal 	struct rte_eth_conf *eth_conf = &dev->data->dev_conf;
32321ce788cSHemant Agrawal 	int rx_ip_csum_offload = false;
32489c2ea8fSHemant Agrawal 	int ret;
3253e5a335dSHemant Agrawal 
3263e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
3273e5a335dSHemant Agrawal 
328e1640849SHemant Agrawal 	if (eth_conf->rxmode.jumbo_frame == 1) {
329e1640849SHemant Agrawal 		if (eth_conf->rxmode.max_rx_pkt_len <= DPAA2_MAX_RX_PKT_LEN) {
33044ea7355SAshish Jain 			ret = dpni_set_max_frame_length(dpni, CMD_PRI_LOW,
33144ea7355SAshish Jain 				priv->token, eth_conf->rxmode.max_rx_pkt_len);
332e1640849SHemant Agrawal 			if (ret) {
333e1640849SHemant Agrawal 				PMD_INIT_LOG(ERR,
334e1640849SHemant Agrawal 					     "unable to set mtu. check config\n");
335e1640849SHemant Agrawal 				return ret;
336e1640849SHemant Agrawal 			}
337e1640849SHemant Agrawal 		} else {
338e1640849SHemant Agrawal 			return -1;
339e1640849SHemant Agrawal 		}
340e1640849SHemant Agrawal 	}
341e1640849SHemant Agrawal 
34289c2ea8fSHemant Agrawal 	if (eth_conf->rxmode.mq_mode == ETH_MQ_RX_RSS) {
34389c2ea8fSHemant Agrawal 		ret = dpaa2_setup_flow_dist(dev,
34489c2ea8fSHemant Agrawal 				eth_conf->rx_adv_conf.rss_conf.rss_hf);
34589c2ea8fSHemant Agrawal 		if (ret) {
34689c2ea8fSHemant Agrawal 			PMD_INIT_LOG(ERR, "unable to set flow distribution."
34789c2ea8fSHemant Agrawal 				     "please check queue config\n");
34889c2ea8fSHemant Agrawal 			return ret;
34989c2ea8fSHemant Agrawal 		}
35089c2ea8fSHemant Agrawal 	}
351c5acbb5eSHemant Agrawal 
35221ce788cSHemant Agrawal 	if (eth_conf->rxmode.hw_ip_checksum)
35321ce788cSHemant Agrawal 		rx_ip_csum_offload = true;
35421ce788cSHemant Agrawal 
35521ce788cSHemant Agrawal 	ret = dpni_set_offload(dpni, CMD_PRI_LOW, priv->token,
35621ce788cSHemant Agrawal 			       DPNI_OFF_RX_L3_CSUM, rx_ip_csum_offload);
35721ce788cSHemant Agrawal 	if (ret) {
35821ce788cSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error to set RX l3 csum:Error = %d\n", ret);
35921ce788cSHemant Agrawal 		return ret;
36021ce788cSHemant Agrawal 	}
36121ce788cSHemant Agrawal 
36221ce788cSHemant Agrawal 	ret = dpni_set_offload(dpni, CMD_PRI_LOW, priv->token,
36321ce788cSHemant Agrawal 			       DPNI_OFF_RX_L4_CSUM, rx_ip_csum_offload);
36421ce788cSHemant Agrawal 	if (ret) {
36521ce788cSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error to get RX l4 csum:Error = %d\n", ret);
36621ce788cSHemant Agrawal 		return ret;
36721ce788cSHemant Agrawal 	}
36821ce788cSHemant Agrawal 
36921ce788cSHemant Agrawal 	ret = dpni_set_offload(dpni, CMD_PRI_LOW, priv->token,
37021ce788cSHemant Agrawal 			       DPNI_OFF_TX_L3_CSUM, true);
37121ce788cSHemant Agrawal 	if (ret) {
37221ce788cSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error to set TX l3 csum:Error = %d\n", ret);
37321ce788cSHemant Agrawal 		return ret;
37421ce788cSHemant Agrawal 	}
37521ce788cSHemant Agrawal 
37621ce788cSHemant Agrawal 	ret = dpni_set_offload(dpni, CMD_PRI_LOW, priv->token,
37721ce788cSHemant Agrawal 			       DPNI_OFF_TX_L4_CSUM, true);
37821ce788cSHemant Agrawal 	if (ret) {
37921ce788cSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error to get TX l4 csum:Error = %d\n", ret);
38021ce788cSHemant Agrawal 		return ret;
38121ce788cSHemant Agrawal 	}
38221ce788cSHemant Agrawal 
383*c172f85eSHemant Agrawal 	if (eth_conf->rxmode.hw_vlan_filter)
384*c172f85eSHemant Agrawal 		dpaa2_vlan_offload_set(dev, ETH_VLAN_FILTER_MASK);
385*c172f85eSHemant Agrawal 
386c5acbb5eSHemant Agrawal 	/* update the current status */
387c5acbb5eSHemant Agrawal 	dpaa2_dev_link_update(dev, 0);
388c5acbb5eSHemant Agrawal 
3893e5a335dSHemant Agrawal 	return 0;
3903e5a335dSHemant Agrawal }
3913e5a335dSHemant Agrawal 
3923e5a335dSHemant Agrawal /* Function to setup RX flow information. It contains traffic class ID,
3933e5a335dSHemant Agrawal  * flow ID, destination configuration etc.
3943e5a335dSHemant Agrawal  */
3953e5a335dSHemant Agrawal static int
3963e5a335dSHemant Agrawal dpaa2_dev_rx_queue_setup(struct rte_eth_dev *dev,
3973e5a335dSHemant Agrawal 			 uint16_t rx_queue_id,
3983e5a335dSHemant Agrawal 			 uint16_t nb_rx_desc __rte_unused,
3993e5a335dSHemant Agrawal 			 unsigned int socket_id __rte_unused,
4003e5a335dSHemant Agrawal 			 const struct rte_eth_rxconf *rx_conf __rte_unused,
4013e5a335dSHemant Agrawal 			 struct rte_mempool *mb_pool)
4023e5a335dSHemant Agrawal {
4033e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
4043e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
4053e5a335dSHemant Agrawal 	struct dpaa2_queue *dpaa2_q;
4063e5a335dSHemant Agrawal 	struct dpni_queue cfg;
4073e5a335dSHemant Agrawal 	uint8_t options = 0;
4083e5a335dSHemant Agrawal 	uint8_t flow_id;
409bee61d86SHemant Agrawal 	uint32_t bpid;
4103e5a335dSHemant Agrawal 	int ret;
4113e5a335dSHemant Agrawal 
4123e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
4133e5a335dSHemant Agrawal 
4142bfea039SHemant Agrawal 	PMD_DRV_LOG(DEBUG, "dev =%p, queue =%d, pool = %p, conf =%p",
4153e5a335dSHemant Agrawal 		    dev, rx_queue_id, mb_pool, rx_conf);
4163e5a335dSHemant Agrawal 
417bee61d86SHemant Agrawal 	if (!priv->bp_list || priv->bp_list->mp != mb_pool) {
418bee61d86SHemant Agrawal 		bpid = mempool_to_bpid(mb_pool);
419bee61d86SHemant Agrawal 		ret = dpaa2_attach_bp_list(priv,
420bee61d86SHemant Agrawal 					   rte_dpaa2_bpid_info[bpid].bp_list);
421bee61d86SHemant Agrawal 		if (ret)
422bee61d86SHemant Agrawal 			return ret;
423bee61d86SHemant Agrawal 	}
4243e5a335dSHemant Agrawal 	dpaa2_q = (struct dpaa2_queue *)priv->rx_vq[rx_queue_id];
4253e5a335dSHemant Agrawal 	dpaa2_q->mb_pool = mb_pool; /**< mbuf pool to populate RX ring. */
4263e5a335dSHemant Agrawal 
427599017a2SHemant Agrawal 	/*Get the flow id from given VQ id*/
428599017a2SHemant Agrawal 	flow_id = rx_queue_id % priv->nb_rx_queues;
4293e5a335dSHemant Agrawal 	memset(&cfg, 0, sizeof(struct dpni_queue));
4303e5a335dSHemant Agrawal 
4313e5a335dSHemant Agrawal 	options = options | DPNI_QUEUE_OPT_USER_CTX;
4323e5a335dSHemant Agrawal 	cfg.user_context = (uint64_t)(dpaa2_q);
4333e5a335dSHemant Agrawal 
43437529eceSHemant Agrawal 	/*if ls2088 or rev2 device, enable the stashing */
43530db823eSHemant Agrawal 
436e0ded73bSHemant Agrawal 	if ((dpaa2_svr_family & 0xffff0000) != SVR_LS2080A) {
43737529eceSHemant Agrawal 		options |= DPNI_QUEUE_OPT_FLC;
43837529eceSHemant Agrawal 		cfg.flc.stash_control = true;
43937529eceSHemant Agrawal 		cfg.flc.value &= 0xFFFFFFFFFFFFFFC0;
44037529eceSHemant Agrawal 		/* 00 00 00 - last 6 bit represent annotation, context stashing,
441e0ded73bSHemant Agrawal 		 * data stashing setting 01 01 00 (0x14)
442e0ded73bSHemant Agrawal 		 * (in following order ->DS AS CS)
443e0ded73bSHemant Agrawal 		 * to enable 1 line data, 1 line annotation.
444e0ded73bSHemant Agrawal 		 * For LX2, this setting should be 01 00 00 (0x10)
44537529eceSHemant Agrawal 		 */
446e0ded73bSHemant Agrawal 		if ((dpaa2_svr_family & 0xffff0000) == SVR_LX2160A)
447e0ded73bSHemant Agrawal 			cfg.flc.value |= 0x10;
448e0ded73bSHemant Agrawal 		else
44937529eceSHemant Agrawal 			cfg.flc.value |= 0x14;
45037529eceSHemant Agrawal 	}
4513e5a335dSHemant Agrawal 	ret = dpni_set_queue(dpni, CMD_PRI_LOW, priv->token, DPNI_QUEUE_RX,
4523e5a335dSHemant Agrawal 			     dpaa2_q->tc_index, flow_id, options, &cfg);
4533e5a335dSHemant Agrawal 	if (ret) {
4543e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error in setting the rx flow: = %d\n", ret);
4553e5a335dSHemant Agrawal 		return -1;
4563e5a335dSHemant Agrawal 	}
4573e5a335dSHemant Agrawal 
45823d6a87eSHemant Agrawal 	if (!(priv->flags & DPAA2_RX_TAILDROP_OFF)) {
45923d6a87eSHemant Agrawal 		struct dpni_taildrop taildrop;
46023d6a87eSHemant Agrawal 
46123d6a87eSHemant Agrawal 		taildrop.enable = 1;
46223d6a87eSHemant Agrawal 		/*enabling per rx queue congestion control */
46323d6a87eSHemant Agrawal 		taildrop.threshold = CONG_THRESHOLD_RX_Q;
46423d6a87eSHemant Agrawal 		taildrop.units = DPNI_CONGESTION_UNIT_BYTES;
465d47f0292SHemant Agrawal 		taildrop.oal = CONG_RX_OAL;
4662bfea039SHemant Agrawal 		PMD_DRV_LOG(DEBUG, "Enabling Early Drop on queue = %d",
46723d6a87eSHemant Agrawal 			    rx_queue_id);
46823d6a87eSHemant Agrawal 		ret = dpni_set_taildrop(dpni, CMD_PRI_LOW, priv->token,
46923d6a87eSHemant Agrawal 					DPNI_CP_QUEUE, DPNI_QUEUE_RX,
47023d6a87eSHemant Agrawal 					dpaa2_q->tc_index, flow_id, &taildrop);
47123d6a87eSHemant Agrawal 		if (ret) {
47223d6a87eSHemant Agrawal 			PMD_INIT_LOG(ERR, "Error in setting the rx flow"
47323d6a87eSHemant Agrawal 				     " err : = %d\n", ret);
47423d6a87eSHemant Agrawal 			return -1;
47523d6a87eSHemant Agrawal 		}
47623d6a87eSHemant Agrawal 	}
47723d6a87eSHemant Agrawal 
4783e5a335dSHemant Agrawal 	dev->data->rx_queues[rx_queue_id] = dpaa2_q;
4793e5a335dSHemant Agrawal 	return 0;
4803e5a335dSHemant Agrawal }
4813e5a335dSHemant Agrawal 
4823e5a335dSHemant Agrawal static int
4833e5a335dSHemant Agrawal dpaa2_dev_tx_queue_setup(struct rte_eth_dev *dev,
4843e5a335dSHemant Agrawal 			 uint16_t tx_queue_id,
4853e5a335dSHemant Agrawal 			 uint16_t nb_tx_desc __rte_unused,
4863e5a335dSHemant Agrawal 			 unsigned int socket_id __rte_unused,
4873e5a335dSHemant Agrawal 			 const struct rte_eth_txconf *tx_conf __rte_unused)
4883e5a335dSHemant Agrawal {
4893e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
4903e5a335dSHemant Agrawal 	struct dpaa2_queue *dpaa2_q = (struct dpaa2_queue *)
4913e5a335dSHemant Agrawal 		priv->tx_vq[tx_queue_id];
4923e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni = priv->hw;
4933e5a335dSHemant Agrawal 	struct dpni_queue tx_conf_cfg;
4943e5a335dSHemant Agrawal 	struct dpni_queue tx_flow_cfg;
4953e5a335dSHemant Agrawal 	uint8_t options = 0, flow_id;
4963e5a335dSHemant Agrawal 	uint32_t tc_id;
4973e5a335dSHemant Agrawal 	int ret;
4983e5a335dSHemant Agrawal 
4993e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
5003e5a335dSHemant Agrawal 
5013e5a335dSHemant Agrawal 	/* Return if queue already configured */
502f9989673SAkhil Goyal 	if (dpaa2_q->flow_id != 0xffff) {
503f9989673SAkhil Goyal 		dev->data->tx_queues[tx_queue_id] = dpaa2_q;
5043e5a335dSHemant Agrawal 		return 0;
505f9989673SAkhil Goyal 	}
5063e5a335dSHemant Agrawal 
5073e5a335dSHemant Agrawal 	memset(&tx_conf_cfg, 0, sizeof(struct dpni_queue));
5083e5a335dSHemant Agrawal 	memset(&tx_flow_cfg, 0, sizeof(struct dpni_queue));
5093e5a335dSHemant Agrawal 
510ef18dafeSHemant Agrawal 	tc_id = tx_queue_id;
511ef18dafeSHemant Agrawal 	flow_id = 0;
5123e5a335dSHemant Agrawal 
5133e5a335dSHemant Agrawal 	ret = dpni_set_queue(dpni, CMD_PRI_LOW, priv->token, DPNI_QUEUE_TX,
5143e5a335dSHemant Agrawal 			     tc_id, flow_id, options, &tx_flow_cfg);
5153e5a335dSHemant Agrawal 	if (ret) {
5163e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error in setting the tx flow: "
5173e5a335dSHemant Agrawal 			     "tc_id=%d, flow =%d ErrorCode = %x\n",
5183e5a335dSHemant Agrawal 			     tc_id, flow_id, -ret);
5193e5a335dSHemant Agrawal 			return -1;
5203e5a335dSHemant Agrawal 	}
5213e5a335dSHemant Agrawal 
5223e5a335dSHemant Agrawal 	dpaa2_q->flow_id = flow_id;
5233e5a335dSHemant Agrawal 
5243e5a335dSHemant Agrawal 	if (tx_queue_id == 0) {
5253e5a335dSHemant Agrawal 		/*Set tx-conf and error configuration*/
5263e5a335dSHemant Agrawal 		ret = dpni_set_tx_confirmation_mode(dpni, CMD_PRI_LOW,
5273e5a335dSHemant Agrawal 						    priv->token,
5283e5a335dSHemant Agrawal 						    DPNI_CONF_DISABLE);
5293e5a335dSHemant Agrawal 		if (ret) {
5303e5a335dSHemant Agrawal 			PMD_INIT_LOG(ERR, "Error in set tx conf mode settings"
5313e5a335dSHemant Agrawal 				     " ErrorCode = %x", ret);
5323e5a335dSHemant Agrawal 			return -1;
5333e5a335dSHemant Agrawal 		}
5343e5a335dSHemant Agrawal 	}
5353e5a335dSHemant Agrawal 	dpaa2_q->tc_index = tc_id;
5363e5a335dSHemant Agrawal 
537a0840963SHemant Agrawal 	if (!(priv->flags & DPAA2_TX_CGR_OFF)) {
5387ae777d0SHemant Agrawal 		struct dpni_congestion_notification_cfg cong_notif_cfg;
5397ae777d0SHemant Agrawal 
54029dfa62fSHemant Agrawal 		cong_notif_cfg.units = DPNI_CONGESTION_UNIT_FRAMES;
5417ae777d0SHemant Agrawal 		cong_notif_cfg.threshold_entry = CONG_ENTER_TX_THRESHOLD;
5427ae777d0SHemant Agrawal 		/* Notify that the queue is not congested when the data in
5437ae777d0SHemant Agrawal 		 * the queue is below this thershold.
5447ae777d0SHemant Agrawal 		 */
5457ae777d0SHemant Agrawal 		cong_notif_cfg.threshold_exit = CONG_EXIT_TX_THRESHOLD;
5467ae777d0SHemant Agrawal 		cong_notif_cfg.message_ctx = 0;
5477ae777d0SHemant Agrawal 		cong_notif_cfg.message_iova = (uint64_t)dpaa2_q->cscn;
5487ae777d0SHemant Agrawal 		cong_notif_cfg.dest_cfg.dest_type = DPNI_DEST_NONE;
5497ae777d0SHemant Agrawal 		cong_notif_cfg.notification_mode =
5507ae777d0SHemant Agrawal 					 DPNI_CONG_OPT_WRITE_MEM_ON_ENTER |
5517ae777d0SHemant Agrawal 					 DPNI_CONG_OPT_WRITE_MEM_ON_EXIT |
5527ae777d0SHemant Agrawal 					 DPNI_CONG_OPT_COHERENT_WRITE;
5537ae777d0SHemant Agrawal 
5547ae777d0SHemant Agrawal 		ret = dpni_set_congestion_notification(dpni, CMD_PRI_LOW,
5557ae777d0SHemant Agrawal 						       priv->token,
5567ae777d0SHemant Agrawal 						       DPNI_QUEUE_TX,
5577ae777d0SHemant Agrawal 						       tc_id,
5587ae777d0SHemant Agrawal 						       &cong_notif_cfg);
5597ae777d0SHemant Agrawal 		if (ret) {
5607ae777d0SHemant Agrawal 			PMD_INIT_LOG(ERR,
5617ae777d0SHemant Agrawal 			   "Error in setting tx congestion notification: = %d",
5627ae777d0SHemant Agrawal 			   -ret);
5637ae777d0SHemant Agrawal 			return -ret;
5647ae777d0SHemant Agrawal 		}
5657ae777d0SHemant Agrawal 	}
5663e5a335dSHemant Agrawal 	dev->data->tx_queues[tx_queue_id] = dpaa2_q;
5673e5a335dSHemant Agrawal 	return 0;
5683e5a335dSHemant Agrawal }
5693e5a335dSHemant Agrawal 
5703e5a335dSHemant Agrawal static void
5713e5a335dSHemant Agrawal dpaa2_dev_rx_queue_release(void *q __rte_unused)
5723e5a335dSHemant Agrawal {
5733e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
5743e5a335dSHemant Agrawal }
5753e5a335dSHemant Agrawal 
5763e5a335dSHemant Agrawal static void
5773e5a335dSHemant Agrawal dpaa2_dev_tx_queue_release(void *q __rte_unused)
5783e5a335dSHemant Agrawal {
5793e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
5803e5a335dSHemant Agrawal }
5813e5a335dSHemant Agrawal 
582f40adb40SHemant Agrawal static uint32_t
583f40adb40SHemant Agrawal dpaa2_dev_rx_queue_count(struct rte_eth_dev *dev, uint16_t rx_queue_id)
584f40adb40SHemant Agrawal {
585f40adb40SHemant Agrawal 	int32_t ret;
586f40adb40SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
587f40adb40SHemant Agrawal 	struct dpaa2_queue *dpaa2_q;
588f40adb40SHemant Agrawal 	struct qbman_swp *swp;
589f40adb40SHemant Agrawal 	struct qbman_fq_query_np_rslt state;
590f40adb40SHemant Agrawal 	uint32_t frame_cnt = 0;
591f40adb40SHemant Agrawal 
592f40adb40SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
593f40adb40SHemant Agrawal 
594f40adb40SHemant Agrawal 	if (unlikely(!DPAA2_PER_LCORE_DPIO)) {
595f40adb40SHemant Agrawal 		ret = dpaa2_affine_qbman_swp();
596f40adb40SHemant Agrawal 		if (ret) {
597f40adb40SHemant Agrawal 			RTE_LOG(ERR, PMD, "Failure in affining portal\n");
598f40adb40SHemant Agrawal 			return -EINVAL;
599f40adb40SHemant Agrawal 		}
600f40adb40SHemant Agrawal 	}
601f40adb40SHemant Agrawal 	swp = DPAA2_PER_LCORE_PORTAL;
602f40adb40SHemant Agrawal 
603f40adb40SHemant Agrawal 	dpaa2_q = (struct dpaa2_queue *)priv->rx_vq[rx_queue_id];
604f40adb40SHemant Agrawal 
605f40adb40SHemant Agrawal 	if (qbman_fq_query_state(swp, dpaa2_q->fqid, &state) == 0) {
606f40adb40SHemant Agrawal 		frame_cnt = qbman_fq_state_frame_count(&state);
607f40adb40SHemant Agrawal 		RTE_LOG(DEBUG, PMD, "RX frame count for q(%d) is %u\n",
608f40adb40SHemant Agrawal 			rx_queue_id, frame_cnt);
609f40adb40SHemant Agrawal 	}
610f40adb40SHemant Agrawal 	return frame_cnt;
611f40adb40SHemant Agrawal }
612f40adb40SHemant Agrawal 
613a5fc38d4SHemant Agrawal static const uint32_t *
614a5fc38d4SHemant Agrawal dpaa2_supported_ptypes_get(struct rte_eth_dev *dev)
615a5fc38d4SHemant Agrawal {
616a5fc38d4SHemant Agrawal 	static const uint32_t ptypes[] = {
617a5fc38d4SHemant Agrawal 		/*todo -= add more types */
618a5fc38d4SHemant Agrawal 		RTE_PTYPE_L2_ETHER,
619a5fc38d4SHemant Agrawal 		RTE_PTYPE_L3_IPV4,
620a5fc38d4SHemant Agrawal 		RTE_PTYPE_L3_IPV4_EXT,
621a5fc38d4SHemant Agrawal 		RTE_PTYPE_L3_IPV6,
622a5fc38d4SHemant Agrawal 		RTE_PTYPE_L3_IPV6_EXT,
623a5fc38d4SHemant Agrawal 		RTE_PTYPE_L4_TCP,
624a5fc38d4SHemant Agrawal 		RTE_PTYPE_L4_UDP,
625a5fc38d4SHemant Agrawal 		RTE_PTYPE_L4_SCTP,
626a5fc38d4SHemant Agrawal 		RTE_PTYPE_L4_ICMP,
627a5fc38d4SHemant Agrawal 		RTE_PTYPE_UNKNOWN
628a5fc38d4SHemant Agrawal 	};
629a5fc38d4SHemant Agrawal 
6305c6942fdSHemant Agrawal 	if (dev->rx_pkt_burst == dpaa2_dev_prefetch_rx)
631a5fc38d4SHemant Agrawal 		return ptypes;
632a5fc38d4SHemant Agrawal 	return NULL;
633a5fc38d4SHemant Agrawal }
634a5fc38d4SHemant Agrawal 
635c5acbb5eSHemant Agrawal /**
636c5acbb5eSHemant Agrawal  * Dpaa2 link Interrupt handler
637c5acbb5eSHemant Agrawal  *
638c5acbb5eSHemant Agrawal  * @param param
639c5acbb5eSHemant Agrawal  *  The address of parameter (struct rte_eth_dev *) regsitered before.
640c5acbb5eSHemant Agrawal  *
641c5acbb5eSHemant Agrawal  * @return
642c5acbb5eSHemant Agrawal  *  void
643c5acbb5eSHemant Agrawal  */
644c5acbb5eSHemant Agrawal static void
645c5acbb5eSHemant Agrawal dpaa2_interrupt_handler(void *param)
646c5acbb5eSHemant Agrawal {
647c5acbb5eSHemant Agrawal 	struct rte_eth_dev *dev = param;
648c5acbb5eSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
649c5acbb5eSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
650c5acbb5eSHemant Agrawal 	int ret;
651c5acbb5eSHemant Agrawal 	int irq_index = DPNI_IRQ_INDEX;
652c5acbb5eSHemant Agrawal 	unsigned int status = 0, clear = 0;
653c5acbb5eSHemant Agrawal 
654c5acbb5eSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
655c5acbb5eSHemant Agrawal 
656c5acbb5eSHemant Agrawal 	if (dpni == NULL) {
657c5acbb5eSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL");
658c5acbb5eSHemant Agrawal 		return;
659c5acbb5eSHemant Agrawal 	}
660c5acbb5eSHemant Agrawal 
661c5acbb5eSHemant Agrawal 	ret = dpni_get_irq_status(dpni, CMD_PRI_LOW, priv->token,
662c5acbb5eSHemant Agrawal 				  irq_index, &status);
663c5acbb5eSHemant Agrawal 	if (unlikely(ret)) {
664c5acbb5eSHemant Agrawal 		RTE_LOG(ERR, PMD, "Can't get irq status (err %d)", ret);
665c5acbb5eSHemant Agrawal 		clear = 0xffffffff;
666c5acbb5eSHemant Agrawal 		goto out;
667c5acbb5eSHemant Agrawal 	}
668c5acbb5eSHemant Agrawal 
669c5acbb5eSHemant Agrawal 	if (status & DPNI_IRQ_EVENT_LINK_CHANGED) {
670c5acbb5eSHemant Agrawal 		clear = DPNI_IRQ_EVENT_LINK_CHANGED;
671c5acbb5eSHemant Agrawal 		dpaa2_dev_link_update(dev, 0);
672c5acbb5eSHemant Agrawal 		/* calling all the apps registered for link status event */
673c5acbb5eSHemant Agrawal 		_rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC,
674cebe3d7bSThomas Monjalon 					      NULL);
675c5acbb5eSHemant Agrawal 	}
676c5acbb5eSHemant Agrawal out:
677c5acbb5eSHemant Agrawal 	ret = dpni_clear_irq_status(dpni, CMD_PRI_LOW, priv->token,
678c5acbb5eSHemant Agrawal 				    irq_index, clear);
679c5acbb5eSHemant Agrawal 	if (unlikely(ret))
680c5acbb5eSHemant Agrawal 		RTE_LOG(ERR, PMD, "Can't clear irq status (err %d)", ret);
681c5acbb5eSHemant Agrawal }
682c5acbb5eSHemant Agrawal 
683c5acbb5eSHemant Agrawal static int
684c5acbb5eSHemant Agrawal dpaa2_eth_setup_irqs(struct rte_eth_dev *dev, int enable)
685c5acbb5eSHemant Agrawal {
686c5acbb5eSHemant Agrawal 	int err = 0;
687c5acbb5eSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
688c5acbb5eSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
689c5acbb5eSHemant Agrawal 	int irq_index = DPNI_IRQ_INDEX;
690c5acbb5eSHemant Agrawal 	unsigned int mask = DPNI_IRQ_EVENT_LINK_CHANGED;
691c5acbb5eSHemant Agrawal 
692c5acbb5eSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
693c5acbb5eSHemant Agrawal 
694c5acbb5eSHemant Agrawal 	err = dpni_set_irq_mask(dpni, CMD_PRI_LOW, priv->token,
695c5acbb5eSHemant Agrawal 				irq_index, mask);
696c5acbb5eSHemant Agrawal 	if (err < 0) {
697c5acbb5eSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error: dpni_set_irq_mask():%d (%s)", err,
698c5acbb5eSHemant Agrawal 			     strerror(-err));
699c5acbb5eSHemant Agrawal 		return err;
700c5acbb5eSHemant Agrawal 	}
701c5acbb5eSHemant Agrawal 
702c5acbb5eSHemant Agrawal 	err = dpni_set_irq_enable(dpni, CMD_PRI_LOW, priv->token,
703c5acbb5eSHemant Agrawal 				  irq_index, enable);
704c5acbb5eSHemant Agrawal 	if (err < 0)
705c5acbb5eSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error: dpni_set_irq_enable():%d (%s)", err,
706c5acbb5eSHemant Agrawal 			     strerror(-err));
707c5acbb5eSHemant Agrawal 
708c5acbb5eSHemant Agrawal 	return err;
709c5acbb5eSHemant Agrawal }
710c5acbb5eSHemant Agrawal 
7113e5a335dSHemant Agrawal static int
7123e5a335dSHemant Agrawal dpaa2_dev_start(struct rte_eth_dev *dev)
7133e5a335dSHemant Agrawal {
714c5acbb5eSHemant Agrawal 	struct rte_device *rdev = dev->device;
715c5acbb5eSHemant Agrawal 	struct rte_dpaa2_device *dpaa2_dev;
7163e5a335dSHemant Agrawal 	struct rte_eth_dev_data *data = dev->data;
7173e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = data->dev_private;
7183e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
7193e5a335dSHemant Agrawal 	struct dpni_queue cfg;
720ef18dafeSHemant Agrawal 	struct dpni_error_cfg	err_cfg;
7213e5a335dSHemant Agrawal 	uint16_t qdid;
7223e5a335dSHemant Agrawal 	struct dpni_queue_id qid;
7233e5a335dSHemant Agrawal 	struct dpaa2_queue *dpaa2_q;
7243e5a335dSHemant Agrawal 	int ret, i;
725c5acbb5eSHemant Agrawal 	struct rte_intr_handle *intr_handle;
726c5acbb5eSHemant Agrawal 
727c5acbb5eSHemant Agrawal 	dpaa2_dev = container_of(rdev, struct rte_dpaa2_device, device);
728c5acbb5eSHemant Agrawal 	intr_handle = &dpaa2_dev->intr_handle;
7293e5a335dSHemant Agrawal 
7303e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
7313e5a335dSHemant Agrawal 
7323e5a335dSHemant Agrawal 	ret = dpni_enable(dpni, CMD_PRI_LOW, priv->token);
7333e5a335dSHemant Agrawal 	if (ret) {
7343e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "Failure %d in enabling dpni %d device\n",
7353e5a335dSHemant Agrawal 			     ret, priv->hw_id);
7363e5a335dSHemant Agrawal 		return ret;
7373e5a335dSHemant Agrawal 	}
7383e5a335dSHemant Agrawal 
739aa8c595aSHemant Agrawal 	/* Power up the phy. Needed to make the link go UP */
740a1f3a12cSHemant Agrawal 	dpaa2_dev_set_link_up(dev);
741a1f3a12cSHemant Agrawal 
7423e5a335dSHemant Agrawal 	ret = dpni_get_qdid(dpni, CMD_PRI_LOW, priv->token,
7433e5a335dSHemant Agrawal 			    DPNI_QUEUE_TX, &qdid);
7443e5a335dSHemant Agrawal 	if (ret) {
7453e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error to get qdid:ErrorCode = %d\n", ret);
7463e5a335dSHemant Agrawal 		return ret;
7473e5a335dSHemant Agrawal 	}
7483e5a335dSHemant Agrawal 	priv->qdid = qdid;
7493e5a335dSHemant Agrawal 
7503e5a335dSHemant Agrawal 	for (i = 0; i < data->nb_rx_queues; i++) {
7513e5a335dSHemant Agrawal 		dpaa2_q = (struct dpaa2_queue *)data->rx_queues[i];
7523e5a335dSHemant Agrawal 		ret = dpni_get_queue(dpni, CMD_PRI_LOW, priv->token,
7533e5a335dSHemant Agrawal 				     DPNI_QUEUE_RX, dpaa2_q->tc_index,
7543e5a335dSHemant Agrawal 				       dpaa2_q->flow_id, &cfg, &qid);
7553e5a335dSHemant Agrawal 		if (ret) {
7563e5a335dSHemant Agrawal 			PMD_INIT_LOG(ERR, "Error to get flow "
7573e5a335dSHemant Agrawal 				     "information Error code = %d\n", ret);
7583e5a335dSHemant Agrawal 			return ret;
7593e5a335dSHemant Agrawal 		}
7603e5a335dSHemant Agrawal 		dpaa2_q->fqid = qid.fqid;
7613e5a335dSHemant Agrawal 	}
7623e5a335dSHemant Agrawal 
763ef18dafeSHemant Agrawal 	/*checksum errors, send them to normal path and set it in annotation */
764ef18dafeSHemant Agrawal 	err_cfg.errors = DPNI_ERROR_L3CE | DPNI_ERROR_L4CE;
765ef18dafeSHemant Agrawal 
766ef18dafeSHemant Agrawal 	err_cfg.error_action = DPNI_ERROR_ACTION_CONTINUE;
767ef18dafeSHemant Agrawal 	err_cfg.set_frame_annotation = true;
768ef18dafeSHemant Agrawal 
769ef18dafeSHemant Agrawal 	ret = dpni_set_errors_behavior(dpni, CMD_PRI_LOW,
770ef18dafeSHemant Agrawal 				       priv->token, &err_cfg);
771ef18dafeSHemant Agrawal 	if (ret) {
772ef18dafeSHemant Agrawal 		PMD_INIT_LOG(ERR, "Error to dpni_set_errors_behavior:"
773ef18dafeSHemant Agrawal 			     "code = %d\n", ret);
774ef18dafeSHemant Agrawal 		return ret;
775ef18dafeSHemant Agrawal 	}
776ef18dafeSHemant Agrawal 
777c5acbb5eSHemant Agrawal 	/* if the interrupts were configured on this devices*/
778c5acbb5eSHemant Agrawal 	if (intr_handle && (intr_handle->fd) &&
779c5acbb5eSHemant Agrawal 	    (dev->data->dev_conf.intr_conf.lsc != 0)) {
780c5acbb5eSHemant Agrawal 		/* Registering LSC interrupt handler */
781c5acbb5eSHemant Agrawal 		rte_intr_callback_register(intr_handle,
782c5acbb5eSHemant Agrawal 					   dpaa2_interrupt_handler,
783c5acbb5eSHemant Agrawal 					   (void *)dev);
784c5acbb5eSHemant Agrawal 
785c5acbb5eSHemant Agrawal 		/* enable vfio intr/eventfd mapping
786c5acbb5eSHemant Agrawal 		 * Interrupt index 0 is required, so we can not use
787c5acbb5eSHemant Agrawal 		 * rte_intr_enable.
788c5acbb5eSHemant Agrawal 		 */
789c5acbb5eSHemant Agrawal 		rte_dpaa2_intr_enable(intr_handle, DPNI_IRQ_INDEX);
790c5acbb5eSHemant Agrawal 
791c5acbb5eSHemant Agrawal 		/* enable dpni_irqs */
792c5acbb5eSHemant Agrawal 		dpaa2_eth_setup_irqs(dev, 1);
793c5acbb5eSHemant Agrawal 	}
794c5acbb5eSHemant Agrawal 
7953e5a335dSHemant Agrawal 	return 0;
7963e5a335dSHemant Agrawal }
7973e5a335dSHemant Agrawal 
7983e5a335dSHemant Agrawal /**
7993e5a335dSHemant Agrawal  *  This routine disables all traffic on the adapter by issuing a
8003e5a335dSHemant Agrawal  *  global reset on the MAC.
8013e5a335dSHemant Agrawal  */
8023e5a335dSHemant Agrawal static void
8033e5a335dSHemant Agrawal dpaa2_dev_stop(struct rte_eth_dev *dev)
8043e5a335dSHemant Agrawal {
8053e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
8063e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
8073e5a335dSHemant Agrawal 	int ret;
808c56c86ffSHemant Agrawal 	struct rte_eth_link link;
809c5acbb5eSHemant Agrawal 	struct rte_intr_handle *intr_handle = dev->intr_handle;
8103e5a335dSHemant Agrawal 
8113e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
8123e5a335dSHemant Agrawal 
813c5acbb5eSHemant Agrawal 	/* reset interrupt callback  */
814c5acbb5eSHemant Agrawal 	if (intr_handle && (intr_handle->fd) &&
815c5acbb5eSHemant Agrawal 	    (dev->data->dev_conf.intr_conf.lsc != 0)) {
816c5acbb5eSHemant Agrawal 		/*disable dpni irqs */
817c5acbb5eSHemant Agrawal 		dpaa2_eth_setup_irqs(dev, 0);
818c5acbb5eSHemant Agrawal 
819c5acbb5eSHemant Agrawal 		/* disable vfio intr before callback unregister */
820c5acbb5eSHemant Agrawal 		rte_dpaa2_intr_disable(intr_handle, DPNI_IRQ_INDEX);
821c5acbb5eSHemant Agrawal 
822c5acbb5eSHemant Agrawal 		/* Unregistering LSC interrupt handler */
823c5acbb5eSHemant Agrawal 		rte_intr_callback_unregister(intr_handle,
824c5acbb5eSHemant Agrawal 					     dpaa2_interrupt_handler,
825c5acbb5eSHemant Agrawal 					     (void *)dev);
826c5acbb5eSHemant Agrawal 	}
827c5acbb5eSHemant Agrawal 
828a1f3a12cSHemant Agrawal 	dpaa2_dev_set_link_down(dev);
829a1f3a12cSHemant Agrawal 
8303e5a335dSHemant Agrawal 	ret = dpni_disable(dpni, CMD_PRI_LOW, priv->token);
8313e5a335dSHemant Agrawal 	if (ret) {
8323e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "Failure (ret %d) in disabling dpni %d dev\n",
8333e5a335dSHemant Agrawal 			     ret, priv->hw_id);
8343e5a335dSHemant Agrawal 		return;
8353e5a335dSHemant Agrawal 	}
836c56c86ffSHemant Agrawal 
837c56c86ffSHemant Agrawal 	/* clear the recorded link status */
838c56c86ffSHemant Agrawal 	memset(&link, 0, sizeof(link));
839c56c86ffSHemant Agrawal 	dpaa2_dev_atomic_write_link_status(dev, &link);
8403e5a335dSHemant Agrawal }
8413e5a335dSHemant Agrawal 
8423e5a335dSHemant Agrawal static void
8433e5a335dSHemant Agrawal dpaa2_dev_close(struct rte_eth_dev *dev)
8443e5a335dSHemant Agrawal {
8457ae777d0SHemant Agrawal 	struct rte_eth_dev_data *data = dev->data;
8463e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
8473e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
8487ae777d0SHemant Agrawal 	int i, ret;
849a1f3a12cSHemant Agrawal 	struct rte_eth_link link;
8507ae777d0SHemant Agrawal 	struct dpaa2_queue *dpaa2_q;
8513e5a335dSHemant Agrawal 
8523e5a335dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
8533e5a335dSHemant Agrawal 
8547ae777d0SHemant Agrawal 	for (i = 0; i < data->nb_tx_queues; i++) {
8557ae777d0SHemant Agrawal 		dpaa2_q = (struct dpaa2_queue *)data->tx_queues[i];
8567ae777d0SHemant Agrawal 		if (!dpaa2_q->cscn) {
8577ae777d0SHemant Agrawal 			rte_free(dpaa2_q->cscn);
8587ae777d0SHemant Agrawal 			dpaa2_q->cscn = NULL;
8597ae777d0SHemant Agrawal 		}
8607ae777d0SHemant Agrawal 	}
8617ae777d0SHemant Agrawal 
8623e5a335dSHemant Agrawal 	/* Clean the device first */
8633e5a335dSHemant Agrawal 	ret = dpni_reset(dpni, CMD_PRI_LOW, priv->token);
8643e5a335dSHemant Agrawal 	if (ret) {
8653e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "Failure cleaning dpni device with"
8663e5a335dSHemant Agrawal 			     " error code %d\n", ret);
8673e5a335dSHemant Agrawal 		return;
8683e5a335dSHemant Agrawal 	}
869a1f3a12cSHemant Agrawal 
870a1f3a12cSHemant Agrawal 	memset(&link, 0, sizeof(link));
871a1f3a12cSHemant Agrawal 	dpaa2_dev_atomic_write_link_status(dev, &link);
8723e5a335dSHemant Agrawal }
8733e5a335dSHemant Agrawal 
874c0e5c69aSHemant Agrawal static void
875c0e5c69aSHemant Agrawal dpaa2_dev_promiscuous_enable(
876c0e5c69aSHemant Agrawal 		struct rte_eth_dev *dev)
877c0e5c69aSHemant Agrawal {
878c0e5c69aSHemant Agrawal 	int ret;
879c0e5c69aSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
880c0e5c69aSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
881c0e5c69aSHemant Agrawal 
882c0e5c69aSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
883c0e5c69aSHemant Agrawal 
884c0e5c69aSHemant Agrawal 	if (dpni == NULL) {
885645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
886c0e5c69aSHemant Agrawal 		return;
887c0e5c69aSHemant Agrawal 	}
888c0e5c69aSHemant Agrawal 
889c0e5c69aSHemant Agrawal 	ret = dpni_set_unicast_promisc(dpni, CMD_PRI_LOW, priv->token, true);
890c0e5c69aSHemant Agrawal 	if (ret < 0)
891645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Unable to enable U promisc mode %d\n", ret);
8925d5aeeedSHemant Agrawal 
8935d5aeeedSHemant Agrawal 	ret = dpni_set_multicast_promisc(dpni, CMD_PRI_LOW, priv->token, true);
8945d5aeeedSHemant Agrawal 	if (ret < 0)
895645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Unable to enable M promisc mode %d\n", ret);
896c0e5c69aSHemant Agrawal }
897c0e5c69aSHemant Agrawal 
898c0e5c69aSHemant Agrawal static void
899c0e5c69aSHemant Agrawal dpaa2_dev_promiscuous_disable(
900c0e5c69aSHemant Agrawal 		struct rte_eth_dev *dev)
901c0e5c69aSHemant Agrawal {
902c0e5c69aSHemant Agrawal 	int ret;
903c0e5c69aSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
904c0e5c69aSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
905c0e5c69aSHemant Agrawal 
906c0e5c69aSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
907c0e5c69aSHemant Agrawal 
908c0e5c69aSHemant Agrawal 	if (dpni == NULL) {
909645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
910c0e5c69aSHemant Agrawal 		return;
911c0e5c69aSHemant Agrawal 	}
912c0e5c69aSHemant Agrawal 
913c0e5c69aSHemant Agrawal 	ret = dpni_set_unicast_promisc(dpni, CMD_PRI_LOW, priv->token, false);
914c0e5c69aSHemant Agrawal 	if (ret < 0)
915645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Unable to disable U promisc mode %d\n", ret);
9165d5aeeedSHemant Agrawal 
9175d5aeeedSHemant Agrawal 	if (dev->data->all_multicast == 0) {
9185d5aeeedSHemant Agrawal 		ret = dpni_set_multicast_promisc(dpni, CMD_PRI_LOW,
9195d5aeeedSHemant Agrawal 						 priv->token, false);
9205d5aeeedSHemant Agrawal 		if (ret < 0)
921645bd25aSHemant Agrawal 			RTE_LOG(ERR, PMD,
922645bd25aSHemant Agrawal 				"Unable to disable M promisc mode %d\n",
9235d5aeeedSHemant Agrawal 				ret);
9245d5aeeedSHemant Agrawal 	}
9255d5aeeedSHemant Agrawal }
9265d5aeeedSHemant Agrawal 
9275d5aeeedSHemant Agrawal static void
9285d5aeeedSHemant Agrawal dpaa2_dev_allmulticast_enable(
9295d5aeeedSHemant Agrawal 		struct rte_eth_dev *dev)
9305d5aeeedSHemant Agrawal {
9315d5aeeedSHemant Agrawal 	int ret;
9325d5aeeedSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
9335d5aeeedSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
9345d5aeeedSHemant Agrawal 
9355d5aeeedSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
9365d5aeeedSHemant Agrawal 
9375d5aeeedSHemant Agrawal 	if (dpni == NULL) {
938645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
9395d5aeeedSHemant Agrawal 		return;
9405d5aeeedSHemant Agrawal 	}
9415d5aeeedSHemant Agrawal 
9425d5aeeedSHemant Agrawal 	ret = dpni_set_multicast_promisc(dpni, CMD_PRI_LOW, priv->token, true);
9435d5aeeedSHemant Agrawal 	if (ret < 0)
944645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Unable to enable multicast mode %d\n", ret);
9455d5aeeedSHemant Agrawal }
9465d5aeeedSHemant Agrawal 
9475d5aeeedSHemant Agrawal static void
9485d5aeeedSHemant Agrawal dpaa2_dev_allmulticast_disable(struct rte_eth_dev *dev)
9495d5aeeedSHemant Agrawal {
9505d5aeeedSHemant Agrawal 	int ret;
9515d5aeeedSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
9525d5aeeedSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
9535d5aeeedSHemant Agrawal 
9545d5aeeedSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
9555d5aeeedSHemant Agrawal 
9565d5aeeedSHemant Agrawal 	if (dpni == NULL) {
957645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
9585d5aeeedSHemant Agrawal 		return;
9595d5aeeedSHemant Agrawal 	}
9605d5aeeedSHemant Agrawal 
9615d5aeeedSHemant Agrawal 	/* must remain on for all promiscuous */
9625d5aeeedSHemant Agrawal 	if (dev->data->promiscuous == 1)
9635d5aeeedSHemant Agrawal 		return;
9645d5aeeedSHemant Agrawal 
9655d5aeeedSHemant Agrawal 	ret = dpni_set_multicast_promisc(dpni, CMD_PRI_LOW, priv->token, false);
9665d5aeeedSHemant Agrawal 	if (ret < 0)
967645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Unable to disable multicast mode %d\n", ret);
968c0e5c69aSHemant Agrawal }
969e31d4d21SHemant Agrawal 
970e31d4d21SHemant Agrawal static int
971e31d4d21SHemant Agrawal dpaa2_dev_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
972e31d4d21SHemant Agrawal {
973e31d4d21SHemant Agrawal 	int ret;
974e31d4d21SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
975e31d4d21SHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
97644ea7355SAshish Jain 	uint32_t frame_size = mtu + ETHER_HDR_LEN + ETHER_CRC_LEN
97744ea7355SAshish Jain 				+ VLAN_TAG_SIZE;
978e31d4d21SHemant Agrawal 
979e31d4d21SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
980e31d4d21SHemant Agrawal 
981e31d4d21SHemant Agrawal 	if (dpni == NULL) {
982645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
983e31d4d21SHemant Agrawal 		return -EINVAL;
984e31d4d21SHemant Agrawal 	}
985e31d4d21SHemant Agrawal 
986e31d4d21SHemant Agrawal 	/* check that mtu is within the allowed range */
987e31d4d21SHemant Agrawal 	if ((mtu < ETHER_MIN_MTU) || (frame_size > DPAA2_MAX_RX_PKT_LEN))
988e31d4d21SHemant Agrawal 		return -EINVAL;
989e31d4d21SHemant Agrawal 
990e1640849SHemant Agrawal 	if (frame_size > ETHER_MAX_LEN)
991e1640849SHemant Agrawal 		dev->data->dev_conf.rxmode.jumbo_frame = 1;
992e1640849SHemant Agrawal 	else
993e1640849SHemant Agrawal 		dev->data->dev_conf.rxmode.jumbo_frame = 0;
994e1640849SHemant Agrawal 
99544ea7355SAshish Jain 	dev->data->dev_conf.rxmode.max_rx_pkt_len = frame_size;
99644ea7355SAshish Jain 
997e31d4d21SHemant Agrawal 	/* Set the Max Rx frame length as 'mtu' +
998e31d4d21SHemant Agrawal 	 * Maximum Ethernet header length
999e31d4d21SHemant Agrawal 	 */
1000e31d4d21SHemant Agrawal 	ret = dpni_set_max_frame_length(dpni, CMD_PRI_LOW, priv->token,
100144ea7355SAshish Jain 					frame_size);
1002e31d4d21SHemant Agrawal 	if (ret) {
1003e31d4d21SHemant Agrawal 		PMD_DRV_LOG(ERR, "setting the max frame length failed");
1004e31d4d21SHemant Agrawal 		return -1;
1005e31d4d21SHemant Agrawal 	}
10062bfea039SHemant Agrawal 	PMD_DRV_LOG(INFO, "MTU is configured %d for the device", mtu);
1007e31d4d21SHemant Agrawal 	return 0;
1008e31d4d21SHemant Agrawal }
1009e31d4d21SHemant Agrawal 
1010b4d97b7dSHemant Agrawal static int
1011b4d97b7dSHemant Agrawal dpaa2_dev_add_mac_addr(struct rte_eth_dev *dev,
1012b4d97b7dSHemant Agrawal 		       struct ether_addr *addr,
1013b4d97b7dSHemant Agrawal 		       __rte_unused uint32_t index,
1014b4d97b7dSHemant Agrawal 		       __rte_unused uint32_t pool)
1015b4d97b7dSHemant Agrawal {
1016b4d97b7dSHemant Agrawal 	int ret;
1017b4d97b7dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1018b4d97b7dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
1019b4d97b7dSHemant Agrawal 
1020b4d97b7dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1021b4d97b7dSHemant Agrawal 
1022b4d97b7dSHemant Agrawal 	if (dpni == NULL) {
1023645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1024b4d97b7dSHemant Agrawal 		return -1;
1025b4d97b7dSHemant Agrawal 	}
1026b4d97b7dSHemant Agrawal 
1027b4d97b7dSHemant Agrawal 	ret = dpni_add_mac_addr(dpni, CMD_PRI_LOW,
1028b4d97b7dSHemant Agrawal 				priv->token, addr->addr_bytes);
1029b4d97b7dSHemant Agrawal 	if (ret)
1030645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD,
1031645bd25aSHemant Agrawal 			"error: Adding the MAC ADDR failed: err = %d\n", ret);
1032b4d97b7dSHemant Agrawal 	return 0;
1033b4d97b7dSHemant Agrawal }
1034b4d97b7dSHemant Agrawal 
1035b4d97b7dSHemant Agrawal static void
1036b4d97b7dSHemant Agrawal dpaa2_dev_remove_mac_addr(struct rte_eth_dev *dev,
1037b4d97b7dSHemant Agrawal 			  uint32_t index)
1038b4d97b7dSHemant Agrawal {
1039b4d97b7dSHemant Agrawal 	int ret;
1040b4d97b7dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1041b4d97b7dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
1042b4d97b7dSHemant Agrawal 	struct rte_eth_dev_data *data = dev->data;
1043b4d97b7dSHemant Agrawal 	struct ether_addr *macaddr;
1044b4d97b7dSHemant Agrawal 
1045b4d97b7dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1046b4d97b7dSHemant Agrawal 
1047b4d97b7dSHemant Agrawal 	macaddr = &data->mac_addrs[index];
1048b4d97b7dSHemant Agrawal 
1049b4d97b7dSHemant Agrawal 	if (dpni == NULL) {
1050645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1051b4d97b7dSHemant Agrawal 		return;
1052b4d97b7dSHemant Agrawal 	}
1053b4d97b7dSHemant Agrawal 
1054b4d97b7dSHemant Agrawal 	ret = dpni_remove_mac_addr(dpni, CMD_PRI_LOW,
1055b4d97b7dSHemant Agrawal 				   priv->token, macaddr->addr_bytes);
1056b4d97b7dSHemant Agrawal 	if (ret)
1057645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD,
1058645bd25aSHemant Agrawal 			"error: Removing the MAC ADDR failed: err = %d\n", ret);
1059b4d97b7dSHemant Agrawal }
1060b4d97b7dSHemant Agrawal 
1061b4d97b7dSHemant Agrawal static void
1062b4d97b7dSHemant Agrawal dpaa2_dev_set_mac_addr(struct rte_eth_dev *dev,
1063b4d97b7dSHemant Agrawal 		       struct ether_addr *addr)
1064b4d97b7dSHemant Agrawal {
1065b4d97b7dSHemant Agrawal 	int ret;
1066b4d97b7dSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1067b4d97b7dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
1068b4d97b7dSHemant Agrawal 
1069b4d97b7dSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1070b4d97b7dSHemant Agrawal 
1071b4d97b7dSHemant Agrawal 	if (dpni == NULL) {
1072645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1073b4d97b7dSHemant Agrawal 		return;
1074b4d97b7dSHemant Agrawal 	}
1075b4d97b7dSHemant Agrawal 
1076b4d97b7dSHemant Agrawal 	ret = dpni_set_primary_mac_addr(dpni, CMD_PRI_LOW,
1077b4d97b7dSHemant Agrawal 					priv->token, addr->addr_bytes);
1078b4d97b7dSHemant Agrawal 
1079b4d97b7dSHemant Agrawal 	if (ret)
1080645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD,
1081645bd25aSHemant Agrawal 			"error: Setting the MAC ADDR failed %d\n", ret);
1082b4d97b7dSHemant Agrawal }
1083b0aa5459SHemant Agrawal static
1084d5b0924bSMatan Azrad int dpaa2_dev_stats_get(struct rte_eth_dev *dev,
1085b0aa5459SHemant Agrawal 			 struct rte_eth_stats *stats)
1086b0aa5459SHemant Agrawal {
1087b0aa5459SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1088b0aa5459SHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
1089b0aa5459SHemant Agrawal 	int32_t  retcode;
1090b0aa5459SHemant Agrawal 	uint8_t page0 = 0, page1 = 1, page2 = 2;
1091b0aa5459SHemant Agrawal 	union dpni_statistics value;
1092b0aa5459SHemant Agrawal 
1093b0aa5459SHemant Agrawal 	memset(&value, 0, sizeof(union dpni_statistics));
1094b0aa5459SHemant Agrawal 
1095b0aa5459SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1096b0aa5459SHemant Agrawal 
1097b0aa5459SHemant Agrawal 	if (!dpni) {
1098645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1099d5b0924bSMatan Azrad 		return -EINVAL;
1100b0aa5459SHemant Agrawal 	}
1101b0aa5459SHemant Agrawal 
1102b0aa5459SHemant Agrawal 	if (!stats) {
1103645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "stats is NULL\n");
1104d5b0924bSMatan Azrad 		return -EINVAL;
1105b0aa5459SHemant Agrawal 	}
1106b0aa5459SHemant Agrawal 
1107b0aa5459SHemant Agrawal 	/*Get Counters from page_0*/
1108b0aa5459SHemant Agrawal 	retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
110916bbc98aSShreyansh Jain 				      page0, 0, &value);
1110b0aa5459SHemant Agrawal 	if (retcode)
1111b0aa5459SHemant Agrawal 		goto err;
1112b0aa5459SHemant Agrawal 
1113b0aa5459SHemant Agrawal 	stats->ipackets = value.page_0.ingress_all_frames;
1114b0aa5459SHemant Agrawal 	stats->ibytes = value.page_0.ingress_all_bytes;
1115b0aa5459SHemant Agrawal 
1116b0aa5459SHemant Agrawal 	/*Get Counters from page_1*/
1117b0aa5459SHemant Agrawal 	retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
111816bbc98aSShreyansh Jain 				      page1, 0, &value);
1119b0aa5459SHemant Agrawal 	if (retcode)
1120b0aa5459SHemant Agrawal 		goto err;
1121b0aa5459SHemant Agrawal 
1122b0aa5459SHemant Agrawal 	stats->opackets = value.page_1.egress_all_frames;
1123b0aa5459SHemant Agrawal 	stats->obytes = value.page_1.egress_all_bytes;
1124b0aa5459SHemant Agrawal 
1125b0aa5459SHemant Agrawal 	/*Get Counters from page_2*/
1126b0aa5459SHemant Agrawal 	retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
112716bbc98aSShreyansh Jain 				      page2, 0, &value);
1128b0aa5459SHemant Agrawal 	if (retcode)
1129b0aa5459SHemant Agrawal 		goto err;
1130b0aa5459SHemant Agrawal 
1131b4d97b7dSHemant Agrawal 	/* Ingress drop frame count due to configured rules */
1132b4d97b7dSHemant Agrawal 	stats->ierrors = value.page_2.ingress_filtered_frames;
1133b4d97b7dSHemant Agrawal 	/* Ingress drop frame count due to error */
1134b4d97b7dSHemant Agrawal 	stats->ierrors += value.page_2.ingress_discarded_frames;
1135b4d97b7dSHemant Agrawal 
1136b0aa5459SHemant Agrawal 	stats->oerrors = value.page_2.egress_discarded_frames;
1137b0aa5459SHemant Agrawal 	stats->imissed = value.page_2.ingress_nobuffer_discards;
1138b0aa5459SHemant Agrawal 
1139d5b0924bSMatan Azrad 	return 0;
1140b0aa5459SHemant Agrawal 
1141b0aa5459SHemant Agrawal err:
1142b0aa5459SHemant Agrawal 	RTE_LOG(ERR, PMD, "Operation not completed:Error Code = %d\n", retcode);
1143d5b0924bSMatan Azrad 	return retcode;
1144b0aa5459SHemant Agrawal };
1145b0aa5459SHemant Agrawal 
11461d6329b2SHemant Agrawal static int
11471d6329b2SHemant Agrawal dpaa2_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
11481d6329b2SHemant Agrawal 		     unsigned int n)
11491d6329b2SHemant Agrawal {
11501d6329b2SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
11511d6329b2SHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
11521d6329b2SHemant Agrawal 	int32_t  retcode;
11531d6329b2SHemant Agrawal 	union dpni_statistics value[3] = {};
11541d6329b2SHemant Agrawal 	unsigned int i = 0, num = RTE_DIM(dpaa2_xstats_strings);
11551d6329b2SHemant Agrawal 
11561d6329b2SHemant Agrawal 	if (xstats == NULL)
11571d6329b2SHemant Agrawal 		return 0;
11581d6329b2SHemant Agrawal 
11591d6329b2SHemant Agrawal 	if (n < num)
11601d6329b2SHemant Agrawal 		return num;
11611d6329b2SHemant Agrawal 
11621d6329b2SHemant Agrawal 	/* Get Counters from page_0*/
11631d6329b2SHemant Agrawal 	retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
11641d6329b2SHemant Agrawal 				      0, 0, &value[0]);
11651d6329b2SHemant Agrawal 	if (retcode)
11661d6329b2SHemant Agrawal 		goto err;
11671d6329b2SHemant Agrawal 
11681d6329b2SHemant Agrawal 	/* Get Counters from page_1*/
11691d6329b2SHemant Agrawal 	retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
11701d6329b2SHemant Agrawal 				      1, 0, &value[1]);
11711d6329b2SHemant Agrawal 	if (retcode)
11721d6329b2SHemant Agrawal 		goto err;
11731d6329b2SHemant Agrawal 
11741d6329b2SHemant Agrawal 	/* Get Counters from page_2*/
11751d6329b2SHemant Agrawal 	retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
11761d6329b2SHemant Agrawal 				      2, 0, &value[2]);
11771d6329b2SHemant Agrawal 	if (retcode)
11781d6329b2SHemant Agrawal 		goto err;
11791d6329b2SHemant Agrawal 
11801d6329b2SHemant Agrawal 	for (i = 0; i < num; i++) {
11811d6329b2SHemant Agrawal 		xstats[i].id = i;
11821d6329b2SHemant Agrawal 		xstats[i].value = value[dpaa2_xstats_strings[i].page_id].
11831d6329b2SHemant Agrawal 			raw.counter[dpaa2_xstats_strings[i].stats_id];
11841d6329b2SHemant Agrawal 	}
11851d6329b2SHemant Agrawal 	return i;
11861d6329b2SHemant Agrawal err:
11871d6329b2SHemant Agrawal 	RTE_LOG(ERR, PMD, "Error in obtaining extended stats (%d)\n", retcode);
11881d6329b2SHemant Agrawal 	return retcode;
11891d6329b2SHemant Agrawal }
11901d6329b2SHemant Agrawal 
11911d6329b2SHemant Agrawal static int
11921d6329b2SHemant Agrawal dpaa2_xstats_get_names(__rte_unused struct rte_eth_dev *dev,
11931d6329b2SHemant Agrawal 		       struct rte_eth_xstat_name *xstats_names,
11941d6329b2SHemant Agrawal 		       __rte_unused unsigned int limit)
11951d6329b2SHemant Agrawal {
11961d6329b2SHemant Agrawal 	unsigned int i, stat_cnt = RTE_DIM(dpaa2_xstats_strings);
11971d6329b2SHemant Agrawal 
11981d6329b2SHemant Agrawal 	if (xstats_names != NULL)
11991d6329b2SHemant Agrawal 		for (i = 0; i < stat_cnt; i++)
12001d6329b2SHemant Agrawal 			snprintf(xstats_names[i].name,
12011d6329b2SHemant Agrawal 				 sizeof(xstats_names[i].name),
12021d6329b2SHemant Agrawal 				 "%s",
12031d6329b2SHemant Agrawal 				 dpaa2_xstats_strings[i].name);
12041d6329b2SHemant Agrawal 
12051d6329b2SHemant Agrawal 	return stat_cnt;
12061d6329b2SHemant Agrawal }
12071d6329b2SHemant Agrawal 
12081d6329b2SHemant Agrawal static int
12091d6329b2SHemant Agrawal dpaa2_xstats_get_by_id(struct rte_eth_dev *dev, const uint64_t *ids,
12101d6329b2SHemant Agrawal 		       uint64_t *values, unsigned int n)
12111d6329b2SHemant Agrawal {
12121d6329b2SHemant Agrawal 	unsigned int i, stat_cnt = RTE_DIM(dpaa2_xstats_strings);
12131d6329b2SHemant Agrawal 	uint64_t values_copy[stat_cnt];
12141d6329b2SHemant Agrawal 
12151d6329b2SHemant Agrawal 	if (!ids) {
12161d6329b2SHemant Agrawal 		struct dpaa2_dev_priv *priv = dev->data->dev_private;
12171d6329b2SHemant Agrawal 		struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
12181d6329b2SHemant Agrawal 		int32_t  retcode;
12191d6329b2SHemant Agrawal 		union dpni_statistics value[3] = {};
12201d6329b2SHemant Agrawal 
12211d6329b2SHemant Agrawal 		if (n < stat_cnt)
12221d6329b2SHemant Agrawal 			return stat_cnt;
12231d6329b2SHemant Agrawal 
12241d6329b2SHemant Agrawal 		if (!values)
12251d6329b2SHemant Agrawal 			return 0;
12261d6329b2SHemant Agrawal 
12271d6329b2SHemant Agrawal 		/* Get Counters from page_0*/
12281d6329b2SHemant Agrawal 		retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
12291d6329b2SHemant Agrawal 					      0, 0, &value[0]);
12301d6329b2SHemant Agrawal 		if (retcode)
12311d6329b2SHemant Agrawal 			return 0;
12321d6329b2SHemant Agrawal 
12331d6329b2SHemant Agrawal 		/* Get Counters from page_1*/
12341d6329b2SHemant Agrawal 		retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
12351d6329b2SHemant Agrawal 					      1, 0, &value[1]);
12361d6329b2SHemant Agrawal 		if (retcode)
12371d6329b2SHemant Agrawal 			return 0;
12381d6329b2SHemant Agrawal 
12391d6329b2SHemant Agrawal 		/* Get Counters from page_2*/
12401d6329b2SHemant Agrawal 		retcode = dpni_get_statistics(dpni, CMD_PRI_LOW, priv->token,
12411d6329b2SHemant Agrawal 					      2, 0, &value[2]);
12421d6329b2SHemant Agrawal 		if (retcode)
12431d6329b2SHemant Agrawal 			return 0;
12441d6329b2SHemant Agrawal 
12451d6329b2SHemant Agrawal 		for (i = 0; i < stat_cnt; i++) {
12461d6329b2SHemant Agrawal 			values[i] = value[dpaa2_xstats_strings[i].page_id].
12471d6329b2SHemant Agrawal 				raw.counter[dpaa2_xstats_strings[i].stats_id];
12481d6329b2SHemant Agrawal 		}
12491d6329b2SHemant Agrawal 		return stat_cnt;
12501d6329b2SHemant Agrawal 	}
12511d6329b2SHemant Agrawal 
12521d6329b2SHemant Agrawal 	dpaa2_xstats_get_by_id(dev, NULL, values_copy, stat_cnt);
12531d6329b2SHemant Agrawal 
12541d6329b2SHemant Agrawal 	for (i = 0; i < n; i++) {
12551d6329b2SHemant Agrawal 		if (ids[i] >= stat_cnt) {
12561d6329b2SHemant Agrawal 			PMD_INIT_LOG(ERR, "id value isn't valid");
12571d6329b2SHemant Agrawal 			return -1;
12581d6329b2SHemant Agrawal 		}
12591d6329b2SHemant Agrawal 		values[i] = values_copy[ids[i]];
12601d6329b2SHemant Agrawal 	}
12611d6329b2SHemant Agrawal 	return n;
12621d6329b2SHemant Agrawal }
12631d6329b2SHemant Agrawal 
12641d6329b2SHemant Agrawal static int
12651d6329b2SHemant Agrawal dpaa2_xstats_get_names_by_id(
12661d6329b2SHemant Agrawal 	struct rte_eth_dev *dev,
12671d6329b2SHemant Agrawal 	struct rte_eth_xstat_name *xstats_names,
12681d6329b2SHemant Agrawal 	const uint64_t *ids,
12691d6329b2SHemant Agrawal 	unsigned int limit)
12701d6329b2SHemant Agrawal {
12711d6329b2SHemant Agrawal 	unsigned int i, stat_cnt = RTE_DIM(dpaa2_xstats_strings);
12721d6329b2SHemant Agrawal 	struct rte_eth_xstat_name xstats_names_copy[stat_cnt];
12731d6329b2SHemant Agrawal 
12741d6329b2SHemant Agrawal 	if (!ids)
12751d6329b2SHemant Agrawal 		return dpaa2_xstats_get_names(dev, xstats_names, limit);
12761d6329b2SHemant Agrawal 
12771d6329b2SHemant Agrawal 	dpaa2_xstats_get_names(dev, xstats_names_copy, limit);
12781d6329b2SHemant Agrawal 
12791d6329b2SHemant Agrawal 	for (i = 0; i < limit; i++) {
12801d6329b2SHemant Agrawal 		if (ids[i] >= stat_cnt) {
12811d6329b2SHemant Agrawal 			PMD_INIT_LOG(ERR, "id value isn't valid");
12821d6329b2SHemant Agrawal 			return -1;
12831d6329b2SHemant Agrawal 		}
12841d6329b2SHemant Agrawal 		strcpy(xstats_names[i].name, xstats_names_copy[ids[i]].name);
12851d6329b2SHemant Agrawal 	}
12861d6329b2SHemant Agrawal 	return limit;
12871d6329b2SHemant Agrawal }
12881d6329b2SHemant Agrawal 
12891d6329b2SHemant Agrawal static void
12901d6329b2SHemant Agrawal dpaa2_dev_stats_reset(struct rte_eth_dev *dev)
1291b0aa5459SHemant Agrawal {
1292b0aa5459SHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1293b0aa5459SHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
1294b0aa5459SHemant Agrawal 	int32_t  retcode;
1295b0aa5459SHemant Agrawal 
1296b0aa5459SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1297b0aa5459SHemant Agrawal 
1298b0aa5459SHemant Agrawal 	if (dpni == NULL) {
1299645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1300b0aa5459SHemant Agrawal 		return;
1301b0aa5459SHemant Agrawal 	}
1302b0aa5459SHemant Agrawal 
1303b0aa5459SHemant Agrawal 	retcode =  dpni_reset_statistics(dpni, CMD_PRI_LOW, priv->token);
1304b0aa5459SHemant Agrawal 	if (retcode)
1305b0aa5459SHemant Agrawal 		goto error;
1306b0aa5459SHemant Agrawal 
1307b0aa5459SHemant Agrawal 	return;
1308b0aa5459SHemant Agrawal 
1309b0aa5459SHemant Agrawal error:
1310b0aa5459SHemant Agrawal 	RTE_LOG(ERR, PMD, "Operation not completed:Error Code = %d\n", retcode);
1311b0aa5459SHemant Agrawal 	return;
1312b0aa5459SHemant Agrawal };
1313b0aa5459SHemant Agrawal 
1314c56c86ffSHemant Agrawal /* return 0 means link status changed, -1 means not changed */
1315c56c86ffSHemant Agrawal static int
1316c56c86ffSHemant Agrawal dpaa2_dev_link_update(struct rte_eth_dev *dev,
1317c56c86ffSHemant Agrawal 			int wait_to_complete __rte_unused)
1318c56c86ffSHemant Agrawal {
1319c56c86ffSHemant Agrawal 	int ret;
1320c56c86ffSHemant Agrawal 	struct dpaa2_dev_priv *priv = dev->data->dev_private;
1321c56c86ffSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
1322c56c86ffSHemant Agrawal 	struct rte_eth_link link, old;
1323c56c86ffSHemant Agrawal 	struct dpni_link_state state = {0};
1324c56c86ffSHemant Agrawal 
1325c56c86ffSHemant Agrawal 	if (dpni == NULL) {
1326645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1327c56c86ffSHemant Agrawal 		return 0;
1328c56c86ffSHemant Agrawal 	}
1329c56c86ffSHemant Agrawal 	memset(&old, 0, sizeof(old));
1330c56c86ffSHemant Agrawal 	dpaa2_dev_atomic_read_link_status(dev, &old);
1331c56c86ffSHemant Agrawal 
1332c56c86ffSHemant Agrawal 	ret = dpni_get_link_state(dpni, CMD_PRI_LOW, priv->token, &state);
1333c56c86ffSHemant Agrawal 	if (ret < 0) {
1334645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "error: dpni_get_link_state %d\n", ret);
1335c56c86ffSHemant Agrawal 		return -1;
1336c56c86ffSHemant Agrawal 	}
1337c56c86ffSHemant Agrawal 
1338c56c86ffSHemant Agrawal 	if ((old.link_status == state.up) && (old.link_speed == state.rate)) {
1339c56c86ffSHemant Agrawal 		RTE_LOG(DEBUG, PMD, "No change in status\n");
1340c56c86ffSHemant Agrawal 		return -1;
1341c56c86ffSHemant Agrawal 	}
1342c56c86ffSHemant Agrawal 
1343c56c86ffSHemant Agrawal 	memset(&link, 0, sizeof(struct rte_eth_link));
1344c56c86ffSHemant Agrawal 	link.link_status = state.up;
1345c56c86ffSHemant Agrawal 	link.link_speed = state.rate;
1346c56c86ffSHemant Agrawal 
1347c56c86ffSHemant Agrawal 	if (state.options & DPNI_LINK_OPT_HALF_DUPLEX)
1348c56c86ffSHemant Agrawal 		link.link_duplex = ETH_LINK_HALF_DUPLEX;
1349c56c86ffSHemant Agrawal 	else
1350c56c86ffSHemant Agrawal 		link.link_duplex = ETH_LINK_FULL_DUPLEX;
1351c56c86ffSHemant Agrawal 
1352c56c86ffSHemant Agrawal 	dpaa2_dev_atomic_write_link_status(dev, &link);
1353c56c86ffSHemant Agrawal 
1354c56c86ffSHemant Agrawal 	if (link.link_status)
1355c56c86ffSHemant Agrawal 		PMD_DRV_LOG(INFO, "Port %d Link is Up\n", dev->data->port_id);
1356c56c86ffSHemant Agrawal 	else
1357aa8c595aSHemant Agrawal 		PMD_DRV_LOG(INFO, "Port %d Link is Down", dev->data->port_id);
1358c56c86ffSHemant Agrawal 	return 0;
1359c56c86ffSHemant Agrawal }
1360c56c86ffSHemant Agrawal 
1361a1f3a12cSHemant Agrawal /**
1362a1f3a12cSHemant Agrawal  * Toggle the DPNI to enable, if not already enabled.
1363a1f3a12cSHemant Agrawal  * This is not strictly PHY up/down - it is more of logical toggling.
1364a1f3a12cSHemant Agrawal  */
1365a1f3a12cSHemant Agrawal static int
1366a1f3a12cSHemant Agrawal dpaa2_dev_set_link_up(struct rte_eth_dev *dev)
1367a1f3a12cSHemant Agrawal {
1368a1f3a12cSHemant Agrawal 	int ret = -EINVAL;
1369a1f3a12cSHemant Agrawal 	struct dpaa2_dev_priv *priv;
1370a1f3a12cSHemant Agrawal 	struct fsl_mc_io *dpni;
1371a1f3a12cSHemant Agrawal 	int en = 0;
1372aa8c595aSHemant Agrawal 	struct dpni_link_state state = {0};
1373a1f3a12cSHemant Agrawal 
1374a1f3a12cSHemant Agrawal 	priv = dev->data->dev_private;
1375a1f3a12cSHemant Agrawal 	dpni = (struct fsl_mc_io *)priv->hw;
1376a1f3a12cSHemant Agrawal 
1377a1f3a12cSHemant Agrawal 	if (dpni == NULL) {
1378645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "DPNI is NULL\n");
1379a1f3a12cSHemant Agrawal 		return ret;
1380a1f3a12cSHemant Agrawal 	}
1381a1f3a12cSHemant Agrawal 
1382a1f3a12cSHemant Agrawal 	/* Check if DPNI is currently enabled */
1383a1f3a12cSHemant Agrawal 	ret = dpni_is_enabled(dpni, CMD_PRI_LOW, priv->token, &en);
1384a1f3a12cSHemant Agrawal 	if (ret) {
1385a1f3a12cSHemant Agrawal 		/* Unable to obtain dpni status; Not continuing */
1386a1f3a12cSHemant Agrawal 		PMD_DRV_LOG(ERR, "Interface Link UP failed (%d)", ret);
1387a1f3a12cSHemant Agrawal 		return -EINVAL;
1388a1f3a12cSHemant Agrawal 	}
1389a1f3a12cSHemant Agrawal 
1390a1f3a12cSHemant Agrawal 	/* Enable link if not already enabled */
1391a1f3a12cSHemant Agrawal 	if (!en) {
1392a1f3a12cSHemant Agrawal 		ret = dpni_enable(dpni, CMD_PRI_LOW, priv->token);
1393a1f3a12cSHemant Agrawal 		if (ret) {
1394a1f3a12cSHemant Agrawal 			PMD_DRV_LOG(ERR, "Interface Link UP failed (%d)", ret);
1395a1f3a12cSHemant Agrawal 			return -EINVAL;
1396a1f3a12cSHemant Agrawal 		}
1397a1f3a12cSHemant Agrawal 	}
1398aa8c595aSHemant Agrawal 	ret = dpni_get_link_state(dpni, CMD_PRI_LOW, priv->token, &state);
1399aa8c595aSHemant Agrawal 	if (ret < 0) {
1400aa8c595aSHemant Agrawal 		RTE_LOG(ERR, PMD, "error: dpni_get_link_state %d\n", ret);
1401aa8c595aSHemant Agrawal 		return -1;
1402aa8c595aSHemant Agrawal 	}
1403aa8c595aSHemant Agrawal 
1404a1f3a12cSHemant Agrawal 	/* changing tx burst function to start enqueues */
1405a1f3a12cSHemant Agrawal 	dev->tx_pkt_burst = dpaa2_dev_tx;
1406aa8c595aSHemant Agrawal 	dev->data->dev_link.link_status = state.up;
1407a1f3a12cSHemant Agrawal 
1408aa8c595aSHemant Agrawal 	if (state.up)
1409aa8c595aSHemant Agrawal 		PMD_DRV_LOG(INFO, "Port %d Link is set as UP",
1410aa8c595aSHemant Agrawal 			    dev->data->port_id);
1411aa8c595aSHemant Agrawal 	else
1412aa8c595aSHemant Agrawal 		PMD_DRV_LOG(INFO, "Port %d Link is DOWN", dev->data->port_id);
1413a1f3a12cSHemant Agrawal 	return ret;
1414a1f3a12cSHemant Agrawal }
1415a1f3a12cSHemant Agrawal 
1416a1f3a12cSHemant Agrawal /**
1417a1f3a12cSHemant Agrawal  * Toggle the DPNI to disable, if not already disabled.
1418a1f3a12cSHemant Agrawal  * This is not strictly PHY up/down - it is more of logical toggling.
1419a1f3a12cSHemant Agrawal  */
1420a1f3a12cSHemant Agrawal static int
1421a1f3a12cSHemant Agrawal dpaa2_dev_set_link_down(struct rte_eth_dev *dev)
1422a1f3a12cSHemant Agrawal {
1423a1f3a12cSHemant Agrawal 	int ret = -EINVAL;
1424a1f3a12cSHemant Agrawal 	struct dpaa2_dev_priv *priv;
1425a1f3a12cSHemant Agrawal 	struct fsl_mc_io *dpni;
1426a1f3a12cSHemant Agrawal 	int dpni_enabled = 0;
1427a1f3a12cSHemant Agrawal 	int retries = 10;
1428a1f3a12cSHemant Agrawal 
1429a1f3a12cSHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1430a1f3a12cSHemant Agrawal 
1431a1f3a12cSHemant Agrawal 	priv = dev->data->dev_private;
1432a1f3a12cSHemant Agrawal 	dpni = (struct fsl_mc_io *)priv->hw;
1433a1f3a12cSHemant Agrawal 
1434a1f3a12cSHemant Agrawal 	if (dpni == NULL) {
1435645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Device has not yet been configured\n");
1436a1f3a12cSHemant Agrawal 		return ret;
1437a1f3a12cSHemant Agrawal 	}
1438a1f3a12cSHemant Agrawal 
1439a1f3a12cSHemant Agrawal 	/*changing  tx burst function to avoid any more enqueues */
1440a1f3a12cSHemant Agrawal 	dev->tx_pkt_burst = dummy_dev_tx;
1441a1f3a12cSHemant Agrawal 
1442a1f3a12cSHemant Agrawal 	/* Loop while dpni_disable() attempts to drain the egress FQs
1443a1f3a12cSHemant Agrawal 	 * and confirm them back to us.
1444a1f3a12cSHemant Agrawal 	 */
1445a1f3a12cSHemant Agrawal 	do {
1446a1f3a12cSHemant Agrawal 		ret = dpni_disable(dpni, 0, priv->token);
1447a1f3a12cSHemant Agrawal 		if (ret) {
1448a1f3a12cSHemant Agrawal 			PMD_DRV_LOG(ERR, "dpni disable failed (%d)", ret);
1449a1f3a12cSHemant Agrawal 			return ret;
1450a1f3a12cSHemant Agrawal 		}
1451a1f3a12cSHemant Agrawal 		ret = dpni_is_enabled(dpni, 0, priv->token, &dpni_enabled);
1452a1f3a12cSHemant Agrawal 		if (ret) {
1453a1f3a12cSHemant Agrawal 			PMD_DRV_LOG(ERR, "dpni_is_enabled failed (%d)", ret);
1454a1f3a12cSHemant Agrawal 			return ret;
1455a1f3a12cSHemant Agrawal 		}
1456a1f3a12cSHemant Agrawal 		if (dpni_enabled)
1457a1f3a12cSHemant Agrawal 			/* Allow the MC some slack */
1458a1f3a12cSHemant Agrawal 			rte_delay_us(100 * 1000);
1459a1f3a12cSHemant Agrawal 	} while (dpni_enabled && --retries);
1460a1f3a12cSHemant Agrawal 
1461a1f3a12cSHemant Agrawal 	if (!retries) {
1462a1f3a12cSHemant Agrawal 		PMD_DRV_LOG(WARNING, "Retry count exceeded disabling DPNI\n");
1463a1f3a12cSHemant Agrawal 		/* todo- we may have to manually cleanup queues.
1464a1f3a12cSHemant Agrawal 		 */
1465a1f3a12cSHemant Agrawal 	} else {
1466a1f3a12cSHemant Agrawal 		PMD_DRV_LOG(INFO, "Port %d Link DOWN successful",
1467a1f3a12cSHemant Agrawal 			    dev->data->port_id);
1468a1f3a12cSHemant Agrawal 	}
1469a1f3a12cSHemant Agrawal 
1470a1f3a12cSHemant Agrawal 	dev->data->dev_link.link_status = 0;
1471a1f3a12cSHemant Agrawal 
1472a1f3a12cSHemant Agrawal 	return ret;
1473a1f3a12cSHemant Agrawal }
1474a1f3a12cSHemant Agrawal 
1475977d0006SHemant Agrawal static int
1476977d0006SHemant Agrawal dpaa2_flow_ctrl_get(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
1477977d0006SHemant Agrawal {
1478977d0006SHemant Agrawal 	int ret = -EINVAL;
1479977d0006SHemant Agrawal 	struct dpaa2_dev_priv *priv;
1480977d0006SHemant Agrawal 	struct fsl_mc_io *dpni;
1481977d0006SHemant Agrawal 	struct dpni_link_state state = {0};
1482977d0006SHemant Agrawal 
1483977d0006SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1484977d0006SHemant Agrawal 
1485977d0006SHemant Agrawal 	priv = dev->data->dev_private;
1486977d0006SHemant Agrawal 	dpni = (struct fsl_mc_io *)priv->hw;
1487977d0006SHemant Agrawal 
1488977d0006SHemant Agrawal 	if (dpni == NULL || fc_conf == NULL) {
1489645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "device not configured\n");
1490977d0006SHemant Agrawal 		return ret;
1491977d0006SHemant Agrawal 	}
1492977d0006SHemant Agrawal 
1493977d0006SHemant Agrawal 	ret = dpni_get_link_state(dpni, CMD_PRI_LOW, priv->token, &state);
1494977d0006SHemant Agrawal 	if (ret) {
1495645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "error: dpni_get_link_state %d\n", ret);
1496977d0006SHemant Agrawal 		return ret;
1497977d0006SHemant Agrawal 	}
1498977d0006SHemant Agrawal 
1499977d0006SHemant Agrawal 	memset(fc_conf, 0, sizeof(struct rte_eth_fc_conf));
1500977d0006SHemant Agrawal 	if (state.options & DPNI_LINK_OPT_PAUSE) {
1501977d0006SHemant Agrawal 		/* DPNI_LINK_OPT_PAUSE set
1502977d0006SHemant Agrawal 		 *  if ASYM_PAUSE not set,
1503977d0006SHemant Agrawal 		 *	RX Side flow control (handle received Pause frame)
1504977d0006SHemant Agrawal 		 *	TX side flow control (send Pause frame)
1505977d0006SHemant Agrawal 		 *  if ASYM_PAUSE set,
1506977d0006SHemant Agrawal 		 *	RX Side flow control (handle received Pause frame)
1507977d0006SHemant Agrawal 		 *	No TX side flow control (send Pause frame disabled)
1508977d0006SHemant Agrawal 		 */
1509977d0006SHemant Agrawal 		if (!(state.options & DPNI_LINK_OPT_ASYM_PAUSE))
1510977d0006SHemant Agrawal 			fc_conf->mode = RTE_FC_FULL;
1511977d0006SHemant Agrawal 		else
1512977d0006SHemant Agrawal 			fc_conf->mode = RTE_FC_RX_PAUSE;
1513977d0006SHemant Agrawal 	} else {
1514977d0006SHemant Agrawal 		/* DPNI_LINK_OPT_PAUSE not set
1515977d0006SHemant Agrawal 		 *  if ASYM_PAUSE set,
1516977d0006SHemant Agrawal 		 *	TX side flow control (send Pause frame)
1517977d0006SHemant Agrawal 		 *	No RX side flow control (No action on pause frame rx)
1518977d0006SHemant Agrawal 		 *  if ASYM_PAUSE not set,
1519977d0006SHemant Agrawal 		 *	Flow control disabled
1520977d0006SHemant Agrawal 		 */
1521977d0006SHemant Agrawal 		if (state.options & DPNI_LINK_OPT_ASYM_PAUSE)
1522977d0006SHemant Agrawal 			fc_conf->mode = RTE_FC_TX_PAUSE;
1523977d0006SHemant Agrawal 		else
1524977d0006SHemant Agrawal 			fc_conf->mode = RTE_FC_NONE;
1525977d0006SHemant Agrawal 	}
1526977d0006SHemant Agrawal 
1527977d0006SHemant Agrawal 	return ret;
1528977d0006SHemant Agrawal }
1529977d0006SHemant Agrawal 
1530977d0006SHemant Agrawal static int
1531977d0006SHemant Agrawal dpaa2_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
1532977d0006SHemant Agrawal {
1533977d0006SHemant Agrawal 	int ret = -EINVAL;
1534977d0006SHemant Agrawal 	struct dpaa2_dev_priv *priv;
1535977d0006SHemant Agrawal 	struct fsl_mc_io *dpni;
1536977d0006SHemant Agrawal 	struct dpni_link_state state = {0};
1537977d0006SHemant Agrawal 	struct dpni_link_cfg cfg = {0};
1538977d0006SHemant Agrawal 
1539977d0006SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1540977d0006SHemant Agrawal 
1541977d0006SHemant Agrawal 	priv = dev->data->dev_private;
1542977d0006SHemant Agrawal 	dpni = (struct fsl_mc_io *)priv->hw;
1543977d0006SHemant Agrawal 
1544977d0006SHemant Agrawal 	if (dpni == NULL) {
1545645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "dpni is NULL\n");
1546977d0006SHemant Agrawal 		return ret;
1547977d0006SHemant Agrawal 	}
1548977d0006SHemant Agrawal 
1549977d0006SHemant Agrawal 	/* It is necessary to obtain the current state before setting fc_conf
1550977d0006SHemant Agrawal 	 * as MC would return error in case rate, autoneg or duplex values are
1551977d0006SHemant Agrawal 	 * different.
1552977d0006SHemant Agrawal 	 */
1553977d0006SHemant Agrawal 	ret = dpni_get_link_state(dpni, CMD_PRI_LOW, priv->token, &state);
1554977d0006SHemant Agrawal 	if (ret) {
1555645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Unable to get link state (err=%d)\n", ret);
1556977d0006SHemant Agrawal 		return -1;
1557977d0006SHemant Agrawal 	}
1558977d0006SHemant Agrawal 
1559977d0006SHemant Agrawal 	/* Disable link before setting configuration */
1560977d0006SHemant Agrawal 	dpaa2_dev_set_link_down(dev);
1561977d0006SHemant Agrawal 
1562977d0006SHemant Agrawal 	/* Based on fc_conf, update cfg */
1563977d0006SHemant Agrawal 	cfg.rate = state.rate;
1564977d0006SHemant Agrawal 	cfg.options = state.options;
1565977d0006SHemant Agrawal 
1566977d0006SHemant Agrawal 	/* update cfg with fc_conf */
1567977d0006SHemant Agrawal 	switch (fc_conf->mode) {
1568977d0006SHemant Agrawal 	case RTE_FC_FULL:
1569977d0006SHemant Agrawal 		/* Full flow control;
1570977d0006SHemant Agrawal 		 * OPT_PAUSE set, ASYM_PAUSE not set
1571977d0006SHemant Agrawal 		 */
1572977d0006SHemant Agrawal 		cfg.options |= DPNI_LINK_OPT_PAUSE;
1573977d0006SHemant Agrawal 		cfg.options &= ~DPNI_LINK_OPT_ASYM_PAUSE;
1574f090a4c3SHemant Agrawal 		break;
1575977d0006SHemant Agrawal 	case RTE_FC_TX_PAUSE:
1576977d0006SHemant Agrawal 		/* Enable RX flow control
1577977d0006SHemant Agrawal 		 * OPT_PAUSE not set;
1578977d0006SHemant Agrawal 		 * ASYM_PAUSE set;
1579977d0006SHemant Agrawal 		 */
1580977d0006SHemant Agrawal 		cfg.options |= DPNI_LINK_OPT_ASYM_PAUSE;
1581977d0006SHemant Agrawal 		cfg.options &= ~DPNI_LINK_OPT_PAUSE;
1582977d0006SHemant Agrawal 		break;
1583977d0006SHemant Agrawal 	case RTE_FC_RX_PAUSE:
1584977d0006SHemant Agrawal 		/* Enable TX Flow control
1585977d0006SHemant Agrawal 		 * OPT_PAUSE set
1586977d0006SHemant Agrawal 		 * ASYM_PAUSE set
1587977d0006SHemant Agrawal 		 */
1588977d0006SHemant Agrawal 		cfg.options |= DPNI_LINK_OPT_PAUSE;
1589977d0006SHemant Agrawal 		cfg.options |= DPNI_LINK_OPT_ASYM_PAUSE;
1590977d0006SHemant Agrawal 		break;
1591977d0006SHemant Agrawal 	case RTE_FC_NONE:
1592977d0006SHemant Agrawal 		/* Disable Flow control
1593977d0006SHemant Agrawal 		 * OPT_PAUSE not set
1594977d0006SHemant Agrawal 		 * ASYM_PAUSE not set
1595977d0006SHemant Agrawal 		 */
1596977d0006SHemant Agrawal 		cfg.options &= ~DPNI_LINK_OPT_PAUSE;
1597977d0006SHemant Agrawal 		cfg.options &= ~DPNI_LINK_OPT_ASYM_PAUSE;
1598977d0006SHemant Agrawal 		break;
1599977d0006SHemant Agrawal 	default:
1600645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD, "Incorrect Flow control flag (%d)\n",
1601977d0006SHemant Agrawal 			fc_conf->mode);
1602977d0006SHemant Agrawal 		return -1;
1603977d0006SHemant Agrawal 	}
1604977d0006SHemant Agrawal 
1605977d0006SHemant Agrawal 	ret = dpni_set_link_cfg(dpni, CMD_PRI_LOW, priv->token, &cfg);
1606977d0006SHemant Agrawal 	if (ret)
1607645bd25aSHemant Agrawal 		RTE_LOG(ERR, PMD,
1608645bd25aSHemant Agrawal 			"Unable to set Link configuration (err=%d)\n",
1609977d0006SHemant Agrawal 			ret);
1610977d0006SHemant Agrawal 
1611977d0006SHemant Agrawal 	/* Enable link */
1612977d0006SHemant Agrawal 	dpaa2_dev_set_link_up(dev);
1613977d0006SHemant Agrawal 
1614977d0006SHemant Agrawal 	return ret;
1615977d0006SHemant Agrawal }
1616977d0006SHemant Agrawal 
161763d5c3b0SHemant Agrawal static int
161863d5c3b0SHemant Agrawal dpaa2_dev_rss_hash_update(struct rte_eth_dev *dev,
161963d5c3b0SHemant Agrawal 			  struct rte_eth_rss_conf *rss_conf)
162063d5c3b0SHemant Agrawal {
162163d5c3b0SHemant Agrawal 	struct rte_eth_dev_data *data = dev->data;
162263d5c3b0SHemant Agrawal 	struct rte_eth_conf *eth_conf = &data->dev_conf;
162363d5c3b0SHemant Agrawal 	int ret;
162463d5c3b0SHemant Agrawal 
162563d5c3b0SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
162663d5c3b0SHemant Agrawal 
162763d5c3b0SHemant Agrawal 	if (rss_conf->rss_hf) {
162863d5c3b0SHemant Agrawal 		ret = dpaa2_setup_flow_dist(dev, rss_conf->rss_hf);
162963d5c3b0SHemant Agrawal 		if (ret) {
163063d5c3b0SHemant Agrawal 			PMD_INIT_LOG(ERR, "unable to set flow dist");
163163d5c3b0SHemant Agrawal 			return ret;
163263d5c3b0SHemant Agrawal 		}
163363d5c3b0SHemant Agrawal 	} else {
163463d5c3b0SHemant Agrawal 		ret = dpaa2_remove_flow_dist(dev, 0);
163563d5c3b0SHemant Agrawal 		if (ret) {
163663d5c3b0SHemant Agrawal 			PMD_INIT_LOG(ERR, "unable to remove flow dist");
163763d5c3b0SHemant Agrawal 			return ret;
163863d5c3b0SHemant Agrawal 		}
163963d5c3b0SHemant Agrawal 	}
164063d5c3b0SHemant Agrawal 	eth_conf->rx_adv_conf.rss_conf.rss_hf = rss_conf->rss_hf;
164163d5c3b0SHemant Agrawal 	return 0;
164263d5c3b0SHemant Agrawal }
164363d5c3b0SHemant Agrawal 
164463d5c3b0SHemant Agrawal static int
164563d5c3b0SHemant Agrawal dpaa2_dev_rss_hash_conf_get(struct rte_eth_dev *dev,
164663d5c3b0SHemant Agrawal 			    struct rte_eth_rss_conf *rss_conf)
164763d5c3b0SHemant Agrawal {
164863d5c3b0SHemant Agrawal 	struct rte_eth_dev_data *data = dev->data;
164963d5c3b0SHemant Agrawal 	struct rte_eth_conf *eth_conf = &data->dev_conf;
165063d5c3b0SHemant Agrawal 
165163d5c3b0SHemant Agrawal 	/* dpaa2 does not support rss_key, so length should be 0*/
165263d5c3b0SHemant Agrawal 	rss_conf->rss_key_len = 0;
165363d5c3b0SHemant Agrawal 	rss_conf->rss_hf = eth_conf->rx_adv_conf.rss_conf.rss_hf;
165463d5c3b0SHemant Agrawal 	return 0;
165563d5c3b0SHemant Agrawal }
165663d5c3b0SHemant Agrawal 
1657b677d4c6SNipun Gupta int dpaa2_eth_eventq_attach(const struct rte_eth_dev *dev,
1658b677d4c6SNipun Gupta 		int eth_rx_queue_id,
1659b677d4c6SNipun Gupta 		uint16_t dpcon_id,
1660b677d4c6SNipun Gupta 		const struct rte_event_eth_rx_adapter_queue_conf *queue_conf)
1661b677d4c6SNipun Gupta {
1662b677d4c6SNipun Gupta 	struct dpaa2_dev_priv *eth_priv = dev->data->dev_private;
1663b677d4c6SNipun Gupta 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)eth_priv->hw;
1664b677d4c6SNipun Gupta 	struct dpaa2_queue *dpaa2_ethq = eth_priv->rx_vq[eth_rx_queue_id];
1665b677d4c6SNipun Gupta 	uint8_t flow_id = dpaa2_ethq->flow_id;
1666b677d4c6SNipun Gupta 	struct dpni_queue cfg;
1667b677d4c6SNipun Gupta 	uint8_t options;
1668b677d4c6SNipun Gupta 	int ret;
1669b677d4c6SNipun Gupta 
1670b677d4c6SNipun Gupta 	if (queue_conf->ev.sched_type == RTE_SCHED_TYPE_PARALLEL)
1671b677d4c6SNipun Gupta 		dpaa2_ethq->cb = dpaa2_dev_process_parallel_event;
16722d378863SNipun Gupta 	else if (queue_conf->ev.sched_type == RTE_SCHED_TYPE_ATOMIC)
16732d378863SNipun Gupta 		dpaa2_ethq->cb = dpaa2_dev_process_atomic_event;
1674b677d4c6SNipun Gupta 	else
1675b677d4c6SNipun Gupta 		return -EINVAL;
1676b677d4c6SNipun Gupta 
1677b677d4c6SNipun Gupta 	memset(&cfg, 0, sizeof(struct dpni_queue));
1678b677d4c6SNipun Gupta 	options = DPNI_QUEUE_OPT_DEST;
1679b677d4c6SNipun Gupta 	cfg.destination.type = DPNI_DEST_DPCON;
1680b677d4c6SNipun Gupta 	cfg.destination.id = dpcon_id;
1681b677d4c6SNipun Gupta 	cfg.destination.priority = queue_conf->ev.priority;
1682b677d4c6SNipun Gupta 
16832d378863SNipun Gupta 	if (queue_conf->ev.sched_type == RTE_SCHED_TYPE_ATOMIC) {
16842d378863SNipun Gupta 		options |= DPNI_QUEUE_OPT_HOLD_ACTIVE;
16852d378863SNipun Gupta 		cfg.destination.hold_active = 1;
16862d378863SNipun Gupta 	}
16872d378863SNipun Gupta 
1688b677d4c6SNipun Gupta 	options |= DPNI_QUEUE_OPT_USER_CTX;
1689b677d4c6SNipun Gupta 	cfg.user_context = (uint64_t)(dpaa2_ethq);
1690b677d4c6SNipun Gupta 
1691b677d4c6SNipun Gupta 	ret = dpni_set_queue(dpni, CMD_PRI_LOW, eth_priv->token, DPNI_QUEUE_RX,
1692b677d4c6SNipun Gupta 			     dpaa2_ethq->tc_index, flow_id, options, &cfg);
1693b677d4c6SNipun Gupta 	if (ret) {
1694b677d4c6SNipun Gupta 		RTE_LOG(ERR, PMD, "Error in dpni_set_queue: ret: %d\n", ret);
1695b677d4c6SNipun Gupta 		return ret;
1696b677d4c6SNipun Gupta 	}
1697b677d4c6SNipun Gupta 
1698b677d4c6SNipun Gupta 	memcpy(&dpaa2_ethq->ev, &queue_conf->ev, sizeof(struct rte_event));
1699b677d4c6SNipun Gupta 
1700b677d4c6SNipun Gupta 	return 0;
1701b677d4c6SNipun Gupta }
1702b677d4c6SNipun Gupta 
1703b677d4c6SNipun Gupta int dpaa2_eth_eventq_detach(const struct rte_eth_dev *dev,
1704b677d4c6SNipun Gupta 		int eth_rx_queue_id)
1705b677d4c6SNipun Gupta {
1706b677d4c6SNipun Gupta 	struct dpaa2_dev_priv *eth_priv = dev->data->dev_private;
1707b677d4c6SNipun Gupta 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)eth_priv->hw;
1708b677d4c6SNipun Gupta 	struct dpaa2_queue *dpaa2_ethq = eth_priv->rx_vq[eth_rx_queue_id];
1709b677d4c6SNipun Gupta 	uint8_t flow_id = dpaa2_ethq->flow_id;
1710b677d4c6SNipun Gupta 	struct dpni_queue cfg;
1711b677d4c6SNipun Gupta 	uint8_t options;
1712b677d4c6SNipun Gupta 	int ret;
1713b677d4c6SNipun Gupta 
1714b677d4c6SNipun Gupta 	memset(&cfg, 0, sizeof(struct dpni_queue));
1715b677d4c6SNipun Gupta 	options = DPNI_QUEUE_OPT_DEST;
1716b677d4c6SNipun Gupta 	cfg.destination.type = DPNI_DEST_NONE;
1717b677d4c6SNipun Gupta 
1718b677d4c6SNipun Gupta 	ret = dpni_set_queue(dpni, CMD_PRI_LOW, eth_priv->token, DPNI_QUEUE_RX,
1719b677d4c6SNipun Gupta 			     dpaa2_ethq->tc_index, flow_id, options, &cfg);
1720b677d4c6SNipun Gupta 	if (ret)
1721b677d4c6SNipun Gupta 		RTE_LOG(ERR, PMD, "Error in dpni_set_queue: ret: %d\n", ret);
1722b677d4c6SNipun Gupta 
1723b677d4c6SNipun Gupta 	return ret;
1724b677d4c6SNipun Gupta }
1725b677d4c6SNipun Gupta 
17263e5a335dSHemant Agrawal static struct eth_dev_ops dpaa2_ethdev_ops = {
17273e5a335dSHemant Agrawal 	.dev_configure	  = dpaa2_eth_dev_configure,
17283e5a335dSHemant Agrawal 	.dev_start	      = dpaa2_dev_start,
17293e5a335dSHemant Agrawal 	.dev_stop	      = dpaa2_dev_stop,
17303e5a335dSHemant Agrawal 	.dev_close	      = dpaa2_dev_close,
1731c0e5c69aSHemant Agrawal 	.promiscuous_enable   = dpaa2_dev_promiscuous_enable,
1732c0e5c69aSHemant Agrawal 	.promiscuous_disable  = dpaa2_dev_promiscuous_disable,
17335d5aeeedSHemant Agrawal 	.allmulticast_enable  = dpaa2_dev_allmulticast_enable,
17345d5aeeedSHemant Agrawal 	.allmulticast_disable = dpaa2_dev_allmulticast_disable,
1735a1f3a12cSHemant Agrawal 	.dev_set_link_up      = dpaa2_dev_set_link_up,
1736a1f3a12cSHemant Agrawal 	.dev_set_link_down    = dpaa2_dev_set_link_down,
1737c56c86ffSHemant Agrawal 	.link_update	   = dpaa2_dev_link_update,
1738b0aa5459SHemant Agrawal 	.stats_get	       = dpaa2_dev_stats_get,
17391d6329b2SHemant Agrawal 	.xstats_get	       = dpaa2_dev_xstats_get,
17401d6329b2SHemant Agrawal 	.xstats_get_by_id     = dpaa2_xstats_get_by_id,
17411d6329b2SHemant Agrawal 	.xstats_get_names_by_id = dpaa2_xstats_get_names_by_id,
17421d6329b2SHemant Agrawal 	.xstats_get_names      = dpaa2_xstats_get_names,
1743b0aa5459SHemant Agrawal 	.stats_reset	   = dpaa2_dev_stats_reset,
17441d6329b2SHemant Agrawal 	.xstats_reset	      = dpaa2_dev_stats_reset,
1745748eccb9SHemant Agrawal 	.fw_version_get	   = dpaa2_fw_version_get,
17463e5a335dSHemant Agrawal 	.dev_infos_get	   = dpaa2_dev_info_get,
1747a5fc38d4SHemant Agrawal 	.dev_supported_ptypes_get = dpaa2_supported_ptypes_get,
1748e31d4d21SHemant Agrawal 	.mtu_set           = dpaa2_dev_mtu_set,
17493ce294f2SHemant Agrawal 	.vlan_filter_set      = dpaa2_vlan_filter_set,
17503ce294f2SHemant Agrawal 	.vlan_offload_set     = dpaa2_vlan_offload_set,
17513e5a335dSHemant Agrawal 	.rx_queue_setup    = dpaa2_dev_rx_queue_setup,
17523e5a335dSHemant Agrawal 	.rx_queue_release  = dpaa2_dev_rx_queue_release,
17533e5a335dSHemant Agrawal 	.tx_queue_setup    = dpaa2_dev_tx_queue_setup,
17543e5a335dSHemant Agrawal 	.tx_queue_release  = dpaa2_dev_tx_queue_release,
1755f40adb40SHemant Agrawal 	.rx_queue_count       = dpaa2_dev_rx_queue_count,
1756977d0006SHemant Agrawal 	.flow_ctrl_get	      = dpaa2_flow_ctrl_get,
1757977d0006SHemant Agrawal 	.flow_ctrl_set	      = dpaa2_flow_ctrl_set,
1758b4d97b7dSHemant Agrawal 	.mac_addr_add         = dpaa2_dev_add_mac_addr,
1759b4d97b7dSHemant Agrawal 	.mac_addr_remove      = dpaa2_dev_remove_mac_addr,
1760b4d97b7dSHemant Agrawal 	.mac_addr_set         = dpaa2_dev_set_mac_addr,
176163d5c3b0SHemant Agrawal 	.rss_hash_update      = dpaa2_dev_rss_hash_update,
176263d5c3b0SHemant Agrawal 	.rss_hash_conf_get    = dpaa2_dev_rss_hash_conf_get,
17633e5a335dSHemant Agrawal };
17643e5a335dSHemant Agrawal 
1765c147eae0SHemant Agrawal static int
1766c147eae0SHemant Agrawal dpaa2_dev_init(struct rte_eth_dev *eth_dev)
1767c147eae0SHemant Agrawal {
17683e5a335dSHemant Agrawal 	struct rte_device *dev = eth_dev->device;
17693e5a335dSHemant Agrawal 	struct rte_dpaa2_device *dpaa2_dev;
17703e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni_dev;
17713e5a335dSHemant Agrawal 	struct dpni_attr attr;
17723e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = eth_dev->data->dev_private;
1773bee61d86SHemant Agrawal 	struct dpni_buffer_layout layout;
1774599017a2SHemant Agrawal 	int ret, hw_id;
17753e5a335dSHemant Agrawal 
1776d401ead1SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1777d401ead1SHemant Agrawal 
1778c147eae0SHemant Agrawal 	/* For secondary processes, the primary has done all the work */
1779c147eae0SHemant Agrawal 	if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1780c147eae0SHemant Agrawal 		return 0;
1781c147eae0SHemant Agrawal 
17823e5a335dSHemant Agrawal 	dpaa2_dev = container_of(dev, struct rte_dpaa2_device, device);
17833e5a335dSHemant Agrawal 
17843e5a335dSHemant Agrawal 	hw_id = dpaa2_dev->object_id;
17853e5a335dSHemant Agrawal 
1786d4984046SHemant Agrawal 	dpni_dev = rte_malloc(NULL, sizeof(struct fsl_mc_io), 0);
17873e5a335dSHemant Agrawal 	if (!dpni_dev) {
17883e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "malloc failed for dpni device\n");
17893e5a335dSHemant Agrawal 		return -1;
17903e5a335dSHemant Agrawal 	}
17913e5a335dSHemant Agrawal 
17923e5a335dSHemant Agrawal 	dpni_dev->regs = rte_mcp_ptr_list[0];
17933e5a335dSHemant Agrawal 	ret = dpni_open(dpni_dev, CMD_PRI_LOW, hw_id, &priv->token);
17943e5a335dSHemant Agrawal 	if (ret) {
1795d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR,
1796d4984046SHemant Agrawal 			     "Failure in opening dpni@%d with err code %d\n",
1797d4984046SHemant Agrawal 			     hw_id, ret);
1798d4984046SHemant Agrawal 		rte_free(dpni_dev);
17993e5a335dSHemant Agrawal 		return -1;
18003e5a335dSHemant Agrawal 	}
18013e5a335dSHemant Agrawal 
18023e5a335dSHemant Agrawal 	/* Clean the device first */
18033e5a335dSHemant Agrawal 	ret = dpni_reset(dpni_dev, CMD_PRI_LOW, priv->token);
18043e5a335dSHemant Agrawal 	if (ret) {
1805d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR,
1806d4984046SHemant Agrawal 			     "Failure cleaning dpni@%d with err code %d\n",
1807d4984046SHemant Agrawal 			     hw_id, ret);
1808d4984046SHemant Agrawal 		goto init_err;
18093e5a335dSHemant Agrawal 	}
18103e5a335dSHemant Agrawal 
18113e5a335dSHemant Agrawal 	ret = dpni_get_attributes(dpni_dev, CMD_PRI_LOW, priv->token, &attr);
18123e5a335dSHemant Agrawal 	if (ret) {
1813d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR,
1814d4984046SHemant Agrawal 			     "Failure in get dpni@%d attribute, err code %d\n",
1815d4984046SHemant Agrawal 			     hw_id, ret);
1816d4984046SHemant Agrawal 		goto init_err;
18173e5a335dSHemant Agrawal 	}
18183e5a335dSHemant Agrawal 
181916bbc98aSShreyansh Jain 	priv->num_rx_tc = attr.num_rx_tcs;
182089c2ea8fSHemant Agrawal 
182116bbc98aSShreyansh Jain 	/* Resetting the "num_rx_queues" to equal number of queues in first TC
1822599017a2SHemant Agrawal 	 * as only one TC is supported on Rx Side. Once Multiple TCs will be
1823599017a2SHemant Agrawal 	 * in use for Rx processing then this will be changed or removed.
182489c2ea8fSHemant Agrawal 	 */
1825599017a2SHemant Agrawal 	priv->nb_rx_queues = attr.num_queues;
182689c2ea8fSHemant Agrawal 
182716bbc98aSShreyansh Jain 	/* Using number of TX queues as number of TX TCs */
182816bbc98aSShreyansh Jain 	priv->nb_tx_queues = attr.num_tx_tcs;
1829ef18dafeSHemant Agrawal 
183016bbc98aSShreyansh Jain 	PMD_DRV_LOG(DEBUG, "RX-TC= %d, nb_rx_queues= %d, nb_tx_queues=%d",
18312bfea039SHemant Agrawal 		    priv->num_rx_tc, priv->nb_rx_queues, priv->nb_tx_queues);
18323e5a335dSHemant Agrawal 
18333e5a335dSHemant Agrawal 	priv->hw = dpni_dev;
18343e5a335dSHemant Agrawal 	priv->hw_id = hw_id;
183533fad432SHemant Agrawal 	priv->options = attr.options;
183633fad432SHemant Agrawal 	priv->max_mac_filters = attr.mac_filter_entries;
183733fad432SHemant Agrawal 	priv->max_vlan_filters = attr.vlan_filter_entries;
18383e5a335dSHemant Agrawal 	priv->flags = 0;
18393e5a335dSHemant Agrawal 
18403e5a335dSHemant Agrawal 	/* Allocate memory for hardware structure for queues */
18413e5a335dSHemant Agrawal 	ret = dpaa2_alloc_rx_tx_queues(eth_dev);
18423e5a335dSHemant Agrawal 	if (ret) {
18433e5a335dSHemant Agrawal 		PMD_INIT_LOG(ERR, "dpaa2_alloc_rx_tx_queuesFailed\n");
1844d4984046SHemant Agrawal 		goto init_err;
18453e5a335dSHemant Agrawal 	}
18463e5a335dSHemant Agrawal 
184733fad432SHemant Agrawal 	/* Allocate memory for storing MAC addresses */
184833fad432SHemant Agrawal 	eth_dev->data->mac_addrs = rte_zmalloc("dpni",
184933fad432SHemant Agrawal 		ETHER_ADDR_LEN * attr.mac_filter_entries, 0);
185033fad432SHemant Agrawal 	if (eth_dev->data->mac_addrs == NULL) {
1851d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR,
1852d4984046SHemant Agrawal 		   "Failed to allocate %d bytes needed to store MAC addresses",
185333fad432SHemant Agrawal 			     ETHER_ADDR_LEN * attr.mac_filter_entries);
1854d4984046SHemant Agrawal 		ret = -ENOMEM;
1855d4984046SHemant Agrawal 		goto init_err;
185633fad432SHemant Agrawal 	}
185733fad432SHemant Agrawal 
185833fad432SHemant Agrawal 	ret = dpni_get_primary_mac_addr(dpni_dev, CMD_PRI_LOW,
185933fad432SHemant Agrawal 					priv->token,
186033fad432SHemant Agrawal 			(uint8_t *)(eth_dev->data->mac_addrs[0].addr_bytes));
186133fad432SHemant Agrawal 	if (ret) {
1862d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR, "DPNI get mac address failed:Err Code = %d\n",
1863d4984046SHemant Agrawal 			     ret);
1864d4984046SHemant Agrawal 		goto init_err;
186533fad432SHemant Agrawal 	}
186633fad432SHemant Agrawal 
1867bee61d86SHemant Agrawal 	/* ... tx buffer layout ... */
1868bee61d86SHemant Agrawal 	memset(&layout, 0, sizeof(struct dpni_buffer_layout));
1869bee61d86SHemant Agrawal 	layout.options = DPNI_BUF_LAYOUT_OPT_FRAME_STATUS;
1870bee61d86SHemant Agrawal 	layout.pass_frame_status = 1;
1871bee61d86SHemant Agrawal 	ret = dpni_set_buffer_layout(dpni_dev, CMD_PRI_LOW, priv->token,
1872bee61d86SHemant Agrawal 				     DPNI_QUEUE_TX, &layout);
1873bee61d86SHemant Agrawal 	if (ret) {
1874d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR, "Error (%d) in setting tx buffer layout",
1875d4984046SHemant Agrawal 			     ret);
1876d4984046SHemant Agrawal 		goto init_err;
1877bee61d86SHemant Agrawal 	}
1878bee61d86SHemant Agrawal 
1879bee61d86SHemant Agrawal 	/* ... tx-conf and error buffer layout ... */
1880bee61d86SHemant Agrawal 	memset(&layout, 0, sizeof(struct dpni_buffer_layout));
1881bee61d86SHemant Agrawal 	layout.options = DPNI_BUF_LAYOUT_OPT_FRAME_STATUS;
1882bee61d86SHemant Agrawal 	layout.pass_frame_status = 1;
1883bee61d86SHemant Agrawal 	ret = dpni_set_buffer_layout(dpni_dev, CMD_PRI_LOW, priv->token,
1884bee61d86SHemant Agrawal 				     DPNI_QUEUE_TX_CONFIRM, &layout);
1885bee61d86SHemant Agrawal 	if (ret) {
1886d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR, "Error (%d) in setting tx-conf buffer layout",
1887d4984046SHemant Agrawal 			     ret);
1888d4984046SHemant Agrawal 		goto init_err;
1889bee61d86SHemant Agrawal 	}
1890bee61d86SHemant Agrawal 
18913e5a335dSHemant Agrawal 	eth_dev->dev_ops = &dpaa2_ethdev_ops;
1892c147eae0SHemant Agrawal 
18935c6942fdSHemant Agrawal 	eth_dev->rx_pkt_burst = dpaa2_dev_prefetch_rx;
1894cd9935ceSHemant Agrawal 	eth_dev->tx_pkt_burst = dpaa2_dev_tx;
18951261cd68SHemant Agrawal 	rte_fslmc_vfio_dmamap();
18961261cd68SHemant Agrawal 
18972bfea039SHemant Agrawal 	RTE_LOG(INFO, PMD, "%s: netdev created\n", eth_dev->data->name);
1898c147eae0SHemant Agrawal 	return 0;
1899d4984046SHemant Agrawal init_err:
1900d4984046SHemant Agrawal 	dpaa2_dev_uninit(eth_dev);
1901d4984046SHemant Agrawal 	return ret;
1902c147eae0SHemant Agrawal }
1903c147eae0SHemant Agrawal 
1904c147eae0SHemant Agrawal static int
19053e5a335dSHemant Agrawal dpaa2_dev_uninit(struct rte_eth_dev *eth_dev)
1906c147eae0SHemant Agrawal {
19073e5a335dSHemant Agrawal 	struct dpaa2_dev_priv *priv = eth_dev->data->dev_private;
19083e5a335dSHemant Agrawal 	struct fsl_mc_io *dpni = (struct fsl_mc_io *)priv->hw;
19093e5a335dSHemant Agrawal 	int i, ret;
19103e5a335dSHemant Agrawal 	struct dpaa2_queue *dpaa2_q;
19113e5a335dSHemant Agrawal 
1912d401ead1SHemant Agrawal 	PMD_INIT_FUNC_TRACE();
1913d401ead1SHemant Agrawal 
1914c147eae0SHemant Agrawal 	if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1915e729ec76SHemant Agrawal 		return 0;
1916c147eae0SHemant Agrawal 
19173e5a335dSHemant Agrawal 	if (!dpni) {
19183e5a335dSHemant Agrawal 		PMD_INIT_LOG(WARNING, "Already closed or not started");
19193e5a335dSHemant Agrawal 		return -1;
19203e5a335dSHemant Agrawal 	}
19213e5a335dSHemant Agrawal 
19223e5a335dSHemant Agrawal 	dpaa2_dev_close(eth_dev);
19233e5a335dSHemant Agrawal 
19243e5a335dSHemant Agrawal 	if (priv->rx_vq[0]) {
19253e5a335dSHemant Agrawal 		/* cleaning up queue storage */
19263e5a335dSHemant Agrawal 		for (i = 0; i < priv->nb_rx_queues; i++) {
19273e5a335dSHemant Agrawal 			dpaa2_q = (struct dpaa2_queue *)priv->rx_vq[i];
19283e5a335dSHemant Agrawal 			if (dpaa2_q->q_storage)
19293e5a335dSHemant Agrawal 				rte_free(dpaa2_q->q_storage);
19303e5a335dSHemant Agrawal 		}
19313e5a335dSHemant Agrawal 		/*free the all queue memory */
19323e5a335dSHemant Agrawal 		rte_free(priv->rx_vq[0]);
19333e5a335dSHemant Agrawal 		priv->rx_vq[0] = NULL;
19343e5a335dSHemant Agrawal 	}
19353e5a335dSHemant Agrawal 
1936d4984046SHemant Agrawal 	/* free memory for storing MAC addresses */
193733fad432SHemant Agrawal 	if (eth_dev->data->mac_addrs) {
193833fad432SHemant Agrawal 		rte_free(eth_dev->data->mac_addrs);
193933fad432SHemant Agrawal 		eth_dev->data->mac_addrs = NULL;
194033fad432SHemant Agrawal 	}
19413e5a335dSHemant Agrawal 
19423e5a335dSHemant Agrawal 	/* Close the device at underlying layer*/
19433e5a335dSHemant Agrawal 	ret = dpni_close(dpni, CMD_PRI_LOW, priv->token);
19443e5a335dSHemant Agrawal 	if (ret) {
1945d4984046SHemant Agrawal 		PMD_INIT_LOG(ERR,
1946d4984046SHemant Agrawal 			     "Failure closing dpni device with err code %d\n",
1947d4984046SHemant Agrawal 			     ret);
19483e5a335dSHemant Agrawal 	}
19493e5a335dSHemant Agrawal 
19503e5a335dSHemant Agrawal 	/* Free the allocated memory for ethernet private data and dpni*/
19513e5a335dSHemant Agrawal 	priv->hw = NULL;
1952d4984046SHemant Agrawal 	rte_free(dpni);
19533e5a335dSHemant Agrawal 
19543e5a335dSHemant Agrawal 	eth_dev->dev_ops = NULL;
1955cd9935ceSHemant Agrawal 	eth_dev->rx_pkt_burst = NULL;
1956cd9935ceSHemant Agrawal 	eth_dev->tx_pkt_burst = NULL;
19573e5a335dSHemant Agrawal 
19582bfea039SHemant Agrawal 	RTE_LOG(INFO, PMD, "%s: netdev created\n", eth_dev->data->name);
1959c147eae0SHemant Agrawal 	return 0;
1960c147eae0SHemant Agrawal }
1961c147eae0SHemant Agrawal 
1962c147eae0SHemant Agrawal static int
196355fd2703SHemant Agrawal rte_dpaa2_probe(struct rte_dpaa2_driver *dpaa2_drv,
1964c147eae0SHemant Agrawal 		struct rte_dpaa2_device *dpaa2_dev)
1965c147eae0SHemant Agrawal {
1966c147eae0SHemant Agrawal 	struct rte_eth_dev *eth_dev;
1967c147eae0SHemant Agrawal 	int diag;
1968c147eae0SHemant Agrawal 
1969c147eae0SHemant Agrawal 	if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
1970e729ec76SHemant Agrawal 		eth_dev = rte_eth_dev_allocate(dpaa2_dev->device.name);
1971e729ec76SHemant Agrawal 		if (!eth_dev)
1972e729ec76SHemant Agrawal 			return -ENODEV;
1973c147eae0SHemant Agrawal 		eth_dev->data->dev_private = rte_zmalloc(
1974c147eae0SHemant Agrawal 						"ethdev private structure",
1975c147eae0SHemant Agrawal 						sizeof(struct dpaa2_dev_priv),
1976c147eae0SHemant Agrawal 						RTE_CACHE_LINE_SIZE);
1977c147eae0SHemant Agrawal 		if (eth_dev->data->dev_private == NULL) {
1978d401ead1SHemant Agrawal 			PMD_INIT_LOG(CRIT, "Cannot allocate memzone for"
1979c147eae0SHemant Agrawal 				     " private port data\n");
1980c147eae0SHemant Agrawal 			rte_eth_dev_release_port(eth_dev);
1981c147eae0SHemant Agrawal 			return -ENOMEM;
1982c147eae0SHemant Agrawal 		}
1983e729ec76SHemant Agrawal 	} else {
1984e729ec76SHemant Agrawal 		eth_dev = rte_eth_dev_attach_secondary(dpaa2_dev->device.name);
1985e729ec76SHemant Agrawal 		if (!eth_dev)
1986e729ec76SHemant Agrawal 			return -ENODEV;
1987c147eae0SHemant Agrawal 	}
1988e729ec76SHemant Agrawal 
1989c147eae0SHemant Agrawal 	eth_dev->device = &dpaa2_dev->device;
199055fd2703SHemant Agrawal 	eth_dev->device->driver = &dpaa2_drv->driver;
199155fd2703SHemant Agrawal 
1992c147eae0SHemant Agrawal 	dpaa2_dev->eth_dev = eth_dev;
1993c147eae0SHemant Agrawal 	eth_dev->data->rx_mbuf_alloc_failed = 0;
1994c147eae0SHemant Agrawal 
199592b7e33eSHemant Agrawal 	if (dpaa2_drv->drv_flags & RTE_DPAA2_DRV_INTR_LSC)
199692b7e33eSHemant Agrawal 		eth_dev->data->dev_flags |= RTE_ETH_DEV_INTR_LSC;
199792b7e33eSHemant Agrawal 
1998c147eae0SHemant Agrawal 	/* Invoke PMD device initialization function */
1999c147eae0SHemant Agrawal 	diag = dpaa2_dev_init(eth_dev);
2000c147eae0SHemant Agrawal 	if (diag == 0)
2001c147eae0SHemant Agrawal 		return 0;
2002c147eae0SHemant Agrawal 
2003c147eae0SHemant Agrawal 	if (rte_eal_process_type() == RTE_PROC_PRIMARY)
2004c147eae0SHemant Agrawal 		rte_free(eth_dev->data->dev_private);
2005c147eae0SHemant Agrawal 	rte_eth_dev_release_port(eth_dev);
2006c147eae0SHemant Agrawal 	return diag;
2007c147eae0SHemant Agrawal }
2008c147eae0SHemant Agrawal 
2009c147eae0SHemant Agrawal static int
2010c147eae0SHemant Agrawal rte_dpaa2_remove(struct rte_dpaa2_device *dpaa2_dev)
2011c147eae0SHemant Agrawal {
2012c147eae0SHemant Agrawal 	struct rte_eth_dev *eth_dev;
2013c147eae0SHemant Agrawal 
2014c147eae0SHemant Agrawal 	eth_dev = dpaa2_dev->eth_dev;
2015c147eae0SHemant Agrawal 	dpaa2_dev_uninit(eth_dev);
2016c147eae0SHemant Agrawal 
2017c147eae0SHemant Agrawal 	if (rte_eal_process_type() == RTE_PROC_PRIMARY)
2018c147eae0SHemant Agrawal 		rte_free(eth_dev->data->dev_private);
2019c147eae0SHemant Agrawal 	rte_eth_dev_release_port(eth_dev);
2020c147eae0SHemant Agrawal 
2021c147eae0SHemant Agrawal 	return 0;
2022c147eae0SHemant Agrawal }
2023c147eae0SHemant Agrawal 
2024c147eae0SHemant Agrawal static struct rte_dpaa2_driver rte_dpaa2_pmd = {
202592b7e33eSHemant Agrawal 	.drv_flags = RTE_DPAA2_DRV_INTR_LSC | RTE_DPAA2_DRV_IOVA_AS_VA,
2026bad555dfSShreyansh Jain 	.drv_type = DPAA2_ETH,
2027c147eae0SHemant Agrawal 	.probe = rte_dpaa2_probe,
2028c147eae0SHemant Agrawal 	.remove = rte_dpaa2_remove,
2029c147eae0SHemant Agrawal };
2030c147eae0SHemant Agrawal 
2031c147eae0SHemant Agrawal RTE_PMD_REGISTER_DPAA2(net_dpaa2, rte_dpaa2_pmd);
2032