net/dpaa: add frame count based tail drop with CGR
[dpdk.git] / drivers / net / dpaa / dpaa_ethdev.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  *
3  *   Copyright 2016 Freescale Semiconductor, Inc. All rights reserved.
4  *   Copyright 2017 NXP
5  *
6  */
7 /* System headers */
8 #include <stdio.h>
9 #include <inttypes.h>
10 #include <unistd.h>
11 #include <limits.h>
12 #include <sched.h>
13 #include <signal.h>
14 #include <pthread.h>
15 #include <sys/types.h>
16 #include <sys/syscall.h>
17
18 #include <rte_byteorder.h>
19 #include <rte_common.h>
20 #include <rte_interrupts.h>
21 #include <rte_log.h>
22 #include <rte_debug.h>
23 #include <rte_pci.h>
24 #include <rte_atomic.h>
25 #include <rte_branch_prediction.h>
26 #include <rte_memory.h>
27 #include <rte_tailq.h>
28 #include <rte_eal.h>
29 #include <rte_alarm.h>
30 #include <rte_ether.h>
31 #include <rte_ethdev.h>
32 #include <rte_malloc.h>
33 #include <rte_ring.h>
34
35 #include <rte_dpaa_bus.h>
36 #include <rte_dpaa_logs.h>
37 #include <dpaa_mempool.h>
38
39 #include <dpaa_ethdev.h>
40 #include <dpaa_rxtx.h>
41
42 #include <fsl_usd.h>
43 #include <fsl_qman.h>
44 #include <fsl_bman.h>
45 #include <fsl_fman.h>
46
47 /* Keep track of whether QMAN and BMAN have been globally initialized */
48 static int is_global_init;
49
50 /* Per FQ Taildrop in frame count */
51 static unsigned int td_threshold = CGR_RX_PERFQ_THRESH;
52
53 struct rte_dpaa_xstats_name_off {
54         char name[RTE_ETH_XSTATS_NAME_SIZE];
55         uint32_t offset;
56 };
57
58 static const struct rte_dpaa_xstats_name_off dpaa_xstats_strings[] = {
59         {"rx_align_err",
60                 offsetof(struct dpaa_if_stats, raln)},
61         {"rx_valid_pause",
62                 offsetof(struct dpaa_if_stats, rxpf)},
63         {"rx_fcs_err",
64                 offsetof(struct dpaa_if_stats, rfcs)},
65         {"rx_vlan_frame",
66                 offsetof(struct dpaa_if_stats, rvlan)},
67         {"rx_frame_err",
68                 offsetof(struct dpaa_if_stats, rerr)},
69         {"rx_drop_err",
70                 offsetof(struct dpaa_if_stats, rdrp)},
71         {"rx_undersized",
72                 offsetof(struct dpaa_if_stats, rund)},
73         {"rx_oversize_err",
74                 offsetof(struct dpaa_if_stats, rovr)},
75         {"rx_fragment_pkt",
76                 offsetof(struct dpaa_if_stats, rfrg)},
77         {"tx_valid_pause",
78                 offsetof(struct dpaa_if_stats, txpf)},
79         {"tx_fcs_err",
80                 offsetof(struct dpaa_if_stats, terr)},
81         {"tx_vlan_frame",
82                 offsetof(struct dpaa_if_stats, tvlan)},
83         {"rx_undersized",
84                 offsetof(struct dpaa_if_stats, tund)},
85 };
86
87 static int
88 dpaa_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
89 {
90         struct dpaa_if *dpaa_intf = dev->data->dev_private;
91         uint32_t frame_size = mtu + ETHER_HDR_LEN + ETHER_CRC_LEN
92                                 + VLAN_TAG_SIZE;
93
94         PMD_INIT_FUNC_TRACE();
95
96         if (mtu < ETHER_MIN_MTU || frame_size > DPAA_MAX_RX_PKT_LEN)
97                 return -EINVAL;
98         if (frame_size > ETHER_MAX_LEN)
99                 dev->data->dev_conf.rxmode.jumbo_frame = 1;
100         else
101                 dev->data->dev_conf.rxmode.jumbo_frame = 0;
102
103         dev->data->dev_conf.rxmode.max_rx_pkt_len = frame_size;
104
105         fman_if_set_maxfrm(dpaa_intf->fif, frame_size);
106
107         return 0;
108 }
109
110 static int
111 dpaa_eth_dev_configure(struct rte_eth_dev *dev __rte_unused)
112 {
113         struct dpaa_if *dpaa_intf = dev->data->dev_private;
114
115         PMD_INIT_FUNC_TRACE();
116
117         if (dev->data->dev_conf.rxmode.jumbo_frame == 1) {
118                 if (dev->data->dev_conf.rxmode.max_rx_pkt_len <=
119                     DPAA_MAX_RX_PKT_LEN) {
120                         fman_if_set_maxfrm(dpaa_intf->fif,
121                                 dev->data->dev_conf.rxmode.max_rx_pkt_len);
122                         return 0;
123                 } else {
124                         return -1;
125                 }
126         }
127         return 0;
128 }
129
130 static const uint32_t *
131 dpaa_supported_ptypes_get(struct rte_eth_dev *dev)
132 {
133         static const uint32_t ptypes[] = {
134                 /*todo -= add more types */
135                 RTE_PTYPE_L2_ETHER,
136                 RTE_PTYPE_L3_IPV4,
137                 RTE_PTYPE_L3_IPV4_EXT,
138                 RTE_PTYPE_L3_IPV6,
139                 RTE_PTYPE_L3_IPV6_EXT,
140                 RTE_PTYPE_L4_TCP,
141                 RTE_PTYPE_L4_UDP,
142                 RTE_PTYPE_L4_SCTP
143         };
144
145         PMD_INIT_FUNC_TRACE();
146
147         if (dev->rx_pkt_burst == dpaa_eth_queue_rx)
148                 return ptypes;
149         return NULL;
150 }
151
152 static int dpaa_eth_dev_start(struct rte_eth_dev *dev)
153 {
154         struct dpaa_if *dpaa_intf = dev->data->dev_private;
155
156         PMD_INIT_FUNC_TRACE();
157
158         /* Change tx callback to the real one */
159         dev->tx_pkt_burst = dpaa_eth_queue_tx;
160         fman_if_enable_rx(dpaa_intf->fif);
161
162         return 0;
163 }
164
165 static void dpaa_eth_dev_stop(struct rte_eth_dev *dev)
166 {
167         struct dpaa_if *dpaa_intf = dev->data->dev_private;
168
169         PMD_INIT_FUNC_TRACE();
170
171         fman_if_disable_rx(dpaa_intf->fif);
172         dev->tx_pkt_burst = dpaa_eth_tx_drop_all;
173 }
174
175 static void dpaa_eth_dev_close(struct rte_eth_dev *dev)
176 {
177         PMD_INIT_FUNC_TRACE();
178
179         dpaa_eth_dev_stop(dev);
180 }
181
182 static int
183 dpaa_fw_version_get(struct rte_eth_dev *dev __rte_unused,
184                      char *fw_version,
185                      size_t fw_size)
186 {
187         int ret;
188         FILE *svr_file = NULL;
189         unsigned int svr_ver = 0;
190
191         PMD_INIT_FUNC_TRACE();
192
193         svr_file = fopen(DPAA_SOC_ID_FILE, "r");
194         if (!svr_file) {
195                 DPAA_PMD_ERR("Unable to open SoC device");
196                 return -ENOTSUP; /* Not supported on this infra */
197         }
198         if (fscanf(svr_file, "svr:%x", &svr_ver) > 0)
199                 dpaa_svr_family = svr_ver & SVR_MASK;
200         else
201                 DPAA_PMD_ERR("Unable to read SoC device");
202
203         fclose(svr_file);
204
205         ret = snprintf(fw_version, fw_size, "SVR:%x-fman-v%x",
206                        svr_ver, fman_ip_rev);
207         ret += 1; /* add the size of '\0' */
208
209         if (fw_size < (uint32_t)ret)
210                 return ret;
211         else
212                 return 0;
213 }
214
215 static void dpaa_eth_dev_info(struct rte_eth_dev *dev,
216                               struct rte_eth_dev_info *dev_info)
217 {
218         struct dpaa_if *dpaa_intf = dev->data->dev_private;
219
220         PMD_INIT_FUNC_TRACE();
221
222         dev_info->max_rx_queues = dpaa_intf->nb_rx_queues;
223         dev_info->max_tx_queues = dpaa_intf->nb_tx_queues;
224         dev_info->min_rx_bufsize = DPAA_MIN_RX_BUF_SIZE;
225         dev_info->max_rx_pktlen = DPAA_MAX_RX_PKT_LEN;
226         dev_info->max_mac_addrs = DPAA_MAX_MAC_FILTER;
227         dev_info->max_hash_mac_addrs = 0;
228         dev_info->max_vfs = 0;
229         dev_info->max_vmdq_pools = ETH_16_POOLS;
230         dev_info->flow_type_rss_offloads = DPAA_RSS_OFFLOAD_ALL;
231         dev_info->speed_capa = (ETH_LINK_SPEED_1G |
232                                 ETH_LINK_SPEED_10G);
233         dev_info->rx_offload_capa =
234                 (DEV_RX_OFFLOAD_IPV4_CKSUM |
235                 DEV_RX_OFFLOAD_UDP_CKSUM   |
236                 DEV_RX_OFFLOAD_TCP_CKSUM);
237         dev_info->tx_offload_capa =
238                 (DEV_TX_OFFLOAD_IPV4_CKSUM  |
239                 DEV_TX_OFFLOAD_UDP_CKSUM   |
240                 DEV_TX_OFFLOAD_TCP_CKSUM);
241 }
242
243 static int dpaa_eth_link_update(struct rte_eth_dev *dev,
244                                 int wait_to_complete __rte_unused)
245 {
246         struct dpaa_if *dpaa_intf = dev->data->dev_private;
247         struct rte_eth_link *link = &dev->data->dev_link;
248
249         PMD_INIT_FUNC_TRACE();
250
251         if (dpaa_intf->fif->mac_type == fman_mac_1g)
252                 link->link_speed = 1000;
253         else if (dpaa_intf->fif->mac_type == fman_mac_10g)
254                 link->link_speed = 10000;
255         else
256                 DPAA_PMD_ERR("invalid link_speed: %s, %d",
257                              dpaa_intf->name, dpaa_intf->fif->mac_type);
258
259         link->link_status = dpaa_intf->valid;
260         link->link_duplex = ETH_LINK_FULL_DUPLEX;
261         link->link_autoneg = ETH_LINK_AUTONEG;
262         return 0;
263 }
264
265 static int dpaa_eth_stats_get(struct rte_eth_dev *dev,
266                                struct rte_eth_stats *stats)
267 {
268         struct dpaa_if *dpaa_intf = dev->data->dev_private;
269
270         PMD_INIT_FUNC_TRACE();
271
272         fman_if_stats_get(dpaa_intf->fif, stats);
273         return 0;
274 }
275
276 static void dpaa_eth_stats_reset(struct rte_eth_dev *dev)
277 {
278         struct dpaa_if *dpaa_intf = dev->data->dev_private;
279
280         PMD_INIT_FUNC_TRACE();
281
282         fman_if_stats_reset(dpaa_intf->fif);
283 }
284
285 static int
286 dpaa_dev_xstats_get(struct rte_eth_dev *dev, struct rte_eth_xstat *xstats,
287                     unsigned int n)
288 {
289         struct dpaa_if *dpaa_intf = dev->data->dev_private;
290         unsigned int i = 0, num = RTE_DIM(dpaa_xstats_strings);
291         uint64_t values[sizeof(struct dpaa_if_stats) / 8];
292
293         if (xstats == NULL)
294                 return 0;
295
296         if (n < num)
297                 return num;
298
299         fman_if_stats_get_all(dpaa_intf->fif, values,
300                               sizeof(struct dpaa_if_stats) / 8);
301
302         for (i = 0; i < num; i++) {
303                 xstats[i].id = i;
304                 xstats[i].value = values[dpaa_xstats_strings[i].offset / 8];
305         }
306         return i;
307 }
308
309 static int
310 dpaa_xstats_get_names(__rte_unused struct rte_eth_dev *dev,
311                       struct rte_eth_xstat_name *xstats_names,
312                       __rte_unused unsigned int limit)
313 {
314         unsigned int i, stat_cnt = RTE_DIM(dpaa_xstats_strings);
315
316         if (xstats_names != NULL)
317                 for (i = 0; i < stat_cnt; i++)
318                         snprintf(xstats_names[i].name,
319                                  sizeof(xstats_names[i].name),
320                                  "%s",
321                                  dpaa_xstats_strings[i].name);
322
323         return stat_cnt;
324 }
325
326 static int
327 dpaa_xstats_get_by_id(struct rte_eth_dev *dev, const uint64_t *ids,
328                       uint64_t *values, unsigned int n)
329 {
330         unsigned int i, stat_cnt = RTE_DIM(dpaa_xstats_strings);
331         uint64_t values_copy[sizeof(struct dpaa_if_stats) / 8];
332
333         if (!ids) {
334                 struct dpaa_if *dpaa_intf = dev->data->dev_private;
335
336                 if (n < stat_cnt)
337                         return stat_cnt;
338
339                 if (!values)
340                         return 0;
341
342                 fman_if_stats_get_all(dpaa_intf->fif, values_copy,
343                                       sizeof(struct dpaa_if_stats));
344
345                 for (i = 0; i < stat_cnt; i++)
346                         values[i] =
347                                 values_copy[dpaa_xstats_strings[i].offset / 8];
348
349                 return stat_cnt;
350         }
351
352         dpaa_xstats_get_by_id(dev, NULL, values_copy, stat_cnt);
353
354         for (i = 0; i < n; i++) {
355                 if (ids[i] >= stat_cnt) {
356                         DPAA_PMD_ERR("id value isn't valid");
357                         return -1;
358                 }
359                 values[i] = values_copy[ids[i]];
360         }
361         return n;
362 }
363
364 static int
365 dpaa_xstats_get_names_by_id(
366         struct rte_eth_dev *dev,
367         struct rte_eth_xstat_name *xstats_names,
368         const uint64_t *ids,
369         unsigned int limit)
370 {
371         unsigned int i, stat_cnt = RTE_DIM(dpaa_xstats_strings);
372         struct rte_eth_xstat_name xstats_names_copy[stat_cnt];
373
374         if (!ids)
375                 return dpaa_xstats_get_names(dev, xstats_names, limit);
376
377         dpaa_xstats_get_names(dev, xstats_names_copy, limit);
378
379         for (i = 0; i < limit; i++) {
380                 if (ids[i] >= stat_cnt) {
381                         DPAA_PMD_ERR("id value isn't valid");
382                         return -1;
383                 }
384                 strcpy(xstats_names[i].name, xstats_names_copy[ids[i]].name);
385         }
386         return limit;
387 }
388
389 static void dpaa_eth_promiscuous_enable(struct rte_eth_dev *dev)
390 {
391         struct dpaa_if *dpaa_intf = dev->data->dev_private;
392
393         PMD_INIT_FUNC_TRACE();
394
395         fman_if_promiscuous_enable(dpaa_intf->fif);
396 }
397
398 static void dpaa_eth_promiscuous_disable(struct rte_eth_dev *dev)
399 {
400         struct dpaa_if *dpaa_intf = dev->data->dev_private;
401
402         PMD_INIT_FUNC_TRACE();
403
404         fman_if_promiscuous_disable(dpaa_intf->fif);
405 }
406
407 static void dpaa_eth_multicast_enable(struct rte_eth_dev *dev)
408 {
409         struct dpaa_if *dpaa_intf = dev->data->dev_private;
410
411         PMD_INIT_FUNC_TRACE();
412
413         fman_if_set_mcast_filter_table(dpaa_intf->fif);
414 }
415
416 static void dpaa_eth_multicast_disable(struct rte_eth_dev *dev)
417 {
418         struct dpaa_if *dpaa_intf = dev->data->dev_private;
419
420         PMD_INIT_FUNC_TRACE();
421
422         fman_if_reset_mcast_filter_table(dpaa_intf->fif);
423 }
424
425 static
426 int dpaa_eth_rx_queue_setup(struct rte_eth_dev *dev, uint16_t queue_idx,
427                             uint16_t nb_desc,
428                             unsigned int socket_id __rte_unused,
429                             const struct rte_eth_rxconf *rx_conf __rte_unused,
430                             struct rte_mempool *mp)
431 {
432         struct dpaa_if *dpaa_intf = dev->data->dev_private;
433         struct qman_fq *rxq = &dpaa_intf->rx_queues[queue_idx];
434
435         PMD_INIT_FUNC_TRACE();
436
437         DPAA_PMD_INFO("Rx queue setup for queue index: %d", queue_idx);
438
439         if (!dpaa_intf->bp_info || dpaa_intf->bp_info->mp != mp) {
440                 struct fman_if_ic_params icp;
441                 uint32_t fd_offset;
442                 uint32_t bp_size;
443
444                 if (!mp->pool_data) {
445                         DPAA_PMD_ERR("Not an offloaded buffer pool!");
446                         return -1;
447                 }
448                 dpaa_intf->bp_info = DPAA_MEMPOOL_TO_POOL_INFO(mp);
449
450                 memset(&icp, 0, sizeof(icp));
451                 /* set ICEOF for to the default value , which is 0*/
452                 icp.iciof = DEFAULT_ICIOF;
453                 icp.iceof = DEFAULT_RX_ICEOF;
454                 icp.icsz = DEFAULT_ICSZ;
455                 fman_if_set_ic_params(dpaa_intf->fif, &icp);
456
457                 fd_offset = RTE_PKTMBUF_HEADROOM + DPAA_HW_BUF_RESERVE;
458                 fman_if_set_fdoff(dpaa_intf->fif, fd_offset);
459
460                 /* Buffer pool size should be equal to Dataroom Size*/
461                 bp_size = rte_pktmbuf_data_room_size(mp);
462                 fman_if_set_bp(dpaa_intf->fif, mp->size,
463                                dpaa_intf->bp_info->bpid, bp_size);
464                 dpaa_intf->valid = 1;
465                 DPAA_PMD_INFO("if =%s - fd_offset = %d offset = %d",
466                             dpaa_intf->name, fd_offset,
467                         fman_if_get_fdoff(dpaa_intf->fif));
468         }
469
470         dev->data->rx_queues[queue_idx] = rxq;
471
472         /* configure the CGR size as per the desc size */
473         if (dpaa_intf->cgr_rx) {
474                 struct qm_mcc_initcgr cgr_opts = {0};
475                 int ret;
476
477                 /* Enable tail drop with cgr on this queue */
478                 qm_cgr_cs_thres_set64(&cgr_opts.cgr.cs_thres, nb_desc, 0);
479                 ret = qman_modify_cgr(dpaa_intf->cgr_rx, 0, &cgr_opts);
480                 if (ret) {
481                         DPAA_PMD_WARN(
482                                 "rx taildrop modify fail on fqid %d (ret=%d)",
483                                 rxq->fqid, ret);
484                 }
485         }
486
487         return 0;
488 }
489
490 static
491 void dpaa_eth_rx_queue_release(void *rxq __rte_unused)
492 {
493         PMD_INIT_FUNC_TRACE();
494 }
495
496 static
497 int dpaa_eth_tx_queue_setup(struct rte_eth_dev *dev, uint16_t queue_idx,
498                             uint16_t nb_desc __rte_unused,
499                 unsigned int socket_id __rte_unused,
500                 const struct rte_eth_txconf *tx_conf __rte_unused)
501 {
502         struct dpaa_if *dpaa_intf = dev->data->dev_private;
503
504         PMD_INIT_FUNC_TRACE();
505
506         DPAA_PMD_INFO("Tx queue setup for queue index: %d", queue_idx);
507         dev->data->tx_queues[queue_idx] = &dpaa_intf->tx_queues[queue_idx];
508         return 0;
509 }
510
511 static void dpaa_eth_tx_queue_release(void *txq __rte_unused)
512 {
513         PMD_INIT_FUNC_TRACE();
514 }
515
516 static int dpaa_link_down(struct rte_eth_dev *dev)
517 {
518         PMD_INIT_FUNC_TRACE();
519
520         dpaa_eth_dev_stop(dev);
521         return 0;
522 }
523
524 static int dpaa_link_up(struct rte_eth_dev *dev)
525 {
526         PMD_INIT_FUNC_TRACE();
527
528         dpaa_eth_dev_start(dev);
529         return 0;
530 }
531
532 static int
533 dpaa_flow_ctrl_set(struct rte_eth_dev *dev,
534                    struct rte_eth_fc_conf *fc_conf)
535 {
536         struct dpaa_if *dpaa_intf = dev->data->dev_private;
537         struct rte_eth_fc_conf *net_fc;
538
539         PMD_INIT_FUNC_TRACE();
540
541         if (!(dpaa_intf->fc_conf)) {
542                 dpaa_intf->fc_conf = rte_zmalloc(NULL,
543                         sizeof(struct rte_eth_fc_conf), MAX_CACHELINE);
544                 if (!dpaa_intf->fc_conf) {
545                         DPAA_PMD_ERR("unable to save flow control info");
546                         return -ENOMEM;
547                 }
548         }
549         net_fc = dpaa_intf->fc_conf;
550
551         if (fc_conf->high_water < fc_conf->low_water) {
552                 DPAA_PMD_ERR("Incorrect Flow Control Configuration");
553                 return -EINVAL;
554         }
555
556         if (fc_conf->mode == RTE_FC_NONE) {
557                 return 0;
558         } else if (fc_conf->mode == RTE_FC_TX_PAUSE ||
559                  fc_conf->mode == RTE_FC_FULL) {
560                 fman_if_set_fc_threshold(dpaa_intf->fif, fc_conf->high_water,
561                                          fc_conf->low_water,
562                                 dpaa_intf->bp_info->bpid);
563                 if (fc_conf->pause_time)
564                         fman_if_set_fc_quanta(dpaa_intf->fif,
565                                               fc_conf->pause_time);
566         }
567
568         /* Save the information in dpaa device */
569         net_fc->pause_time = fc_conf->pause_time;
570         net_fc->high_water = fc_conf->high_water;
571         net_fc->low_water = fc_conf->low_water;
572         net_fc->send_xon = fc_conf->send_xon;
573         net_fc->mac_ctrl_frame_fwd = fc_conf->mac_ctrl_frame_fwd;
574         net_fc->mode = fc_conf->mode;
575         net_fc->autoneg = fc_conf->autoneg;
576
577         return 0;
578 }
579
580 static int
581 dpaa_flow_ctrl_get(struct rte_eth_dev *dev,
582                    struct rte_eth_fc_conf *fc_conf)
583 {
584         struct dpaa_if *dpaa_intf = dev->data->dev_private;
585         struct rte_eth_fc_conf *net_fc = dpaa_intf->fc_conf;
586         int ret;
587
588         PMD_INIT_FUNC_TRACE();
589
590         if (net_fc) {
591                 fc_conf->pause_time = net_fc->pause_time;
592                 fc_conf->high_water = net_fc->high_water;
593                 fc_conf->low_water = net_fc->low_water;
594                 fc_conf->send_xon = net_fc->send_xon;
595                 fc_conf->mac_ctrl_frame_fwd = net_fc->mac_ctrl_frame_fwd;
596                 fc_conf->mode = net_fc->mode;
597                 fc_conf->autoneg = net_fc->autoneg;
598                 return 0;
599         }
600         ret = fman_if_get_fc_threshold(dpaa_intf->fif);
601         if (ret) {
602                 fc_conf->mode = RTE_FC_TX_PAUSE;
603                 fc_conf->pause_time = fman_if_get_fc_quanta(dpaa_intf->fif);
604         } else {
605                 fc_conf->mode = RTE_FC_NONE;
606         }
607
608         return 0;
609 }
610
611 static int
612 dpaa_dev_add_mac_addr(struct rte_eth_dev *dev,
613                              struct ether_addr *addr,
614                              uint32_t index,
615                              __rte_unused uint32_t pool)
616 {
617         int ret;
618         struct dpaa_if *dpaa_intf = dev->data->dev_private;
619
620         PMD_INIT_FUNC_TRACE();
621
622         ret = fman_if_add_mac_addr(dpaa_intf->fif, addr->addr_bytes, index);
623
624         if (ret)
625                 RTE_LOG(ERR, PMD, "error: Adding the MAC ADDR failed:"
626                         " err = %d", ret);
627         return 0;
628 }
629
630 static void
631 dpaa_dev_remove_mac_addr(struct rte_eth_dev *dev,
632                           uint32_t index)
633 {
634         struct dpaa_if *dpaa_intf = dev->data->dev_private;
635
636         PMD_INIT_FUNC_TRACE();
637
638         fman_if_clear_mac_addr(dpaa_intf->fif, index);
639 }
640
641 static void
642 dpaa_dev_set_mac_addr(struct rte_eth_dev *dev,
643                        struct ether_addr *addr)
644 {
645         int ret;
646         struct dpaa_if *dpaa_intf = dev->data->dev_private;
647
648         PMD_INIT_FUNC_TRACE();
649
650         ret = fman_if_add_mac_addr(dpaa_intf->fif, addr->addr_bytes, 0);
651         if (ret)
652                 RTE_LOG(ERR, PMD, "error: Setting the MAC ADDR failed %d", ret);
653 }
654
655 static struct eth_dev_ops dpaa_devops = {
656         .dev_configure            = dpaa_eth_dev_configure,
657         .dev_start                = dpaa_eth_dev_start,
658         .dev_stop                 = dpaa_eth_dev_stop,
659         .dev_close                = dpaa_eth_dev_close,
660         .dev_infos_get            = dpaa_eth_dev_info,
661         .dev_supported_ptypes_get = dpaa_supported_ptypes_get,
662
663         .rx_queue_setup           = dpaa_eth_rx_queue_setup,
664         .tx_queue_setup           = dpaa_eth_tx_queue_setup,
665         .rx_queue_release         = dpaa_eth_rx_queue_release,
666         .tx_queue_release         = dpaa_eth_tx_queue_release,
667
668         .flow_ctrl_get            = dpaa_flow_ctrl_get,
669         .flow_ctrl_set            = dpaa_flow_ctrl_set,
670
671         .link_update              = dpaa_eth_link_update,
672         .stats_get                = dpaa_eth_stats_get,
673         .xstats_get               = dpaa_dev_xstats_get,
674         .xstats_get_by_id         = dpaa_xstats_get_by_id,
675         .xstats_get_names_by_id   = dpaa_xstats_get_names_by_id,
676         .xstats_get_names         = dpaa_xstats_get_names,
677         .xstats_reset             = dpaa_eth_stats_reset,
678         .stats_reset              = dpaa_eth_stats_reset,
679         .promiscuous_enable       = dpaa_eth_promiscuous_enable,
680         .promiscuous_disable      = dpaa_eth_promiscuous_disable,
681         .allmulticast_enable      = dpaa_eth_multicast_enable,
682         .allmulticast_disable     = dpaa_eth_multicast_disable,
683         .mtu_set                  = dpaa_mtu_set,
684         .dev_set_link_down        = dpaa_link_down,
685         .dev_set_link_up          = dpaa_link_up,
686         .mac_addr_add             = dpaa_dev_add_mac_addr,
687         .mac_addr_remove          = dpaa_dev_remove_mac_addr,
688         .mac_addr_set             = dpaa_dev_set_mac_addr,
689
690         .fw_version_get           = dpaa_fw_version_get,
691 };
692
693 static int dpaa_fc_set_default(struct dpaa_if *dpaa_intf)
694 {
695         struct rte_eth_fc_conf *fc_conf;
696         int ret;
697
698         PMD_INIT_FUNC_TRACE();
699
700         if (!(dpaa_intf->fc_conf)) {
701                 dpaa_intf->fc_conf = rte_zmalloc(NULL,
702                         sizeof(struct rte_eth_fc_conf), MAX_CACHELINE);
703                 if (!dpaa_intf->fc_conf) {
704                         DPAA_PMD_ERR("unable to save flow control info");
705                         return -ENOMEM;
706                 }
707         }
708         fc_conf = dpaa_intf->fc_conf;
709         ret = fman_if_get_fc_threshold(dpaa_intf->fif);
710         if (ret) {
711                 fc_conf->mode = RTE_FC_TX_PAUSE;
712                 fc_conf->pause_time = fman_if_get_fc_quanta(dpaa_intf->fif);
713         } else {
714                 fc_conf->mode = RTE_FC_NONE;
715         }
716
717         return 0;
718 }
719
720 /* Initialise an Rx FQ */
721 static int dpaa_rx_queue_init(struct qman_fq *fq, struct qman_cgr *cgr_rx,
722                               uint32_t fqid)
723 {
724         struct qm_mcc_initfq opts = {0};
725         int ret;
726         u32 flags = 0;
727         struct qm_mcc_initcgr cgr_opts = {
728                 .we_mask = QM_CGR_WE_CS_THRES |
729                                 QM_CGR_WE_CSTD_EN |
730                                 QM_CGR_WE_MODE,
731                 .cgr = {
732                         .cstd_en = QM_CGR_EN,
733                         .mode = QMAN_CGR_MODE_FRAME
734                 }
735         };
736
737         PMD_INIT_FUNC_TRACE();
738
739         ret = qman_reserve_fqid(fqid);
740         if (ret) {
741                 DPAA_PMD_ERR("reserve rx fqid %d failed with ret: %d",
742                              fqid, ret);
743                 return -EINVAL;
744         }
745
746         DPAA_PMD_DEBUG("creating rx fq %p, fqid %d", fq, fqid);
747         ret = qman_create_fq(fqid, QMAN_FQ_FLAG_NO_ENQUEUE, fq);
748         if (ret) {
749                 DPAA_PMD_ERR("create rx fqid %d failed with ret: %d",
750                         fqid, ret);
751                 return ret;
752         }
753
754         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
755                        QM_INITFQ_WE_CONTEXTA;
756
757         opts.fqd.dest.wq = DPAA_IF_RX_PRIORITY;
758         opts.fqd.fq_ctrl = QM_FQCTRL_AVOIDBLOCK | QM_FQCTRL_CTXASTASHING |
759                            QM_FQCTRL_PREFERINCACHE;
760         opts.fqd.context_a.stashing.exclusive = 0;
761         opts.fqd.context_a.stashing.annotation_cl = DPAA_IF_RX_ANNOTATION_STASH;
762         opts.fqd.context_a.stashing.data_cl = DPAA_IF_RX_DATA_STASH;
763         opts.fqd.context_a.stashing.context_cl = DPAA_IF_RX_CONTEXT_STASH;
764
765         if (cgr_rx) {
766                 /* Enable tail drop with cgr on this queue */
767                 qm_cgr_cs_thres_set64(&cgr_opts.cgr.cs_thres, td_threshold, 0);
768                 cgr_rx->cb = NULL;
769                 ret = qman_create_cgr(cgr_rx, QMAN_CGR_FLAG_USE_INIT,
770                                       &cgr_opts);
771                 if (ret) {
772                         DPAA_PMD_WARN(
773                                 "rx taildrop init fail on rx fqid %d (ret=%d)",
774                                 fqid, ret);
775                         goto without_cgr;
776                 }
777                 opts.we_mask |= QM_INITFQ_WE_CGID;
778                 opts.fqd.cgid = cgr_rx->cgrid;
779                 opts.fqd.fq_ctrl |= QM_FQCTRL_CGE;
780         }
781 without_cgr:
782         ret = qman_init_fq(fq, flags, &opts);
783         if (ret)
784                 DPAA_PMD_ERR("init rx fqid %d failed with ret: %d", fqid, ret);
785         return ret;
786 }
787
788 /* Initialise a Tx FQ */
789 static int dpaa_tx_queue_init(struct qman_fq *fq,
790                               struct fman_if *fman_intf)
791 {
792         struct qm_mcc_initfq opts = {0};
793         int ret;
794
795         PMD_INIT_FUNC_TRACE();
796
797         ret = qman_create_fq(0, QMAN_FQ_FLAG_DYNAMIC_FQID |
798                              QMAN_FQ_FLAG_TO_DCPORTAL, fq);
799         if (ret) {
800                 DPAA_PMD_ERR("create tx fq failed with ret: %d", ret);
801                 return ret;
802         }
803         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
804                        QM_INITFQ_WE_CONTEXTB | QM_INITFQ_WE_CONTEXTA;
805         opts.fqd.dest.channel = fman_intf->tx_channel_id;
806         opts.fqd.dest.wq = DPAA_IF_TX_PRIORITY;
807         opts.fqd.fq_ctrl = QM_FQCTRL_PREFERINCACHE;
808         opts.fqd.context_b = 0;
809         /* no tx-confirmation */
810         opts.fqd.context_a.hi = 0x80000000 | fman_dealloc_bufs_mask_hi;
811         opts.fqd.context_a.lo = 0 | fman_dealloc_bufs_mask_lo;
812         DPAA_PMD_DEBUG("init tx fq %p, fqid %d", fq, fq->fqid);
813         ret = qman_init_fq(fq, QMAN_INITFQ_FLAG_SCHED, &opts);
814         if (ret)
815                 DPAA_PMD_ERR("init tx fqid %d failed %d", fq->fqid, ret);
816         return ret;
817 }
818
819 #ifdef RTE_LIBRTE_DPAA_DEBUG_DRIVER
820 /* Initialise a DEBUG FQ ([rt]x_error, rx_default). */
821 static int dpaa_debug_queue_init(struct qman_fq *fq, uint32_t fqid)
822 {
823         struct qm_mcc_initfq opts = {0};
824         int ret;
825
826         PMD_INIT_FUNC_TRACE();
827
828         ret = qman_reserve_fqid(fqid);
829         if (ret) {
830                 DPAA_PMD_ERR("Reserve debug fqid %d failed with ret: %d",
831                         fqid, ret);
832                 return -EINVAL;
833         }
834         /* "map" this Rx FQ to one of the interfaces Tx FQID */
835         DPAA_PMD_DEBUG("Creating debug fq %p, fqid %d", fq, fqid);
836         ret = qman_create_fq(fqid, QMAN_FQ_FLAG_NO_ENQUEUE, fq);
837         if (ret) {
838                 DPAA_PMD_ERR("create debug fqid %d failed with ret: %d",
839                         fqid, ret);
840                 return ret;
841         }
842         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL;
843         opts.fqd.dest.wq = DPAA_IF_DEBUG_PRIORITY;
844         ret = qman_init_fq(fq, 0, &opts);
845         if (ret)
846                 DPAA_PMD_ERR("init debug fqid %d failed with ret: %d",
847                             fqid, ret);
848         return ret;
849 }
850 #endif
851
852 /* Initialise a network interface */
853 static int
854 dpaa_dev_init(struct rte_eth_dev *eth_dev)
855 {
856         int num_cores, num_rx_fqs, fqid;
857         int loop, ret = 0;
858         int dev_id;
859         struct rte_dpaa_device *dpaa_device;
860         struct dpaa_if *dpaa_intf;
861         struct fm_eth_port_cfg *cfg;
862         struct fman_if *fman_intf;
863         struct fman_if_bpool *bp, *tmp_bp;
864         uint32_t cgrid[DPAA_MAX_NUM_PCD_QUEUES];
865
866         PMD_INIT_FUNC_TRACE();
867
868         /* For secondary processes, the primary has done all the work */
869         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
870                 return 0;
871
872         dpaa_device = DEV_TO_DPAA_DEVICE(eth_dev->device);
873         dev_id = dpaa_device->id.dev_id;
874         dpaa_intf = eth_dev->data->dev_private;
875         cfg = &dpaa_netcfg->port_cfg[dev_id];
876         fman_intf = cfg->fman_if;
877
878         dpaa_intf->name = dpaa_device->name;
879
880         /* save fman_if & cfg in the interface struture */
881         dpaa_intf->fif = fman_intf;
882         dpaa_intf->ifid = dev_id;
883         dpaa_intf->cfg = cfg;
884
885         /* Initialize Rx FQ's */
886         if (getenv("DPAA_NUM_RX_QUEUES"))
887                 num_rx_fqs = atoi(getenv("DPAA_NUM_RX_QUEUES"));
888         else
889                 num_rx_fqs = DPAA_DEFAULT_NUM_PCD_QUEUES;
890
891         /* Each device can not have more than DPAA_PCD_FQID_MULTIPLIER RX
892          * queues.
893          */
894         if (num_rx_fqs <= 0 || num_rx_fqs > DPAA_PCD_FQID_MULTIPLIER) {
895                 DPAA_PMD_ERR("Invalid number of RX queues\n");
896                 return -EINVAL;
897         }
898
899         dpaa_intf->rx_queues = rte_zmalloc(NULL,
900                 sizeof(struct qman_fq) * num_rx_fqs, MAX_CACHELINE);
901
902         /* If congestion control is enabled globally*/
903         if (td_threshold) {
904                 dpaa_intf->cgr_rx = rte_zmalloc(NULL,
905                         sizeof(struct qman_cgr) * num_rx_fqs, MAX_CACHELINE);
906
907                 ret = qman_alloc_cgrid_range(&cgrid[0], num_rx_fqs, 1, 0);
908                 if (ret != num_rx_fqs) {
909                         DPAA_PMD_WARN("insufficient CGRIDs available");
910                         return -EINVAL;
911                 }
912         } else {
913                 dpaa_intf->cgr_rx = NULL;
914         }
915
916         for (loop = 0; loop < num_rx_fqs; loop++) {
917                 fqid = DPAA_PCD_FQID_START + dpaa_intf->ifid *
918                         DPAA_PCD_FQID_MULTIPLIER + loop;
919
920                 if (dpaa_intf->cgr_rx)
921                         dpaa_intf->cgr_rx[loop].cgrid = cgrid[loop];
922
923                 ret = dpaa_rx_queue_init(&dpaa_intf->rx_queues[loop],
924                         dpaa_intf->cgr_rx ? &dpaa_intf->cgr_rx[loop] : NULL,
925                         fqid);
926                 if (ret)
927                         return ret;
928                 dpaa_intf->rx_queues[loop].dpaa_intf = dpaa_intf;
929         }
930         dpaa_intf->nb_rx_queues = num_rx_fqs;
931
932         /* Initialise Tx FQs. Have as many Tx FQ's as number of cores */
933         num_cores = rte_lcore_count();
934         dpaa_intf->tx_queues = rte_zmalloc(NULL, sizeof(struct qman_fq) *
935                 num_cores, MAX_CACHELINE);
936         if (!dpaa_intf->tx_queues)
937                 return -ENOMEM;
938
939         for (loop = 0; loop < num_cores; loop++) {
940                 ret = dpaa_tx_queue_init(&dpaa_intf->tx_queues[loop],
941                                          fman_intf);
942                 if (ret)
943                         return ret;
944                 dpaa_intf->tx_queues[loop].dpaa_intf = dpaa_intf;
945         }
946         dpaa_intf->nb_tx_queues = num_cores;
947
948 #ifdef RTE_LIBRTE_DPAA_DEBUG_DRIVER
949         dpaa_debug_queue_init(&dpaa_intf->debug_queues[
950                 DPAA_DEBUG_FQ_RX_ERROR], fman_intf->fqid_rx_err);
951         dpaa_intf->debug_queues[DPAA_DEBUG_FQ_RX_ERROR].dpaa_intf = dpaa_intf;
952         dpaa_debug_queue_init(&dpaa_intf->debug_queues[
953                 DPAA_DEBUG_FQ_TX_ERROR], fman_intf->fqid_tx_err);
954         dpaa_intf->debug_queues[DPAA_DEBUG_FQ_TX_ERROR].dpaa_intf = dpaa_intf;
955 #endif
956
957         DPAA_PMD_DEBUG("All frame queues created");
958
959         /* Get the initial configuration for flow control */
960         dpaa_fc_set_default(dpaa_intf);
961
962         /* reset bpool list, initialize bpool dynamically */
963         list_for_each_entry_safe(bp, tmp_bp, &cfg->fman_if->bpool_list, node) {
964                 list_del(&bp->node);
965                 free(bp);
966         }
967
968         /* Populate ethdev structure */
969         eth_dev->dev_ops = &dpaa_devops;
970         eth_dev->rx_pkt_burst = dpaa_eth_queue_rx;
971         eth_dev->tx_pkt_burst = dpaa_eth_tx_drop_all;
972
973         /* Allocate memory for storing MAC addresses */
974         eth_dev->data->mac_addrs = rte_zmalloc("mac_addr",
975                 ETHER_ADDR_LEN * DPAA_MAX_MAC_FILTER, 0);
976         if (eth_dev->data->mac_addrs == NULL) {
977                 DPAA_PMD_ERR("Failed to allocate %d bytes needed to "
978                                                 "store MAC addresses",
979                                 ETHER_ADDR_LEN * DPAA_MAX_MAC_FILTER);
980                 rte_free(dpaa_intf->cgr_rx);
981                 rte_free(dpaa_intf->rx_queues);
982                 rte_free(dpaa_intf->tx_queues);
983                 dpaa_intf->rx_queues = NULL;
984                 dpaa_intf->tx_queues = NULL;
985                 dpaa_intf->nb_rx_queues = 0;
986                 dpaa_intf->nb_tx_queues = 0;
987                 return -ENOMEM;
988         }
989
990         /* copy the primary mac address */
991         ether_addr_copy(&fman_intf->mac_addr, &eth_dev->data->mac_addrs[0]);
992
993         RTE_LOG(INFO, PMD, "net: dpaa: %s: %02x:%02x:%02x:%02x:%02x:%02x\n",
994                 dpaa_device->name,
995                 fman_intf->mac_addr.addr_bytes[0],
996                 fman_intf->mac_addr.addr_bytes[1],
997                 fman_intf->mac_addr.addr_bytes[2],
998                 fman_intf->mac_addr.addr_bytes[3],
999                 fman_intf->mac_addr.addr_bytes[4],
1000                 fman_intf->mac_addr.addr_bytes[5]);
1001
1002         /* Disable RX mode */
1003         fman_if_discard_rx_errors(fman_intf);
1004         fman_if_disable_rx(fman_intf);
1005         /* Disable promiscuous mode */
1006         fman_if_promiscuous_disable(fman_intf);
1007         /* Disable multicast */
1008         fman_if_reset_mcast_filter_table(fman_intf);
1009         /* Reset interface statistics */
1010         fman_if_stats_reset(fman_intf);
1011
1012         return 0;
1013 }
1014
1015 static int
1016 dpaa_dev_uninit(struct rte_eth_dev *dev)
1017 {
1018         struct dpaa_if *dpaa_intf = dev->data->dev_private;
1019         int loop;
1020
1021         PMD_INIT_FUNC_TRACE();
1022
1023         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1024                 return -EPERM;
1025
1026         if (!dpaa_intf) {
1027                 DPAA_PMD_WARN("Already closed or not started");
1028                 return -1;
1029         }
1030
1031         dpaa_eth_dev_close(dev);
1032
1033         /* release configuration memory */
1034         if (dpaa_intf->fc_conf)
1035                 rte_free(dpaa_intf->fc_conf);
1036
1037         /* Release RX congestion Groups */
1038         if (dpaa_intf->cgr_rx) {
1039                 for (loop = 0; loop < dpaa_intf->nb_rx_queues; loop++)
1040                         qman_delete_cgr(&dpaa_intf->cgr_rx[loop]);
1041
1042                 qman_release_cgrid_range(dpaa_intf->cgr_rx[loop].cgrid,
1043                                          dpaa_intf->nb_rx_queues);
1044         }
1045
1046         rte_free(dpaa_intf->cgr_rx);
1047         dpaa_intf->cgr_rx = NULL;
1048
1049         rte_free(dpaa_intf->rx_queues);
1050         dpaa_intf->rx_queues = NULL;
1051
1052         rte_free(dpaa_intf->tx_queues);
1053         dpaa_intf->tx_queues = NULL;
1054
1055         /* free memory for storing MAC addresses */
1056         rte_free(dev->data->mac_addrs);
1057         dev->data->mac_addrs = NULL;
1058
1059         dev->dev_ops = NULL;
1060         dev->rx_pkt_burst = NULL;
1061         dev->tx_pkt_burst = NULL;
1062
1063         return 0;
1064 }
1065
1066 static int
1067 rte_dpaa_probe(struct rte_dpaa_driver *dpaa_drv,
1068                struct rte_dpaa_device *dpaa_dev)
1069 {
1070         int diag;
1071         int ret;
1072         struct rte_eth_dev *eth_dev;
1073
1074         PMD_INIT_FUNC_TRACE();
1075
1076         /* In case of secondary process, the device is already configured
1077          * and no further action is required, except portal initialization
1078          * and verifying secondary attachment to port name.
1079          */
1080         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
1081                 eth_dev = rte_eth_dev_attach_secondary(dpaa_dev->name);
1082                 if (!eth_dev)
1083                         return -ENOMEM;
1084                 return 0;
1085         }
1086
1087         if (!is_global_init) {
1088                 /* One time load of Qman/Bman drivers */
1089                 ret = qman_global_init();
1090                 if (ret) {
1091                         DPAA_PMD_ERR("QMAN initialization failed: %d",
1092                                      ret);
1093                         return ret;
1094                 }
1095                 ret = bman_global_init();
1096                 if (ret) {
1097                         DPAA_PMD_ERR("BMAN initialization failed: %d",
1098                                      ret);
1099                         return ret;
1100                 }
1101
1102                 is_global_init = 1;
1103         }
1104
1105         ret = rte_dpaa_portal_init((void *)1);
1106         if (ret) {
1107                 DPAA_PMD_ERR("Unable to initialize portal");
1108                 return ret;
1109         }
1110
1111         eth_dev = rte_eth_dev_allocate(dpaa_dev->name);
1112         if (eth_dev == NULL)
1113                 return -ENOMEM;
1114
1115         eth_dev->data->dev_private = rte_zmalloc(
1116                                         "ethdev private structure",
1117                                         sizeof(struct dpaa_if),
1118                                         RTE_CACHE_LINE_SIZE);
1119         if (!eth_dev->data->dev_private) {
1120                 DPAA_PMD_ERR("Cannot allocate memzone for port data");
1121                 rte_eth_dev_release_port(eth_dev);
1122                 return -ENOMEM;
1123         }
1124
1125         eth_dev->device = &dpaa_dev->device;
1126         eth_dev->device->driver = &dpaa_drv->driver;
1127         dpaa_dev->eth_dev = eth_dev;
1128
1129         /* Invoke PMD device initialization function */
1130         diag = dpaa_dev_init(eth_dev);
1131         if (diag == 0)
1132                 return 0;
1133
1134         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
1135                 rte_free(eth_dev->data->dev_private);
1136
1137         rte_eth_dev_release_port(eth_dev);
1138         return diag;
1139 }
1140
1141 static int
1142 rte_dpaa_remove(struct rte_dpaa_device *dpaa_dev)
1143 {
1144         struct rte_eth_dev *eth_dev;
1145
1146         PMD_INIT_FUNC_TRACE();
1147
1148         eth_dev = dpaa_dev->eth_dev;
1149         dpaa_dev_uninit(eth_dev);
1150
1151         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
1152                 rte_free(eth_dev->data->dev_private);
1153
1154         rte_eth_dev_release_port(eth_dev);
1155
1156         return 0;
1157 }
1158
1159 static struct rte_dpaa_driver rte_dpaa_pmd = {
1160         .drv_type = FSL_DPAA_ETH,
1161         .probe = rte_dpaa_probe,
1162         .remove = rte_dpaa_remove,
1163 };
1164
1165 RTE_PMD_REGISTER_DPAA(net_dpaa, rte_dpaa_pmd);