ethdev: add support for device offload capabilities
[dpdk.git] / lib / librte_ether / rte_ethdev.c
1 /*-
2  *   BSD LICENSE
3  * 
4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
5  *   All rights reserved.
6  * 
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  * 
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of Intel Corporation nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  * 
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33
34 #include <sys/types.h>
35 #include <sys/queue.h>
36 #include <ctype.h>
37 #include <stdio.h>
38 #include <stdlib.h>
39 #include <string.h>
40 #include <stdarg.h>
41 #include <errno.h>
42 #include <stdint.h>
43 #include <inttypes.h>
44
45 #include <rte_byteorder.h>
46 #include <rte_log.h>
47 #include <rte_debug.h>
48 #include <rte_interrupts.h>
49 #include <rte_pci.h>
50 #include <rte_memory.h>
51 #include <rte_memcpy.h>
52 #include <rte_memzone.h>
53 #include <rte_launch.h>
54 #include <rte_tailq.h>
55 #include <rte_eal.h>
56 #include <rte_per_lcore.h>
57 #include <rte_lcore.h>
58 #include <rte_atomic.h>
59 #include <rte_branch_prediction.h>
60 #include <rte_common.h>
61 #include <rte_ring.h>
62 #include <rte_mempool.h>
63 #include <rte_malloc.h>
64 #include <rte_mbuf.h>
65 #include <rte_errno.h>
66 #include <rte_spinlock.h>
67
68 #include "rte_ether.h"
69 #include "rte_ethdev.h"
70
71 #ifdef RTE_LIBRTE_ETHDEV_DEBUG
72 #define PMD_DEBUG_TRACE(fmt, args...) do {                        \
73                 RTE_LOG(ERR, PMD, "%s: " fmt, __func__, ## args); \
74         } while (0)
75 #else
76 #define PMD_DEBUG_TRACE(fmt, args...)
77 #endif
78
79 /* Macros for checking for restricting functions to primary instance only */
80 #define PROC_PRIMARY_OR_ERR_RET(retval) do { \
81         if (rte_eal_process_type() != RTE_PROC_PRIMARY) { \
82                 PMD_DEBUG_TRACE("Cannot run in secondary processes\n"); \
83                 return (retval); \
84         } \
85 } while(0)
86 #define PROC_PRIMARY_OR_RET() do { \
87         if (rte_eal_process_type() != RTE_PROC_PRIMARY) { \
88                 PMD_DEBUG_TRACE("Cannot run in secondary processes\n"); \
89                 return; \
90         } \
91 } while(0)
92
93 /* Macros to check for invlaid function pointers in dev_ops structure */
94 #define FUNC_PTR_OR_ERR_RET(func, retval) do { \
95         if ((func) == NULL) { \
96                 PMD_DEBUG_TRACE("Function not supported\n"); \
97                 return (retval); \
98         } \
99 } while(0)
100 #define FUNC_PTR_OR_RET(func) do { \
101         if ((func) == NULL) { \
102                 PMD_DEBUG_TRACE("Function not supported\n"); \
103                 return; \
104         } \
105 } while(0)
106
107 static const char *MZ_RTE_ETH_DEV_DATA = "rte_eth_dev_data";
108 struct rte_eth_dev rte_eth_devices[RTE_MAX_ETHPORTS];
109 static struct rte_eth_dev_data *rte_eth_dev_data = NULL;
110 static uint8_t nb_ports = 0;
111
112 /* spinlock for eth device callbacks */
113 static rte_spinlock_t rte_eth_dev_cb_lock = RTE_SPINLOCK_INITIALIZER;
114
115 /**
116  * The user application callback description.
117  *
118  * It contains callback address to be registered by user application,
119  * the pointer to the parameters for callback, and the event type.
120  */
121 struct rte_eth_dev_callback {
122         TAILQ_ENTRY(rte_eth_dev_callback) next; /**< Callbacks list */
123         rte_eth_dev_cb_fn cb_fn;                /**< Callback address */
124         void *cb_arg;                           /**< Parameter for callback */
125         enum rte_eth_event_type event;          /**< Interrupt event type */
126         uint32_t active;                        /**< Callback is executing */
127 };
128
129 enum {
130         STAT_QMAP_TX = 0,
131         STAT_QMAP_RX
132 };
133
134 static inline void
135 rte_eth_dev_data_alloc(void)
136 {
137         const unsigned flags = 0;
138         const struct rte_memzone *mz;
139
140         if (rte_eal_process_type() == RTE_PROC_PRIMARY){
141                 mz = rte_memzone_reserve(MZ_RTE_ETH_DEV_DATA,
142                                 RTE_MAX_ETHPORTS * sizeof(*rte_eth_dev_data),
143                                 rte_socket_id(), flags);
144         } else
145                 mz = rte_memzone_lookup(MZ_RTE_ETH_DEV_DATA);
146         if (mz == NULL)
147                 rte_panic("Cannot allocate memzone for ethernet port data\n");
148
149         rte_eth_dev_data = mz->addr;
150         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
151                 memset(rte_eth_dev_data, 0,
152                                 RTE_MAX_ETHPORTS * sizeof(*rte_eth_dev_data));
153 }
154
155 struct rte_eth_dev *
156 rte_eth_dev_allocate(void)
157 {
158         struct rte_eth_dev *eth_dev;
159
160         if (nb_ports == RTE_MAX_ETHPORTS) {
161                 PMD_DEBUG_TRACE("Reached maximum number of ethernet ports\n");
162                 return NULL;
163         }
164
165         if (rte_eth_dev_data == NULL)
166                 rte_eth_dev_data_alloc();
167
168         eth_dev = &rte_eth_devices[nb_ports];
169         eth_dev->data = &rte_eth_dev_data[nb_ports];
170         eth_dev->data->port_id = nb_ports++;
171         return eth_dev;
172 }
173
174 static int
175 rte_eth_dev_init(struct rte_pci_driver *pci_drv,
176                  struct rte_pci_device *pci_dev)
177 {
178         struct eth_driver    *eth_drv;
179         struct rte_eth_dev *eth_dev;
180         int diag;
181
182         eth_drv = (struct eth_driver *)pci_drv;
183
184         eth_dev = rte_eth_dev_allocate();
185         if (eth_dev == NULL)
186                 return -ENOMEM;
187
188         if (rte_eal_process_type() == RTE_PROC_PRIMARY){
189                 eth_dev->data->dev_private = rte_zmalloc("ethdev private structure",
190                                   eth_drv->dev_private_size,
191                                   CACHE_LINE_SIZE);
192                 if (eth_dev->data->dev_private == NULL)
193                         rte_panic("Cannot allocate memzone for private port data\n");
194         }
195         eth_dev->pci_dev = pci_dev;
196         eth_dev->driver = eth_drv;
197         eth_dev->data->rx_mbuf_alloc_failed = 0;
198
199         /* init user callbacks */
200         TAILQ_INIT(&(eth_dev->callbacks));
201
202         /*
203          * Set the default maximum frame size.
204          */
205         eth_dev->data->max_frame_size = ETHER_MAX_LEN;
206
207         /* Invoke PMD device initialization function */
208         diag = (*eth_drv->eth_dev_init)(eth_drv, eth_dev);
209         if (diag == 0)
210                 return (0);
211
212         PMD_DEBUG_TRACE("driver %s: eth_dev_init(vendor_id=0x%u device_id=0x%x)"
213                         " failed\n", pci_drv->name,
214                         (unsigned) pci_dev->id.vendor_id,
215                         (unsigned) pci_dev->id.device_id);
216         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
217                 rte_free(eth_dev->data->dev_private);
218         nb_ports--;
219         return diag;
220 }
221
222 /**
223  * Register an Ethernet [Poll Mode] driver.
224  *
225  * Function invoked by the initialization function of an Ethernet driver
226  * to simultaneously register itself as a PCI driver and as an Ethernet
227  * Poll Mode Driver.
228  * Invokes the rte_eal_pci_register() function to register the *pci_drv*
229  * structure embedded in the *eth_drv* structure, after having stored the
230  * address of the rte_eth_dev_init() function in the *devinit* field of
231  * the *pci_drv* structure.
232  * During the PCI probing phase, the rte_eth_dev_init() function is
233  * invoked for each PCI [Ethernet device] matching the embedded PCI
234  * identifiers provided by the driver.
235  */
236 void
237 rte_eth_driver_register(struct eth_driver *eth_drv)
238 {
239         eth_drv->pci_drv.devinit = rte_eth_dev_init;
240         rte_eal_pci_register(&eth_drv->pci_drv);
241 }
242
243 int
244 rte_eth_dev_socket_id(uint8_t port_id)
245 {
246         if (port_id >= nb_ports)
247                 return -1;
248         return rte_eth_devices[port_id].pci_dev->numa_node;
249 }
250
251 uint8_t
252 rte_eth_dev_count(void)
253 {
254         return (nb_ports);
255 }
256
257 static int
258 rte_eth_dev_rx_queue_config(struct rte_eth_dev *dev, uint16_t nb_queues)
259 {
260         uint16_t old_nb_queues = dev->data->nb_rx_queues;
261         void **rxq;
262         unsigned i;
263
264         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->rx_queue_release, -ENOTSUP);
265
266         if (dev->data->rx_queues == NULL) {
267                 dev->data->rx_queues = rte_zmalloc("ethdev->rx_queues",
268                                 sizeof(dev->data->rx_queues[0]) * nb_queues,
269                                 CACHE_LINE_SIZE);
270                 if (dev->data->rx_queues == NULL) {
271                         dev->data->nb_rx_queues = 0;
272                         return -(ENOMEM);
273                 }
274         } else {
275                 rxq = dev->data->rx_queues;
276
277                 for (i = nb_queues; i < old_nb_queues; i++)
278                         (*dev->dev_ops->rx_queue_release)(rxq[i]);
279                 rxq = rte_realloc(rxq, sizeof(rxq[0]) * nb_queues,
280                                 CACHE_LINE_SIZE);
281                 if (rxq == NULL)
282                         return -(ENOMEM);
283
284                 if (nb_queues > old_nb_queues)
285                         memset(rxq + old_nb_queues, 0,
286                                 sizeof(rxq[0]) * (nb_queues - old_nb_queues));
287
288                 dev->data->rx_queues = rxq;
289
290         }
291         dev->data->nb_rx_queues = nb_queues;
292         return (0);
293 }
294
295 static int
296 rte_eth_dev_tx_queue_config(struct rte_eth_dev *dev, uint16_t nb_queues)
297 {
298         uint16_t old_nb_queues = dev->data->nb_tx_queues;
299         void **txq;
300         unsigned i;
301
302         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->tx_queue_release, -ENOTSUP);
303
304         if (dev->data->tx_queues == NULL) {
305                 dev->data->tx_queues = rte_zmalloc("ethdev->tx_queues",
306                                 sizeof(dev->data->tx_queues[0]) * nb_queues,
307                                 CACHE_LINE_SIZE);
308                 if (dev->data->tx_queues == NULL) {
309                         dev->data->nb_tx_queues = 0;
310                         return -(ENOMEM);
311                 }
312         } else {
313                 txq = dev->data->tx_queues;
314
315                 for (i = nb_queues; i < old_nb_queues; i++)
316                         (*dev->dev_ops->tx_queue_release)(txq[i]);
317                 txq = rte_realloc(txq, sizeof(txq[0]) * nb_queues,
318                                 CACHE_LINE_SIZE);
319                 if (txq == NULL)
320                         return -(ENOMEM);
321
322                 if (nb_queues > old_nb_queues)
323                         memset(txq + old_nb_queues, 0,
324                                 sizeof(txq[0]) * (nb_queues - old_nb_queues));
325
326                 dev->data->tx_queues = txq;
327
328         }
329         dev->data->nb_tx_queues = nb_queues;
330         return (0);
331 }
332
333 static int
334 rte_eth_dev_check_mq_mode(uint8_t port_id, uint16_t nb_rx_q, uint16_t nb_tx_q,
335                       const struct rte_eth_conf *dev_conf)
336 {
337         struct rte_eth_dev *dev = &rte_eth_devices[port_id];
338
339         if (RTE_ETH_DEV_SRIOV(dev).active != 0) {
340                 /* check multi-queue mode */
341                 if ((dev_conf->rxmode.mq_mode == ETH_MQ_RX_RSS) || 
342                     (dev_conf->rxmode.mq_mode == ETH_MQ_RX_DCB) ||
343                     (dev_conf->rxmode.mq_mode == ETH_MQ_RX_DCB_RSS) ||
344                     (dev_conf->txmode.mq_mode == ETH_MQ_TX_DCB)) {
345                         /* SRIOV only works in VMDq enable mode */
346                         PMD_DEBUG_TRACE("ethdev port_id=%hhu SRIOV active, "
347                                         "wrong VMDQ mq_mode rx %u tx %u\n", 
348                                         port_id,
349                                         dev_conf->rxmode.mq_mode,
350                                         dev_conf->txmode.mq_mode);
351                         return (-EINVAL);
352                 }
353
354                 switch (dev_conf->rxmode.mq_mode) {
355                 case ETH_MQ_RX_VMDQ_RSS:
356                 case ETH_MQ_RX_VMDQ_DCB:
357                 case ETH_MQ_RX_VMDQ_DCB_RSS:
358                         /* DCB/RSS VMDQ in SRIOV mode, not implement yet */
359                         PMD_DEBUG_TRACE("ethdev port_id=%hhu SRIOV active, "
360                                         "unsupported VMDQ mq_mode rx %u\n", 
361                                         port_id, dev_conf->rxmode.mq_mode);
362                         return (-EINVAL);
363                 default: /* ETH_MQ_RX_VMDQ_ONLY or ETH_MQ_RX_NONE */
364                         /* if nothing mq mode configure, use default scheme */
365                         dev->data->dev_conf.rxmode.mq_mode = ETH_MQ_RX_VMDQ_ONLY;
366                         if (RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool > 1)
367                                 RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool = 1;
368                         break;
369                 }
370
371                 switch (dev_conf->txmode.mq_mode) {
372                 case ETH_MQ_TX_VMDQ_DCB:
373                         /* DCB VMDQ in SRIOV mode, not implement yet */
374                         PMD_DEBUG_TRACE("ethdev port_id=%hhu SRIOV active, "
375                                         "unsupported VMDQ mq_mode tx %u\n", 
376                                         port_id, dev_conf->txmode.mq_mode);
377                         return (-EINVAL);
378                 default: /* ETH_MQ_TX_VMDQ_ONLY or ETH_MQ_TX_NONE */
379                         /* if nothing mq mode configure, use default scheme */
380                         dev->data->dev_conf.txmode.mq_mode = ETH_MQ_TX_VMDQ_ONLY;
381                         if (RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool > 1)
382                                 RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool = 1;
383                         break;
384                 }
385
386                 /* check valid queue number */
387                 if ((nb_rx_q > RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool) ||
388                     (nb_tx_q > RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool)) {
389                         PMD_DEBUG_TRACE("ethdev port_id=%d SRIOV active, "
390                                     "queue number must less equal to %d\n", 
391                                         port_id, RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool);
392                         return (-EINVAL);
393                 }
394         } else {
395                 /* For vmdb+dcb mode check our configuration before we go further */
396                 if (dev_conf->rxmode.mq_mode == ETH_MQ_RX_VMDQ_DCB) {
397                         const struct rte_eth_vmdq_dcb_conf *conf;
398                         
399                         if (nb_rx_q != ETH_VMDQ_DCB_NUM_QUEUES) {
400                                 PMD_DEBUG_TRACE("ethdev port_id=%d VMDQ+DCB, nb_rx_q "
401                                                 "!= %d\n",
402                                                 port_id, ETH_VMDQ_DCB_NUM_QUEUES);
403                                 return (-EINVAL);
404                         }
405                         conf = &(dev_conf->rx_adv_conf.vmdq_dcb_conf);
406                         if (! (conf->nb_queue_pools == ETH_16_POOLS ||
407                                conf->nb_queue_pools == ETH_32_POOLS)) {
408                                 PMD_DEBUG_TRACE("ethdev port_id=%d VMDQ+DCB selected, "
409                                                 "nb_queue_pools must be %d or %d\n",
410                                                 port_id, ETH_16_POOLS, ETH_32_POOLS);
411                                 return (-EINVAL);
412                         }
413                 }
414                 if (dev_conf->txmode.mq_mode == ETH_MQ_TX_VMDQ_DCB) {
415                         const struct rte_eth_vmdq_dcb_tx_conf *conf;
416                         
417                         if (nb_tx_q != ETH_VMDQ_DCB_NUM_QUEUES) {
418                                 PMD_DEBUG_TRACE("ethdev port_id=%d VMDQ+DCB, nb_tx_q "
419                                                 "!= %d\n",
420                                                 port_id, ETH_VMDQ_DCB_NUM_QUEUES);
421                                 return (-EINVAL);
422                         }
423                         conf = &(dev_conf->tx_adv_conf.vmdq_dcb_tx_conf);
424                         if (! (conf->nb_queue_pools == ETH_16_POOLS ||
425                                conf->nb_queue_pools == ETH_32_POOLS)) {
426                                 PMD_DEBUG_TRACE("ethdev port_id=%d VMDQ+DCB selected, "
427                                                 "nb_queue_pools != %d or nb_queue_pools "
428                                                 "!= %d\n",
429                                                 port_id, ETH_16_POOLS, ETH_32_POOLS);
430                                 return (-EINVAL);
431                         }
432                 }
433                 
434                 /* For DCB mode check our configuration before we go further */
435                 if (dev_conf->rxmode.mq_mode == ETH_MQ_RX_DCB) {
436                         const struct rte_eth_dcb_rx_conf *conf;
437                         
438                         if (nb_rx_q != ETH_DCB_NUM_QUEUES) {
439                                 PMD_DEBUG_TRACE("ethdev port_id=%d DCB, nb_rx_q "
440                                                 "!= %d\n",
441                                                 port_id, ETH_DCB_NUM_QUEUES);
442                                 return (-EINVAL);
443                         }
444                         conf = &(dev_conf->rx_adv_conf.dcb_rx_conf);
445                         if (! (conf->nb_tcs == ETH_4_TCS ||
446                                conf->nb_tcs == ETH_8_TCS)) {
447                                 PMD_DEBUG_TRACE("ethdev port_id=%d DCB selected, "
448                                                 "nb_tcs != %d or nb_tcs "
449                                                 "!= %d\n",
450                                                 port_id, ETH_4_TCS, ETH_8_TCS);
451                                 return (-EINVAL);
452                         }
453                 }
454                 
455                 if (dev_conf->txmode.mq_mode == ETH_MQ_TX_DCB) {
456                         const struct rte_eth_dcb_tx_conf *conf;
457                         
458                         if (nb_tx_q != ETH_DCB_NUM_QUEUES) {
459                                 PMD_DEBUG_TRACE("ethdev port_id=%d DCB, nb_tx_q "
460                                                 "!= %d\n",
461                                                 port_id, ETH_DCB_NUM_QUEUES);
462                                 return (-EINVAL);
463                         }
464                         conf = &(dev_conf->tx_adv_conf.dcb_tx_conf);
465                         if (! (conf->nb_tcs == ETH_4_TCS ||
466                                conf->nb_tcs == ETH_8_TCS)) {
467                                 PMD_DEBUG_TRACE("ethdev port_id=%d DCB selected, "
468                                                 "nb_tcs != %d or nb_tcs "
469                                                 "!= %d\n",
470                                                 port_id, ETH_4_TCS, ETH_8_TCS);
471                                 return (-EINVAL);
472                         }
473                 }
474         }
475         return 0;
476 }
477
478 int
479 rte_eth_dev_configure(uint8_t port_id, uint16_t nb_rx_q, uint16_t nb_tx_q,
480                       const struct rte_eth_conf *dev_conf)
481 {
482         struct rte_eth_dev *dev;
483         struct rte_eth_dev_info dev_info;
484         int diag;
485
486         /* This function is only safe when called from the primary process
487          * in a multi-process setup*/
488         PROC_PRIMARY_OR_ERR_RET(-E_RTE_SECONDARY);
489
490         if (port_id >= nb_ports || port_id >= RTE_MAX_ETHPORTS) {
491                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
492                 return (-EINVAL);
493         }
494         dev = &rte_eth_devices[port_id];
495
496         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->dev_infos_get, -ENOTSUP);
497         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->dev_configure, -ENOTSUP);
498
499         if (dev->data->dev_started) {
500                 PMD_DEBUG_TRACE(
501                     "port %d must be stopped to allow configuration\n", port_id);
502                 return (-EBUSY);
503         }
504
505         /*
506          * Check that the numbers of RX and TX queues are not greater
507          * than the maximum number of RX and TX queues supported by the
508          * configured device.
509          */
510         (*dev->dev_ops->dev_infos_get)(dev, &dev_info);
511         if (nb_rx_q > dev_info.max_rx_queues) {
512                 PMD_DEBUG_TRACE("ethdev port_id=%d nb_rx_queues=%d > %d\n",
513                                 port_id, nb_rx_q, dev_info.max_rx_queues);
514                 return (-EINVAL);
515         }
516         if (nb_rx_q == 0) {
517                 PMD_DEBUG_TRACE("ethdev port_id=%d nb_rx_q == 0\n", port_id);
518                 return (-EINVAL);
519         }
520
521         if (nb_tx_q > dev_info.max_tx_queues) {
522                 PMD_DEBUG_TRACE("ethdev port_id=%d nb_tx_queues=%d > %d\n",
523                                 port_id, nb_tx_q, dev_info.max_tx_queues);
524                 return (-EINVAL);
525         }
526         if (nb_tx_q == 0) {
527                 PMD_DEBUG_TRACE("ethdev port_id=%d nb_tx_q == 0\n", port_id);
528                 return (-EINVAL);
529         }
530
531         /* Copy the dev_conf parameter into the dev structure */
532         memcpy(&dev->data->dev_conf, dev_conf, sizeof(dev->data->dev_conf));
533
534         /*
535          * If jumbo frames are enabled, check that the maximum RX packet
536          * length is supported by the configured device.
537          */
538         if (dev_conf->rxmode.jumbo_frame == 1) {
539                 if (dev_conf->rxmode.max_rx_pkt_len >
540                     dev_info.max_rx_pktlen) {
541                         PMD_DEBUG_TRACE("ethdev port_id=%d max_rx_pkt_len %u"
542                                 " > max valid value %u\n",
543                                 port_id,
544                                 (unsigned)dev_conf->rxmode.max_rx_pkt_len,
545                                 (unsigned)dev_info.max_rx_pktlen);
546                         return (-EINVAL);
547                 }
548                 else if (dev_conf->rxmode.max_rx_pkt_len < ETHER_MIN_LEN) {
549                         PMD_DEBUG_TRACE("ethdev port_id=%d max_rx_pkt_len %u"
550                                 " < min valid value %u\n",
551                                 port_id,
552                                 (unsigned)dev_conf->rxmode.max_rx_pkt_len,
553                                 (unsigned)ETHER_MIN_LEN);
554                         return (-EINVAL);
555                 }
556         } else
557                 /* Use default value */
558                 dev->data->dev_conf.rxmode.max_rx_pkt_len = ETHER_MAX_LEN;
559
560         /* multipe queue mode checking */
561         diag = rte_eth_dev_check_mq_mode(port_id, nb_rx_q, nb_tx_q, dev_conf);
562         if (diag != 0) {
563                 PMD_DEBUG_TRACE("port%d rte_eth_dev_check_mq_mode = %d\n",
564                                 port_id, diag);
565                 return diag;
566         }
567
568         /*
569          * Setup new number of RX/TX queues and reconfigure device.
570          */
571         diag = rte_eth_dev_rx_queue_config(dev, nb_rx_q);
572         if (diag != 0) {
573                 PMD_DEBUG_TRACE("port%d rte_eth_dev_rx_queue_config = %d\n",
574                                 port_id, diag);
575                 return diag;
576         }
577
578         diag = rte_eth_dev_tx_queue_config(dev, nb_tx_q);
579         if (diag != 0) {
580                 PMD_DEBUG_TRACE("port%d rte_eth_dev_tx_queue_config = %d\n",
581                                 port_id, diag);
582                 rte_eth_dev_rx_queue_config(dev, 0);
583                 return diag;
584         }
585
586         diag = (*dev->dev_ops->dev_configure)(dev);
587         if (diag != 0) {
588                 PMD_DEBUG_TRACE("port%d dev_configure = %d\n",
589                                 port_id, diag);
590                 rte_eth_dev_rx_queue_config(dev, 0);
591                 rte_eth_dev_tx_queue_config(dev, 0);
592                 return diag;
593         }
594
595         return 0;
596 }
597
598 static void
599 rte_eth_dev_config_restore(uint8_t port_id)
600 {
601         struct rte_eth_dev *dev;
602         struct rte_eth_dev_info dev_info;
603         struct ether_addr addr;
604         uint16_t i;
605         uint32_t pool = 0;
606
607         dev = &rte_eth_devices[port_id];
608
609         rte_eth_dev_info_get(port_id, &dev_info);
610
611         if (RTE_ETH_DEV_SRIOV(dev).active)
612                 pool = RTE_ETH_DEV_SRIOV(dev).def_vmdq_idx;
613
614         /* replay MAC address configuration */
615         for (i = 0; i < dev_info.max_mac_addrs; i++) {
616                 addr = dev->data->mac_addrs[i];
617
618                 /* skip zero address */
619                 if (is_zero_ether_addr(&addr))
620                         continue;
621
622                 /* add address to the hardware */
623                 if  (*dev->dev_ops->mac_addr_add)
624                         (*dev->dev_ops->mac_addr_add)(dev, &addr, i, pool);
625                 else {
626                         PMD_DEBUG_TRACE("port %d: MAC address array not supported\n",
627                                         port_id);
628                         /* exit the loop but not return an error */
629                         break;
630                 }
631         }
632
633         /* replay promiscuous configuration */
634         if (rte_eth_promiscuous_get(port_id) == 1)
635                 rte_eth_promiscuous_enable(port_id);
636         else if (rte_eth_promiscuous_get(port_id) == 0)
637                 rte_eth_promiscuous_disable(port_id);
638
639         /* replay allmulticast configuration */
640         if (rte_eth_allmulticast_get(port_id) == 1)
641                 rte_eth_allmulticast_enable(port_id);
642         else if (rte_eth_allmulticast_get(port_id) == 0)
643                 rte_eth_allmulticast_disable(port_id);
644 }
645
646 int
647 rte_eth_dev_start(uint8_t port_id)
648 {
649         struct rte_eth_dev *dev;
650         int diag;
651
652         /* This function is only safe when called from the primary process
653          * in a multi-process setup*/
654         PROC_PRIMARY_OR_ERR_RET(-E_RTE_SECONDARY);
655
656         if (port_id >= nb_ports) {
657                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
658                 return (-EINVAL);
659         }
660         dev = &rte_eth_devices[port_id];
661
662         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->dev_start, -ENOTSUP);
663         diag = (*dev->dev_ops->dev_start)(dev);
664         if (diag == 0)
665                 dev->data->dev_started = 1;
666         else
667                 return diag;
668
669         rte_eth_dev_config_restore(port_id);
670
671         return 0;
672 }
673
674 void
675 rte_eth_dev_stop(uint8_t port_id)
676 {
677         struct rte_eth_dev *dev;
678
679         /* This function is only safe when called from the primary process
680          * in a multi-process setup*/
681         PROC_PRIMARY_OR_RET();
682
683         if (port_id >= nb_ports) {
684                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
685                 return;
686         }
687         dev = &rte_eth_devices[port_id];
688
689         FUNC_PTR_OR_RET(*dev->dev_ops->dev_stop);
690         dev->data->dev_started = 0;
691         (*dev->dev_ops->dev_stop)(dev);
692 }
693
694 void
695 rte_eth_dev_close(uint8_t port_id)
696 {
697         struct rte_eth_dev *dev;
698
699         /* This function is only safe when called from the primary process
700          * in a multi-process setup*/
701         PROC_PRIMARY_OR_RET();
702
703         if (port_id >= nb_ports) {
704                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
705                 return;
706         }
707
708         dev = &rte_eth_devices[port_id];
709
710         FUNC_PTR_OR_RET(*dev->dev_ops->dev_close);
711         dev->data->dev_started = 0;
712         (*dev->dev_ops->dev_close)(dev);
713 }
714
715 int
716 rte_eth_rx_queue_setup(uint8_t port_id, uint16_t rx_queue_id,
717                        uint16_t nb_rx_desc, unsigned int socket_id,
718                        const struct rte_eth_rxconf *rx_conf,
719                        struct rte_mempool *mp)
720 {
721         struct rte_eth_dev *dev;
722         struct rte_pktmbuf_pool_private *mbp_priv;
723         struct rte_eth_dev_info dev_info;
724
725         /* This function is only safe when called from the primary process
726          * in a multi-process setup*/
727         PROC_PRIMARY_OR_ERR_RET(-E_RTE_SECONDARY);
728
729         if (port_id >= nb_ports) {
730                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
731                 return (-EINVAL);
732         }
733         dev = &rte_eth_devices[port_id];
734         if (rx_queue_id >= dev->data->nb_rx_queues) {
735                 PMD_DEBUG_TRACE("Invalid RX queue_id=%d\n", rx_queue_id);
736                 return (-EINVAL);
737         }
738
739         if (dev->data->dev_started) {
740                 PMD_DEBUG_TRACE(
741                     "port %d must be stopped to allow configuration\n", port_id);
742                 return -EBUSY;
743         }
744
745         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->dev_infos_get, -ENOTSUP);
746         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->rx_queue_setup, -ENOTSUP);
747
748         /*
749          * Check the size of the mbuf data buffer.
750          * This value must be provided in the private data of the memory pool.
751          * First check that the memory pool has a valid private data.
752          */
753         (*dev->dev_ops->dev_infos_get)(dev, &dev_info);
754         if (mp->private_data_size < sizeof(struct rte_pktmbuf_pool_private)) {
755                 PMD_DEBUG_TRACE("%s private_data_size %d < %d\n",
756                                 mp->name, (int) mp->private_data_size,
757                                 (int) sizeof(struct rte_pktmbuf_pool_private));
758                 return (-ENOSPC);
759         }
760         mbp_priv = rte_mempool_get_priv(mp);
761         if ((uint32_t) (mbp_priv->mbuf_data_room_size - RTE_PKTMBUF_HEADROOM) <
762             dev_info.min_rx_bufsize) {
763                 PMD_DEBUG_TRACE("%s mbuf_data_room_size %d < %d "
764                                 "(RTE_PKTMBUF_HEADROOM=%d + min_rx_bufsize(dev)"
765                                 "=%d)\n",
766                                 mp->name,
767                                 (int)mbp_priv->mbuf_data_room_size,
768                                 (int)(RTE_PKTMBUF_HEADROOM +
769                                       dev_info.min_rx_bufsize),
770                                 (int)RTE_PKTMBUF_HEADROOM,
771                                 (int)dev_info.min_rx_bufsize);
772                 return (-EINVAL);
773         }
774
775         return (*dev->dev_ops->rx_queue_setup)(dev, rx_queue_id, nb_rx_desc,
776                                                socket_id, rx_conf, mp);
777 }
778
779 int
780 rte_eth_tx_queue_setup(uint8_t port_id, uint16_t tx_queue_id,
781                        uint16_t nb_tx_desc, unsigned int socket_id,
782                        const struct rte_eth_txconf *tx_conf)
783 {
784         struct rte_eth_dev *dev;
785
786         /* This function is only safe when called from the primary process
787          * in a multi-process setup*/
788         PROC_PRIMARY_OR_ERR_RET(-E_RTE_SECONDARY);
789
790         if (port_id >= RTE_MAX_ETHPORTS || port_id >= nb_ports) {
791                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
792                 return (-EINVAL);
793         }
794         dev = &rte_eth_devices[port_id];
795         if (tx_queue_id >= dev->data->nb_tx_queues) {
796                 PMD_DEBUG_TRACE("Invalid TX queue_id=%d\n", tx_queue_id);
797                 return (-EINVAL);
798         }
799
800         if (dev->data->dev_started) {
801                 PMD_DEBUG_TRACE(
802                     "port %d must be stopped to allow configuration\n", port_id);
803                 return -EBUSY;
804         }
805
806         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->tx_queue_setup, -ENOTSUP);
807         return (*dev->dev_ops->tx_queue_setup)(dev, tx_queue_id, nb_tx_desc,
808                                                socket_id, tx_conf);
809 }
810
811 void
812 rte_eth_promiscuous_enable(uint8_t port_id)
813 {
814         struct rte_eth_dev *dev;
815
816         if (port_id >= nb_ports) {
817                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
818                 return;
819         }
820         dev = &rte_eth_devices[port_id];
821
822         FUNC_PTR_OR_RET(*dev->dev_ops->promiscuous_enable);
823         (*dev->dev_ops->promiscuous_enable)(dev);
824         dev->data->promiscuous = 1;
825 }
826
827 void
828 rte_eth_promiscuous_disable(uint8_t port_id)
829 {
830         struct rte_eth_dev *dev;
831
832         if (port_id >= nb_ports) {
833                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
834                 return;
835         }
836         dev = &rte_eth_devices[port_id];
837
838         FUNC_PTR_OR_RET(*dev->dev_ops->promiscuous_disable);
839         dev->data->promiscuous = 0;
840         (*dev->dev_ops->promiscuous_disable)(dev);
841 }
842
843 int
844 rte_eth_promiscuous_get(uint8_t port_id)
845 {
846         struct rte_eth_dev *dev;
847
848         if (port_id >= nb_ports) {
849                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
850                 return -1;
851         }
852
853         dev = &rte_eth_devices[port_id];
854         return dev->data->promiscuous;
855 }
856
857 void
858 rte_eth_allmulticast_enable(uint8_t port_id)
859 {
860         struct rte_eth_dev *dev;
861
862         if (port_id >= nb_ports) {
863                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
864                 return;
865         }
866         dev = &rte_eth_devices[port_id];
867
868         FUNC_PTR_OR_RET(*dev->dev_ops->allmulticast_enable);
869         (*dev->dev_ops->allmulticast_enable)(dev);
870         dev->data->all_multicast = 1;
871 }
872
873 void
874 rte_eth_allmulticast_disable(uint8_t port_id)
875 {
876         struct rte_eth_dev *dev;
877
878         if (port_id >= nb_ports) {
879                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
880                 return;
881         }
882         dev = &rte_eth_devices[port_id];
883
884         FUNC_PTR_OR_RET(*dev->dev_ops->allmulticast_disable);
885         dev->data->all_multicast = 0;
886         (*dev->dev_ops->allmulticast_disable)(dev);
887 }
888
889 int
890 rte_eth_allmulticast_get(uint8_t port_id)
891 {
892         struct rte_eth_dev *dev;
893
894         if (port_id >= nb_ports) {
895                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
896                 return -1;
897         }
898
899         dev = &rte_eth_devices[port_id];
900         return dev->data->all_multicast;
901 }
902
903 static inline int
904 rte_eth_dev_atomic_read_link_status(struct rte_eth_dev *dev,
905                                 struct rte_eth_link *link)
906 {
907         struct rte_eth_link *dst = link;
908         struct rte_eth_link *src = &(dev->data->dev_link);
909
910         if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst,
911                                         *(uint64_t *)src) == 0)
912                 return -1;
913
914         return 0;
915 }
916
917 void
918 rte_eth_link_get(uint8_t port_id, struct rte_eth_link *eth_link)
919 {
920         struct rte_eth_dev *dev;
921
922         if (port_id >= nb_ports) {
923                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
924                 return;
925         }
926         dev = &rte_eth_devices[port_id];
927         FUNC_PTR_OR_RET(*dev->dev_ops->link_update);
928
929         if (dev->data->dev_conf.intr_conf.lsc != 0)
930                 rte_eth_dev_atomic_read_link_status(dev, eth_link);
931         else {
932                 (*dev->dev_ops->link_update)(dev, 1);
933                 *eth_link = dev->data->dev_link;
934         }
935 }
936
937 void
938 rte_eth_link_get_nowait(uint8_t port_id, struct rte_eth_link *eth_link)
939 {
940         struct rte_eth_dev *dev;
941
942         if (port_id >= nb_ports) {
943                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
944                 return;
945         }
946         dev = &rte_eth_devices[port_id];
947         FUNC_PTR_OR_RET(*dev->dev_ops->link_update);
948
949         if (dev->data->dev_conf.intr_conf.lsc != 0)
950                 rte_eth_dev_atomic_read_link_status(dev, eth_link);
951         else {
952                 (*dev->dev_ops->link_update)(dev, 0);
953                 *eth_link = dev->data->dev_link;
954         }
955 }
956
957 void
958 rte_eth_stats_get(uint8_t port_id, struct rte_eth_stats *stats)
959 {
960         struct rte_eth_dev *dev;
961
962         if (port_id >= nb_ports) {
963                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
964                 return;
965         }
966         dev = &rte_eth_devices[port_id];
967         memset(stats, 0, sizeof(*stats));
968
969         FUNC_PTR_OR_RET(*dev->dev_ops->stats_get);
970         (*dev->dev_ops->stats_get)(dev, stats);
971         stats->rx_nombuf = dev->data->rx_mbuf_alloc_failed;
972 }
973
974 void
975 rte_eth_stats_reset(uint8_t port_id)
976 {
977         struct rte_eth_dev *dev;
978
979         if (port_id >= nb_ports) {
980                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
981                 return;
982         }
983         dev = &rte_eth_devices[port_id];
984
985         FUNC_PTR_OR_RET(*dev->dev_ops->stats_reset);
986         (*dev->dev_ops->stats_reset)(dev);
987 }
988
989
990 static int
991 set_queue_stats_mapping(uint8_t port_id, uint16_t queue_id, uint8_t stat_idx,
992                 uint8_t is_rx)
993 {
994         struct rte_eth_dev *dev;
995
996         if (port_id >= nb_ports) {
997                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
998                 return -ENODEV;
999         }
1000         dev = &rte_eth_devices[port_id];
1001
1002         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->queue_stats_mapping_set, -ENOTSUP);
1003         return (*dev->dev_ops->queue_stats_mapping_set)
1004                         (dev, queue_id, stat_idx, is_rx);
1005 }
1006
1007
1008 int
1009 rte_eth_dev_set_tx_queue_stats_mapping(uint8_t port_id, uint16_t tx_queue_id,
1010                 uint8_t stat_idx)
1011 {
1012         return set_queue_stats_mapping(port_id, tx_queue_id, stat_idx,
1013                         STAT_QMAP_TX);
1014 }
1015
1016
1017 int
1018 rte_eth_dev_set_rx_queue_stats_mapping(uint8_t port_id, uint16_t rx_queue_id,
1019                 uint8_t stat_idx)
1020 {
1021         return set_queue_stats_mapping(port_id, rx_queue_id, stat_idx,
1022                         STAT_QMAP_RX);
1023 }
1024
1025
1026 void
1027 rte_eth_dev_info_get(uint8_t port_id, struct rte_eth_dev_info *dev_info)
1028 {
1029         struct rte_eth_dev *dev;
1030
1031         if (port_id >= nb_ports) {
1032                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1033                 return;
1034         }
1035         dev = &rte_eth_devices[port_id];
1036
1037         /* Default device offload capabilities to zero */
1038         dev_info->rx_offload_capa = 0;
1039         dev_info->tx_offload_capa = 0;
1040         FUNC_PTR_OR_RET(*dev->dev_ops->dev_infos_get);
1041         (*dev->dev_ops->dev_infos_get)(dev, dev_info);
1042         dev_info->pci_dev = dev->pci_dev;
1043         if (dev->driver)
1044                 dev_info->driver_name = dev->driver->pci_drv.name;
1045 }
1046
1047 void
1048 rte_eth_macaddr_get(uint8_t port_id, struct ether_addr *mac_addr)
1049 {
1050         struct rte_eth_dev *dev;
1051
1052         if (port_id >= nb_ports) {
1053                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1054                 return;
1055         }
1056         dev = &rte_eth_devices[port_id];
1057         ether_addr_copy(&dev->data->mac_addrs[0], mac_addr);
1058 }
1059
1060 int
1061 rte_eth_dev_vlan_filter(uint8_t port_id, uint16_t vlan_id, int on)
1062 {
1063         struct rte_eth_dev *dev;
1064
1065         if (port_id >= nb_ports) {
1066                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1067                 return (-ENODEV);
1068         }
1069         dev = &rte_eth_devices[port_id];
1070         if (! (dev->data->dev_conf.rxmode.hw_vlan_filter)) {
1071                 PMD_DEBUG_TRACE("port %d: vlan-filtering disabled\n", port_id);
1072                 return (-ENOSYS);
1073         }
1074
1075         if (vlan_id > 4095) {
1076                 PMD_DEBUG_TRACE("(port_id=%d) invalid vlan_id=%u > 4095\n",
1077                                 port_id, (unsigned) vlan_id);
1078                 return (-EINVAL);
1079         }
1080         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->vlan_filter_set, -ENOTSUP);
1081         (*dev->dev_ops->vlan_filter_set)(dev, vlan_id, on);
1082         return (0);
1083 }
1084
1085 int
1086 rte_eth_dev_set_vlan_strip_on_queue(uint8_t port_id, uint16_t rx_queue_id, int on)
1087 {
1088         struct rte_eth_dev *dev;
1089
1090         if (port_id >= nb_ports) {
1091                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1092                 return (-ENODEV);
1093         }
1094
1095         dev = &rte_eth_devices[port_id];
1096         if (rx_queue_id >= dev->data->nb_rx_queues) {
1097                 PMD_DEBUG_TRACE("Invalid rx_queue_id=%d\n", port_id);
1098                 return (-EINVAL);
1099         }
1100
1101         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->vlan_strip_queue_set, -ENOTSUP);
1102         (*dev->dev_ops->vlan_strip_queue_set)(dev, rx_queue_id, on);
1103
1104         return (0);
1105 }
1106
1107 int
1108 rte_eth_dev_set_vlan_ether_type(uint8_t port_id, uint16_t tpid)
1109 {
1110         struct rte_eth_dev *dev;
1111
1112         if (port_id >= nb_ports) {
1113                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1114                 return (-ENODEV);
1115         }
1116
1117         dev = &rte_eth_devices[port_id];
1118         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->vlan_tpid_set, -ENOTSUP);
1119         (*dev->dev_ops->vlan_tpid_set)(dev, tpid);
1120
1121         return (0);
1122 }
1123
1124 int
1125 rte_eth_dev_set_vlan_offload(uint8_t port_id, int offload_mask)
1126 {
1127         struct rte_eth_dev *dev;
1128         int ret = 0;
1129         int mask = 0;
1130         int cur, org = 0;
1131         
1132         if (port_id >= nb_ports) {
1133                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1134                 return (-ENODEV);
1135         }
1136
1137         dev = &rte_eth_devices[port_id];
1138
1139         /*check which option changed by application*/
1140         cur = !!(offload_mask & ETH_VLAN_STRIP_OFFLOAD);
1141         org = !!(dev->data->dev_conf.rxmode.hw_vlan_strip);
1142         if (cur != org){
1143                 dev->data->dev_conf.rxmode.hw_vlan_strip = (uint8_t)cur;
1144                 mask |= ETH_VLAN_STRIP_MASK;
1145         }
1146         
1147         cur = !!(offload_mask & ETH_VLAN_FILTER_OFFLOAD);
1148         org = !!(dev->data->dev_conf.rxmode.hw_vlan_filter);
1149         if (cur != org){
1150                 dev->data->dev_conf.rxmode.hw_vlan_filter = (uint8_t)cur;
1151                 mask |= ETH_VLAN_FILTER_MASK;
1152         }
1153
1154         cur = !!(offload_mask & ETH_VLAN_EXTEND_OFFLOAD);
1155         org = !!(dev->data->dev_conf.rxmode.hw_vlan_extend);
1156         if (cur != org){
1157                 dev->data->dev_conf.rxmode.hw_vlan_extend = (uint8_t)cur;
1158                 mask |= ETH_VLAN_EXTEND_MASK;
1159         }
1160
1161         /*no change*/
1162         if(mask == 0)
1163                 return ret;
1164         
1165         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->vlan_offload_set, -ENOTSUP);
1166         (*dev->dev_ops->vlan_offload_set)(dev, mask);
1167
1168         return ret;
1169 }
1170
1171 int
1172 rte_eth_dev_get_vlan_offload(uint8_t port_id)
1173 {
1174         struct rte_eth_dev *dev;
1175         int ret = 0;
1176
1177         if (port_id >= nb_ports) {
1178                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1179                 return (-ENODEV);
1180         }
1181
1182         dev = &rte_eth_devices[port_id];
1183
1184         if (dev->data->dev_conf.rxmode.hw_vlan_strip)
1185                 ret |= ETH_VLAN_STRIP_OFFLOAD ;
1186
1187         if (dev->data->dev_conf.rxmode.hw_vlan_filter)
1188                 ret |= ETH_VLAN_FILTER_OFFLOAD ;
1189
1190         if (dev->data->dev_conf.rxmode.hw_vlan_extend)
1191                 ret |= ETH_VLAN_EXTEND_OFFLOAD ;
1192
1193         return ret;
1194 }
1195
1196
1197 int
1198 rte_eth_dev_fdir_add_signature_filter(uint8_t port_id,
1199                                       struct rte_fdir_filter *fdir_filter,
1200                                       uint8_t queue)
1201 {
1202         struct rte_eth_dev *dev;
1203
1204         if (port_id >= nb_ports) {
1205                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1206                 return (-ENODEV);
1207         }
1208
1209         dev = &rte_eth_devices[port_id];
1210
1211         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_SIGNATURE) {
1212                 PMD_DEBUG_TRACE("port %d: invalid FDIR mode=%u\n",
1213                                 port_id, dev->data->dev_conf.fdir_conf.mode);
1214                 return (-ENOSYS);
1215         }
1216
1217         if ((fdir_filter->l4type == RTE_FDIR_L4TYPE_SCTP
1218              || fdir_filter->l4type == RTE_FDIR_L4TYPE_NONE)
1219             && (fdir_filter->port_src || fdir_filter->port_dst)) {
1220                 PMD_DEBUG_TRACE(" Port are meaningless for SCTP and " \
1221                                 "None l4type, source & destinations ports " \
1222                                 "should be null!\n");
1223                 return (-EINVAL);
1224         }
1225
1226         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_add_signature_filter, -ENOTSUP);
1227         return (*dev->dev_ops->fdir_add_signature_filter)(dev, fdir_filter,
1228                                                                 queue);
1229 }
1230
1231 int
1232 rte_eth_dev_fdir_update_signature_filter(uint8_t port_id,
1233                                          struct rte_fdir_filter *fdir_filter,
1234                                          uint8_t queue)
1235 {
1236         struct rte_eth_dev *dev;
1237
1238         if (port_id >= nb_ports) {
1239                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1240                 return (-ENODEV);
1241         }
1242
1243         dev = &rte_eth_devices[port_id];
1244
1245         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_SIGNATURE) {
1246                 PMD_DEBUG_TRACE("port %d: invalid FDIR mode=%u\n",
1247                                 port_id, dev->data->dev_conf.fdir_conf.mode);
1248                 return (-ENOSYS);
1249         }
1250
1251         if ((fdir_filter->l4type == RTE_FDIR_L4TYPE_SCTP
1252              || fdir_filter->l4type == RTE_FDIR_L4TYPE_NONE)
1253             && (fdir_filter->port_src || fdir_filter->port_dst)) {
1254                 PMD_DEBUG_TRACE(" Port are meaningless for SCTP and " \
1255                                 "None l4type, source & destinations ports " \
1256                                 "should be null!\n");
1257                 return (-EINVAL);
1258         }
1259
1260         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_update_signature_filter, -ENOTSUP);
1261         return (*dev->dev_ops->fdir_update_signature_filter)(dev, fdir_filter,
1262                                                                 queue);
1263
1264 }
1265
1266 int
1267 rte_eth_dev_fdir_remove_signature_filter(uint8_t port_id,
1268                                          struct rte_fdir_filter *fdir_filter)
1269 {
1270         struct rte_eth_dev *dev;
1271
1272         if (port_id >= nb_ports) {
1273                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1274                 return (-ENODEV);
1275         }
1276
1277         dev = &rte_eth_devices[port_id];
1278
1279         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_SIGNATURE) {
1280                 PMD_DEBUG_TRACE("port %d: invalid FDIR mode=%u\n",
1281                                 port_id, dev->data->dev_conf.fdir_conf.mode);
1282                 return (-ENOSYS);
1283         }
1284
1285         if ((fdir_filter->l4type == RTE_FDIR_L4TYPE_SCTP
1286              || fdir_filter->l4type == RTE_FDIR_L4TYPE_NONE)
1287             && (fdir_filter->port_src || fdir_filter->port_dst)) {
1288                 PMD_DEBUG_TRACE(" Port are meaningless for SCTP and " \
1289                                 "None l4type source & destinations ports " \
1290                                 "should be null!\n");
1291                 return (-EINVAL);
1292         }
1293
1294         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_remove_signature_filter, -ENOTSUP);
1295         return (*dev->dev_ops->fdir_remove_signature_filter)(dev, fdir_filter);
1296 }
1297
1298 int
1299 rte_eth_dev_fdir_get_infos(uint8_t port_id, struct rte_eth_fdir *fdir)
1300 {
1301         struct rte_eth_dev *dev;
1302
1303         if (port_id >= nb_ports) {
1304                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1305                 return (-ENODEV);
1306         }
1307
1308         dev = &rte_eth_devices[port_id];
1309         if (! (dev->data->dev_conf.fdir_conf.mode)) {
1310                 PMD_DEBUG_TRACE("port %d: pkt-filter disabled\n", port_id);
1311                 return (-ENOSYS);
1312         }
1313
1314         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_infos_get, -ENOTSUP);
1315
1316         (*dev->dev_ops->fdir_infos_get)(dev, fdir);
1317         return (0);
1318 }
1319
1320 int
1321 rte_eth_dev_fdir_add_perfect_filter(uint8_t port_id,
1322                                     struct rte_fdir_filter *fdir_filter,
1323                                     uint16_t soft_id, uint8_t queue,
1324                                     uint8_t drop)
1325 {
1326         struct rte_eth_dev *dev;
1327
1328         if (port_id >= nb_ports) {
1329                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1330                 return (-ENODEV);
1331         }
1332
1333         dev = &rte_eth_devices[port_id];
1334
1335         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_PERFECT) {
1336                 PMD_DEBUG_TRACE("port %d: invalid FDIR mode=%u\n",
1337                                 port_id, dev->data->dev_conf.fdir_conf.mode);
1338                 return (-ENOSYS);
1339         }
1340
1341         if ((fdir_filter->l4type == RTE_FDIR_L4TYPE_SCTP
1342              || fdir_filter->l4type == RTE_FDIR_L4TYPE_NONE)
1343             && (fdir_filter->port_src || fdir_filter->port_dst)) {
1344                 PMD_DEBUG_TRACE(" Port are meaningless for SCTP and " \
1345                                 "None l4type, source & destinations ports " \
1346                                 "should be null!\n");
1347                 return (-EINVAL);
1348         }
1349
1350         /* For now IPv6 is not supported with perfect filter */
1351         if (fdir_filter->iptype == RTE_FDIR_IPTYPE_IPV6)
1352                 return (-ENOTSUP);
1353
1354         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_add_perfect_filter, -ENOTSUP);
1355         return (*dev->dev_ops->fdir_add_perfect_filter)(dev, fdir_filter,
1356                                                                 soft_id, queue,
1357                                                                 drop);
1358 }
1359
1360 int
1361 rte_eth_dev_fdir_update_perfect_filter(uint8_t port_id,
1362                                        struct rte_fdir_filter *fdir_filter,
1363                                        uint16_t soft_id, uint8_t queue,
1364                                        uint8_t drop)
1365 {
1366         struct rte_eth_dev *dev;
1367
1368         if (port_id >= nb_ports) {
1369                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1370                 return (-ENODEV);
1371         }
1372
1373         dev = &rte_eth_devices[port_id];
1374
1375         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_PERFECT) {
1376                 PMD_DEBUG_TRACE("port %d: invalid FDIR mode=%u\n",
1377                                 port_id, dev->data->dev_conf.fdir_conf.mode);
1378                 return (-ENOSYS);
1379         }
1380
1381         if ((fdir_filter->l4type == RTE_FDIR_L4TYPE_SCTP
1382              || fdir_filter->l4type == RTE_FDIR_L4TYPE_NONE)
1383             && (fdir_filter->port_src || fdir_filter->port_dst)) {
1384                 PMD_DEBUG_TRACE(" Port are meaningless for SCTP and " \
1385                                 "None l4type, source & destinations ports " \
1386                                 "should be null!\n");
1387                 return (-EINVAL);
1388         }
1389
1390         /* For now IPv6 is not supported with perfect filter */
1391         if (fdir_filter->iptype == RTE_FDIR_IPTYPE_IPV6)
1392                 return (-ENOTSUP);
1393
1394         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_update_perfect_filter, -ENOTSUP);
1395         return (*dev->dev_ops->fdir_update_perfect_filter)(dev, fdir_filter,
1396                                                         soft_id, queue, drop);
1397 }
1398
1399 int
1400 rte_eth_dev_fdir_remove_perfect_filter(uint8_t port_id,
1401                                        struct rte_fdir_filter *fdir_filter,
1402                                        uint16_t soft_id)
1403 {
1404         struct rte_eth_dev *dev;
1405
1406         if (port_id >= nb_ports) {
1407                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1408                 return (-ENODEV);
1409         }
1410
1411         dev = &rte_eth_devices[port_id];
1412
1413         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_PERFECT) {
1414                 PMD_DEBUG_TRACE("port %d: invalid FDIR mode=%u\n",
1415                                 port_id, dev->data->dev_conf.fdir_conf.mode);
1416                 return (-ENOSYS);
1417         }
1418
1419         if ((fdir_filter->l4type == RTE_FDIR_L4TYPE_SCTP
1420              || fdir_filter->l4type == RTE_FDIR_L4TYPE_NONE)
1421             && (fdir_filter->port_src || fdir_filter->port_dst)) {
1422                 PMD_DEBUG_TRACE(" Port are meaningless for SCTP and " \
1423                                 "None l4type, source & destinations ports " \
1424                                 "should be null!\n");
1425                 return (-EINVAL);
1426         }
1427
1428         /* For now IPv6 is not supported with perfect filter */
1429         if (fdir_filter->iptype == RTE_FDIR_IPTYPE_IPV6)
1430                 return (-ENOTSUP);
1431
1432         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_remove_perfect_filter, -ENOTSUP);
1433         return (*dev->dev_ops->fdir_remove_perfect_filter)(dev, fdir_filter,
1434                                                                 soft_id);
1435 }
1436
1437 int
1438 rte_eth_dev_fdir_set_masks(uint8_t port_id, struct rte_fdir_masks *fdir_mask)
1439 {
1440         struct rte_eth_dev *dev;
1441
1442         if (port_id >= nb_ports) {
1443                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1444                 return (-ENODEV);
1445         }
1446
1447         dev = &rte_eth_devices[port_id];
1448         if (! (dev->data->dev_conf.fdir_conf.mode)) {
1449                 PMD_DEBUG_TRACE("port %d: pkt-filter disabled\n", port_id);
1450                 return (-ENOSYS);
1451         }
1452
1453         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->fdir_set_masks, -ENOTSUP);
1454         return (*dev->dev_ops->fdir_set_masks)(dev, fdir_mask);
1455 }
1456
1457 int
1458 rte_eth_dev_flow_ctrl_set(uint8_t port_id, struct rte_eth_fc_conf *fc_conf)
1459 {
1460         struct rte_eth_dev *dev;
1461
1462         if (port_id >= nb_ports) {
1463                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1464                 return (-ENODEV);
1465         }
1466
1467         if ((fc_conf->send_xon != 0) && (fc_conf->send_xon != 1)) {
1468                 PMD_DEBUG_TRACE("Invalid send_xon, only 0/1 allowed\n");
1469                 return (-EINVAL);
1470         }
1471
1472         dev = &rte_eth_devices[port_id];
1473         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->flow_ctrl_set, -ENOTSUP);
1474         return (*dev->dev_ops->flow_ctrl_set)(dev, fc_conf);
1475 }
1476
1477 int
1478 rte_eth_dev_priority_flow_ctrl_set(uint8_t port_id, struct rte_eth_pfc_conf *pfc_conf)
1479 {
1480         struct rte_eth_dev *dev;
1481
1482         if (port_id >= nb_ports) {
1483                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1484                 return (-ENODEV);
1485         }
1486
1487         if (pfc_conf->priority > (ETH_DCB_NUM_USER_PRIORITIES - 1)) {
1488                 PMD_DEBUG_TRACE("Invalid priority, only 0-7 allowed\n");
1489                 return (-EINVAL);
1490         }
1491
1492         dev = &rte_eth_devices[port_id];
1493         /* High water, low water validation are device specific */
1494         if  (*dev->dev_ops->priority_flow_ctrl_set)
1495                 return (*dev->dev_ops->priority_flow_ctrl_set)(dev, pfc_conf);
1496         return (-ENOTSUP);
1497 }
1498
1499 int
1500 rte_eth_dev_rss_reta_update(uint8_t port_id, struct rte_eth_rss_reta *reta_conf)
1501 {
1502         struct rte_eth_dev *dev;
1503         uint8_t i,j;
1504
1505         if (port_id >= nb_ports) {
1506                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1507                 return (-ENODEV);
1508         }
1509
1510         /* Invalid mask bit(s) setting */
1511         if ((reta_conf->mask_lo == 0) && (reta_conf->mask_hi == 0)) {
1512                 PMD_DEBUG_TRACE("Invalid update mask bits for port=%d\n",port_id);
1513                 return (-EINVAL);
1514         }
1515
1516         if (reta_conf->mask_lo != 0) {
1517                 for (i = 0; i < ETH_RSS_RETA_NUM_ENTRIES/2; i++) {
1518                         if ((reta_conf->mask_lo & (1ULL << i)) &&
1519                                 (reta_conf->reta[i] >= ETH_RSS_RETA_MAX_QUEUE)) {
1520                                 PMD_DEBUG_TRACE("RETA hash index output"
1521                                         "configration for port=%d,invalid"
1522                                         "queue=%d\n",port_id,reta_conf->reta[i]);
1523
1524                                 return (-EINVAL);
1525                         } 
1526                 }
1527         }
1528
1529         if (reta_conf->mask_hi != 0) {
1530                 for (i = 0; i< ETH_RSS_RETA_NUM_ENTRIES/2; i++) {       
1531                         j = (uint8_t)(i + ETH_RSS_RETA_NUM_ENTRIES/2);
1532
1533                         /* Check if the max entry >= 128 */
1534                         if ((reta_conf->mask_hi & (1ULL << i)) && 
1535                                 (reta_conf->reta[j] >= ETH_RSS_RETA_MAX_QUEUE)) {
1536                                 PMD_DEBUG_TRACE("RETA hash index output"
1537                                         "configration for port=%d,invalid"
1538                                         "queue=%d\n",port_id,reta_conf->reta[j]);
1539
1540                                 return (-EINVAL);
1541                         }
1542                 }
1543         }
1544
1545         dev = &rte_eth_devices[port_id];
1546
1547         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->reta_update, -ENOTSUP);
1548         return (*dev->dev_ops->reta_update)(dev, reta_conf);
1549 }
1550
1551 int 
1552 rte_eth_dev_rss_reta_query(uint8_t port_id, struct rte_eth_rss_reta *reta_conf)
1553 {
1554         struct rte_eth_dev *dev;
1555         
1556         if (port_id >= nb_ports) {
1557                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1558                 return (-ENODEV);
1559         }
1560
1561         if((reta_conf->mask_lo == 0) && (reta_conf->mask_hi == 0)) {
1562                 PMD_DEBUG_TRACE("Invalid update mask bits for the port=%d\n",port_id);
1563                 return (-EINVAL);
1564         }
1565
1566         dev = &rte_eth_devices[port_id];
1567         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->reta_query, -ENOTSUP);
1568         return (*dev->dev_ops->reta_query)(dev, reta_conf);
1569 }
1570
1571 int
1572 rte_eth_led_on(uint8_t port_id)
1573 {
1574         struct rte_eth_dev *dev;
1575
1576         if (port_id >= nb_ports) {
1577                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1578                 return (-ENODEV);
1579         }
1580
1581         dev = &rte_eth_devices[port_id];
1582         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->dev_led_on, -ENOTSUP);
1583         return ((*dev->dev_ops->dev_led_on)(dev));
1584 }
1585
1586 int
1587 rte_eth_led_off(uint8_t port_id)
1588 {
1589         struct rte_eth_dev *dev;
1590
1591         if (port_id >= nb_ports) {
1592                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1593                 return (-ENODEV);
1594         }
1595
1596         dev = &rte_eth_devices[port_id];
1597         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->dev_led_off, -ENOTSUP);
1598         return ((*dev->dev_ops->dev_led_off)(dev));
1599 }
1600
1601 /*
1602  * Returns index into MAC address array of addr. Use 00:00:00:00:00:00 to find
1603  * an empty spot.
1604  */
1605 static inline int
1606 get_mac_addr_index(uint8_t port_id, struct ether_addr *addr)
1607 {
1608         struct rte_eth_dev_info dev_info;
1609         struct rte_eth_dev *dev = &rte_eth_devices[port_id];
1610         unsigned i;
1611
1612         rte_eth_dev_info_get(port_id, &dev_info);
1613
1614         for (i = 0; i < dev_info.max_mac_addrs; i++)
1615                 if (memcmp(addr, &dev->data->mac_addrs[i], ETHER_ADDR_LEN) == 0)
1616                         return i;
1617
1618         return -1;
1619 }
1620
1621 static struct ether_addr null_mac_addr = {{0, 0, 0, 0, 0, 0}};
1622
1623 int
1624 rte_eth_dev_mac_addr_add(uint8_t port_id, struct ether_addr *addr,
1625                         uint32_t pool)
1626 {
1627         struct rte_eth_dev *dev;
1628         int index;
1629         uint64_t pool_mask;
1630
1631         if (port_id >= nb_ports) {
1632                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1633                 return (-ENODEV);
1634         }
1635         dev = &rte_eth_devices[port_id];
1636         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->mac_addr_add, -ENOTSUP);
1637
1638         if (is_zero_ether_addr(addr)) {
1639                 PMD_DEBUG_TRACE("port %d: Cannot add NULL MAC address\n", 
1640                         port_id);
1641                 return (-EINVAL);
1642         }
1643         if (pool >= ETH_64_POOLS) {
1644                 PMD_DEBUG_TRACE("pool id must be 0-%d\n",ETH_64_POOLS - 1);
1645                 return (-EINVAL);
1646         }
1647         
1648         index = get_mac_addr_index(port_id, addr);
1649         if (index < 0) {
1650                 index = get_mac_addr_index(port_id, &null_mac_addr);
1651                 if (index < 0) {
1652                         PMD_DEBUG_TRACE("port %d: MAC address array full\n",
1653                                 port_id);
1654                         return (-ENOSPC);
1655                 }
1656         } else {
1657                 pool_mask = dev->data->mac_pool_sel[index];
1658                 
1659                 /* Check if both MAC address and pool is alread there, and do nothing */
1660                 if (pool_mask & (1ULL << pool))
1661                         return 0;
1662         }
1663
1664         /* Update NIC */
1665         (*dev->dev_ops->mac_addr_add)(dev, addr, index, pool);
1666
1667         /* Update address in NIC data structure */
1668         ether_addr_copy(addr, &dev->data->mac_addrs[index]);
1669         
1670         /* Update pool bitmap in NIC data structure */
1671         dev->data->mac_pool_sel[index] |= (1ULL << pool);
1672
1673         return 0;
1674 }
1675
1676 int
1677 rte_eth_dev_mac_addr_remove(uint8_t port_id, struct ether_addr *addr)
1678 {
1679         struct rte_eth_dev *dev;
1680         int index;
1681
1682         if (port_id >= nb_ports) {
1683                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1684                 return (-ENODEV);
1685         }
1686         dev = &rte_eth_devices[port_id];
1687         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->mac_addr_remove, -ENOTSUP);
1688
1689         index = get_mac_addr_index(port_id, addr);
1690         if (index == 0) {
1691                 PMD_DEBUG_TRACE("port %d: Cannot remove default MAC address\n", port_id);
1692                 return (-EADDRINUSE);
1693         } else if (index < 0)
1694                 return 0;  /* Do nothing if address wasn't found */
1695
1696         /* Update NIC */
1697         (*dev->dev_ops->mac_addr_remove)(dev, index);
1698
1699         /* Update address in NIC data structure */
1700         ether_addr_copy(&null_mac_addr, &dev->data->mac_addrs[index]);
1701
1702         return 0;
1703 }
1704
1705 int 
1706 rte_eth_dev_set_vf_rxmode(uint8_t port_id,  uint16_t vf,
1707                                 uint16_t rx_mode, uint8_t on)
1708 {
1709         uint16_t num_vfs;
1710         struct rte_eth_dev *dev;
1711         struct rte_eth_dev_info dev_info;
1712
1713         if (port_id >= nb_ports) {
1714                 PMD_DEBUG_TRACE("set VF RX mode:Invalid port_id=%d\n",
1715                                 port_id);
1716                 return (-ENODEV);
1717         }       
1718         
1719         dev = &rte_eth_devices[port_id];
1720         rte_eth_dev_info_get(port_id, &dev_info);
1721
1722         num_vfs = dev_info.max_vfs;
1723         if (vf > num_vfs)
1724         {
1725                 PMD_DEBUG_TRACE("set VF RX mode:invalid VF id %d\n", vf);
1726                 return (-EINVAL);
1727         }
1728         if (rx_mode == 0)
1729         {
1730                 PMD_DEBUG_TRACE("set VF RX mode:mode mask ca not be zero\n");
1731                 return (-EINVAL);       
1732         }
1733         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->set_vf_rx_mode, -ENOTSUP);
1734         return (*dev->dev_ops->set_vf_rx_mode)(dev, vf, rx_mode, on);
1735 }
1736
1737 /*
1738  * Returns index into MAC address array of addr. Use 00:00:00:00:00:00 to find
1739  * an empty spot.
1740  */
1741 static inline int
1742 get_hash_mac_addr_index(uint8_t port_id, struct ether_addr *addr)
1743 {
1744         struct rte_eth_dev_info dev_info;
1745         struct rte_eth_dev *dev = &rte_eth_devices[port_id];
1746         unsigned i;
1747
1748         rte_eth_dev_info_get(port_id, &dev_info);
1749         if (!dev->data->hash_mac_addrs)
1750                 return -1;
1751
1752         for (i = 0; i < dev_info.max_hash_mac_addrs; i++)
1753                 if (memcmp(addr, &dev->data->hash_mac_addrs[i],
1754                         ETHER_ADDR_LEN) == 0)
1755                         return i;
1756
1757         return -1;
1758 }
1759
1760 int
1761 rte_eth_dev_uc_hash_table_set(uint8_t port_id, struct ether_addr *addr,
1762                                 uint8_t on)
1763 {
1764         int index;
1765         int ret;
1766         struct rte_eth_dev *dev;
1767         
1768         if (port_id >= nb_ports) {
1769                 PMD_DEBUG_TRACE("unicast hash setting:Invalid port_id=%d\n",
1770                         port_id);
1771                 return (-ENODEV);
1772         }
1773         
1774         dev = &rte_eth_devices[port_id];
1775         if (is_zero_ether_addr(addr)) {
1776                 PMD_DEBUG_TRACE("port %d: Cannot add NULL MAC address\n", 
1777                         port_id);
1778                 return (-EINVAL);
1779         }
1780
1781         index = get_hash_mac_addr_index(port_id, addr);
1782         /* Check if it's already there, and do nothing */
1783         if ((index >= 0) && (on))
1784                 return 0;
1785         
1786         if (index < 0) {
1787                 if (!on) {
1788                         PMD_DEBUG_TRACE("port %d: the MAC address was not" 
1789                                 "set in UTA\n", port_id);
1790                         return (-EINVAL);
1791                 }
1792                         
1793                 index = get_hash_mac_addr_index(port_id, &null_mac_addr);
1794                 if (index < 0) {
1795                         PMD_DEBUG_TRACE("port %d: MAC address array full\n",
1796                                         port_id);
1797                         return (-ENOSPC);
1798                 }
1799         } 
1800          
1801         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->uc_hash_table_set, -ENOTSUP);
1802         ret = (*dev->dev_ops->uc_hash_table_set)(dev, addr, on);
1803         if (ret == 0) {
1804                 /* Update address in NIC data structure */
1805                 if (on)
1806                         ether_addr_copy(addr,
1807                                         &dev->data->hash_mac_addrs[index]);
1808                 else 
1809                         ether_addr_copy(&null_mac_addr,
1810                                         &dev->data->hash_mac_addrs[index]);
1811         }
1812         
1813         return ret;
1814 }
1815
1816 int
1817 rte_eth_dev_uc_all_hash_table_set(uint8_t port_id, uint8_t on)
1818 {
1819         struct rte_eth_dev *dev;
1820         
1821         if (port_id >= nb_ports) {
1822                 PMD_DEBUG_TRACE("unicast hash setting:Invalid port_id=%d\n",
1823                         port_id);
1824                 return (-ENODEV);
1825         }
1826         
1827         dev = &rte_eth_devices[port_id];
1828
1829         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->uc_all_hash_table_set, -ENOTSUP);
1830         return (*dev->dev_ops->uc_all_hash_table_set)(dev, on);
1831 }
1832
1833 int 
1834 rte_eth_dev_set_vf_rx(uint8_t port_id,uint16_t vf, uint8_t on)
1835 {
1836         uint16_t num_vfs;
1837         struct rte_eth_dev *dev;
1838         struct rte_eth_dev_info dev_info;
1839
1840         if (port_id >= nb_ports) {
1841                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1842                 return (-ENODEV);
1843         }
1844         
1845         dev = &rte_eth_devices[port_id];
1846         rte_eth_dev_info_get(port_id, &dev_info);
1847         
1848         num_vfs = dev_info.max_vfs;
1849         if (vf > num_vfs) 
1850         {
1851                 PMD_DEBUG_TRACE("port %d: invalid vf id\n", port_id);
1852                 return (-EINVAL);
1853         }       
1854         
1855         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->set_vf_rx, -ENOTSUP);
1856         return (*dev->dev_ops->set_vf_rx)(dev, vf,on);
1857 }
1858
1859 int 
1860 rte_eth_dev_set_vf_tx(uint8_t port_id,uint16_t vf, uint8_t on)
1861 {
1862         uint16_t num_vfs;
1863         struct rte_eth_dev *dev;
1864         struct rte_eth_dev_info dev_info;
1865
1866         if (port_id >= nb_ports) {
1867                 PMD_DEBUG_TRACE("set pool tx:Invalid port_id=%d\n", port_id);
1868                 return (-ENODEV);
1869         }
1870         
1871         dev = &rte_eth_devices[port_id];
1872         rte_eth_dev_info_get(port_id, &dev_info);
1873
1874         num_vfs = dev_info.max_vfs;
1875         if (vf > num_vfs) 
1876         {
1877                 PMD_DEBUG_TRACE("set pool tx:invalid pool id=%d\n", vf);
1878                 return (-EINVAL);
1879         }
1880         
1881         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->set_vf_tx, -ENOTSUP);
1882         return (*dev->dev_ops->set_vf_tx)(dev, vf,on);
1883 }
1884
1885 int
1886 rte_eth_dev_set_vf_vlan_filter(uint8_t port_id, uint16_t vlan_id, 
1887                                  uint64_t vf_mask,uint8_t vlan_on)
1888 {
1889         struct rte_eth_dev *dev;
1890
1891         if (port_id >= nb_ports) {
1892                 PMD_DEBUG_TRACE("VF VLAN filter:invalid port id=%d\n",
1893                                 port_id);
1894                 return (-ENODEV);
1895         }
1896         dev = &rte_eth_devices[port_id];
1897
1898         if(vlan_id > ETHER_MAX_VLAN_ID)
1899         {
1900                 PMD_DEBUG_TRACE("VF VLAN filter:invalid VLAN id=%d\n",
1901                         vlan_id);
1902                 return (-EINVAL);
1903         }
1904         if (vf_mask == 0)
1905         {
1906                 PMD_DEBUG_TRACE("VF VLAN filter:pool_mask can not be 0\n");
1907                 return (-EINVAL);
1908         }
1909         
1910         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->set_vf_vlan_filter, -ENOTSUP);
1911         return (*dev->dev_ops->set_vf_vlan_filter)(dev, vlan_id,
1912                                                 vf_mask,vlan_on);
1913 }
1914
1915 int
1916 rte_eth_mirror_rule_set(uint8_t port_id, 
1917                         struct rte_eth_vmdq_mirror_conf *mirror_conf,
1918                         uint8_t rule_id, uint8_t on)
1919 {
1920         struct rte_eth_dev *dev = &rte_eth_devices[port_id];
1921
1922         if (port_id >= nb_ports) {
1923                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1924                 return (-ENODEV);
1925         }
1926         
1927         if (mirror_conf->rule_type_mask == 0) {
1928                 PMD_DEBUG_TRACE("mirror rule type can not be 0.\n");
1929                 return (-EINVAL);
1930         }
1931         
1932         if (mirror_conf->dst_pool >= ETH_64_POOLS) {
1933                 PMD_DEBUG_TRACE("Invalid dst pool, pool id must"
1934                         "be 0-%d\n",ETH_64_POOLS - 1);
1935                 return (-EINVAL);
1936         }
1937         
1938         if ((mirror_conf->rule_type_mask & ETH_VMDQ_POOL_MIRROR) && 
1939                 (mirror_conf->pool_mask == 0)) {
1940                 PMD_DEBUG_TRACE("Invalid mirror pool, pool mask can not"
1941                                 "be 0.\n");             
1942                 return (-EINVAL);
1943         }
1944         
1945         if(rule_id >= ETH_VMDQ_NUM_MIRROR_RULE)
1946         {
1947                 PMD_DEBUG_TRACE("Invalid rule_id, rule_id must be 0-%d\n",
1948                         ETH_VMDQ_NUM_MIRROR_RULE - 1);
1949                 return (-EINVAL);
1950         }
1951
1952         dev = &rte_eth_devices[port_id];
1953         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->mirror_rule_set, -ENOTSUP);
1954
1955         return (*dev->dev_ops->mirror_rule_set)(dev, mirror_conf, rule_id, on);
1956 }
1957
1958 int
1959 rte_eth_mirror_rule_reset(uint8_t port_id, uint8_t rule_id)
1960 {
1961         struct rte_eth_dev *dev = &rte_eth_devices[port_id];
1962
1963         if (port_id >= nb_ports) {
1964                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1965                 return (-ENODEV);
1966         }
1967
1968         if(rule_id >= ETH_VMDQ_NUM_MIRROR_RULE)
1969         {
1970                 PMD_DEBUG_TRACE("Invalid rule_id, rule_id must be 0-%d\n",
1971                         ETH_VMDQ_NUM_MIRROR_RULE-1);
1972                 return (-EINVAL);
1973         }
1974
1975         dev = &rte_eth_devices[port_id];
1976         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->mirror_rule_reset, -ENOTSUP);
1977
1978         return (*dev->dev_ops->mirror_rule_reset)(dev, rule_id);
1979 }
1980
1981 #ifdef RTE_LIBRTE_ETHDEV_DEBUG
1982 uint16_t
1983 rte_eth_rx_burst(uint8_t port_id, uint16_t queue_id,
1984                  struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
1985 {
1986         struct rte_eth_dev *dev;
1987
1988         if (port_id >= nb_ports) {
1989                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
1990                 return 0;
1991         }
1992         dev = &rte_eth_devices[port_id];
1993         FUNC_PTR_OR_ERR_RET(*dev->rx_pkt_burst, -ENOTSUP);
1994         if (queue_id >= dev->data->nb_rx_queues) {
1995                 PMD_DEBUG_TRACE("Invalid RX queue_id=%d\n", queue_id);
1996                 return 0;
1997         }
1998         return (*dev->rx_pkt_burst)(dev->data->rx_queues[queue_id],
1999                                                 rx_pkts, nb_pkts);
2000 }
2001
2002 uint16_t
2003 rte_eth_tx_burst(uint8_t port_id, uint16_t queue_id,
2004                  struct rte_mbuf **tx_pkts, uint16_t nb_pkts)
2005 {
2006         struct rte_eth_dev *dev;
2007
2008         if (port_id >= nb_ports) {
2009                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2010                 return 0;
2011         }
2012         dev = &rte_eth_devices[port_id];
2013
2014         FUNC_PTR_OR_ERR_RET(*dev->tx_pkt_burst, -ENOTSUP);
2015         if (queue_id >= dev->data->nb_tx_queues) {
2016                 PMD_DEBUG_TRACE("Invalid TX queue_id=%d\n", queue_id);
2017                 return 0;
2018         }
2019         return (*dev->tx_pkt_burst)(dev->data->tx_queues[queue_id],
2020                                                 tx_pkts, nb_pkts);
2021 }
2022
2023 uint32_t
2024 rte_eth_rx_queue_count(uint8_t port_id, uint16_t queue_id)
2025 {
2026         struct rte_eth_dev *dev;
2027
2028         if (port_id >= nb_ports) {
2029                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2030                 return 0;
2031         }
2032         dev = &rte_eth_devices[port_id];
2033         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->rx_queue_count, -ENOTSUP);
2034         return (*dev->dev_ops->rx_queue_count)(dev, queue_id);  
2035 }
2036
2037 int
2038 rte_eth_rx_descriptor_done(uint8_t port_id, uint16_t queue_id, uint16_t offset)
2039 {
2040         struct rte_eth_dev *dev;
2041
2042         if (port_id >= nb_ports) {
2043                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2044                 return (-ENODEV);
2045         }
2046         dev = &rte_eth_devices[port_id];
2047         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->rx_descriptor_done, -ENOTSUP);
2048         return (*dev->dev_ops->rx_descriptor_done)( \
2049                 dev->data->rx_queues[queue_id], offset);
2050 }
2051 #endif
2052
2053 int
2054 rte_eth_dev_callback_register(uint8_t port_id,
2055                         enum rte_eth_event_type event,
2056                         rte_eth_dev_cb_fn cb_fn, void *cb_arg)
2057 {
2058         struct rte_eth_dev *dev;
2059         struct rte_eth_dev_callback *user_cb;
2060
2061         if (!cb_fn)
2062                 return (-EINVAL);
2063         if (port_id >= nb_ports) {
2064                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2065                 return (-EINVAL);
2066         }
2067
2068         dev = &rte_eth_devices[port_id];
2069         rte_spinlock_lock(&rte_eth_dev_cb_lock);
2070
2071         TAILQ_FOREACH(user_cb, &(dev->callbacks), next) {
2072                 if (user_cb->cb_fn == cb_fn &&
2073                         user_cb->cb_arg == cb_arg &&
2074                         user_cb->event == event) {
2075                         break;
2076                 }
2077         }
2078
2079         /* create a new callback. */
2080         if (user_cb == NULL && (user_cb = rte_zmalloc("INTR_USER_CALLBACK",
2081                         sizeof(struct rte_eth_dev_callback), 0)) != NULL) {
2082                 user_cb->cb_fn = cb_fn;
2083                 user_cb->cb_arg = cb_arg;
2084                 user_cb->event = event;
2085                 TAILQ_INSERT_TAIL(&(dev->callbacks), user_cb, next);
2086         }
2087
2088         rte_spinlock_unlock(&rte_eth_dev_cb_lock);
2089         return ((user_cb == NULL) ? -ENOMEM : 0);
2090 }
2091
2092 int
2093 rte_eth_dev_callback_unregister(uint8_t port_id,
2094                         enum rte_eth_event_type event,
2095                         rte_eth_dev_cb_fn cb_fn, void *cb_arg)
2096 {
2097         int ret;
2098         struct rte_eth_dev *dev;
2099         struct rte_eth_dev_callback *cb, *next;
2100
2101         if (!cb_fn)
2102                 return (-EINVAL);
2103         if (port_id >= nb_ports) {
2104                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2105                 return (-EINVAL);
2106         }
2107
2108         dev = &rte_eth_devices[port_id];
2109         rte_spinlock_lock(&rte_eth_dev_cb_lock);
2110
2111         ret = 0;
2112         for (cb = TAILQ_FIRST(&dev->callbacks); cb != NULL; cb = next) {
2113
2114                 next = TAILQ_NEXT(cb, next);
2115
2116                 if (cb->cb_fn != cb_fn || cb->event != event ||
2117                                 (cb->cb_arg != (void *)-1 &&
2118                                 cb->cb_arg != cb_arg))
2119                         continue;
2120
2121                 /*
2122                  * if this callback is not executing right now,
2123                  * then remove it.
2124                  */
2125                 if (cb->active == 0) {
2126                         TAILQ_REMOVE(&(dev->callbacks), cb, next);
2127                         rte_free(cb);
2128                 } else {
2129                         ret = -EAGAIN;
2130                 }
2131         }
2132
2133         rte_spinlock_unlock(&rte_eth_dev_cb_lock);
2134         return (ret);
2135 }
2136
2137 void
2138 _rte_eth_dev_callback_process(struct rte_eth_dev *dev,
2139         enum rte_eth_event_type event)
2140 {
2141         struct rte_eth_dev_callback *cb_lst;
2142         struct rte_eth_dev_callback dev_cb;
2143
2144         rte_spinlock_lock(&rte_eth_dev_cb_lock);
2145         TAILQ_FOREACH(cb_lst, &(dev->callbacks), next) {
2146                 if (cb_lst->cb_fn == NULL || cb_lst->event != event)
2147                         continue;
2148                 dev_cb = *cb_lst;
2149                 cb_lst->active = 1;
2150                 rte_spinlock_unlock(&rte_eth_dev_cb_lock);
2151                 dev_cb.cb_fn(dev->data->port_id, dev_cb.event,
2152                                                 dev_cb.cb_arg);
2153                 rte_spinlock_lock(&rte_eth_dev_cb_lock);
2154                 cb_lst->active = 0;
2155         }
2156         rte_spinlock_unlock(&rte_eth_dev_cb_lock);
2157 }
2158 #ifdef RTE_NIC_BYPASS
2159 int rte_eth_dev_bypass_init(uint8_t port_id)
2160 {
2161         struct rte_eth_dev *dev;
2162
2163         if (port_id >= nb_ports) {
2164                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2165                 return (-ENODEV);
2166         }
2167
2168         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2169                 PMD_DEBUG_TRACE("Invalid port device\n");
2170                 return (-ENODEV);
2171         }
2172
2173         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_init, -ENOTSUP);
2174         (*dev->dev_ops->bypass_init)(dev);
2175         return 0;
2176 }
2177
2178 int
2179 rte_eth_dev_bypass_state_show(uint8_t port_id, uint32_t *state)
2180 {
2181         struct rte_eth_dev *dev;
2182
2183         if (port_id >= nb_ports) {
2184                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2185                 return (-ENODEV);
2186         }
2187
2188         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2189                 PMD_DEBUG_TRACE("Invalid port device\n");
2190                 return (-ENODEV);
2191         }
2192         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_state_show, -ENOTSUP);
2193         (*dev->dev_ops->bypass_state_show)(dev, state);
2194         return 0;
2195 }
2196
2197 int
2198 rte_eth_dev_bypass_state_set(uint8_t port_id, uint32_t *new_state)
2199 {
2200         struct rte_eth_dev *dev;
2201
2202         if (port_id >= nb_ports) {
2203                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2204                 return (-ENODEV);
2205         }
2206
2207         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2208                 PMD_DEBUG_TRACE("Invalid port device\n");
2209                 return (-ENODEV);
2210         }
2211
2212         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_state_set, -ENOTSUP);
2213         (*dev->dev_ops->bypass_state_set)(dev, new_state);
2214         return 0;
2215 }
2216
2217 int
2218 rte_eth_dev_bypass_event_show(uint8_t port_id, uint32_t event, uint32_t *state)
2219 {
2220         struct rte_eth_dev *dev;
2221
2222         if (port_id >= nb_ports) {
2223                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2224                 return (-ENODEV);
2225         }
2226
2227         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2228                 PMD_DEBUG_TRACE("Invalid port device\n");
2229                 return (-ENODEV);
2230         }
2231
2232         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_state_show, -ENOTSUP);
2233         (*dev->dev_ops->bypass_event_show)(dev, event, state);
2234         return 0;
2235 }
2236
2237 int
2238 rte_eth_dev_bypass_event_store(uint8_t port_id, uint32_t event, uint32_t state)
2239 {
2240         struct rte_eth_dev *dev;
2241
2242         if (port_id >= nb_ports) {
2243                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2244                 return (-ENODEV);
2245         }
2246
2247         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2248                 PMD_DEBUG_TRACE("Invalid port device\n");
2249                 return (-ENODEV);
2250         }
2251
2252         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_event_set, -ENOTSUP);
2253         (*dev->dev_ops->bypass_event_set)(dev, event, state);
2254         return 0;
2255 }
2256
2257 int
2258 rte_eth_dev_wd_timeout_store(uint8_t port_id, uint32_t timeout)
2259 {
2260         struct rte_eth_dev *dev;
2261
2262         if (port_id >= nb_ports) {
2263                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2264                 return (-ENODEV);
2265         }
2266
2267         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2268                 PMD_DEBUG_TRACE("Invalid port device\n");
2269                 return (-ENODEV);
2270         }
2271
2272         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_wd_timeout_set, -ENOTSUP);
2273         (*dev->dev_ops->bypass_wd_timeout_set)(dev, timeout);
2274         return 0;
2275 }
2276
2277 int
2278 rte_eth_dev_bypass_ver_show(uint8_t port_id, uint32_t *ver)
2279 {
2280         struct rte_eth_dev *dev;
2281
2282         if (port_id >= nb_ports) {
2283                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2284                 return (-ENODEV);
2285         }
2286
2287         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2288                 PMD_DEBUG_TRACE("Invalid port device\n");
2289                 return (-ENODEV);
2290         }
2291
2292         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_ver_show, -ENOTSUP);
2293         (*dev->dev_ops->bypass_ver_show)(dev, ver);
2294         return 0;
2295 }
2296
2297 int
2298 rte_eth_dev_bypass_wd_timeout_show(uint8_t port_id, uint32_t *wd_timeout)
2299 {
2300         struct rte_eth_dev *dev;
2301
2302         if (port_id >= nb_ports) {
2303                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2304                 return (-ENODEV);
2305         }
2306
2307         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2308                 PMD_DEBUG_TRACE("Invalid port device\n");
2309                 return (-ENODEV);
2310         }
2311
2312         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_wd_timeout_show, -ENOTSUP);
2313         (*dev->dev_ops->bypass_wd_timeout_show)(dev, wd_timeout);
2314         return 0;
2315 }
2316
2317 int
2318 rte_eth_dev_bypass_wd_reset(uint8_t port_id)
2319 {
2320         struct rte_eth_dev *dev;
2321
2322         if (port_id >= nb_ports) {
2323                 PMD_DEBUG_TRACE("Invalid port_id=%d\n", port_id);
2324                 return (-ENODEV);
2325         }
2326
2327         if ((dev= &rte_eth_devices[port_id]) == NULL) {
2328                 PMD_DEBUG_TRACE("Invalid port device\n");
2329                 return (-ENODEV);
2330         }
2331
2332         FUNC_PTR_OR_ERR_RET(*dev->dev_ops->bypass_wd_reset, -ENOTSUP);
2333         (*dev->dev_ops->bypass_wd_reset)(dev);
2334         return 0;
2335 }
2336 #endif