drivers/net: fix double free on init failure
[dpdk.git] / drivers / net / ark / ark_ethdev.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright (c) 2015-2018 Atomic Rules LLC
3  */
4
5 #include <unistd.h>
6 #include <sys/stat.h>
7 #include <dlfcn.h>
8
9 #include <rte_bus_pci.h>
10 #include <rte_ethdev_pci.h>
11 #include <rte_kvargs.h>
12
13 #include "ark_global.h"
14 #include "ark_logs.h"
15 #include "ark_ethdev_tx.h"
16 #include "ark_ethdev_rx.h"
17 #include "ark_mpu.h"
18 #include "ark_ddm.h"
19 #include "ark_udm.h"
20 #include "ark_rqp.h"
21 #include "ark_pktdir.h"
22 #include "ark_pktgen.h"
23 #include "ark_pktchkr.h"
24
25 /*  Internal prototypes */
26 static int eth_ark_check_args(struct ark_adapter *ark, const char *params);
27 static int eth_ark_dev_init(struct rte_eth_dev *dev);
28 static int ark_config_device(struct rte_eth_dev *dev);
29 static int eth_ark_dev_uninit(struct rte_eth_dev *eth_dev);
30 static int eth_ark_dev_configure(struct rte_eth_dev *dev);
31 static int eth_ark_dev_start(struct rte_eth_dev *dev);
32 static void eth_ark_dev_stop(struct rte_eth_dev *dev);
33 static void eth_ark_dev_close(struct rte_eth_dev *dev);
34 static void eth_ark_dev_info_get(struct rte_eth_dev *dev,
35                                  struct rte_eth_dev_info *dev_info);
36 static int eth_ark_dev_link_update(struct rte_eth_dev *dev,
37                                    int wait_to_complete);
38 static int eth_ark_dev_set_link_up(struct rte_eth_dev *dev);
39 static int eth_ark_dev_set_link_down(struct rte_eth_dev *dev);
40 static int eth_ark_dev_stats_get(struct rte_eth_dev *dev,
41                                   struct rte_eth_stats *stats);
42 static void eth_ark_dev_stats_reset(struct rte_eth_dev *dev);
43 static int eth_ark_set_default_mac_addr(struct rte_eth_dev *dev,
44                                          struct rte_ether_addr *mac_addr);
45 static int eth_ark_macaddr_add(struct rte_eth_dev *dev,
46                                struct rte_ether_addr *mac_addr,
47                                uint32_t index,
48                                uint32_t pool);
49 static void eth_ark_macaddr_remove(struct rte_eth_dev *dev,
50                                    uint32_t index);
51 static int  eth_ark_set_mtu(struct rte_eth_dev *dev, uint16_t size);
52
53 /*
54  * The packet generator is a functional block used to generate packet
55  * patterns for testing.  It is not intended for nominal use.
56  */
57 #define ARK_PKTGEN_ARG "Pkt_gen"
58
59 /*
60  * The packet checker is a functional block used to verify packet
61  * patterns for testing.  It is not intended for nominal use.
62  */
63 #define ARK_PKTCHKR_ARG "Pkt_chkr"
64
65 /*
66  * The packet director is used to select the internal ingress and
67  * egress packets paths during testing.  It is not intended for
68  * nominal use.
69  */
70 #define ARK_PKTDIR_ARG "Pkt_dir"
71
72 /* Devinfo configurations */
73 #define ARK_RX_MAX_QUEUE (4096 * 4)
74 #define ARK_RX_MIN_QUEUE (512)
75 #define ARK_RX_MAX_PKT_LEN ((16 * 1024) - 128)
76 #define ARK_RX_MIN_BUFSIZE (1024)
77
78 #define ARK_TX_MAX_QUEUE (4096 * 4)
79 #define ARK_TX_MIN_QUEUE (256)
80
81 static const char * const valid_arguments[] = {
82         ARK_PKTGEN_ARG,
83         ARK_PKTCHKR_ARG,
84         ARK_PKTDIR_ARG,
85         NULL
86 };
87
88 static const struct rte_pci_id pci_id_ark_map[] = {
89         {RTE_PCI_DEVICE(0x1d6c, 0x100d)},
90         {RTE_PCI_DEVICE(0x1d6c, 0x100e)},
91         {.vendor_id = 0, /* sentinel */ },
92 };
93
94 static int
95 eth_ark_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
96                 struct rte_pci_device *pci_dev)
97 {
98         struct rte_eth_dev *eth_dev;
99         int ret;
100
101         eth_dev = rte_eth_dev_pci_allocate(pci_dev, sizeof(struct ark_adapter));
102
103         if (eth_dev == NULL)
104                 return -ENOMEM;
105
106         ret = eth_ark_dev_init(eth_dev);
107         if (ret)
108                 rte_eth_dev_pci_release(eth_dev);
109
110         return ret;
111 }
112
113 static int
114 eth_ark_pci_remove(struct rte_pci_device *pci_dev)
115 {
116         return rte_eth_dev_pci_generic_remove(pci_dev, eth_ark_dev_uninit);
117 }
118
119 static struct rte_pci_driver rte_ark_pmd = {
120         .id_table = pci_id_ark_map,
121         .drv_flags = RTE_PCI_DRV_NEED_MAPPING | RTE_PCI_DRV_INTR_LSC,
122         .probe = eth_ark_pci_probe,
123         .remove = eth_ark_pci_remove,
124 };
125
126 static const struct eth_dev_ops ark_eth_dev_ops = {
127         .dev_configure = eth_ark_dev_configure,
128         .dev_start = eth_ark_dev_start,
129         .dev_stop = eth_ark_dev_stop,
130         .dev_close = eth_ark_dev_close,
131
132         .dev_infos_get = eth_ark_dev_info_get,
133
134         .rx_queue_setup = eth_ark_dev_rx_queue_setup,
135         .rx_queue_count = eth_ark_dev_rx_queue_count,
136         .tx_queue_setup = eth_ark_tx_queue_setup,
137
138         .link_update = eth_ark_dev_link_update,
139         .dev_set_link_up = eth_ark_dev_set_link_up,
140         .dev_set_link_down = eth_ark_dev_set_link_down,
141
142         .rx_queue_start = eth_ark_rx_start_queue,
143         .rx_queue_stop = eth_ark_rx_stop_queue,
144
145         .tx_queue_start = eth_ark_tx_queue_start,
146         .tx_queue_stop = eth_ark_tx_queue_stop,
147
148         .stats_get = eth_ark_dev_stats_get,
149         .stats_reset = eth_ark_dev_stats_reset,
150
151         .mac_addr_add = eth_ark_macaddr_add,
152         .mac_addr_remove = eth_ark_macaddr_remove,
153         .mac_addr_set = eth_ark_set_default_mac_addr,
154
155         .mtu_set = eth_ark_set_mtu,
156 };
157
158 static int
159 check_for_ext(struct ark_adapter *ark)
160 {
161         int found = 0;
162
163         /* Get the env */
164         const char *dllpath = getenv("ARK_EXT_PATH");
165
166         if (dllpath == NULL) {
167                 PMD_DEBUG_LOG(DEBUG, "ARK EXT NO dll path specified\n");
168                 return 0;
169         }
170         PMD_DRV_LOG(INFO, "ARK EXT found dll path at %s\n", dllpath);
171
172         /* Open and load the .so */
173         ark->d_handle = dlopen(dllpath, RTLD_LOCAL | RTLD_LAZY);
174         if (ark->d_handle == NULL) {
175                 PMD_DRV_LOG(ERR, "Could not load user extension %s\n",
176                             dllpath);
177                 return -1;
178         }
179         PMD_DRV_LOG(INFO, "SUCCESS: loaded user extension %s\n",
180                             dllpath);
181
182         /* Get the entry points */
183         ark->user_ext.dev_init =
184                 (void *(*)(struct rte_eth_dev *, void *, int))
185                 dlsym(ark->d_handle, "dev_init");
186         PMD_DEBUG_LOG(DEBUG, "device ext init pointer = %p\n",
187                       ark->user_ext.dev_init);
188         ark->user_ext.dev_get_port_count =
189                 (int (*)(struct rte_eth_dev *, void *))
190                 dlsym(ark->d_handle, "dev_get_port_count");
191         ark->user_ext.dev_uninit =
192                 (void (*)(struct rte_eth_dev *, void *))
193                 dlsym(ark->d_handle, "dev_uninit");
194         ark->user_ext.dev_configure =
195                 (int (*)(struct rte_eth_dev *, void *))
196                 dlsym(ark->d_handle, "dev_configure");
197         ark->user_ext.dev_start =
198                 (int (*)(struct rte_eth_dev *, void *))
199                 dlsym(ark->d_handle, "dev_start");
200         ark->user_ext.dev_stop =
201                 (void (*)(struct rte_eth_dev *, void *))
202                 dlsym(ark->d_handle, "dev_stop");
203         ark->user_ext.dev_close =
204                 (void (*)(struct rte_eth_dev *, void *))
205                 dlsym(ark->d_handle, "dev_close");
206         ark->user_ext.link_update =
207                 (int (*)(struct rte_eth_dev *, int, void *))
208                 dlsym(ark->d_handle, "link_update");
209         ark->user_ext.dev_set_link_up =
210                 (int (*)(struct rte_eth_dev *, void *))
211                 dlsym(ark->d_handle, "dev_set_link_up");
212         ark->user_ext.dev_set_link_down =
213                 (int (*)(struct rte_eth_dev *, void *))
214                 dlsym(ark->d_handle, "dev_set_link_down");
215         ark->user_ext.stats_get =
216                 (int (*)(struct rte_eth_dev *, struct rte_eth_stats *,
217                           void *))
218                 dlsym(ark->d_handle, "stats_get");
219         ark->user_ext.stats_reset =
220                 (void (*)(struct rte_eth_dev *, void *))
221                 dlsym(ark->d_handle, "stats_reset");
222         ark->user_ext.mac_addr_add =
223                 (void (*)(struct rte_eth_dev *, struct rte_ether_addr *,
224                         uint32_t, uint32_t, void *))
225                 dlsym(ark->d_handle, "mac_addr_add");
226         ark->user_ext.mac_addr_remove =
227                 (void (*)(struct rte_eth_dev *, uint32_t, void *))
228                 dlsym(ark->d_handle, "mac_addr_remove");
229         ark->user_ext.mac_addr_set =
230                 (void (*)(struct rte_eth_dev *, struct rte_ether_addr *,
231                           void *))
232                 dlsym(ark->d_handle, "mac_addr_set");
233         ark->user_ext.set_mtu =
234                 (int (*)(struct rte_eth_dev *, uint16_t,
235                           void *))
236                 dlsym(ark->d_handle, "set_mtu");
237
238         return found;
239 }
240
241 static int
242 eth_ark_dev_init(struct rte_eth_dev *dev)
243 {
244         struct ark_adapter *ark = dev->data->dev_private;
245         struct rte_pci_device *pci_dev;
246         int ret;
247         int port_count = 1;
248         int p;
249
250         ark->eth_dev = dev;
251
252         PMD_FUNC_LOG(DEBUG, "\n");
253
254         /* Check to see if there is an extension that we need to load */
255         ret = check_for_ext(ark);
256         if (ret)
257                 return ret;
258         pci_dev = RTE_ETH_DEV_TO_PCI(dev);
259         rte_eth_copy_pci_info(dev, pci_dev);
260
261         /* Use dummy function until setup */
262         dev->rx_pkt_burst = &eth_ark_recv_pkts_noop;
263         dev->tx_pkt_burst = &eth_ark_xmit_pkts_noop;
264
265         ark->bar0 = (uint8_t *)pci_dev->mem_resource[0].addr;
266         ark->a_bar = (uint8_t *)pci_dev->mem_resource[2].addr;
267
268         ark->sysctrl.v  = (void *)&ark->bar0[ARK_SYSCTRL_BASE];
269         ark->mpurx.v  = (void *)&ark->bar0[ARK_MPU_RX_BASE];
270         ark->udm.v  = (void *)&ark->bar0[ARK_UDM_BASE];
271         ark->mputx.v  = (void *)&ark->bar0[ARK_MPU_TX_BASE];
272         ark->ddm.v  = (void *)&ark->bar0[ARK_DDM_BASE];
273         ark->cmac.v  = (void *)&ark->bar0[ARK_CMAC_BASE];
274         ark->external.v  = (void *)&ark->bar0[ARK_EXTERNAL_BASE];
275         ark->pktdir.v  = (void *)&ark->bar0[ARK_PKTDIR_BASE];
276         ark->pktgen.v  = (void *)&ark->bar0[ARK_PKTGEN_BASE];
277         ark->pktchkr.v  = (void *)&ark->bar0[ARK_PKTCHKR_BASE];
278
279         ark->rqpacing =
280                 (struct ark_rqpace_t *)(ark->bar0 + ARK_RCPACING_BASE);
281         ark->started = 0;
282
283         PMD_DEBUG_LOG(INFO, "Sys Ctrl Const = 0x%x  HW Commit_ID: %08x\n",
284                       ark->sysctrl.t32[4],
285                       rte_be_to_cpu_32(ark->sysctrl.t32[0x20 / 4]));
286         PMD_DRV_LOG(INFO, "Arkville HW Commit_ID: %08x\n",
287                     rte_be_to_cpu_32(ark->sysctrl.t32[0x20 / 4]));
288
289         /* If HW sanity test fails, return an error */
290         if (ark->sysctrl.t32[4] != 0xcafef00d) {
291                 PMD_DRV_LOG(ERR,
292                             "HW Sanity test has failed, expected constant"
293                             " 0x%x, read 0x%x (%s)\n",
294                             0xcafef00d,
295                             ark->sysctrl.t32[4], __func__);
296                 return -1;
297         }
298         if (ark->sysctrl.t32[3] != 0) {
299                 if (ark_rqp_lasped(ark->rqpacing)) {
300                         PMD_DRV_LOG(ERR, "Arkville Evaluation System - "
301                                     "Timer has Expired\n");
302                         return -1;
303                 }
304                 PMD_DRV_LOG(WARNING, "Arkville Evaluation System - "
305                             "Timer is Running\n");
306         }
307
308         PMD_DRV_LOG(INFO,
309                     "HW Sanity test has PASSED, expected constant"
310                     " 0x%x, read 0x%x (%s)\n",
311                     0xcafef00d, ark->sysctrl.t32[4], __func__);
312
313         /* We are a single function multi-port device. */
314         ret = ark_config_device(dev);
315         if (ret)
316                 return -1;
317
318         dev->dev_ops = &ark_eth_dev_ops;
319
320         dev->data->mac_addrs = rte_zmalloc("ark", RTE_ETHER_ADDR_LEN, 0);
321         if (!dev->data->mac_addrs) {
322                 PMD_DRV_LOG(ERR,
323                             "Failed to allocated memory for storing mac address"
324                             );
325         }
326
327         if (ark->user_ext.dev_init) {
328                 ark->user_data[dev->data->port_id] =
329                         ark->user_ext.dev_init(dev, ark->a_bar, 0);
330                 if (!ark->user_data[dev->data->port_id]) {
331                         PMD_DRV_LOG(INFO,
332                                     "Failed to initialize PMD extension!"
333                                     " continuing without it\n");
334                         memset(&ark->user_ext, 0, sizeof(struct ark_user_ext));
335                         dlclose(ark->d_handle);
336                 }
337         }
338
339         if (pci_dev->device.devargs)
340                 ret = eth_ark_check_args(ark, pci_dev->device.devargs->args);
341         else
342                 PMD_DRV_LOG(INFO, "No Device args found\n");
343
344         if (ret)
345                 goto error;
346         /*
347          * We will create additional devices based on the number of requested
348          * ports
349          */
350         if (ark->user_ext.dev_get_port_count)
351                 port_count =
352                         ark->user_ext.dev_get_port_count(dev,
353                                  ark->user_data[dev->data->port_id]);
354         ark->num_ports = port_count;
355
356         for (p = 0; p < port_count; p++) {
357                 struct rte_eth_dev *eth_dev;
358                 char name[RTE_ETH_NAME_MAX_LEN];
359
360                 snprintf(name, sizeof(name), "arketh%d",
361                          dev->data->port_id + p);
362
363                 if (p == 0) {
364                         /* First port is already allocated by DPDK */
365                         eth_dev = ark->eth_dev;
366                         rte_eth_dev_probing_finish(eth_dev);
367                         continue;
368                 }
369
370                 /* reserve an ethdev entry */
371                 eth_dev = rte_eth_dev_allocate(name);
372                 if (!eth_dev) {
373                         PMD_DRV_LOG(ERR,
374                                     "Could not allocate eth_dev for port %d\n",
375                                     p);
376                         goto error;
377                 }
378
379                 eth_dev->device = &pci_dev->device;
380                 eth_dev->data->dev_private = ark;
381                 eth_dev->dev_ops = ark->eth_dev->dev_ops;
382                 eth_dev->tx_pkt_burst = ark->eth_dev->tx_pkt_burst;
383                 eth_dev->rx_pkt_burst = ark->eth_dev->rx_pkt_burst;
384
385                 rte_eth_copy_pci_info(eth_dev, pci_dev);
386
387                 eth_dev->data->mac_addrs = rte_zmalloc(name,
388                                                 RTE_ETHER_ADDR_LEN, 0);
389                 if (!eth_dev->data->mac_addrs) {
390                         PMD_DRV_LOG(ERR,
391                                     "Memory allocation for MAC failed!"
392                                     " Exiting.\n");
393                         goto error;
394                 }
395
396                 if (ark->user_ext.dev_init) {
397                         ark->user_data[eth_dev->data->port_id] =
398                                 ark->user_ext.dev_init(dev, ark->a_bar, p);
399                 }
400
401                 rte_eth_dev_probing_finish(eth_dev);
402         }
403
404         return ret;
405
406 error:
407         rte_free(dev->data->mac_addrs);
408         dev->data->mac_addrs = NULL;
409         return -1;
410 }
411
412 /*
413  *Initial device configuration when device is opened
414  * setup the DDM, and UDM
415  * Called once per PCIE device
416  */
417 static int
418 ark_config_device(struct rte_eth_dev *dev)
419 {
420         struct ark_adapter *ark = dev->data->dev_private;
421         uint16_t num_q, i;
422         struct ark_mpu_t *mpu;
423
424         /*
425          * Make sure that the packet director, generator and checker are in a
426          * known state
427          */
428         ark->start_pg = 0;
429         ark->pg = ark_pktgen_init(ark->pktgen.v, 0, 1);
430         if (ark->pg == NULL)
431                 return -1;
432         ark_pktgen_reset(ark->pg);
433         ark->pc = ark_pktchkr_init(ark->pktchkr.v, 0, 1);
434         if (ark->pc == NULL)
435                 return -1;
436         ark_pktchkr_stop(ark->pc);
437         ark->pd = ark_pktdir_init(ark->pktdir.v);
438         if (ark->pd == NULL)
439                 return -1;
440
441         /* Verify HW */
442         if (ark_udm_verify(ark->udm.v))
443                 return -1;
444         if (ark_ddm_verify(ark->ddm.v))
445                 return -1;
446
447         /* UDM */
448         if (ark_udm_reset(ark->udm.v)) {
449                 PMD_DRV_LOG(ERR, "Unable to stop and reset UDM\n");
450                 return -1;
451         }
452         /* Keep in reset until the MPU are cleared */
453
454         /* MPU reset */
455         mpu = ark->mpurx.v;
456         num_q = ark_api_num_queues(mpu);
457         ark->rx_queues = num_q;
458         for (i = 0; i < num_q; i++) {
459                 ark_mpu_reset(mpu);
460                 mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
461         }
462
463         ark_udm_stop(ark->udm.v, 0);
464         ark_udm_configure(ark->udm.v,
465                           RTE_PKTMBUF_HEADROOM,
466                           RTE_MBUF_DEFAULT_DATAROOM,
467                           ARK_RX_WRITE_TIME_NS);
468         ark_udm_stats_reset(ark->udm.v);
469         ark_udm_stop(ark->udm.v, 0);
470
471         /* TX -- DDM */
472         if (ark_ddm_stop(ark->ddm.v, 1))
473                 PMD_DRV_LOG(ERR, "Unable to stop DDM\n");
474
475         mpu = ark->mputx.v;
476         num_q = ark_api_num_queues(mpu);
477         ark->tx_queues = num_q;
478         for (i = 0; i < num_q; i++) {
479                 ark_mpu_reset(mpu);
480                 mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
481         }
482
483         ark_ddm_reset(ark->ddm.v);
484         ark_ddm_stats_reset(ark->ddm.v);
485
486         ark_ddm_stop(ark->ddm.v, 0);
487         ark_rqp_stats_reset(ark->rqpacing);
488
489         return 0;
490 }
491
492 static int
493 eth_ark_dev_uninit(struct rte_eth_dev *dev)
494 {
495         struct ark_adapter *ark = dev->data->dev_private;
496
497         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
498                 return 0;
499
500         if (ark->user_ext.dev_uninit)
501                 ark->user_ext.dev_uninit(dev,
502                          ark->user_data[dev->data->port_id]);
503
504         ark_pktgen_uninit(ark->pg);
505         ark_pktchkr_uninit(ark->pc);
506
507         dev->dev_ops = NULL;
508         dev->rx_pkt_burst = NULL;
509         dev->tx_pkt_burst = NULL;
510         return 0;
511 }
512
513 static int
514 eth_ark_dev_configure(struct rte_eth_dev *dev)
515 {
516         PMD_FUNC_LOG(DEBUG, "\n");
517         struct ark_adapter *ark = dev->data->dev_private;
518
519         eth_ark_dev_set_link_up(dev);
520         if (ark->user_ext.dev_configure)
521                 return ark->user_ext.dev_configure(dev,
522                            ark->user_data[dev->data->port_id]);
523         return 0;
524 }
525
526 static void *
527 delay_pg_start(void *arg)
528 {
529         struct ark_adapter *ark = (struct ark_adapter *)arg;
530
531         /* This function is used exclusively for regression testing, We
532          * perform a blind sleep here to ensure that the external test
533          * application has time to setup the test before we generate packets
534          */
535         usleep(100000);
536         ark_pktgen_run(ark->pg);
537         return NULL;
538 }
539
540 static int
541 eth_ark_dev_start(struct rte_eth_dev *dev)
542 {
543         struct ark_adapter *ark = dev->data->dev_private;
544         int i;
545
546         PMD_FUNC_LOG(DEBUG, "\n");
547
548         /* RX Side */
549         /* start UDM */
550         ark_udm_start(ark->udm.v);
551
552         for (i = 0; i < dev->data->nb_rx_queues; i++)
553                 eth_ark_rx_start_queue(dev, i);
554
555         /* TX Side */
556         for (i = 0; i < dev->data->nb_tx_queues; i++)
557                 eth_ark_tx_queue_start(dev, i);
558
559         /* start DDM */
560         ark_ddm_start(ark->ddm.v);
561
562         ark->started = 1;
563         /* set xmit and receive function */
564         dev->rx_pkt_burst = &eth_ark_recv_pkts;
565         dev->tx_pkt_burst = &eth_ark_xmit_pkts;
566
567         if (ark->start_pg)
568                 ark_pktchkr_run(ark->pc);
569
570         if (ark->start_pg && (dev->data->port_id == 0)) {
571                 pthread_t thread;
572
573                 /* Delay packet generatpr start allow the hardware to be ready
574                  * This is only used for sanity checking with internal generator
575                  */
576                 if (pthread_create(&thread, NULL, delay_pg_start, ark)) {
577                         PMD_DRV_LOG(ERR, "Could not create pktgen "
578                                     "starter thread\n");
579                         return -1;
580                 }
581         }
582
583         if (ark->user_ext.dev_start)
584                 ark->user_ext.dev_start(dev,
585                         ark->user_data[dev->data->port_id]);
586
587         return 0;
588 }
589
590 static void
591 eth_ark_dev_stop(struct rte_eth_dev *dev)
592 {
593         uint16_t i;
594         int status;
595         struct ark_adapter *ark = dev->data->dev_private;
596         struct ark_mpu_t *mpu;
597
598         PMD_FUNC_LOG(DEBUG, "\n");
599
600         if (ark->started == 0)
601                 return;
602         ark->started = 0;
603
604         /* Stop the extension first */
605         if (ark->user_ext.dev_stop)
606                 ark->user_ext.dev_stop(dev,
607                        ark->user_data[dev->data->port_id]);
608
609         /* Stop the packet generator */
610         if (ark->start_pg)
611                 ark_pktgen_pause(ark->pg);
612
613         dev->rx_pkt_burst = &eth_ark_recv_pkts_noop;
614         dev->tx_pkt_burst = &eth_ark_xmit_pkts_noop;
615
616         /* STOP TX Side */
617         for (i = 0; i < dev->data->nb_tx_queues; i++) {
618                 status = eth_ark_tx_queue_stop(dev, i);
619                 if (status != 0) {
620                         uint16_t port = dev->data->port_id;
621                         PMD_DRV_LOG(ERR,
622                                     "tx_queue stop anomaly"
623                                     " port %u, queue %u\n",
624                                     port, i);
625                 }
626         }
627
628         /* Stop DDM */
629         /* Wait up to 0.1 second.  each stop is up to 1000 * 10 useconds */
630         for (i = 0; i < 10; i++) {
631                 status = ark_ddm_stop(ark->ddm.v, 1);
632                 if (status == 0)
633                         break;
634         }
635         if (status || i != 0) {
636                 PMD_DRV_LOG(ERR, "DDM stop anomaly. status:"
637                             " %d iter: %u. (%s)\n",
638                             status,
639                             i,
640                             __func__);
641                 ark_ddm_dump(ark->ddm.v, "Stop anomaly");
642
643                 mpu = ark->mputx.v;
644                 for (i = 0; i < ark->tx_queues; i++) {
645                         ark_mpu_dump(mpu, "DDM failure dump", i);
646                         mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
647                 }
648         }
649
650         /* STOP RX Side */
651         /* Stop UDM  multiple tries attempted */
652         for (i = 0; i < 10; i++) {
653                 status = ark_udm_stop(ark->udm.v, 1);
654                 if (status == 0)
655                         break;
656         }
657         if (status || i != 0) {
658                 PMD_DRV_LOG(ERR, "UDM stop anomaly. status %d iter: %u. (%s)\n",
659                             status, i, __func__);
660                 ark_udm_dump(ark->udm.v, "Stop anomaly");
661
662                 mpu = ark->mpurx.v;
663                 for (i = 0; i < ark->rx_queues; i++) {
664                         ark_mpu_dump(mpu, "UDM Stop anomaly", i);
665                         mpu = RTE_PTR_ADD(mpu, ARK_MPU_QOFFSET);
666                 }
667         }
668
669         ark_udm_dump_stats(ark->udm.v, "Post stop");
670         ark_udm_dump_perf(ark->udm.v, "Post stop");
671
672         for (i = 0; i < dev->data->nb_rx_queues; i++)
673                 eth_ark_rx_dump_queue(dev, i, __func__);
674
675         /* Stop the packet checker if it is running */
676         if (ark->start_pg) {
677                 ark_pktchkr_dump_stats(ark->pc);
678                 ark_pktchkr_stop(ark->pc);
679         }
680 }
681
682 static void
683 eth_ark_dev_close(struct rte_eth_dev *dev)
684 {
685         struct ark_adapter *ark = dev->data->dev_private;
686         uint16_t i;
687
688         if (ark->user_ext.dev_close)
689                 ark->user_ext.dev_close(dev,
690                  ark->user_data[dev->data->port_id]);
691
692         eth_ark_dev_stop(dev);
693         eth_ark_udm_force_close(dev);
694
695         /*
696          * TODO This should only be called once for the device during shutdown
697          */
698         ark_rqp_dump(ark->rqpacing);
699
700         for (i = 0; i < dev->data->nb_tx_queues; i++) {
701                 eth_ark_tx_queue_release(dev->data->tx_queues[i]);
702                 dev->data->tx_queues[i] = 0;
703         }
704
705         for (i = 0; i < dev->data->nb_rx_queues; i++) {
706                 eth_ark_dev_rx_queue_release(dev->data->rx_queues[i]);
707                 dev->data->rx_queues[i] = 0;
708         }
709 }
710
711 static void
712 eth_ark_dev_info_get(struct rte_eth_dev *dev,
713                      struct rte_eth_dev_info *dev_info)
714 {
715         struct ark_adapter *ark = dev->data->dev_private;
716         struct ark_mpu_t *tx_mpu = RTE_PTR_ADD(ark->bar0, ARK_MPU_TX_BASE);
717         struct ark_mpu_t *rx_mpu = RTE_PTR_ADD(ark->bar0, ARK_MPU_RX_BASE);
718         uint16_t ports = ark->num_ports;
719
720         dev_info->max_rx_pktlen = ARK_RX_MAX_PKT_LEN;
721         dev_info->min_rx_bufsize = ARK_RX_MIN_BUFSIZE;
722
723         dev_info->max_rx_queues = ark_api_num_queues_per_port(rx_mpu, ports);
724         dev_info->max_tx_queues = ark_api_num_queues_per_port(tx_mpu, ports);
725
726         dev_info->rx_desc_lim = (struct rte_eth_desc_lim) {
727                 .nb_max = ARK_RX_MAX_QUEUE,
728                 .nb_min = ARK_RX_MIN_QUEUE,
729                 .nb_align = ARK_RX_MIN_QUEUE}; /* power of 2 */
730
731         dev_info->tx_desc_lim = (struct rte_eth_desc_lim) {
732                 .nb_max = ARK_TX_MAX_QUEUE,
733                 .nb_min = ARK_TX_MIN_QUEUE,
734                 .nb_align = ARK_TX_MIN_QUEUE}; /* power of 2 */
735
736         /* ARK PMD supports all line rates, how do we indicate that here ?? */
737         dev_info->speed_capa = (ETH_LINK_SPEED_1G |
738                                 ETH_LINK_SPEED_10G |
739                                 ETH_LINK_SPEED_25G |
740                                 ETH_LINK_SPEED_40G |
741                                 ETH_LINK_SPEED_50G |
742                                 ETH_LINK_SPEED_100G);
743 }
744
745 static int
746 eth_ark_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete)
747 {
748         PMD_DEBUG_LOG(DEBUG, "link status = %d\n",
749                         dev->data->dev_link.link_status);
750         struct ark_adapter *ark = dev->data->dev_private;
751
752         if (ark->user_ext.link_update) {
753                 return ark->user_ext.link_update
754                         (dev, wait_to_complete,
755                          ark->user_data[dev->data->port_id]);
756         }
757         return 0;
758 }
759
760 static int
761 eth_ark_dev_set_link_up(struct rte_eth_dev *dev)
762 {
763         dev->data->dev_link.link_status = 1;
764         struct ark_adapter *ark = dev->data->dev_private;
765
766         if (ark->user_ext.dev_set_link_up)
767                 return ark->user_ext.dev_set_link_up(dev,
768                              ark->user_data[dev->data->port_id]);
769         return 0;
770 }
771
772 static int
773 eth_ark_dev_set_link_down(struct rte_eth_dev *dev)
774 {
775         dev->data->dev_link.link_status = 0;
776         struct ark_adapter *ark = dev->data->dev_private;
777
778         if (ark->user_ext.dev_set_link_down)
779                 return ark->user_ext.dev_set_link_down(dev,
780                        ark->user_data[dev->data->port_id]);
781         return 0;
782 }
783
784 static int
785 eth_ark_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
786 {
787         uint16_t i;
788         struct ark_adapter *ark = dev->data->dev_private;
789
790         stats->ipackets = 0;
791         stats->ibytes = 0;
792         stats->opackets = 0;
793         stats->obytes = 0;
794         stats->imissed = 0;
795         stats->oerrors = 0;
796
797         for (i = 0; i < dev->data->nb_tx_queues; i++)
798                 eth_tx_queue_stats_get(dev->data->tx_queues[i], stats);
799         for (i = 0; i < dev->data->nb_rx_queues; i++)
800                 eth_rx_queue_stats_get(dev->data->rx_queues[i], stats);
801         if (ark->user_ext.stats_get)
802                 return ark->user_ext.stats_get(dev, stats,
803                         ark->user_data[dev->data->port_id]);
804         return 0;
805 }
806
807 static void
808 eth_ark_dev_stats_reset(struct rte_eth_dev *dev)
809 {
810         uint16_t i;
811         struct ark_adapter *ark = dev->data->dev_private;
812
813         for (i = 0; i < dev->data->nb_tx_queues; i++)
814                 eth_tx_queue_stats_reset(dev->data->tx_queues[i]);
815         for (i = 0; i < dev->data->nb_rx_queues; i++)
816                 eth_rx_queue_stats_reset(dev->data->rx_queues[i]);
817         if (ark->user_ext.stats_reset)
818                 ark->user_ext.stats_reset(dev,
819                           ark->user_data[dev->data->port_id]);
820 }
821
822 static int
823 eth_ark_macaddr_add(struct rte_eth_dev *dev,
824                     struct rte_ether_addr *mac_addr,
825                     uint32_t index,
826                     uint32_t pool)
827 {
828         struct ark_adapter *ark = dev->data->dev_private;
829
830         if (ark->user_ext.mac_addr_add) {
831                 ark->user_ext.mac_addr_add(dev,
832                                            mac_addr,
833                                            index,
834                                            pool,
835                            ark->user_data[dev->data->port_id]);
836                 return 0;
837         }
838         return -ENOTSUP;
839 }
840
841 static void
842 eth_ark_macaddr_remove(struct rte_eth_dev *dev, uint32_t index)
843 {
844         struct ark_adapter *ark = dev->data->dev_private;
845
846         if (ark->user_ext.mac_addr_remove)
847                 ark->user_ext.mac_addr_remove(dev, index,
848                               ark->user_data[dev->data->port_id]);
849 }
850
851 static int
852 eth_ark_set_default_mac_addr(struct rte_eth_dev *dev,
853                              struct rte_ether_addr *mac_addr)
854 {
855         struct ark_adapter *ark = dev->data->dev_private;
856
857         if (ark->user_ext.mac_addr_set) {
858                 ark->user_ext.mac_addr_set(dev, mac_addr,
859                            ark->user_data[dev->data->port_id]);
860                 return 0;
861         }
862         return -ENOTSUP;
863 }
864
865 static int
866 eth_ark_set_mtu(struct rte_eth_dev *dev, uint16_t  size)
867 {
868         struct ark_adapter *ark = dev->data->dev_private;
869
870         if (ark->user_ext.set_mtu)
871                 return ark->user_ext.set_mtu(dev, size,
872                              ark->user_data[dev->data->port_id]);
873
874         return -ENOTSUP;
875 }
876
877 static inline int
878 process_pktdir_arg(const char *key, const char *value,
879                    void *extra_args)
880 {
881         PMD_FUNC_LOG(DEBUG, "key = %s, value = %s\n",
882                     key, value);
883         struct ark_adapter *ark =
884                 (struct ark_adapter *)extra_args;
885
886         ark->pkt_dir_v = strtol(value, NULL, 16);
887         PMD_FUNC_LOG(DEBUG, "pkt_dir_v = 0x%x\n", ark->pkt_dir_v);
888         return 0;
889 }
890
891 static inline int
892 process_file_args(const char *key, const char *value, void *extra_args)
893 {
894         PMD_FUNC_LOG(DEBUG, "key = %s, value = %s\n",
895                     key, value);
896         char *args = (char *)extra_args;
897
898         /* Open the configuration file */
899         FILE *file = fopen(value, "r");
900         char line[ARK_MAX_ARG_LEN];
901         int  size = 0;
902         int first = 1;
903
904         if (file == NULL) {
905                 PMD_DRV_LOG(ERR, "Unable to open "
906                             "config file %s\n", value);
907                 return -1;
908         }
909
910         while (fgets(line, sizeof(line), file)) {
911                 size += strlen(line);
912                 if (size >= ARK_MAX_ARG_LEN) {
913                         PMD_DRV_LOG(ERR, "Unable to parse file %s args, "
914                                     "parameter list is too long\n", value);
915                         fclose(file);
916                         return -1;
917                 }
918                 if (first) {
919                         strncpy(args, line, ARK_MAX_ARG_LEN);
920                         first = 0;
921                 } else {
922                         strncat(args, line, ARK_MAX_ARG_LEN);
923                 }
924         }
925         PMD_FUNC_LOG(DEBUG, "file = %s\n", args);
926         fclose(file);
927         return 0;
928 }
929
930 static int
931 eth_ark_check_args(struct ark_adapter *ark, const char *params)
932 {
933         struct rte_kvargs *kvlist;
934         unsigned int k_idx;
935         struct rte_kvargs_pair *pair = NULL;
936         int ret = -1;
937
938         kvlist = rte_kvargs_parse(params, valid_arguments);
939         if (kvlist == NULL)
940                 return 0;
941
942         ark->pkt_gen_args[0] = 0;
943         ark->pkt_chkr_args[0] = 0;
944
945         for (k_idx = 0; k_idx < kvlist->count; k_idx++) {
946                 pair = &kvlist->pairs[k_idx];
947                 PMD_FUNC_LOG(DEBUG, "**** Arg passed to PMD = %s:%s\n",
948                              pair->key,
949                              pair->value);
950         }
951
952         if (rte_kvargs_process(kvlist,
953                                ARK_PKTDIR_ARG,
954                                &process_pktdir_arg,
955                                ark) != 0) {
956                 PMD_DRV_LOG(ERR, "Unable to parse arg %s\n", ARK_PKTDIR_ARG);
957                 goto free_kvlist;
958         }
959
960         if (rte_kvargs_process(kvlist,
961                                ARK_PKTGEN_ARG,
962                                &process_file_args,
963                                ark->pkt_gen_args) != 0) {
964                 PMD_DRV_LOG(ERR, "Unable to parse arg %s\n", ARK_PKTGEN_ARG);
965                 goto free_kvlist;
966         }
967
968         if (rte_kvargs_process(kvlist,
969                                ARK_PKTCHKR_ARG,
970                                &process_file_args,
971                                ark->pkt_chkr_args) != 0) {
972                 PMD_DRV_LOG(ERR, "Unable to parse arg %s\n", ARK_PKTCHKR_ARG);
973                 goto free_kvlist;
974         }
975
976         PMD_DRV_LOG(INFO, "packet director set to 0x%x\n", ark->pkt_dir_v);
977         /* Setup the packet director */
978         ark_pktdir_setup(ark->pd, ark->pkt_dir_v);
979
980         /* Setup the packet generator */
981         if (ark->pkt_gen_args[0]) {
982                 PMD_DRV_LOG(INFO, "Setting up the packet generator\n");
983                 ark_pktgen_parse(ark->pkt_gen_args);
984                 ark_pktgen_reset(ark->pg);
985                 ark_pktgen_setup(ark->pg);
986                 ark->start_pg = 1;
987         }
988
989         /* Setup the packet checker */
990         if (ark->pkt_chkr_args[0]) {
991                 ark_pktchkr_parse(ark->pkt_chkr_args);
992                 ark_pktchkr_setup(ark->pc);
993         }
994
995         ret = 0;
996
997 free_kvlist:
998         rte_kvargs_free(kvlist);
999
1000         return ret;
1001 }
1002
1003 RTE_PMD_REGISTER_PCI(net_ark, rte_ark_pmd);
1004 RTE_PMD_REGISTER_KMOD_DEP(net_ark, "* igb_uio | uio_pci_generic ");
1005 RTE_PMD_REGISTER_PCI_TABLE(net_ark, pci_id_ark_map);
1006 RTE_PMD_REGISTER_PARAM_STRING(net_ark,
1007                               ARK_PKTGEN_ARG "=<filename> "
1008                               ARK_PKTCHKR_ARG "=<filename> "
1009                               ARK_PKTDIR_ARG "=<bitmap>");