Branch data Line data Source code
1 : : /*
2 : : * SPDX-License-Identifier: BSD-3-Clause
3 : : * Copyright(c) 2023 Napatech A/S
4 : : */
5 : :
6 : : #include <stdint.h>
7 : : #include <stdarg.h>
8 : :
9 : : #include <signal.h>
10 : :
11 : : #include <rte_eal.h>
12 : : #include <rte_dev.h>
13 : : #include <rte_vfio.h>
14 : : #include <rte_ethdev.h>
15 : : #include <rte_bus_pci.h>
16 : : #include <ethdev_pci.h>
17 : : #include <rte_kvargs.h>
18 : :
19 : : #include <sys/queue.h>
20 : :
21 : : #include "rte_spinlock.h"
22 : : #include "ntlog.h"
23 : : #include "ntdrv_4ga.h"
24 : : #include "ntos_drv.h"
25 : : #include "ntos_system.h"
26 : : #include "nthw_fpga_instances.h"
27 : : #include "ntnic_vfio.h"
28 : : #include "ntnic_mod_reg.h"
29 : : #include "nt_util.h"
30 : : #include "flow_hsh_cfg.h"
31 : : #include "profile_inline/flm_age_queue.h"
32 : : #include "profile_inline/flm_evt_queue.h"
33 : : #include "rte_pmd_ntnic.h"
34 : :
35 : : const rte_thread_attr_t thread_attr = { .priority = RTE_THREAD_PRIORITY_NORMAL };
36 : : #define THREAD_CREATE(a, b, c) rte_thread_create(a, &thread_attr, b, c)
37 : : #define THREAD_CTRL_CREATE(a, b, c, d) rte_thread_create_internal_control(a, b, c, d)
38 : : #define THREAD_JOIN(a) rte_thread_join(a, NULL)
39 : : #define THREAD_FUNC static uint32_t
40 : : #define THREAD_RETURN (0)
41 : : #define HW_MAX_PKT_LEN (10000)
42 : : #define MAX_MTU (HW_MAX_PKT_LEN - RTE_ETHER_HDR_LEN - RTE_ETHER_CRC_LEN)
43 : : #define MIN_MTU_INLINE 512
44 : :
45 : : #define EXCEPTION_PATH_HID 0
46 : :
47 : : #define MAX_TOTAL_QUEUES 128
48 : :
49 : : #define SG_NB_HW_RX_DESCRIPTORS 1024
50 : : #define SG_NB_HW_TX_DESCRIPTORS 1024
51 : : #define SG_HW_RX_PKT_BUFFER_SIZE (1024 << 1)
52 : : #define SG_HW_TX_PKT_BUFFER_SIZE (1024 << 1)
53 : :
54 : : #define NUM_VQ_SEGS(_data_size_) \
55 : : ({ \
56 : : size_t _size = (_data_size_); \
57 : : size_t _segment_count = ((_size + SG_HDR_SIZE) > SG_HW_TX_PKT_BUFFER_SIZE) \
58 : : ? (((_size + SG_HDR_SIZE) + SG_HW_TX_PKT_BUFFER_SIZE - 1) / \
59 : : SG_HW_TX_PKT_BUFFER_SIZE) \
60 : : : 1; \
61 : : _segment_count; \
62 : : })
63 : :
64 : : #define VIRTQ_DESCR_IDX(_tx_pkt_idx_) \
65 : : (((_tx_pkt_idx_) + first_vq_descr_idx) % SG_NB_HW_TX_DESCRIPTORS)
66 : :
67 : : #define VIRTQ_DESCR_IDX_NEXT(_vq_descr_idx_) (((_vq_descr_idx_) + 1) % SG_NB_HW_TX_DESCRIPTORS)
68 : :
69 : : #define ONE_G_SIZE 0x40000000
70 : : #define ONE_G_MASK (ONE_G_SIZE - 1)
71 : :
72 : : #define MAX_RX_PACKETS 128
73 : : #define MAX_TX_PACKETS 128
74 : :
75 : : #define MTUINITVAL 1500
76 : :
77 : : uint64_t rte_tsc_freq;
78 : :
79 : :
80 : : #define ETH_DEV_NTNIC_HELP_ARG "help"
81 : : #define ETH_DEV_NTHW_RXQUEUES_ARG "rxqs"
82 : : #define ETH_DEV_NTHW_TXQUEUES_ARG "txqs"
83 : :
84 : : static const char *const valid_arguments[] = {
85 : : ETH_DEV_NTNIC_HELP_ARG,
86 : : ETH_DEV_NTHW_RXQUEUES_ARG,
87 : : ETH_DEV_NTHW_TXQUEUES_ARG,
88 : : NULL,
89 : : };
90 : :
91 : :
92 : : static const struct rte_pci_id nthw_pci_id_map[] = {
93 : : { RTE_PCI_DEVICE(NT_HW_PCI_VENDOR_ID, NT_HW_PCI_DEVICE_ID_NT200A02) },
94 : : { RTE_PCI_DEVICE(NT_HW_PCI_VENDOR_ID, NT_HW_PCI_DEVICE_ID_NT400D13) },
95 : : {
96 : : .vendor_id = 0,
97 : : }, /* sentinel */
98 : : };
99 : :
100 : : static const struct sg_ops_s *sg_ops;
101 : :
102 : : rte_spinlock_t hwlock = RTE_SPINLOCK_INITIALIZER;
103 : :
104 : : /*
105 : : * Store and get adapter info
106 : : */
107 : :
108 : : static struct drv_s *_g_p_drv[NUM_ADAPTER_MAX] = { NULL };
109 : :
110 : : static void
111 : 0 : store_pdrv(struct drv_s *p_drv)
112 : : {
113 [ # # ]: 0 : if (p_drv->adapter_no >= NUM_ADAPTER_MAX) {
114 : 0 : NT_LOG(ERR, NTNIC,
115 : : "Internal error adapter number %u out of range. Max number of adapters: %u",
116 : : p_drv->adapter_no, NUM_ADAPTER_MAX);
117 : 0 : return;
118 : : }
119 : :
120 [ # # ]: 0 : if (_g_p_drv[p_drv->adapter_no] != 0) {
121 : 0 : NT_LOG(WRN, NTNIC,
122 : : "Overwriting adapter structure for PCI " PCIIDENT_PRINT_STR
123 : : " with adapter structure for PCI " PCIIDENT_PRINT_STR,
124 : : PCIIDENT_TO_DOMAIN(_g_p_drv[p_drv->adapter_no]->ntdrv.pciident),
125 : : PCIIDENT_TO_BUSNR(_g_p_drv[p_drv->adapter_no]->ntdrv.pciident),
126 : : PCIIDENT_TO_DEVNR(_g_p_drv[p_drv->adapter_no]->ntdrv.pciident),
127 : : PCIIDENT_TO_FUNCNR(_g_p_drv[p_drv->adapter_no]->ntdrv.pciident),
128 : : PCIIDENT_TO_DOMAIN(p_drv->ntdrv.pciident),
129 : : PCIIDENT_TO_BUSNR(p_drv->ntdrv.pciident),
130 : : PCIIDENT_TO_DEVNR(p_drv->ntdrv.pciident),
131 : : PCIIDENT_TO_FUNCNR(p_drv->ntdrv.pciident));
132 : : }
133 : :
134 : : rte_spinlock_lock(&hwlock);
135 : 0 : _g_p_drv[p_drv->adapter_no] = p_drv;
136 : : rte_spinlock_unlock(&hwlock);
137 : : }
138 : :
139 : 0 : static void clear_pdrv(struct drv_s *p_drv)
140 : : {
141 [ # # ]: 0 : if (p_drv->adapter_no >= NUM_ADAPTER_MAX)
142 : : return;
143 : :
144 : : rte_spinlock_lock(&hwlock);
145 : 0 : _g_p_drv[p_drv->adapter_no] = NULL;
146 : : rte_spinlock_unlock(&hwlock);
147 : : }
148 : :
149 : : static struct drv_s *
150 : 0 : get_pdrv_from_pci(struct rte_pci_addr addr)
151 : : {
152 : : int i;
153 : : struct drv_s *p_drv = NULL;
154 : : rte_spinlock_lock(&hwlock);
155 : :
156 [ # # ]: 0 : for (i = 0; i < NUM_ADAPTER_MAX; i++) {
157 [ # # ]: 0 : if (_g_p_drv[i]) {
158 [ # # ]: 0 : if (PCIIDENT_TO_DOMAIN(_g_p_drv[i]->ntdrv.pciident) == addr.domain &&
159 [ # # ]: 0 : PCIIDENT_TO_BUSNR(_g_p_drv[i]->ntdrv.pciident) == addr.bus) {
160 : : p_drv = _g_p_drv[i];
161 : : break;
162 : : }
163 : : }
164 : : }
165 : :
166 : : rte_spinlock_unlock(&hwlock);
167 : 0 : return p_drv;
168 : : }
169 : :
170 : 0 : static int dpdk_stats_collect(struct pmd_internals *internals, struct rte_eth_stats *stats)
171 : : {
172 : 0 : const struct ntnic_filter_ops *ntnic_filter_ops = get_ntnic_filter_ops();
173 : :
174 [ # # ]: 0 : if (ntnic_filter_ops == NULL) {
175 : 0 : NT_LOG_DBGX(ERR, NTNIC, "ntnic_filter_ops uninitialized");
176 : 0 : return -1;
177 : : }
178 : :
179 : : unsigned int i;
180 : 0 : struct drv_s *p_drv = internals->p_drv;
181 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
182 : : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
183 : 0 : nthw_stat_t *p_nthw_stat = p_nt4ga_stat->mp_nthw_stat;
184 : 0 : const int n_intf_no = internals->n_intf_no;
185 : : uint64_t rx_total = 0;
186 : : uint64_t rx_total_b = 0;
187 : : uint64_t tx_total = 0;
188 : : uint64_t tx_total_b = 0;
189 : : uint64_t tx_err_total = 0;
190 : :
191 [ # # # # : 0 : if (!p_nthw_stat || !p_nt4ga_stat || !stats || n_intf_no < 0 ||
# # ]
192 : : n_intf_no > NUM_ADAPTER_PORTS_MAX) {
193 : 0 : NT_LOG_DBGX(WRN, NTNIC, "error exit");
194 : 0 : return -1;
195 : : }
196 : :
197 : : /*
198 : : * Pull the latest port statistic numbers (Rx/Tx pkts and bytes)
199 : : * Return values are in the "internals->rxq_scg[]" and "internals->txq_scg[]" arrays
200 : : */
201 : 0 : ntnic_filter_ops->poll_statistics(internals);
202 : :
203 [ # # ]: 0 : for (i = 0; i < internals->nb_rx_queues; i++) {
204 [ # # ]: 0 : if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) {
205 : 0 : stats->q_ipackets[i] = internals->rxq_scg[i].rx_pkts;
206 : 0 : stats->q_ibytes[i] = internals->rxq_scg[i].rx_bytes;
207 : : }
208 : 0 : rx_total += internals->rxq_scg[i].rx_pkts;
209 : 0 : rx_total_b += internals->rxq_scg[i].rx_bytes;
210 : : }
211 : :
212 [ # # ]: 0 : for (i = 0; i < internals->nb_tx_queues; i++) {
213 [ # # ]: 0 : if (i < RTE_ETHDEV_QUEUE_STAT_CNTRS) {
214 : 0 : stats->q_opackets[i] = internals->txq_scg[i].tx_pkts;
215 : 0 : stats->q_obytes[i] = internals->txq_scg[i].tx_bytes;
216 : 0 : stats->q_errors[i] = internals->txq_scg[i].err_pkts;
217 : : }
218 : 0 : tx_total += internals->txq_scg[i].tx_pkts;
219 : 0 : tx_total_b += internals->txq_scg[i].tx_bytes;
220 : 0 : tx_err_total += internals->txq_scg[i].err_pkts;
221 : : }
222 : :
223 : 0 : stats->imissed = internals->rx_missed;
224 : 0 : stats->ipackets = rx_total;
225 : 0 : stats->ibytes = rx_total_b;
226 : 0 : stats->opackets = tx_total;
227 : 0 : stats->obytes = tx_total_b;
228 : 0 : stats->oerrors = tx_err_total;
229 : :
230 : 0 : return 0;
231 : : }
232 : :
233 : 0 : static int dpdk_stats_reset(struct pmd_internals *internals, struct ntdrv_4ga_s *p_nt_drv,
234 : : int n_intf_no)
235 : : {
236 : : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
237 : 0 : nthw_stat_t *p_nthw_stat = p_nt4ga_stat->mp_nthw_stat;
238 : : unsigned int i;
239 : :
240 [ # # # # ]: 0 : if (!p_nthw_stat || !p_nt4ga_stat || n_intf_no < 0 || n_intf_no > NUM_ADAPTER_PORTS_MAX)
241 : : return -1;
242 : :
243 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
244 : :
245 : : /* Rx */
246 [ # # ]: 0 : for (i = 0; i < internals->nb_rx_queues; i++) {
247 : 0 : internals->rxq_scg[i].rx_pkts = 0;
248 : 0 : internals->rxq_scg[i].rx_bytes = 0;
249 : 0 : internals->rxq_scg[i].err_pkts = 0;
250 : : }
251 : :
252 : 0 : internals->rx_missed = 0;
253 : :
254 : : /* Tx */
255 [ # # ]: 0 : for (i = 0; i < internals->nb_tx_queues; i++) {
256 : 0 : internals->txq_scg[i].tx_pkts = 0;
257 : 0 : internals->txq_scg[i].tx_bytes = 0;
258 : 0 : internals->txq_scg[i].err_pkts = 0;
259 : : }
260 : :
261 : 0 : p_nt4ga_stat->n_totals_reset_timestamp = time(NULL);
262 : :
263 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
264 : :
265 : 0 : return 0;
266 : : }
267 : :
268 : : static int
269 : 0 : eth_link_update(struct rte_eth_dev *eth_dev, int wait_to_complete __rte_unused)
270 : : {
271 : 0 : const struct port_ops *port_ops = get_port_ops();
272 : :
273 [ # # ]: 0 : if (port_ops == NULL) {
274 : 0 : NT_LOG(ERR, NTNIC, "Link management module uninitialized");
275 : 0 : return -1;
276 : : }
277 : :
278 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
279 : :
280 : 0 : const int n_intf_no = internals->n_intf_no;
281 : 0 : struct adapter_info_s *p_adapter_info = &internals->p_drv->ntdrv.adapter_info;
282 : :
283 [ # # ]: 0 : if (eth_dev->data->dev_started) {
284 : 0 : const bool port_link_status = port_ops->get_link_status(p_adapter_info, n_intf_no);
285 : 0 : eth_dev->data->dev_link.link_status =
286 : : port_link_status ? RTE_ETH_LINK_UP : RTE_ETH_LINK_DOWN;
287 : :
288 : : nt_link_speed_t port_link_speed =
289 : 0 : port_ops->get_link_speed(p_adapter_info, n_intf_no);
290 : 0 : eth_dev->data->dev_link.link_speed =
291 : 0 : nt_link_speed_to_eth_speed_num(port_link_speed);
292 : :
293 : : nt_link_duplex_t nt_link_duplex =
294 : 0 : port_ops->get_link_duplex(p_adapter_info, n_intf_no);
295 : 0 : eth_dev->data->dev_link.link_duplex = nt_link_duplex_to_eth_duplex(nt_link_duplex);
296 : :
297 : : } else {
298 : 0 : eth_dev->data->dev_link.link_status = RTE_ETH_LINK_DOWN;
299 : 0 : eth_dev->data->dev_link.link_speed = RTE_ETH_SPEED_NUM_NONE;
300 : 0 : eth_dev->data->dev_link.link_duplex = RTE_ETH_LINK_FULL_DUPLEX;
301 : : }
302 : :
303 : : return 0;
304 : : }
305 : :
306 : 0 : static int eth_stats_get(struct rte_eth_dev *eth_dev, struct rte_eth_stats *stats)
307 : : {
308 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
309 : 0 : dpdk_stats_collect(internals, stats);
310 : 0 : return 0;
311 : : }
312 : :
313 : 0 : static int eth_stats_reset(struct rte_eth_dev *eth_dev)
314 : : {
315 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
316 : 0 : struct drv_s *p_drv = internals->p_drv;
317 : 0 : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
318 : 0 : const int n_intf_no = internals->n_intf_no;
319 : 0 : dpdk_stats_reset(internals, p_nt_drv, n_intf_no);
320 : 0 : return 0;
321 : : }
322 : :
323 : : static int
324 : 0 : eth_dev_infos_get(struct rte_eth_dev *eth_dev, struct rte_eth_dev_info *dev_info)
325 : : {
326 : 0 : const struct port_ops *port_ops = get_port_ops();
327 : :
328 [ # # ]: 0 : if (port_ops == NULL) {
329 : 0 : NT_LOG(ERR, NTNIC, "Link management module uninitialized");
330 : 0 : return -1;
331 : : }
332 : :
333 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
334 : :
335 [ # # ]: 0 : if (internals == NULL) {
336 : 0 : NT_LOG(ERR, NTNIC, "PMD-specific private data not initialized");
337 : 0 : return -1;
338 : : }
339 : :
340 : 0 : const int n_intf_no = internals->n_intf_no;
341 : 0 : struct adapter_info_s *p_adapter_info = &internals->p_drv->ntdrv.adapter_info;
342 : :
343 : 0 : dev_info->driver_name = internals->name;
344 : 0 : dev_info->max_mac_addrs = NUM_MAC_ADDRS_PER_PORT;
345 : 0 : dev_info->max_rx_pktlen = HW_MAX_PKT_LEN;
346 : 0 : dev_info->max_mtu = MAX_MTU;
347 : :
348 [ # # ]: 0 : if (p_adapter_info->fpga_info.profile == FPGA_INFO_PROFILE_INLINE) {
349 : 0 : dev_info->min_mtu = MIN_MTU_INLINE;
350 : 0 : dev_info->flow_type_rss_offloads = NT_ETH_RSS_OFFLOAD_MASK;
351 : 0 : dev_info->hash_key_size = MAX_RSS_KEY_LEN;
352 : :
353 : 0 : dev_info->rss_algo_capa = RTE_ETH_HASH_ALGO_CAPA_MASK(DEFAULT) |
354 : : RTE_ETH_HASH_ALGO_CAPA_MASK(TOEPLITZ);
355 : : }
356 : :
357 : : if (internals->p_drv) {
358 : 0 : dev_info->max_rx_queues = internals->nb_rx_queues;
359 : 0 : dev_info->max_tx_queues = internals->nb_tx_queues;
360 : :
361 : 0 : dev_info->min_rx_bufsize = 64;
362 : :
363 : : const uint32_t nt_port_speed_capa =
364 : 0 : port_ops->get_link_speed_capabilities(p_adapter_info, n_intf_no);
365 : 0 : dev_info->speed_capa = nt_link_speed_capa_to_eth_speed_capa(nt_port_speed_capa);
366 : : }
367 : :
368 : 0 : return 0;
369 : : }
370 : :
371 : : static __rte_always_inline int copy_virtqueue_to_mbuf(struct rte_mbuf *mbuf,
372 : : struct rte_mempool *mb_pool,
373 : : struct nthw_received_packets *hw_recv,
374 : : int max_segs,
375 : : uint16_t data_len)
376 : : {
377 : : int src_pkt = 0;
378 : : /*
379 : : * 1. virtqueue packets may be segmented
380 : : * 2. the mbuf size may be too small and may need to be segmented
381 : : */
382 : 0 : char *data = (char *)hw_recv[src_pkt].addr + SG_HDR_SIZE;
383 : 0 : char *dst = (char *)mbuf->buf_addr + RTE_PKTMBUF_HEADROOM;
384 : :
385 : : /* set packet length */
386 : 0 : mbuf->pkt_len = data_len - SG_HDR_SIZE;
387 : :
388 : : int remain = mbuf->pkt_len;
389 : : /* First cpy_size is without header */
390 : : int cpy_size = (data_len > SG_HW_RX_PKT_BUFFER_SIZE)
391 : : ? SG_HW_RX_PKT_BUFFER_SIZE - SG_HDR_SIZE
392 : 0 : : remain;
393 : :
394 : : struct rte_mbuf *m = mbuf; /* if mbuf segmentation is needed */
395 : :
396 [ # # ]: 0 : while (++src_pkt <= max_segs) {
397 : : /* keep track of space in dst */
398 : 0 : int cpto_size = rte_pktmbuf_tailroom(m);
399 : :
400 [ # # ]: 0 : if (cpy_size > cpto_size) {
401 : : int new_cpy_size = cpto_size;
402 : :
403 [ # # ]: 0 : rte_memcpy((void *)dst, (void *)data, new_cpy_size);
404 : 0 : m->data_len += new_cpy_size;
405 : 0 : remain -= new_cpy_size;
406 : 0 : cpy_size -= new_cpy_size;
407 : :
408 : 0 : data += new_cpy_size;
409 : :
410 : : /*
411 : : * loop if remaining data from this virtqueue seg
412 : : * cannot fit in one extra mbuf
413 : : */
414 : : do {
415 : 0 : m->next = rte_pktmbuf_alloc(mb_pool);
416 : :
417 [ # # ]: 0 : if (unlikely(!m->next))
418 : : return -1;
419 : :
420 : : m = m->next;
421 : :
422 : : /* Headroom is not needed in chained mbufs */
423 : 0 : rte_pktmbuf_prepend(m, rte_pktmbuf_headroom(m));
424 : 0 : dst = (char *)m->buf_addr;
425 : 0 : m->data_len = 0;
426 [ # # ]: 0 : m->pkt_len = 0;
427 : :
428 : 0 : cpto_size = rte_pktmbuf_tailroom(m);
429 : :
430 : 0 : int actual_cpy_size =
431 : : (cpy_size > cpto_size) ? cpto_size : cpy_size;
432 : :
433 [ # # ]: 0 : rte_memcpy((void *)dst, (void *)data, actual_cpy_size);
434 : 0 : m->pkt_len += actual_cpy_size;
435 : 0 : m->data_len += actual_cpy_size;
436 : :
437 : 0 : remain -= actual_cpy_size;
438 : 0 : cpy_size -= actual_cpy_size;
439 : :
440 : 0 : data += actual_cpy_size;
441 : :
442 : 0 : mbuf->nb_segs++;
443 : :
444 [ # # ]: 0 : } while (cpy_size && remain);
445 : :
446 : : } else {
447 : : /* all data from this virtqueue segment can fit in current mbuf */
448 [ # # ]: 0 : rte_memcpy((void *)dst, (void *)data, cpy_size);
449 : 0 : m->data_len += cpy_size;
450 : :
451 [ # # ]: 0 : if (mbuf->nb_segs > 1)
452 : 0 : m->pkt_len += cpy_size;
453 : :
454 : 0 : remain -= cpy_size;
455 : : }
456 : :
457 : : /* packet complete - all data from current virtqueue packet has been copied */
458 [ # # ]: 0 : if (remain == 0)
459 : : break;
460 : :
461 : : /* increment dst to data end */
462 : 0 : dst = rte_pktmbuf_mtod_offset(m, char *, m->data_len);
463 : : /* prepare for next virtqueue segment */
464 : 0 : data = (char *)hw_recv[src_pkt].addr; /* following packets are full data */
465 : :
466 : 0 : cpy_size = (remain > SG_HW_RX_PKT_BUFFER_SIZE) ? SG_HW_RX_PKT_BUFFER_SIZE : remain;
467 : : };
468 : :
469 [ # # ]: 0 : if (src_pkt > max_segs) {
470 : 0 : NT_LOG(ERR, NTNIC,
471 : : "Did not receive correct number of segment for a whole packet");
472 : : return -1;
473 : : }
474 : :
475 : : return src_pkt;
476 : : }
477 : :
478 : 0 : static uint16_t eth_dev_rx_scg(void *queue, struct rte_mbuf **bufs, uint16_t nb_pkts)
479 : : {
480 : : unsigned int i;
481 : : struct rte_mbuf *mbuf;
482 : : struct ntnic_rx_queue *rx_q = queue;
483 : : uint16_t num_rx = 0;
484 : :
485 : : struct nthw_received_packets hw_recv[MAX_RX_PACKETS];
486 : :
487 [ # # ]: 0 : if (unlikely(nb_pkts == 0))
488 : : return 0;
489 : :
490 : : if (nb_pkts > MAX_RX_PACKETS)
491 : : nb_pkts = MAX_RX_PACKETS;
492 : :
493 : 0 : uint16_t whole_pkts = 0;
494 : : uint16_t hw_recv_pkt_segs = 0;
495 : :
496 [ # # ]: 0 : if (sg_ops != NULL) {
497 : : hw_recv_pkt_segs =
498 : 0 : sg_ops->nthw_get_rx_packets(rx_q->vq, nb_pkts, hw_recv, &whole_pkts);
499 : :
500 [ # # ]: 0 : if (!hw_recv_pkt_segs)
501 : : return 0;
502 : : }
503 : :
504 : 0 : nb_pkts = whole_pkts;
505 : :
506 : : int src_pkt = 0;/* from 0 to hw_recv_pkt_segs */
507 : :
508 [ # # ]: 0 : for (i = 0; i < nb_pkts; i++) {
509 : 0 : bufs[i] = rte_pktmbuf_alloc(rx_q->mb_pool);
510 : :
511 [ # # ]: 0 : if (!bufs[i]) {
512 : 0 : NT_LOG(ERR, NTNIC, "ERROR - no more buffers mbuf in mempool");
513 : 0 : goto err_exit;
514 : : }
515 : :
516 : : mbuf = bufs[i];
517 : :
518 : 0 : struct _pkt_hdr_rx *phdr = (struct _pkt_hdr_rx *)hw_recv[src_pkt].addr;
519 : :
520 [ # # ]: 0 : if (phdr->cap_len < SG_HDR_SIZE) {
521 : 0 : NT_LOG(ERR, NTNIC,
522 : : "Pkt len of zero received. No header!! - dropping packets");
523 : 0 : rte_pktmbuf_free(mbuf);
524 : 0 : goto err_exit;
525 : : }
526 : :
527 : : {
528 [ # # # # ]: 0 : if (phdr->cap_len <= SG_HW_RX_PKT_BUFFER_SIZE &&
529 [ # # ]: 0 : (phdr->cap_len - SG_HDR_SIZE) <= rte_pktmbuf_tailroom(mbuf)) {
530 : 0 : mbuf->data_len = phdr->cap_len - SG_HDR_SIZE;
531 [ # # ]: 0 : rte_memcpy(rte_pktmbuf_mtod(mbuf, char *),
532 : : (char *)hw_recv[src_pkt].addr + SG_HDR_SIZE,
533 : : mbuf->data_len);
534 : :
535 : 0 : mbuf->pkt_len = mbuf->data_len;
536 : 0 : src_pkt++;
537 : :
538 : : } else {
539 [ # # ]: 0 : int cpy_segs = copy_virtqueue_to_mbuf(mbuf, rx_q->mb_pool,
540 : : &hw_recv[src_pkt],
541 : : hw_recv_pkt_segs - src_pkt,
542 : : phdr->cap_len);
543 : :
544 [ # # ]: 0 : if (cpy_segs < 0) {
545 : : /* Error */
546 : 0 : rte_pktmbuf_free(mbuf);
547 : 0 : goto err_exit;
548 : : }
549 : :
550 : 0 : src_pkt += cpy_segs;
551 : : }
552 : :
553 : 0 : num_rx++;
554 : :
555 : 0 : mbuf->ol_flags &= ~(RTE_MBUF_F_RX_FDIR_ID | RTE_MBUF_F_RX_FDIR);
556 : 0 : mbuf->port = (uint16_t)-1;
557 : : }
558 : : }
559 : :
560 : 0 : err_exit:
561 : :
562 [ # # ]: 0 : if (sg_ops != NULL)
563 : 0 : sg_ops->nthw_release_rx_packets(rx_q->vq, hw_recv_pkt_segs);
564 : :
565 : : return num_rx;
566 : : }
567 : :
568 : 0 : static int copy_mbuf_to_virtqueue(struct nthw_cvirtq_desc *cvq_desc,
569 : : uint16_t vq_descr_idx,
570 : : struct nthw_memory_descriptor *vq_bufs,
571 : : int max_segs,
572 : : struct rte_mbuf *mbuf)
573 : : {
574 : : /*
575 : : * 1. mbuf packet may be segmented
576 : : * 2. the virtqueue buffer size may be too small and may need to be segmented
577 : : */
578 : :
579 : 0 : char *data = rte_pktmbuf_mtod(mbuf, char *);
580 : 0 : char *dst = (char *)vq_bufs[vq_descr_idx].virt_addr + SG_HDR_SIZE;
581 : :
582 : 0 : int remain = mbuf->pkt_len;
583 : 0 : int cpy_size = mbuf->data_len;
584 : :
585 : : struct rte_mbuf *m = mbuf;
586 : : int cpto_size = SG_HW_TX_PKT_BUFFER_SIZE - SG_HDR_SIZE;
587 : :
588 : 0 : cvq_desc->b[vq_descr_idx].len = SG_HDR_SIZE;
589 : :
590 : : int cur_seg_num = 0; /* start from 0 */
591 : :
592 [ # # ]: 0 : while (m) {
593 : : /* Can all data in current src segment be in current dest segment */
594 [ # # ]: 0 : if (cpy_size > cpto_size) {
595 : : int new_cpy_size = cpto_size;
596 : :
597 [ # # ]: 0 : rte_memcpy((void *)dst, (void *)data, new_cpy_size);
598 : :
599 : 0 : cvq_desc->b[vq_descr_idx].len += new_cpy_size;
600 : :
601 : 0 : remain -= new_cpy_size;
602 : 0 : cpy_size -= new_cpy_size;
603 : :
604 : 0 : data += new_cpy_size;
605 : :
606 : : /*
607 : : * Loop if remaining data from this virtqueue seg cannot fit in one extra
608 : : * mbuf
609 : : */
610 : : do {
611 [ # # # # ]: 0 : vq_add_flags(cvq_desc, vq_descr_idx, VIRTQ_DESC_F_NEXT);
612 : :
613 : 0 : int next_vq_descr_idx = VIRTQ_DESCR_IDX_NEXT(vq_descr_idx);
614 : :
615 [ # # ]: 0 : vq_set_next(cvq_desc, vq_descr_idx, next_vq_descr_idx);
616 : :
617 : 0 : vq_descr_idx = next_vq_descr_idx;
618 : :
619 [ # # # # ]: 0 : vq_set_flags(cvq_desc, vq_descr_idx, 0);
620 [ # # ]: 0 : vq_set_next(cvq_desc, vq_descr_idx, 0);
621 : :
622 [ # # ]: 0 : if (++cur_seg_num > max_segs)
623 : : break;
624 : :
625 : 0 : dst = (char *)vq_bufs[vq_descr_idx].virt_addr;
626 : : cpto_size = SG_HW_TX_PKT_BUFFER_SIZE;
627 : :
628 : 0 : int actual_cpy_size =
629 : : (cpy_size > cpto_size) ? cpto_size : cpy_size;
630 [ # # ]: 0 : rte_memcpy((void *)dst, (void *)data, actual_cpy_size);
631 : :
632 : 0 : cvq_desc->b[vq_descr_idx].len = actual_cpy_size;
633 : :
634 : 0 : remain -= actual_cpy_size;
635 : 0 : cpy_size -= actual_cpy_size;
636 : 0 : cpto_size -= actual_cpy_size;
637 : :
638 : 0 : data += actual_cpy_size;
639 : :
640 [ # # ]: 0 : } while (cpy_size && remain);
641 : :
642 : : } else {
643 : : /* All data from this segment can fit in current virtqueue buffer */
644 [ # # ]: 0 : rte_memcpy((void *)dst, (void *)data, cpy_size);
645 : :
646 : 0 : cvq_desc->b[vq_descr_idx].len += cpy_size;
647 : :
648 : 0 : remain -= cpy_size;
649 : 0 : cpto_size -= cpy_size;
650 : : }
651 : :
652 : : /* Packet complete - all segments from current mbuf has been copied */
653 [ # # ]: 0 : if (remain == 0)
654 : : break;
655 : :
656 : : /* increment dst to data end */
657 : 0 : dst = (char *)vq_bufs[vq_descr_idx].virt_addr + cvq_desc->b[vq_descr_idx].len;
658 : :
659 : 0 : m = m->next;
660 : :
661 [ # # ]: 0 : if (!m) {
662 : 0 : NT_LOG(ERR, NTNIC, "ERROR: invalid packet size");
663 : 0 : break;
664 : : }
665 : :
666 : : /* Prepare for next mbuf segment */
667 : 0 : data = rte_pktmbuf_mtod(m, char *);
668 : 0 : cpy_size = m->data_len;
669 : : };
670 : :
671 : 0 : cur_seg_num++;
672 : :
673 [ # # ]: 0 : if (cur_seg_num > max_segs) {
674 : 0 : NT_LOG(ERR, NTNIC,
675 : : "Did not receive correct number of segment for a whole packet");
676 : 0 : return -1;
677 : : }
678 : :
679 : : return cur_seg_num;
680 : : }
681 : :
682 : 0 : static uint16_t eth_dev_tx_scg(void *queue, struct rte_mbuf **bufs, uint16_t nb_pkts)
683 : : {
684 : : uint16_t pkt;
685 : 0 : uint16_t first_vq_descr_idx = 0;
686 : :
687 : : struct nthw_cvirtq_desc cvq_desc;
688 : :
689 : : struct nthw_memory_descriptor *vq_bufs;
690 : :
691 : : struct ntnic_tx_queue *tx_q = queue;
692 : :
693 : : int nb_segs = 0, i;
694 : : int pkts_sent = 0;
695 : : uint16_t nb_segs_arr[MAX_TX_PACKETS];
696 : :
697 : : if (nb_pkts > MAX_TX_PACKETS)
698 : : nb_pkts = MAX_TX_PACKETS;
699 : :
700 : : /*
701 : : * count all segments needed to contain all packets in vq buffers
702 : : */
703 [ # # ]: 0 : for (i = 0; i < nb_pkts; i++) {
704 : : /* build the num segments array for segmentation control and release function */
705 [ # # ]: 0 : int vq_segs = NUM_VQ_SEGS(bufs[i]->pkt_len);
706 : 0 : nb_segs_arr[i] = vq_segs;
707 : 0 : nb_segs += vq_segs;
708 : : }
709 : :
710 [ # # ]: 0 : if (!nb_segs)
711 : 0 : goto exit_out;
712 : :
713 [ # # ]: 0 : if (sg_ops == NULL)
714 : 0 : goto exit_out;
715 : :
716 : 0 : int got_nb_segs = sg_ops->nthw_get_tx_packets(tx_q->vq, nb_segs, &first_vq_descr_idx,
717 : : &cvq_desc /*&vq_descr,*/, &vq_bufs);
718 : :
719 [ # # ]: 0 : if (!got_nb_segs)
720 : 0 : goto exit_out;
721 : :
722 : : /*
723 : : * we may get less vq buffers than we have asked for
724 : : * calculate last whole packet that can fit into what
725 : : * we have got
726 : : */
727 [ # # ]: 0 : while (got_nb_segs < nb_segs) {
728 [ # # ]: 0 : if (!--nb_pkts)
729 : 0 : goto exit_out;
730 : :
731 [ # # ]: 0 : nb_segs -= NUM_VQ_SEGS(bufs[nb_pkts]->pkt_len);
732 : :
733 [ # # ]: 0 : if (nb_segs <= 0)
734 : 0 : goto exit_out;
735 : : }
736 : :
737 : : /*
738 : : * nb_pkts & nb_segs, got it all, ready to copy
739 : : */
740 : : int seg_idx = 0;
741 : : int last_seg_idx = seg_idx;
742 : :
743 [ # # ]: 0 : for (pkt = 0; pkt < nb_pkts; ++pkt) {
744 : 0 : uint16_t vq_descr_idx = VIRTQ_DESCR_IDX(seg_idx);
745 : :
746 [ # # # # ]: 0 : vq_set_flags(&cvq_desc, vq_descr_idx, 0);
747 [ # # ]: 0 : vq_set_next(&cvq_desc, vq_descr_idx, 0);
748 : :
749 [ # # # # ]: 0 : if (bufs[pkt]->nb_segs == 1 && nb_segs_arr[pkt] == 1) {
750 : 0 : rte_memcpy((void *)((char *)vq_bufs[vq_descr_idx].virt_addr + SG_HDR_SIZE),
751 [ # # ]: 0 : rte_pktmbuf_mtod(bufs[pkt], void *), bufs[pkt]->pkt_len);
752 : :
753 : 0 : cvq_desc.b[vq_descr_idx].len = bufs[pkt]->pkt_len + SG_HDR_SIZE;
754 : :
755 : 0 : seg_idx++;
756 : :
757 : : } else {
758 : 0 : int cpy_segs = copy_mbuf_to_virtqueue(&cvq_desc, vq_descr_idx, vq_bufs,
759 : : nb_segs - last_seg_idx, bufs[pkt]);
760 : :
761 [ # # ]: 0 : if (cpy_segs < 0)
762 : : break;
763 : :
764 : 0 : seg_idx += cpy_segs;
765 : : }
766 : :
767 : : last_seg_idx = seg_idx;
768 : 0 : rte_pktmbuf_free(bufs[pkt]);
769 : 0 : pkts_sent++;
770 : : }
771 : :
772 : 0 : exit_out:
773 : :
774 [ # # ]: 0 : if (sg_ops != NULL) {
775 [ # # ]: 0 : if (pkts_sent)
776 : 0 : sg_ops->nthw_release_tx_packets(tx_q->vq, pkts_sent, nb_segs_arr);
777 : : }
778 : :
779 : 0 : return pkts_sent;
780 : : }
781 : :
782 : 0 : static int allocate_hw_virtio_queues(struct rte_eth_dev *eth_dev, int vf_num, struct hwq_s *hwq,
783 : : int num_descr, int buf_size)
784 : : {
785 : : int i, res;
786 : : uint32_t size;
787 : : uint64_t iova_addr;
788 : :
789 : 0 : NT_LOG(DBG, NTNIC, "***** Configure IOMMU for HW queues on VF %i *****", vf_num);
790 : :
791 : : /* Just allocate 1MB to hold all combined descr rings */
792 : 0 : uint64_t tot_alloc_size = 0x100000 + (uint64_t)buf_size * (uint64_t)num_descr;
793 : :
794 : : void *virt =
795 : 0 : rte_malloc_socket("VirtQDescr", tot_alloc_size, nt_util_align_size(tot_alloc_size),
796 : 0 : eth_dev->data->numa_node);
797 : :
798 [ # # ]: 0 : if (!virt)
799 : : return -1;
800 : :
801 : 0 : uint64_t gp_offset = (uint64_t)virt & ONE_G_MASK;
802 : 0 : rte_iova_t hpa = rte_malloc_virt2iova(virt);
803 : :
804 : 0 : NT_LOG(DBG, NTNIC, "Allocated virtio descr rings : virt "
805 : : "%p [0x%" PRIX64 "],hpa %" PRIX64 " [0x%" PRIX64 "]",
806 : : virt, gp_offset, hpa, hpa & ONE_G_MASK);
807 : :
808 : : /*
809 : : * Same offset on both HPA and IOVA
810 : : * Make sure 1G boundary is never crossed
811 : : */
812 [ # # ]: 0 : if (((hpa & ONE_G_MASK) != gp_offset) ||
813 [ # # ]: 0 : (((uint64_t)virt + tot_alloc_size) & ~ONE_G_MASK) !=
814 : : ((uint64_t)virt & ~ONE_G_MASK)) {
815 : 0 : NT_LOG(ERR, NTNIC, "*********************************************************");
816 : 0 : NT_LOG(ERR, NTNIC, "ERROR, no optimal IOMMU mapping available hpa: %016" PRIX64
817 : : "(%016" PRIX64 "), gp_offset: %016" PRIX64 " size: %" PRIu64,
818 : : hpa, hpa & ONE_G_MASK, gp_offset, tot_alloc_size);
819 : 0 : NT_LOG(ERR, NTNIC, "*********************************************************");
820 : :
821 : 0 : rte_free(virt);
822 : :
823 : : /* Just allocate 1MB to hold all combined descr rings */
824 : : size = 0x100000;
825 : 0 : void *virt = rte_malloc_socket("VirtQDescr", size, 4096, eth_dev->data->numa_node);
826 : :
827 [ # # ]: 0 : if (!virt)
828 : : return -1;
829 : :
830 : 0 : res = nt_vfio_dma_map(vf_num, virt, &iova_addr, size);
831 : :
832 : 0 : NT_LOG(DBG, NTNIC, "VFIO MMAP res %i, vf_num %i", res, vf_num);
833 : :
834 [ # # ]: 0 : if (res != 0)
835 : : return -1;
836 : :
837 : 0 : hwq->vf_num = vf_num;
838 : 0 : hwq->virt_queues_ctrl.virt_addr = virt;
839 : 0 : hwq->virt_queues_ctrl.phys_addr = (void *)iova_addr;
840 : 0 : hwq->virt_queues_ctrl.len = size;
841 : :
842 : 0 : NT_LOG(DBG, NTNIC,
843 : : "Allocated for virtio descr rings combined 1MB : %p, IOVA %016" PRIX64 "",
844 : : virt, iova_addr);
845 : :
846 : 0 : size = num_descr * sizeof(struct nthw_memory_descriptor);
847 : 0 : hwq->pkt_buffers =
848 : 0 : rte_zmalloc_socket("rx_pkt_buffers", size, 64, eth_dev->data->numa_node);
849 : :
850 [ # # ]: 0 : if (!hwq->pkt_buffers) {
851 : 0 : NT_LOG(ERR, NTNIC,
852 : : "Failed to allocated buffer array for hw-queue %p, total size %"
853 : : PRIu32 ", elements %i",
854 : : hwq->pkt_buffers, size, num_descr);
855 : 0 : rte_free(virt);
856 : 0 : return -1;
857 : : }
858 : :
859 : 0 : size = buf_size * num_descr;
860 : : void *virt_addr =
861 : 0 : rte_malloc_socket("pkt_buffer_pkts", size, 4096, eth_dev->data->numa_node);
862 : :
863 [ # # ]: 0 : if (!virt_addr) {
864 : 0 : NT_LOG(ERR, NTNIC,
865 : : "Failed allocate packet buffers for hw-queue %p, buf size %i, elements %i",
866 : : hwq->pkt_buffers, buf_size, num_descr);
867 : 0 : rte_free(hwq->pkt_buffers);
868 : 0 : rte_free(virt);
869 : 0 : return -1;
870 : : }
871 : :
872 : 0 : res = nt_vfio_dma_map(vf_num, virt_addr, &iova_addr, size);
873 : :
874 : 0 : NT_LOG(DBG, NTNIC,
875 : : "VFIO MMAP res %i, virt %p, iova %016"
876 : : PRIX64 ", vf_num %i, num pkt bufs %i, tot size %" PRIu32 "",
877 : : res, virt_addr, iova_addr, vf_num, num_descr, size);
878 : :
879 [ # # ]: 0 : if (res != 0)
880 : : return -1;
881 : :
882 : 0 : hwq->pkt_buffers_ctrl.virt_addr = virt_addr;
883 : 0 : hwq->pkt_buffers_ctrl.phys_addr = (void *)iova_addr;
884 : 0 : hwq->pkt_buffers_ctrl.len = size;
885 : :
886 [ # # ]: 0 : for (i = 0; i < num_descr; i++) {
887 : 0 : hwq->pkt_buffers[i].virt_addr =
888 : 0 : (void *)((char *)virt_addr + ((uint64_t)(i) * buf_size));
889 : 0 : hwq->pkt_buffers[i].phys_addr =
890 : 0 : (void *)(iova_addr + ((uint64_t)(i) * buf_size));
891 : 0 : hwq->pkt_buffers[i].len = buf_size;
892 : : }
893 : :
894 : : return 0;
895 : : } /* End of: no optimal IOMMU mapping available */
896 : :
897 : 0 : res = nt_vfio_dma_map(vf_num, virt, &iova_addr, ONE_G_SIZE);
898 : :
899 [ # # ]: 0 : if (res != 0) {
900 : 0 : NT_LOG(ERR, NTNIC, "VFIO MMAP FAILED! res %i, vf_num %i", res, vf_num);
901 : 0 : return -1;
902 : : }
903 : :
904 : 0 : hwq->vf_num = vf_num;
905 : 0 : hwq->virt_queues_ctrl.virt_addr = virt;
906 : 0 : hwq->virt_queues_ctrl.phys_addr = (void *)(iova_addr);
907 : 0 : hwq->virt_queues_ctrl.len = ONE_G_SIZE;
908 : 0 : iova_addr += 0x100000;
909 : :
910 : 0 : hwq->pkt_buffers_ctrl.virt_addr = NULL;
911 : 0 : hwq->pkt_buffers_ctrl.phys_addr = NULL;
912 : 0 : hwq->pkt_buffers_ctrl.len = 0;
913 : :
914 : 0 : NT_LOG(DBG, NTNIC,
915 : : "VFIO MMAP: virt_addr=%p phys_addr=%p size=%" PRIX32 " hpa=%" PRIX64 "",
916 : : hwq->virt_queues_ctrl.virt_addr, hwq->virt_queues_ctrl.phys_addr,
917 : : hwq->virt_queues_ctrl.len, rte_malloc_virt2iova(hwq->virt_queues_ctrl.virt_addr));
918 : :
919 : 0 : size = num_descr * sizeof(struct nthw_memory_descriptor);
920 : 0 : hwq->pkt_buffers =
921 : 0 : rte_zmalloc_socket("rx_pkt_buffers", size, 64, eth_dev->data->numa_node);
922 : :
923 [ # # ]: 0 : if (!hwq->pkt_buffers) {
924 : 0 : NT_LOG(ERR, NTNIC,
925 : : "Failed to allocated buffer array for hw-queue %p, total size %"
926 : : PRIu32 ", elements %i",
927 : : hwq->pkt_buffers, size, num_descr);
928 : 0 : rte_free(virt);
929 : 0 : return -1;
930 : : }
931 : :
932 : 0 : void *virt_addr = (void *)((uint64_t)virt + 0x100000);
933 : :
934 [ # # ]: 0 : for (i = 0; i < num_descr; i++) {
935 : 0 : hwq->pkt_buffers[i].virt_addr =
936 : 0 : (void *)((char *)virt_addr + ((uint64_t)(i) * buf_size));
937 : 0 : hwq->pkt_buffers[i].phys_addr = (void *)(iova_addr + ((uint64_t)(i) * buf_size));
938 : 0 : hwq->pkt_buffers[i].len = buf_size;
939 : : }
940 : :
941 : : return 0;
942 : : }
943 : :
944 : : static void release_hw_virtio_queues(struct hwq_s *hwq)
945 : : {
946 [ # # # # : 0 : if (!hwq || hwq->vf_num == 0)
# # ]
947 : : return;
948 : :
949 : 0 : hwq->vf_num = 0;
950 : : }
951 : :
952 : 0 : static int deallocate_hw_virtio_queues(struct hwq_s *hwq)
953 : : {
954 : 0 : int vf_num = hwq->vf_num;
955 : :
956 : 0 : void *virt = hwq->virt_queues_ctrl.virt_addr;
957 : :
958 : 0 : int res = nt_vfio_dma_unmap(vf_num, hwq->virt_queues_ctrl.virt_addr,
959 : 0 : (uint64_t)hwq->virt_queues_ctrl.phys_addr, hwq->virt_queues_ctrl.len);
960 : :
961 [ # # ]: 0 : if (res != 0) {
962 : 0 : NT_LOG(ERR, NTNIC, "VFIO UNMMAP FAILED! res %i, vf_num %i", res, vf_num);
963 : 0 : return -1;
964 : : }
965 : :
966 [ # # ]: 0 : if (hwq->pkt_buffers_ctrl.virt_addr != NULL &&
967 [ # # ]: 0 : hwq->pkt_buffers_ctrl.phys_addr != NULL &&
968 [ # # ]: 0 : hwq->pkt_buffers_ctrl.len > 0) {
969 : 0 : int res = nt_vfio_dma_unmap(vf_num,
970 : : hwq->pkt_buffers_ctrl.virt_addr,
971 : : (uint64_t)hwq->pkt_buffers_ctrl.phys_addr,
972 : : hwq->pkt_buffers_ctrl.len);
973 : :
974 [ # # ]: 0 : if (res != 0) {
975 : 0 : NT_LOG(ERR, NTNIC, "VFIO UNMMAP FAILED! res %i, vf_num %i", res, vf_num);
976 : 0 : return -1;
977 : : }
978 : : }
979 : :
980 : : release_hw_virtio_queues(hwq);
981 : 0 : rte_free(hwq->pkt_buffers);
982 : 0 : rte_free(virt);
983 : 0 : return 0;
984 : : }
985 : :
986 : 0 : static void eth_tx_queue_release(struct rte_eth_dev *eth_dev, uint16_t queue_id)
987 : : {
988 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
989 : 0 : struct ntnic_tx_queue *tx_q = &internals->txq_scg[queue_id];
990 : 0 : deallocate_hw_virtio_queues(&tx_q->hwq);
991 : 0 : }
992 : :
993 : 0 : static void eth_rx_queue_release(struct rte_eth_dev *eth_dev, uint16_t queue_id)
994 : : {
995 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
996 : 0 : struct ntnic_rx_queue *rx_q = &internals->rxq_scg[queue_id];
997 : 0 : deallocate_hw_virtio_queues(&rx_q->hwq);
998 : 0 : }
999 : :
1000 : : static int num_queues_allocated;
1001 : :
1002 : : /* Returns num queue starting at returned queue num or -1 on fail */
1003 : 0 : static int allocate_queue(int num)
1004 : : {
1005 : 0 : int next_free = num_queues_allocated;
1006 : 0 : NT_LOG_DBGX(DBG, NTNIC, "num_queues_allocated=%i, New queues=%i, Max queues=%d",
1007 : : num_queues_allocated, num, MAX_TOTAL_QUEUES);
1008 : :
1009 [ # # ]: 0 : if (num_queues_allocated + num > MAX_TOTAL_QUEUES)
1010 : : return -1;
1011 : :
1012 : 0 : num_queues_allocated += num;
1013 : 0 : return next_free;
1014 : : }
1015 : :
1016 : 0 : static int eth_rx_scg_queue_setup(struct rte_eth_dev *eth_dev,
1017 : : uint16_t rx_queue_id,
1018 : : uint16_t nb_rx_desc __rte_unused,
1019 : : unsigned int socket_id __rte_unused,
1020 : : const struct rte_eth_rxconf *rx_conf,
1021 : : struct rte_mempool *mb_pool)
1022 : : {
1023 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Rx queue setup");
1024 : : struct rte_pktmbuf_pool_private *mbp_priv;
1025 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1026 : 0 : struct ntnic_rx_queue *rx_q = &internals->rxq_scg[rx_queue_id];
1027 : 0 : struct drv_s *p_drv = internals->p_drv;
1028 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1029 : :
1030 [ # # ]: 0 : if (sg_ops == NULL) {
1031 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
1032 : 0 : return 0;
1033 : : }
1034 : :
1035 [ # # ]: 0 : if (internals->type == PORT_TYPE_OVERRIDE) {
1036 : 0 : rx_q->mb_pool = mb_pool;
1037 : 0 : eth_dev->data->rx_queues[rx_queue_id] = rx_q;
1038 [ # # ]: 0 : mbp_priv = rte_mempool_get_priv(rx_q->mb_pool);
1039 : 0 : rx_q->buf_size = (uint16_t)(mbp_priv->mbuf_data_room_size - RTE_PKTMBUF_HEADROOM);
1040 : 0 : rx_q->enabled = 1;
1041 : 0 : return 0;
1042 : : }
1043 : :
1044 : 0 : NT_LOG(DBG, NTNIC, "(%" PRIu32 ") NTNIC RX OVS-SW queue setup: queue id %"
1045 : : PRIu16 ", hw queue index %i",
1046 : : internals->port, rx_queue_id, rx_q->queue.hw_id);
1047 : :
1048 : 0 : rx_q->mb_pool = mb_pool;
1049 : :
1050 : 0 : eth_dev->data->rx_queues[rx_queue_id] = rx_q;
1051 : :
1052 [ # # ]: 0 : mbp_priv = rte_mempool_get_priv(rx_q->mb_pool);
1053 : 0 : rx_q->buf_size = (uint16_t)(mbp_priv->mbuf_data_room_size - RTE_PKTMBUF_HEADROOM);
1054 : 0 : rx_q->enabled = !rx_conf->rx_deferred_start;
1055 : 0 : rx_q->rx_deferred_start = rx_conf->rx_deferred_start;
1056 : :
1057 [ # # ]: 0 : if (allocate_hw_virtio_queues(eth_dev, EXCEPTION_PATH_HID, &rx_q->hwq,
1058 : : SG_NB_HW_RX_DESCRIPTORS, SG_HW_RX_PKT_BUFFER_SIZE) < 0)
1059 : : return -1;
1060 : :
1061 : 0 : rx_q->nb_hw_rx_descr = SG_NB_HW_RX_DESCRIPTORS;
1062 : :
1063 : 0 : rx_q->profile = p_drv->ntdrv.adapter_info.fpga_info.profile;
1064 : :
1065 : 0 : rx_q->vq =
1066 : 0 : sg_ops->nthw_setup_mngd_rx_virt_queue(p_nt_drv->adapter_info.fpga_info.mp_nthw_dbs,
1067 : 0 : rx_q->queue.hw_id, /* index */
1068 : : rx_q->nb_hw_rx_descr,
1069 : : EXCEPTION_PATH_HID, /* host_id */
1070 : : 1, /* header NT DVIO header for exception path */
1071 : : &rx_q->hwq.virt_queues_ctrl,
1072 : : rx_q->hwq.pkt_buffers,
1073 : : SPLIT_RING,
1074 : : -1,
1075 : 0 : rx_conf->rx_deferred_start);
1076 : :
1077 : 0 : NT_LOG(DBG, NTNIC, "(%" PRIu32 ") NTNIC RX OVS-SW queues successfully setup",
1078 : : internals->port);
1079 : :
1080 : 0 : return 0;
1081 : : }
1082 : :
1083 : 0 : static int eth_tx_scg_queue_setup(struct rte_eth_dev *eth_dev,
1084 : : uint16_t tx_queue_id,
1085 : : uint16_t nb_tx_desc __rte_unused,
1086 : : unsigned int socket_id __rte_unused,
1087 : : const struct rte_eth_txconf *tx_conf)
1088 : : {
1089 : 0 : const struct port_ops *port_ops = get_port_ops();
1090 : :
1091 [ # # ]: 0 : if (port_ops == NULL) {
1092 : 0 : NT_LOG_DBGX(ERR, NTNIC, "Link management module uninitialized");
1093 : 0 : return -1;
1094 : : }
1095 : :
1096 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Tx queue setup");
1097 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1098 : 0 : struct drv_s *p_drv = internals->p_drv;
1099 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1100 : 0 : struct ntnic_tx_queue *tx_q = &internals->txq_scg[tx_queue_id];
1101 : :
1102 [ # # ]: 0 : if (internals->type == PORT_TYPE_OVERRIDE) {
1103 : 0 : eth_dev->data->tx_queues[tx_queue_id] = tx_q;
1104 : 0 : return 0;
1105 : : }
1106 : :
1107 [ # # ]: 0 : if (sg_ops == NULL) {
1108 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
1109 : 0 : return 0;
1110 : : }
1111 : :
1112 : 0 : NT_LOG(DBG, NTNIC, "(%" PRIu32 ") NTNIC TX OVS-SW queue setup: queue id %" PRIu16 ", hw queue index %i",
1113 : : tx_q->port, tx_queue_id, tx_q->queue.hw_id);
1114 : :
1115 [ # # ]: 0 : if (tx_queue_id > internals->nb_tx_queues) {
1116 : 0 : NT_LOG(ERR, NTNIC, "Error invalid tx queue id");
1117 : 0 : return -1;
1118 : : }
1119 : :
1120 : 0 : eth_dev->data->tx_queues[tx_queue_id] = tx_q;
1121 : :
1122 : : /* Calculate target ID for HW - to be used in NTDVIO0 header bypass_port */
1123 [ # # ]: 0 : if (tx_q->rss_target_id >= 0) {
1124 : : /* bypass to a multiqueue port - qsl-hsh index */
1125 : 0 : tx_q->target_id = tx_q->rss_target_id + 0x90;
1126 : :
1127 [ # # ]: 0 : } else if (internals->vpq[tx_queue_id].hw_id > -1) {
1128 : : /* virtual port - queue index */
1129 : 0 : tx_q->target_id = internals->vpq[tx_queue_id].hw_id;
1130 : :
1131 : : } else {
1132 : : /* Phy port - phy port identifier */
1133 : : /* output/bypass to MAC */
1134 : 0 : tx_q->target_id = (int)(tx_q->port + 0x80);
1135 : : }
1136 : :
1137 [ # # ]: 0 : if (allocate_hw_virtio_queues(eth_dev, EXCEPTION_PATH_HID, &tx_q->hwq,
1138 : : SG_NB_HW_TX_DESCRIPTORS, SG_HW_TX_PKT_BUFFER_SIZE) < 0) {
1139 : : return -1;
1140 : : }
1141 : :
1142 : 0 : tx_q->nb_hw_tx_descr = SG_NB_HW_TX_DESCRIPTORS;
1143 : :
1144 : 0 : tx_q->profile = p_drv->ntdrv.adapter_info.fpga_info.profile;
1145 : :
1146 : : uint32_t port, header;
1147 : 0 : port = tx_q->port; /* transmit port */
1148 : : header = 0; /* header type VirtIO-Net */
1149 : :
1150 : 0 : tx_q->vq =
1151 : 0 : sg_ops->nthw_setup_mngd_tx_virt_queue(p_nt_drv->adapter_info.fpga_info.mp_nthw_dbs,
1152 : 0 : tx_q->queue.hw_id, /* index */
1153 : : tx_q->nb_hw_tx_descr, /* queue size */
1154 : : EXCEPTION_PATH_HID, /* host_id always VF4 */
1155 : : port,
1156 : : /*
1157 : : * in_port - in vswitch mode has
1158 : : * to move tx port from OVS excep.
1159 : : * away from VM tx port,
1160 : : * because of QoS is matched by port id!
1161 : : */
1162 : : tx_q->port + 128,
1163 : : header,
1164 : : &tx_q->hwq.virt_queues_ctrl,
1165 : : tx_q->hwq.pkt_buffers,
1166 : : SPLIT_RING,
1167 : : -1,
1168 : : IN_ORDER,
1169 : 0 : tx_conf->tx_deferred_start);
1170 : :
1171 : 0 : tx_q->enabled = !tx_conf->tx_deferred_start;
1172 : 0 : tx_q->tx_deferred_start = tx_conf->tx_deferred_start;
1173 : :
1174 : 0 : NT_LOG(DBG, NTNIC, "(%" PRIu32 ") NTNIC TX OVS-SW queues successfully setup",
1175 : : internals->port);
1176 : :
1177 [ # # ]: 0 : if (internals->type == PORT_TYPE_PHYSICAL) {
1178 : 0 : struct adapter_info_s *p_adapter_info = &internals->p_drv->ntdrv.adapter_info;
1179 : 0 : NT_LOG(DBG, NTNIC, "Port %i is ready for data. Enable port",
1180 : : internals->n_intf_no);
1181 : 0 : port_ops->set_adm_state(p_adapter_info, internals->n_intf_no, true);
1182 : : }
1183 : :
1184 : : return 0;
1185 : : }
1186 : :
1187 : 0 : static int dev_set_mtu_inline(struct rte_eth_dev *eth_dev, uint16_t mtu)
1188 : : {
1189 : 0 : const struct profile_inline_ops *profile_inline_ops = get_profile_inline_ops();
1190 : :
1191 [ # # ]: 0 : if (profile_inline_ops == NULL) {
1192 : 0 : NT_LOG_DBGX(ERR, NTNIC, "profile_inline module uninitialized");
1193 : 0 : return -1;
1194 : : }
1195 : :
1196 : 0 : struct pmd_internals *internals = (struct pmd_internals *)eth_dev->data->dev_private;
1197 : :
1198 : 0 : struct flow_eth_dev *flw_dev = internals->flw_dev;
1199 : : int ret = -1;
1200 : :
1201 [ # # # # ]: 0 : if (internals->type == PORT_TYPE_PHYSICAL && mtu >= MIN_MTU_INLINE && mtu <= MAX_MTU)
1202 : 0 : ret = profile_inline_ops->flow_set_mtu_inline(flw_dev, internals->port, mtu);
1203 : :
1204 [ # # ]: 0 : return ret ? -EINVAL : 0;
1205 : : }
1206 : :
1207 : 0 : static int eth_rx_queue_start(struct rte_eth_dev *eth_dev, uint16_t rx_queue_id)
1208 : : {
1209 [ # # ]: 0 : if (sg_ops == NULL) {
1210 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
1211 : 0 : return -1;
1212 : : }
1213 : :
1214 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1215 : 0 : struct drv_s *p_drv = internals->p_drv;
1216 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1217 : 0 : nthw_dbs_t *p_nthw_dbs = p_nt_drv->adapter_info.fpga_info.mp_nthw_dbs;
1218 : 0 : struct ntnic_rx_queue *rx_q = &internals->rxq_scg[rx_queue_id];
1219 : 0 : int index = rx_q->queue.hw_id;
1220 : :
1221 [ # # ]: 0 : if (sg_ops->nthw_switch_rx_virt_queue(p_nthw_dbs, index, 1) != 0) {
1222 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Failed to start Rx queue #%d", index);
1223 : 0 : return -1;
1224 : : }
1225 : :
1226 : 0 : rx_q->enabled = 1;
1227 : 0 : eth_dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
1228 : 0 : return 0;
1229 : : }
1230 : :
1231 : 0 : static int eth_rx_queue_stop(struct rte_eth_dev *eth_dev, uint16_t rx_queue_id)
1232 : : {
1233 [ # # ]: 0 : if (sg_ops == NULL) {
1234 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
1235 : 0 : return -1;
1236 : : }
1237 : :
1238 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1239 : 0 : struct drv_s *p_drv = internals->p_drv;
1240 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1241 : 0 : nthw_dbs_t *p_nthw_dbs = p_nt_drv->adapter_info.fpga_info.mp_nthw_dbs;
1242 : 0 : struct ntnic_rx_queue *rx_q = &internals->rxq_scg[rx_queue_id];
1243 : 0 : int index = rx_q->queue.hw_id;
1244 : :
1245 [ # # ]: 0 : if (sg_ops->nthw_switch_rx_virt_queue(p_nthw_dbs, index, 0) != 0) {
1246 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Failed to stop Rx queue #%d", index);
1247 : 0 : return -1;
1248 : : }
1249 : :
1250 : 0 : rx_q->enabled = 0;
1251 : 0 : eth_dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
1252 : 0 : return 0;
1253 : : }
1254 : :
1255 : 0 : static int eth_tx_queue_start(struct rte_eth_dev *eth_dev, uint16_t tx_queue_id)
1256 : : {
1257 [ # # ]: 0 : if (sg_ops == NULL) {
1258 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
1259 : 0 : return -1;
1260 : : }
1261 : :
1262 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1263 : 0 : struct drv_s *p_drv = internals->p_drv;
1264 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1265 : 0 : nthw_dbs_t *p_nthw_dbs = p_nt_drv->adapter_info.fpga_info.mp_nthw_dbs;
1266 : 0 : struct ntnic_tx_queue *tx_q = &internals->txq_scg[tx_queue_id];
1267 : 0 : int index = tx_q->queue.hw_id;
1268 : :
1269 [ # # ]: 0 : if (sg_ops->nthw_switch_tx_virt_queue(p_nthw_dbs, index, 1) != 0) {
1270 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Failed to start Tx queue #%d", index);
1271 : 0 : return -1;
1272 : : }
1273 : :
1274 : 0 : tx_q->enabled = 1;
1275 : 0 : eth_dev->data->tx_queue_state[tx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
1276 : 0 : return 0;
1277 : : }
1278 : :
1279 : 0 : static int eth_tx_queue_stop(struct rte_eth_dev *eth_dev, uint16_t tx_queue_id)
1280 : : {
1281 [ # # ]: 0 : if (sg_ops == NULL) {
1282 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
1283 : 0 : return -1;
1284 : : }
1285 : :
1286 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1287 : 0 : struct drv_s *p_drv = internals->p_drv;
1288 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1289 : 0 : nthw_dbs_t *p_nthw_dbs = p_nt_drv->adapter_info.fpga_info.mp_nthw_dbs;
1290 : 0 : struct ntnic_tx_queue *tx_q = &internals->txq_scg[tx_queue_id];
1291 : 0 : int index = tx_q->queue.hw_id;
1292 : :
1293 [ # # ]: 0 : if (sg_ops->nthw_switch_tx_virt_queue(p_nthw_dbs, index, 0) != 0) {
1294 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Failed to stop Tx queue #%d", index);
1295 : 0 : return -1;
1296 : : }
1297 : :
1298 : 0 : tx_q->enabled = 0;
1299 : 0 : eth_dev->data->tx_queue_state[tx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
1300 : 0 : return 0;
1301 : : }
1302 : :
1303 : : static int
1304 : 0 : eth_mac_addr_add(struct rte_eth_dev *eth_dev,
1305 : : struct rte_ether_addr *mac_addr,
1306 : : uint32_t index,
1307 : : uint32_t vmdq __rte_unused)
1308 : : {
1309 : 0 : struct rte_ether_addr *const eth_addrs = eth_dev->data->mac_addrs;
1310 : :
1311 : : RTE_ASSERT(index < NUM_MAC_ADDRS_PER_PORT);
1312 : :
1313 [ # # ]: 0 : if (index >= NUM_MAC_ADDRS_PER_PORT) {
1314 : 0 : const struct pmd_internals *const internals =
1315 : : eth_dev->data->dev_private;
1316 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Port %i: illegal index %u (>= %u)",
1317 : : internals->n_intf_no, index, NUM_MAC_ADDRS_PER_PORT);
1318 : 0 : return -1;
1319 : : }
1320 : :
1321 : 0 : eth_addrs[index] = *mac_addr;
1322 : :
1323 : 0 : return 0;
1324 : : }
1325 : :
1326 : : static int
1327 : 0 : eth_mac_addr_set(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr)
1328 : : {
1329 : 0 : struct rte_ether_addr *const eth_addrs = dev->data->mac_addrs;
1330 : :
1331 : 0 : eth_addrs[0U] = *mac_addr;
1332 : :
1333 : 0 : return 0;
1334 : : }
1335 : :
1336 : : static int
1337 : 0 : eth_set_mc_addr_list(struct rte_eth_dev *eth_dev,
1338 : : struct rte_ether_addr *mc_addr_set,
1339 : : uint32_t nb_mc_addr)
1340 : : {
1341 : 0 : struct pmd_internals *const internals = eth_dev->data->dev_private;
1342 : 0 : struct rte_ether_addr *const mc_addrs = internals->mc_addrs;
1343 : : size_t i;
1344 : :
1345 [ # # ]: 0 : if (nb_mc_addr >= NUM_MULTICAST_ADDRS_PER_PORT) {
1346 : 0 : NT_LOG_DBGX(DBG, NTNIC,
1347 : : "Port %i: too many multicast addresses %u (>= %u)",
1348 : : internals->n_intf_no, nb_mc_addr, NUM_MULTICAST_ADDRS_PER_PORT);
1349 : 0 : return -1;
1350 : : }
1351 : :
1352 [ # # ]: 0 : for (i = 0U; i < NUM_MULTICAST_ADDRS_PER_PORT; i++)
1353 [ # # ]: 0 : if (i < nb_mc_addr)
1354 : 0 : mc_addrs[i] = mc_addr_set[i];
1355 : :
1356 : : else
1357 : 0 : memset(&mc_addrs[i], 0, sizeof(mc_addrs[i]));
1358 : :
1359 : : return 0;
1360 : : }
1361 : :
1362 : : static int
1363 : 0 : eth_dev_configure(struct rte_eth_dev *eth_dev)
1364 : : {
1365 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Called for eth_dev %p", eth_dev);
1366 : :
1367 : : /* The device is ALWAYS running promiscuous mode. */
1368 : 0 : eth_dev->data->promiscuous ^= ~eth_dev->data->promiscuous;
1369 : 0 : return 0;
1370 : : }
1371 : :
1372 : : static int
1373 : 0 : eth_dev_start(struct rte_eth_dev *eth_dev)
1374 : : {
1375 : 0 : const struct port_ops *port_ops = get_port_ops();
1376 : :
1377 [ # # ]: 0 : if (port_ops == NULL) {
1378 : 0 : NT_LOG(ERR, NTNIC, "Link management module uninitialized");
1379 : 0 : return -1;
1380 : : }
1381 : :
1382 : 0 : eth_dev->flow_fp_ops = get_dev_fp_flow_ops();
1383 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1384 : :
1385 : 0 : const int n_intf_no = internals->n_intf_no;
1386 : 0 : struct adapter_info_s *p_adapter_info = &internals->p_drv->ntdrv.adapter_info;
1387 : :
1388 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Port %i", internals->n_intf_no);
1389 : :
1390 : : /* Start queues */
1391 : : uint q;
1392 : :
1393 [ # # ]: 0 : for (q = 0; q < internals->nb_rx_queues; q++)
1394 [ # # ]: 0 : if (!internals->rxq_scg[q].rx_deferred_start)
1395 : 0 : eth_rx_queue_start(eth_dev, q);
1396 : :
1397 [ # # ]: 0 : for (q = 0; q < internals->nb_tx_queues; q++)
1398 [ # # ]: 0 : if (!internals->txq_scg[q].tx_deferred_start)
1399 : 0 : eth_tx_queue_start(eth_dev, q);
1400 : :
1401 [ # # ]: 0 : if (internals->type == PORT_TYPE_VIRTUAL || internals->type == PORT_TYPE_OVERRIDE) {
1402 : 0 : eth_dev->data->dev_link.link_status = RTE_ETH_LINK_UP;
1403 : :
1404 : : } else {
1405 : : /* Enable the port */
1406 : 0 : port_ops->set_adm_state(p_adapter_info, internals->n_intf_no, true);
1407 : :
1408 : : /*
1409 : : * wait for link on port
1410 : : * If application starts sending too soon before FPGA port is ready, garbage is
1411 : : * produced
1412 : : */
1413 : : int loop = 0;
1414 : :
1415 [ # # ]: 0 : while (port_ops->get_link_status(p_adapter_info, n_intf_no) == RTE_ETH_LINK_DOWN) {
1416 : : /* break out after 5 sec */
1417 [ # # ]: 0 : if (++loop >= 50) {
1418 : 0 : NT_LOG_DBGX(DBG, NTNIC,
1419 : : "TIMEOUT No link on port %i (5sec timeout)",
1420 : : internals->n_intf_no);
1421 : 0 : break;
1422 : : }
1423 : :
1424 : 0 : nt_os_wait_usec(100 * 1000);
1425 : : }
1426 : :
1427 [ # # ]: 0 : if (internals->lpbk_mode) {
1428 [ # # ]: 0 : if (internals->lpbk_mode & 1 << 0) {
1429 : 0 : port_ops->set_loopback_mode(p_adapter_info, n_intf_no,
1430 : : NT_LINK_LOOPBACK_HOST);
1431 : : }
1432 : :
1433 [ # # ]: 0 : if (internals->lpbk_mode & 1 << 1) {
1434 : 0 : port_ops->set_loopback_mode(p_adapter_info, n_intf_no,
1435 : : NT_LINK_LOOPBACK_LINE);
1436 : : }
1437 : : }
1438 : : }
1439 : :
1440 : : return 0;
1441 : : }
1442 : :
1443 : : static int
1444 : 0 : eth_dev_stop(struct rte_eth_dev *eth_dev)
1445 : : {
1446 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1447 : :
1448 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Port %i", internals->n_intf_no);
1449 : :
1450 [ # # ]: 0 : if (internals->type != PORT_TYPE_VIRTUAL) {
1451 : : uint q;
1452 : :
1453 [ # # ]: 0 : for (q = 0; q < internals->nb_rx_queues; q++)
1454 : 0 : eth_rx_queue_stop(eth_dev, q);
1455 : :
1456 [ # # ]: 0 : for (q = 0; q < internals->nb_tx_queues; q++)
1457 : 0 : eth_tx_queue_stop(eth_dev, q);
1458 : : }
1459 : :
1460 : 0 : eth_dev->data->dev_link.link_status = RTE_ETH_LINK_DOWN;
1461 : 0 : return 0;
1462 : : }
1463 : :
1464 : : static int
1465 : 0 : eth_dev_set_link_up(struct rte_eth_dev *eth_dev)
1466 : : {
1467 : 0 : const struct port_ops *port_ops = get_port_ops();
1468 : :
1469 [ # # ]: 0 : if (port_ops == NULL) {
1470 : 0 : NT_LOG(ERR, NTNIC, "Link management module uninitialized");
1471 : 0 : return -1;
1472 : : }
1473 : :
1474 : 0 : struct pmd_internals *const internals = eth_dev->data->dev_private;
1475 : :
1476 : 0 : struct adapter_info_s *p_adapter_info = &internals->p_drv->ntdrv.adapter_info;
1477 : 0 : const int port = internals->n_intf_no;
1478 : :
1479 [ # # ]: 0 : if (internals->type == PORT_TYPE_VIRTUAL || internals->type == PORT_TYPE_OVERRIDE)
1480 : : return 0;
1481 : :
1482 : : RTE_ASSERT(port >= 0 && port < NUM_ADAPTER_PORTS_MAX);
1483 : :
1484 : 0 : port_ops->set_adm_state(p_adapter_info, port, true);
1485 : :
1486 : 0 : return 0;
1487 : : }
1488 : :
1489 : : static int
1490 : 0 : eth_dev_set_link_down(struct rte_eth_dev *eth_dev)
1491 : : {
1492 : 0 : const struct port_ops *port_ops = get_port_ops();
1493 : :
1494 [ # # ]: 0 : if (port_ops == NULL) {
1495 : 0 : NT_LOG(ERR, NTNIC, "Link management module uninitialized");
1496 : 0 : return -1;
1497 : : }
1498 : :
1499 : 0 : struct pmd_internals *const internals = eth_dev->data->dev_private;
1500 : :
1501 : 0 : struct adapter_info_s *p_adapter_info = &internals->p_drv->ntdrv.adapter_info;
1502 : 0 : const int port = internals->n_intf_no;
1503 : :
1504 [ # # ]: 0 : if (internals->type == PORT_TYPE_VIRTUAL || internals->type == PORT_TYPE_OVERRIDE)
1505 : : return 0;
1506 : :
1507 : : RTE_ASSERT(port >= 0 && port < NUM_ADAPTER_PORTS_MAX);
1508 : :
1509 : 0 : port_ops->set_link_status(p_adapter_info, port, false);
1510 : :
1511 : 0 : return 0;
1512 : : }
1513 : :
1514 : : static void
1515 : 0 : drv_deinit(struct drv_s *p_drv)
1516 : : {
1517 : 0 : const struct profile_inline_ops *profile_inline_ops = get_profile_inline_ops();
1518 : :
1519 [ # # ]: 0 : if (profile_inline_ops == NULL) {
1520 : 0 : NT_LOG_DBGX(ERR, NTNIC, "profile_inline module uninitialized");
1521 : 0 : return;
1522 : : }
1523 : :
1524 : 0 : const struct adapter_ops *adapter_ops = get_adapter_ops();
1525 : :
1526 [ # # ]: 0 : if (adapter_ops == NULL) {
1527 : 0 : NT_LOG(ERR, NTNIC, "Adapter module uninitialized");
1528 : 0 : return;
1529 : : }
1530 : :
1531 [ # # ]: 0 : if (p_drv == NULL)
1532 : : return;
1533 : :
1534 : 0 : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1535 : : fpga_info_t *fpga_info = &p_nt_drv->adapter_info.fpga_info;
1536 : :
1537 : : /*
1538 : : * Mark the global pdrv for cleared. Used by some threads to terminate.
1539 : : * 1 second to give the threads a chance to see the termonation.
1540 : : */
1541 : 0 : clear_pdrv(p_drv);
1542 : 0 : nt_os_wait_usec(1000000);
1543 : :
1544 : : /* stop statistics threads */
1545 : 0 : p_drv->ntdrv.b_shutdown = true;
1546 : 0 : THREAD_JOIN(p_nt_drv->stat_thread);
1547 : :
1548 [ # # ]: 0 : if (fpga_info->profile == FPGA_INFO_PROFILE_INLINE) {
1549 : 0 : THREAD_JOIN(p_nt_drv->flm_thread);
1550 : 0 : profile_inline_ops->flm_free_queues();
1551 : 0 : THREAD_JOIN(p_nt_drv->port_event_thread);
1552 : : /* Free all local flm event queues */
1553 : 0 : nthw_flm_inf_sta_queue_free_all(FLM_INFO_LOCAL);
1554 : : /* Free all remote flm event queues */
1555 : 0 : nthw_flm_inf_sta_queue_free_all(FLM_INFO_REMOTE);
1556 : : /* Free all aged flow event queues */
1557 : 0 : flm_age_queue_free_all();
1558 : : }
1559 : :
1560 : : /* stop adapter */
1561 : 0 : adapter_ops->deinit(&p_nt_drv->adapter_info);
1562 : :
1563 : : /* clean memory */
1564 : 0 : rte_free(p_drv);
1565 : : p_drv = NULL;
1566 : : }
1567 : :
1568 : : static int
1569 : 0 : eth_dev_close(struct rte_eth_dev *eth_dev)
1570 : : {
1571 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1572 : 0 : struct drv_s *p_drv = internals->p_drv;
1573 : :
1574 [ # # ]: 0 : if (internals->type != PORT_TYPE_VIRTUAL) {
1575 : 0 : struct ntnic_rx_queue *rx_q = internals->rxq_scg;
1576 : 0 : struct ntnic_tx_queue *tx_q = internals->txq_scg;
1577 : :
1578 : : uint q;
1579 : :
1580 [ # # ]: 0 : if (sg_ops != NULL) {
1581 [ # # ]: 0 : for (q = 0; q < internals->nb_rx_queues; q++)
1582 : 0 : sg_ops->nthw_release_mngd_rx_virt_queue(rx_q[q].vq);
1583 : :
1584 [ # # ]: 0 : for (q = 0; q < internals->nb_tx_queues; q++)
1585 : 0 : sg_ops->nthw_release_mngd_tx_virt_queue(tx_q[q].vq);
1586 : : }
1587 : : }
1588 : :
1589 : 0 : internals->p_drv = NULL;
1590 : :
1591 [ # # ]: 0 : if (p_drv) {
1592 : : /* decrease initialized ethernet devices */
1593 : 0 : p_drv->n_eth_dev_init_count--;
1594 : :
1595 : : /*
1596 : : * rte_pci_dev has no private member for p_drv
1597 : : * wait until all rte_eth_dev's are closed - then close adapters via p_drv
1598 : : */
1599 [ # # ]: 0 : if (!p_drv->n_eth_dev_init_count)
1600 : 0 : drv_deinit(p_drv);
1601 : : }
1602 : :
1603 : 0 : return 0;
1604 : : }
1605 : :
1606 : : static int
1607 : 0 : eth_fw_version_get(struct rte_eth_dev *eth_dev, char *fw_version, size_t fw_size)
1608 : : {
1609 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1610 : :
1611 [ # # ]: 0 : if (internals->type == PORT_TYPE_VIRTUAL || internals->type == PORT_TYPE_OVERRIDE)
1612 : : return 0;
1613 : :
1614 : 0 : fpga_info_t *fpga_info = &internals->p_drv->ntdrv.adapter_info.fpga_info;
1615 [ # # ]: 0 : const int length = snprintf(fw_version, fw_size, "%03d-%04d-%02d-%02d",
1616 : : fpga_info->n_fpga_type_id, fpga_info->n_fpga_prod_id,
1617 : : fpga_info->n_fpga_ver_id, fpga_info->n_fpga_rev_id);
1618 : :
1619 [ # # ]: 0 : if ((size_t)length < fw_size) {
1620 : : /* We have space for the version string */
1621 : : return 0;
1622 : :
1623 : : } else {
1624 : : /* We do not have space for the version string -return the needed space */
1625 : 0 : return length + 1;
1626 : : }
1627 : : }
1628 : :
1629 : 0 : static int dev_flow_ops_get(struct rte_eth_dev *dev __rte_unused, const struct rte_flow_ops **ops)
1630 : : {
1631 : 0 : *ops = get_dev_flow_ops();
1632 : 0 : return 0;
1633 : : }
1634 : :
1635 : 0 : static int eth_xstats_get(struct rte_eth_dev *eth_dev, struct rte_eth_xstat *stats, unsigned int n)
1636 : : {
1637 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1638 : 0 : struct drv_s *p_drv = internals->p_drv;
1639 : : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1640 : 0 : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
1641 : 0 : int n_intf_no = internals->n_intf_no;
1642 : : int nb_xstats;
1643 : :
1644 : 0 : const struct ntnic_xstats_ops *ntnic_xstats_ops = get_ntnic_xstats_ops();
1645 : :
1646 [ # # ]: 0 : if (ntnic_xstats_ops == NULL) {
1647 : 0 : NT_LOG(INF, NTNIC, "ntnic_xstats module not included");
1648 : 0 : return -1;
1649 : : }
1650 : :
1651 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
1652 : 0 : nb_xstats = ntnic_xstats_ops->nthw_xstats_get(p_nt4ga_stat, stats, n, n_intf_no);
1653 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
1654 : 0 : return nb_xstats;
1655 : : }
1656 : :
1657 : 0 : static int eth_xstats_get_by_id(struct rte_eth_dev *eth_dev,
1658 : : const uint64_t *ids,
1659 : : uint64_t *values,
1660 : : unsigned int n)
1661 : : {
1662 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1663 : 0 : struct drv_s *p_drv = internals->p_drv;
1664 : : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1665 : 0 : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
1666 : 0 : int n_intf_no = internals->n_intf_no;
1667 : : int nb_xstats;
1668 : :
1669 : 0 : const struct ntnic_xstats_ops *ntnic_xstats_ops = get_ntnic_xstats_ops();
1670 : :
1671 [ # # ]: 0 : if (ntnic_xstats_ops == NULL) {
1672 : 0 : NT_LOG(INF, NTNIC, "ntnic_xstats module not included");
1673 : 0 : return -1;
1674 : : }
1675 : :
1676 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
1677 : : nb_xstats =
1678 : 0 : ntnic_xstats_ops->nthw_xstats_get_by_id(p_nt4ga_stat, ids, values, n, n_intf_no);
1679 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
1680 : 0 : return nb_xstats;
1681 : : }
1682 : :
1683 : 0 : static int eth_xstats_reset(struct rte_eth_dev *eth_dev)
1684 : : {
1685 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1686 : 0 : struct drv_s *p_drv = internals->p_drv;
1687 : 0 : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1688 : 0 : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
1689 : 0 : int n_intf_no = internals->n_intf_no;
1690 : :
1691 : 0 : struct ntnic_xstats_ops *ntnic_xstats_ops = get_ntnic_xstats_ops();
1692 : :
1693 [ # # ]: 0 : if (ntnic_xstats_ops == NULL) {
1694 : 0 : NT_LOG(INF, NTNIC, "ntnic_xstats module not included");
1695 : 0 : return -1;
1696 : : }
1697 : :
1698 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
1699 : 0 : ntnic_xstats_ops->nthw_xstats_reset(p_nt4ga_stat, n_intf_no);
1700 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
1701 : 0 : return dpdk_stats_reset(internals, p_nt_drv, n_intf_no);
1702 : : }
1703 : :
1704 : 0 : static int eth_xstats_get_names(struct rte_eth_dev *eth_dev,
1705 : : struct rte_eth_xstat_name *xstats_names, unsigned int size)
1706 : : {
1707 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1708 : 0 : struct drv_s *p_drv = internals->p_drv;
1709 : : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1710 : 0 : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
1711 : :
1712 : 0 : const struct ntnic_xstats_ops *ntnic_xstats_ops = get_ntnic_xstats_ops();
1713 : :
1714 [ # # ]: 0 : if (ntnic_xstats_ops == NULL) {
1715 : 0 : NT_LOG(INF, NTNIC, "ntnic_xstats module not included");
1716 : 0 : return -1;
1717 : : }
1718 : :
1719 : 0 : return ntnic_xstats_ops->nthw_xstats_get_names(p_nt4ga_stat, xstats_names, size);
1720 : : }
1721 : :
1722 : 0 : static int eth_xstats_get_names_by_id(struct rte_eth_dev *eth_dev,
1723 : : const uint64_t *ids,
1724 : : struct rte_eth_xstat_name *xstats_names,
1725 : : unsigned int size)
1726 : : {
1727 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1728 : 0 : struct drv_s *p_drv = internals->p_drv;
1729 : : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1730 : 0 : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
1731 : 0 : const struct ntnic_xstats_ops *ntnic_xstats_ops = get_ntnic_xstats_ops();
1732 : :
1733 [ # # ]: 0 : if (ntnic_xstats_ops == NULL) {
1734 : 0 : NT_LOG(INF, NTNIC, "ntnic_xstats module not included");
1735 : 0 : return -1;
1736 : : }
1737 : :
1738 : 0 : return ntnic_xstats_ops->nthw_xstats_get_names_by_id(p_nt4ga_stat, xstats_names, ids,
1739 : : size);
1740 : : }
1741 : :
1742 : : static int
1743 : 0 : promiscuous_enable(struct rte_eth_dev __rte_unused(*dev))
1744 : : {
1745 : 0 : NT_LOG(DBG, NTHW, "The device always run promiscuous mode");
1746 : 0 : return 0;
1747 : : }
1748 : :
1749 : 0 : static int eth_dev_rss_hash_update(struct rte_eth_dev *eth_dev, struct rte_eth_rss_conf *rss_conf)
1750 : : {
1751 : 0 : const struct flow_filter_ops *flow_filter_ops = get_flow_filter_ops();
1752 : :
1753 [ # # ]: 0 : if (flow_filter_ops == NULL) {
1754 : 0 : NT_LOG_DBGX(ERR, NTNIC, "flow_filter module uninitialized");
1755 : 0 : return -1;
1756 : : }
1757 : :
1758 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1759 : :
1760 : 0 : struct flow_nic_dev *ndev = internals->flw_dev->ndev;
1761 : 0 : struct nt_eth_rss_conf tmp_rss_conf = { 0 };
1762 : : const int hsh_idx = 0; /* hsh index 0 means the default receipt in HSH module */
1763 : :
1764 [ # # ]: 0 : if (rss_conf->rss_key != NULL) {
1765 [ # # ]: 0 : if (rss_conf->rss_key_len > MAX_RSS_KEY_LEN) {
1766 : 0 : NT_LOG(ERR, NTNIC,
1767 : : "ERROR: - RSS hash key length %u exceeds maximum value %u",
1768 : : rss_conf->rss_key_len, MAX_RSS_KEY_LEN);
1769 : 0 : return -1;
1770 : : }
1771 : :
1772 [ # # ]: 0 : rte_memcpy(&tmp_rss_conf.rss_key, rss_conf->rss_key, rss_conf->rss_key_len);
1773 : : }
1774 : :
1775 : 0 : tmp_rss_conf.algorithm = rss_conf->algorithm;
1776 : :
1777 : 0 : tmp_rss_conf.rss_hf = rss_conf->rss_hf;
1778 : 0 : int res = hsh_set(ndev, hsh_idx, tmp_rss_conf);
1779 : :
1780 [ # # ]: 0 : if (res == 0) {
1781 : 0 : flow_filter_ops->hw_mod_hsh_rcp_flush(&ndev->be, hsh_idx, 1);
1782 [ # # ]: 0 : rte_memcpy(&ndev->rss_conf, &tmp_rss_conf, sizeof(struct nt_eth_rss_conf));
1783 : :
1784 : : } else {
1785 : 0 : NT_LOG(ERR, NTNIC, "ERROR: - RSS hash update failed with error %i", res);
1786 : : }
1787 : :
1788 : : return res;
1789 : : }
1790 : :
1791 : 0 : static int rss_hash_conf_get(struct rte_eth_dev *eth_dev, struct rte_eth_rss_conf *rss_conf)
1792 : : {
1793 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
1794 : 0 : struct flow_nic_dev *ndev = internals->flw_dev->ndev;
1795 : :
1796 : 0 : rss_conf->algorithm = (enum rte_eth_hash_function)ndev->rss_conf.algorithm;
1797 : :
1798 : 0 : rss_conf->rss_hf = ndev->rss_conf.rss_hf;
1799 : :
1800 : : /*
1801 : : * copy full stored key into rss_key and pad it with
1802 : : * zeros up to rss_key_len / MAX_RSS_KEY_LEN
1803 : : */
1804 [ # # ]: 0 : if (rss_conf->rss_key != NULL) {
1805 : 0 : int key_len = RTE_MIN(rss_conf->rss_key_len, MAX_RSS_KEY_LEN);
1806 [ # # ]: 0 : memset(rss_conf->rss_key, 0, rss_conf->rss_key_len);
1807 [ # # ]: 0 : rte_memcpy(rss_conf->rss_key, &ndev->rss_conf.rss_key, key_len);
1808 : 0 : rss_conf->rss_key_len = key_len;
1809 : : }
1810 : :
1811 : 0 : return 0;
1812 : : }
1813 : :
1814 : : static struct eth_dev_ops nthw_eth_dev_ops = {
1815 : : .dev_configure = eth_dev_configure,
1816 : : .dev_start = eth_dev_start,
1817 : : .dev_stop = eth_dev_stop,
1818 : : .dev_set_link_up = eth_dev_set_link_up,
1819 : : .dev_set_link_down = eth_dev_set_link_down,
1820 : : .dev_close = eth_dev_close,
1821 : : .link_update = eth_link_update,
1822 : : .stats_get = eth_stats_get,
1823 : : .stats_reset = eth_stats_reset,
1824 : : .dev_infos_get = eth_dev_infos_get,
1825 : : .fw_version_get = eth_fw_version_get,
1826 : : .rx_queue_setup = eth_rx_scg_queue_setup,
1827 : : .rx_queue_start = eth_rx_queue_start,
1828 : : .rx_queue_stop = eth_rx_queue_stop,
1829 : : .rx_queue_release = eth_rx_queue_release,
1830 : : .tx_queue_setup = eth_tx_scg_queue_setup,
1831 : : .tx_queue_start = eth_tx_queue_start,
1832 : : .tx_queue_stop = eth_tx_queue_stop,
1833 : : .tx_queue_release = eth_tx_queue_release,
1834 : : .mac_addr_add = eth_mac_addr_add,
1835 : : .mac_addr_set = eth_mac_addr_set,
1836 : : .set_mc_addr_list = eth_set_mc_addr_list,
1837 : : .mtr_ops_get = NULL,
1838 : : .flow_ops_get = dev_flow_ops_get,
1839 : : .xstats_get = eth_xstats_get,
1840 : : .xstats_get_names = eth_xstats_get_names,
1841 : : .xstats_reset = eth_xstats_reset,
1842 : : .xstats_get_by_id = eth_xstats_get_by_id,
1843 : : .xstats_get_names_by_id = eth_xstats_get_names_by_id,
1844 : : .mtu_set = NULL,
1845 : : .promiscuous_enable = promiscuous_enable,
1846 : : .rss_hash_update = eth_dev_rss_hash_update,
1847 : : .rss_hash_conf_get = rss_hash_conf_get,
1848 : : };
1849 : :
1850 : : /*
1851 : : * Port event thread
1852 : : */
1853 : 0 : THREAD_FUNC port_event_thread_fn(void *context)
1854 : : {
1855 : : struct pmd_internals *internals = context;
1856 : 0 : struct drv_s *p_drv = internals->p_drv;
1857 : : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
1858 : : struct adapter_info_s *p_adapter_info = &p_nt_drv->adapter_info;
1859 : 0 : struct flow_nic_dev *ndev = p_adapter_info->nt4ga_filter.mp_flow_device;
1860 : :
1861 : : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
1862 : 0 : struct rte_eth_dev *eth_dev = &rte_eth_devices[internals->port_id];
1863 : 0 : uint8_t port_no = internals->port;
1864 : :
1865 : : ntnic_flm_load_t flmdata;
1866 : : ntnic_port_load_t portdata;
1867 : :
1868 : : memset(&flmdata, 0, sizeof(flmdata));
1869 : : memset(&portdata, 0, sizeof(portdata));
1870 : :
1871 [ # # # # ]: 0 : while (ndev != NULL && ndev->eth_base == NULL)
1872 : 0 : nt_os_wait_usec(1 * 1000 * 1000);
1873 : :
1874 [ # # ]: 0 : while (!p_drv->ntdrv.b_shutdown) {
1875 : : /*
1876 : : * FLM load measurement
1877 : : * Do only send event, if there has been a change
1878 : : */
1879 [ # # # # ]: 0 : if (p_nt4ga_stat->flm_stat_ver > 22 && p_nt4ga_stat->mp_stat_structs_flm) {
1880 [ # # ]: 0 : if (flmdata.lookup != p_nt4ga_stat->mp_stat_structs_flm->load_lps ||
1881 [ # # ]: 0 : flmdata.access != p_nt4ga_stat->mp_stat_structs_flm->load_aps) {
1882 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
1883 : 0 : flmdata.lookup = p_nt4ga_stat->mp_stat_structs_flm->load_lps;
1884 : 0 : flmdata.access = p_nt4ga_stat->mp_stat_structs_flm->load_aps;
1885 : 0 : flmdata.lookup_maximum =
1886 : 0 : p_nt4ga_stat->mp_stat_structs_flm->max_lps;
1887 : 0 : flmdata.access_maximum =
1888 : 0 : p_nt4ga_stat->mp_stat_structs_flm->max_aps;
1889 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
1890 : :
1891 [ # # # # ]: 0 : if (eth_dev && eth_dev->data && eth_dev->data->dev_private) {
1892 : 0 : rte_eth_dev_callback_process(eth_dev,
1893 : : (enum rte_eth_event_type)RTE_NTNIC_FLM_LOAD_EVENT,
1894 : : &flmdata);
1895 : : }
1896 : : }
1897 : : }
1898 : :
1899 : : /*
1900 : : * Port load measurement
1901 : : * Do only send event, if there has been a change.
1902 : : */
1903 [ # # ]: 0 : if (p_nt4ga_stat->mp_port_load) {
1904 [ # # ]: 0 : if (portdata.rx_bps != p_nt4ga_stat->mp_port_load[port_no].rx_bps ||
1905 [ # # ]: 0 : portdata.tx_bps != p_nt4ga_stat->mp_port_load[port_no].tx_bps) {
1906 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
1907 : 0 : portdata.rx_bps = p_nt4ga_stat->mp_port_load[port_no].rx_bps;
1908 : 0 : portdata.tx_bps = p_nt4ga_stat->mp_port_load[port_no].tx_bps;
1909 : 0 : portdata.rx_pps = p_nt4ga_stat->mp_port_load[port_no].rx_pps;
1910 : 0 : portdata.tx_pps = p_nt4ga_stat->mp_port_load[port_no].tx_pps;
1911 : 0 : portdata.rx_pps_maximum =
1912 : 0 : p_nt4ga_stat->mp_port_load[port_no].rx_pps_max;
1913 : 0 : portdata.tx_pps_maximum =
1914 : 0 : p_nt4ga_stat->mp_port_load[port_no].tx_pps_max;
1915 : 0 : portdata.rx_bps_maximum =
1916 : 0 : p_nt4ga_stat->mp_port_load[port_no].rx_bps_max;
1917 : 0 : portdata.tx_bps_maximum =
1918 : 0 : p_nt4ga_stat->mp_port_load[port_no].tx_bps_max;
1919 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
1920 : :
1921 [ # # # # ]: 0 : if (eth_dev && eth_dev->data && eth_dev->data->dev_private) {
1922 : 0 : rte_eth_dev_callback_process(eth_dev,
1923 : : (enum rte_eth_event_type)RTE_NTNIC_PORT_LOAD_EVENT,
1924 : : &portdata);
1925 : : }
1926 : : }
1927 : : }
1928 : :
1929 : : /* Process events */
1930 : : {
1931 : : int count = 0;
1932 : : bool do_wait = true;
1933 : :
1934 [ # # ]: 0 : while (count < 5000) {
1935 : : /* Local FLM statistic events */
1936 : : struct flm_info_event_s data;
1937 : :
1938 [ # # ]: 0 : if (nthw_flm_inf_queue_get(port_no, FLM_INFO_LOCAL, &data) == 0) {
1939 [ # # ]: 0 : if (eth_dev && eth_dev->data &&
1940 [ # # ]: 0 : eth_dev->data->dev_private) {
1941 : : struct ntnic_flm_statistic_s event_data;
1942 : 0 : event_data.bytes = data.bytes;
1943 : 0 : event_data.packets = data.packets;
1944 : 0 : event_data.cause = data.cause;
1945 : 0 : event_data.id = data.id;
1946 : 0 : event_data.timestamp = data.timestamp;
1947 : 0 : rte_eth_dev_callback_process(eth_dev,
1948 : : (enum rte_eth_event_type)
1949 : : RTE_NTNIC_FLM_STATS_EVENT,
1950 : : &event_data);
1951 : : do_wait = false;
1952 : : }
1953 : : }
1954 : :
1955 : : /* AGED event */
1956 : : /* Note: RTE_FLOW_PORT_FLAG_STRICT_QUEUE flag is not supported so
1957 : : * event is always generated
1958 : : */
1959 : 0 : int aged_event_count = flm_age_event_get(port_no);
1960 : :
1961 [ # # # # ]: 0 : if (aged_event_count > 0 && eth_dev && eth_dev->data &&
1962 [ # # ]: 0 : eth_dev->data->dev_private) {
1963 : 0 : rte_eth_dev_callback_process(eth_dev,
1964 : : RTE_ETH_EVENT_FLOW_AGED,
1965 : : NULL);
1966 : 0 : flm_age_event_clear(port_no);
1967 : : do_wait = false;
1968 : : }
1969 : :
1970 [ # # ]: 0 : if (do_wait)
1971 : 0 : nt_os_wait_usec(10);
1972 : :
1973 : 0 : count++;
1974 : : do_wait = true;
1975 : : }
1976 : : }
1977 : : }
1978 : :
1979 : 0 : return THREAD_RETURN;
1980 : : }
1981 : :
1982 : : /*
1983 : : * Adapter flm stat thread
1984 : : */
1985 : 0 : THREAD_FUNC adapter_flm_update_thread_fn(void *context)
1986 : : {
1987 : 0 : const struct profile_inline_ops *profile_inline_ops = get_profile_inline_ops();
1988 : :
1989 [ # # ]: 0 : if (profile_inline_ops == NULL) {
1990 : 0 : NT_LOG(ERR, NTNIC, "%s: profile_inline module uninitialized", __func__);
1991 : 0 : return THREAD_RETURN;
1992 : : }
1993 : :
1994 : : struct drv_s *p_drv = context;
1995 : :
1996 : : struct ntdrv_4ga_s *p_nt_drv = &p_drv->ntdrv;
1997 : : struct adapter_info_s *p_adapter_info = &p_nt_drv->adapter_info;
1998 : : struct nt4ga_filter_s *p_nt4ga_filter = &p_adapter_info->nt4ga_filter;
1999 : 0 : struct flow_nic_dev *p_flow_nic_dev = p_nt4ga_filter->mp_flow_device;
2000 : :
2001 : 0 : NT_LOG(DBG, NTNIC, "%s: %s: waiting for port configuration",
2002 : : p_adapter_info->mp_adapter_id_str, __func__);
2003 : :
2004 [ # # ]: 0 : while (p_flow_nic_dev->eth_base == NULL)
2005 : 0 : nt_os_wait_usec(1 * 1000 * 1000);
2006 : :
2007 : : struct flow_eth_dev *dev = p_flow_nic_dev->eth_base;
2008 : :
2009 : 0 : NT_LOG(DBG, NTNIC, "%s: %s: begin", p_adapter_info->mp_adapter_id_str, __func__);
2010 : :
2011 [ # # ]: 0 : while (!p_drv->ntdrv.b_shutdown)
2012 [ # # ]: 0 : if (profile_inline_ops->flm_update(dev) == 0)
2013 : 0 : nt_os_wait_usec(10);
2014 : :
2015 : 0 : NT_LOG(DBG, NTNIC, "%s: %s: end", p_adapter_info->mp_adapter_id_str, __func__);
2016 : 0 : return THREAD_RETURN;
2017 : : }
2018 : :
2019 : : /*
2020 : : * Adapter stat thread
2021 : : */
2022 : 0 : THREAD_FUNC adapter_stat_thread_fn(void *context)
2023 : : {
2024 : 0 : const struct nt4ga_stat_ops *nt4ga_stat_ops = get_nt4ga_stat_ops();
2025 : :
2026 [ # # ]: 0 : if (nt4ga_stat_ops == NULL) {
2027 : 0 : NT_LOG_DBGX(ERR, NTNIC, "Statistics module uninitialized");
2028 : 0 : return THREAD_RETURN;
2029 : : }
2030 : :
2031 : : struct drv_s *p_drv = context;
2032 : :
2033 : : ntdrv_4ga_t *p_nt_drv = &p_drv->ntdrv;
2034 : 0 : nt4ga_stat_t *p_nt4ga_stat = &p_nt_drv->adapter_info.nt4ga_stat;
2035 : 0 : nthw_stat_t *p_nthw_stat = p_nt4ga_stat->mp_nthw_stat;
2036 : 0 : const char *const p_adapter_id_str = p_nt_drv->adapter_info.mp_adapter_id_str;
2037 : : (void)p_adapter_id_str;
2038 : :
2039 [ # # ]: 0 : if (!p_nthw_stat)
2040 : : return THREAD_RETURN;
2041 : :
2042 : 0 : NT_LOG_DBGX(DBG, NTNIC, "%s: begin", p_adapter_id_str);
2043 : :
2044 : : RTE_ASSERT(p_nthw_stat);
2045 : :
2046 [ # # ]: 0 : while (!p_drv->ntdrv.b_shutdown) {
2047 : 0 : nt_os_wait_usec(10 * 1000);
2048 : :
2049 : 0 : nthw_stat_trigger(p_nthw_stat);
2050 : :
2051 : : uint32_t loop = 0;
2052 : :
2053 [ # # ]: 0 : while ((!p_drv->ntdrv.b_shutdown) &&
2054 [ # # ]: 0 : (*p_nthw_stat->mp_timestamp == (uint64_t)-1)) {
2055 : 0 : nt_os_wait_usec(1 * 100);
2056 : :
2057 [ # # ]: 0 : if (rte_log_get_level(nt_log_ntnic) == RTE_LOG_DEBUG &&
2058 [ # # ]: 0 : (++loop & 0x3fff) == 0) {
2059 [ # # ]: 0 : if (p_nt4ga_stat->mp_nthw_rpf) {
2060 : 0 : NT_LOG(ERR, NTNIC, "Statistics DMA frozen");
2061 : :
2062 [ # # ]: 0 : } else if (p_nt4ga_stat->mp_nthw_rmc) {
2063 : : uint32_t sf_ram_of =
2064 : 0 : nthw_rmc_get_status_sf_ram_of(p_nt4ga_stat
2065 : : ->mp_nthw_rmc);
2066 : : uint32_t descr_fifo_of =
2067 : 0 : nthw_rmc_get_status_descr_fifo_of(p_nt4ga_stat
2068 : : ->mp_nthw_rmc);
2069 : :
2070 : : uint32_t dbg_merge =
2071 : 0 : nthw_rmc_get_dbg_merge(p_nt4ga_stat->mp_nthw_rmc);
2072 : : uint32_t mac_if_err =
2073 : 0 : nthw_rmc_get_mac_if_err(p_nt4ga_stat->mp_nthw_rmc);
2074 : :
2075 : 0 : NT_LOG(ERR, NTNIC, "Statistics DMA frozen");
2076 : 0 : NT_LOG(ERR, NTNIC, "SF RAM Overflow : %08x",
2077 : : sf_ram_of);
2078 : 0 : NT_LOG(ERR, NTNIC, "Descr Fifo Overflow : %08x",
2079 : : descr_fifo_of);
2080 : 0 : NT_LOG(ERR, NTNIC, "DBG Merge : %08x",
2081 : : dbg_merge);
2082 : 0 : NT_LOG(ERR, NTNIC, "MAC If Errors : %08x",
2083 : : mac_if_err);
2084 : : }
2085 : : }
2086 : : }
2087 : :
2088 : : /* Check then collect */
2089 : : {
2090 : 0 : rte_spinlock_lock(&p_nt_drv->stat_lck);
2091 : 0 : nt4ga_stat_ops->nt4ga_stat_collect(&p_nt_drv->adapter_info, p_nt4ga_stat);
2092 : : rte_spinlock_unlock(&p_nt_drv->stat_lck);
2093 : : }
2094 : : }
2095 : :
2096 : 0 : NT_LOG_DBGX(DBG, NTNIC, "%s: end", p_adapter_id_str);
2097 : 0 : return THREAD_RETURN;
2098 : : }
2099 : :
2100 : : static int
2101 : 0 : nthw_pci_dev_init(struct rte_pci_device *pci_dev)
2102 : : {
2103 : 0 : const struct flow_filter_ops *flow_filter_ops = get_flow_filter_ops();
2104 : :
2105 [ # # ]: 0 : if (flow_filter_ops == NULL) {
2106 : 0 : NT_LOG_DBGX(ERR, NTNIC, "flow_filter module uninitialized");
2107 : : /* Return statement is not necessary here to allow traffic processing by SW */
2108 : : }
2109 : :
2110 : 0 : const struct profile_inline_ops *profile_inline_ops = get_profile_inline_ops();
2111 : :
2112 [ # # ]: 0 : if (profile_inline_ops == NULL) {
2113 : 0 : NT_LOG_DBGX(ERR, NTNIC, "profile_inline module uninitialized");
2114 : : /* Return statement is not necessary here to allow traffic processing by SW */
2115 : : }
2116 : :
2117 : 0 : nt_vfio_init();
2118 : 0 : const struct port_ops *port_ops = get_port_ops();
2119 : :
2120 [ # # ]: 0 : if (port_ops == NULL) {
2121 : 0 : NT_LOG(ERR, NTNIC, "Link management module uninitialized");
2122 : 0 : return -1;
2123 : : }
2124 : :
2125 : 0 : const struct adapter_ops *adapter_ops = get_adapter_ops();
2126 : :
2127 [ # # ]: 0 : if (adapter_ops == NULL) {
2128 : 0 : NT_LOG(ERR, NTNIC, "Adapter module uninitialized");
2129 : 0 : return -1;
2130 : : }
2131 : :
2132 : : int res;
2133 : : struct drv_s *p_drv;
2134 : : ntdrv_4ga_t *p_nt_drv;
2135 : : hw_info_t *p_hw_info;
2136 : : fpga_info_t *fpga_info;
2137 : : uint32_t n_port_mask = -1; /* All ports enabled by default */
2138 : 0 : uint32_t nb_rx_queues = 1;
2139 : 0 : uint32_t nb_tx_queues = 1;
2140 : : uint32_t exception_path = 0;
2141 : : struct flow_queue_id_s queue_ids[MAX_QUEUES];
2142 : : int n_phy_ports;
2143 : : enum flow_eth_dev_profile profile = FLOW_ETH_DEV_PROFILE_INLINE;
2144 : :
2145 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Dev %s PF #%i Init : %02x:%02x:%i", pci_dev->name,
2146 : : pci_dev->addr.function, pci_dev->addr.bus, pci_dev->addr.devid,
2147 : : pci_dev->addr.function);
2148 : :
2149 : : /*
2150 : : * Process options/arguments
2151 : : */
2152 [ # # # # ]: 0 : if (pci_dev->device.devargs && pci_dev->device.devargs->args) {
2153 : : int kvargs_count;
2154 : : struct rte_kvargs *kvlist =
2155 : 0 : rte_kvargs_parse(pci_dev->device.devargs->args, valid_arguments);
2156 : :
2157 [ # # ]: 0 : if (kvlist == NULL)
2158 : : return -1;
2159 : :
2160 : : /*
2161 : : * Argument: help
2162 : : * NOTE: this argument/option check should be the first as it will stop
2163 : : * execution after producing its output
2164 : : */
2165 : : {
2166 [ # # ]: 0 : if (rte_kvargs_get(kvlist, ETH_DEV_NTNIC_HELP_ARG)) {
2167 : : size_t i;
2168 : :
2169 : : for (i = 0; i < RTE_DIM(valid_arguments); i++)
2170 : : if (valid_arguments[i] == NULL)
2171 : : break;
2172 : :
2173 : 0 : exit(0);
2174 : : }
2175 : : }
2176 : :
2177 : : /*
2178 : : * rxq option/argument
2179 : : * The number of rxq (hostbuffers) allocated in memory.
2180 : : * Default is 32 RX Hostbuffers
2181 : : */
2182 : 0 : kvargs_count = rte_kvargs_count(kvlist, ETH_DEV_NTHW_RXQUEUES_ARG);
2183 : :
2184 [ # # ]: 0 : if (kvargs_count != 0) {
2185 : : RTE_ASSERT(kvargs_count == 1);
2186 : 0 : res = rte_kvargs_process(kvlist, ETH_DEV_NTHW_RXQUEUES_ARG,
2187 : : &nthw_string_to_u32,
2188 : : &nb_rx_queues);
2189 : :
2190 [ # # ]: 0 : if (res < 0) {
2191 : 0 : NT_LOG_DBGX(ERR, NTNIC,
2192 : : "problem with command line arguments: res=%d",
2193 : : res);
2194 : 0 : free(kvlist);
2195 : 0 : return -1;
2196 : : }
2197 : :
2198 : 0 : NT_LOG_DBGX(DBG, NTNIC, "devargs: %s=%u",
2199 : : ETH_DEV_NTHW_RXQUEUES_ARG, nb_rx_queues);
2200 : : }
2201 : :
2202 : : /*
2203 : : * txq option/argument
2204 : : * The number of txq (hostbuffers) allocated in memory.
2205 : : * Default is 32 TX Hostbuffers
2206 : : */
2207 : 0 : kvargs_count = rte_kvargs_count(kvlist, ETH_DEV_NTHW_TXQUEUES_ARG);
2208 : :
2209 [ # # ]: 0 : if (kvargs_count != 0) {
2210 : : RTE_ASSERT(kvargs_count == 1);
2211 : 0 : res = rte_kvargs_process(kvlist, ETH_DEV_NTHW_TXQUEUES_ARG,
2212 : : &nthw_string_to_u32,
2213 : : &nb_tx_queues);
2214 : :
2215 [ # # ]: 0 : if (res < 0) {
2216 : 0 : NT_LOG_DBGX(ERR, NTNIC,
2217 : : "problem with command line arguments: res=%d",
2218 : : res);
2219 : 0 : free(kvlist);
2220 : 0 : return -1;
2221 : : }
2222 : :
2223 : 0 : NT_LOG_DBGX(DBG, NTNIC, "devargs: %s=%u",
2224 : : ETH_DEV_NTHW_TXQUEUES_ARG, nb_tx_queues);
2225 : : }
2226 : : }
2227 : :
2228 : :
2229 : : /* alloc */
2230 : 0 : p_drv = rte_zmalloc_socket(pci_dev->name, sizeof(struct drv_s), RTE_CACHE_LINE_SIZE,
2231 : : pci_dev->device.numa_node);
2232 : :
2233 [ # # ]: 0 : if (!p_drv) {
2234 [ # # ]: 0 : NT_LOG_DBGX(ERR, NTNIC, "%s: error %d",
2235 : : (pci_dev->name[0] ? pci_dev->name : "NA"), -1);
2236 : 0 : return -1;
2237 : : }
2238 : :
2239 : : /* Setup VFIO context */
2240 : 0 : int vfio = nt_vfio_setup(pci_dev);
2241 : :
2242 [ # # ]: 0 : if (vfio < 0) {
2243 [ # # ]: 0 : NT_LOG_DBGX(ERR, NTNIC, "%s: vfio_setup error %d",
2244 : : (pci_dev->name[0] ? pci_dev->name : "NA"), -1);
2245 : 0 : rte_free(p_drv);
2246 : 0 : return -1;
2247 : : }
2248 : :
2249 : : /* context */
2250 : : p_nt_drv = &p_drv->ntdrv;
2251 : : p_hw_info = &p_nt_drv->adapter_info.hw_info;
2252 : 0 : fpga_info = &p_nt_drv->adapter_info.fpga_info;
2253 : :
2254 : 0 : p_drv->p_dev = pci_dev;
2255 : :
2256 : : /* Set context for NtDrv */
2257 : 0 : p_nt_drv->pciident = BDF_TO_PCIIDENT(pci_dev->addr.domain, pci_dev->addr.bus,
2258 : : pci_dev->addr.devid, pci_dev->addr.function);
2259 : 0 : p_nt_drv->adapter_info.n_rx_host_buffers = nb_rx_queues;
2260 : 0 : p_nt_drv->adapter_info.n_tx_host_buffers = nb_tx_queues;
2261 : :
2262 : 0 : fpga_info->bar0_addr = (void *)pci_dev->mem_resource[0].addr;
2263 : 0 : fpga_info->bar0_size = pci_dev->mem_resource[0].len;
2264 : 0 : fpga_info->numa_node = pci_dev->device.numa_node;
2265 : 0 : fpga_info->pciident = p_nt_drv->pciident;
2266 : 0 : fpga_info->adapter_no = p_drv->adapter_no;
2267 : :
2268 : 0 : p_nt_drv->adapter_info.hw_info.pci_class_id = pci_dev->id.class_id;
2269 : 0 : p_nt_drv->adapter_info.hw_info.pci_vendor_id = pci_dev->id.vendor_id;
2270 : 0 : p_nt_drv->adapter_info.hw_info.pci_device_id = pci_dev->id.device_id;
2271 : 0 : p_nt_drv->adapter_info.hw_info.pci_sub_vendor_id = pci_dev->id.subsystem_vendor_id;
2272 : 0 : p_nt_drv->adapter_info.hw_info.pci_sub_device_id = pci_dev->id.subsystem_device_id;
2273 : :
2274 : 0 : NT_LOG(DBG, NTNIC, "%s: " PCIIDENT_PRINT_STR " %04X:%04X: %04X:%04X:",
2275 : : p_nt_drv->adapter_info.mp_adapter_id_str, PCIIDENT_TO_DOMAIN(p_nt_drv->pciident),
2276 : : PCIIDENT_TO_BUSNR(p_nt_drv->pciident), PCIIDENT_TO_DEVNR(p_nt_drv->pciident),
2277 : : PCIIDENT_TO_FUNCNR(p_nt_drv->pciident),
2278 : : p_nt_drv->adapter_info.hw_info.pci_vendor_id,
2279 : : p_nt_drv->adapter_info.hw_info.pci_device_id,
2280 : : p_nt_drv->adapter_info.hw_info.pci_sub_vendor_id,
2281 : : p_nt_drv->adapter_info.hw_info.pci_sub_device_id);
2282 : :
2283 : 0 : p_nt_drv->b_shutdown = false;
2284 : 0 : p_nt_drv->adapter_info.pb_shutdown = &p_nt_drv->b_shutdown;
2285 : :
2286 : : /* store context */
2287 : 0 : store_pdrv(p_drv);
2288 : :
2289 : : /* initialize nt4ga nthw fpga module instance in drv */
2290 : 0 : int err = adapter_ops->init(&p_nt_drv->adapter_info);
2291 : :
2292 [ # # ]: 0 : if (err != 0) {
2293 : 0 : NT_LOG(ERR, NTNIC, "%s: Cannot initialize the adapter instance",
2294 : : p_nt_drv->adapter_info.mp_adapter_id_str);
2295 : 0 : return -1;
2296 : : }
2297 : :
2298 : 0 : const struct meter_ops_s *meter_ops = get_meter_ops();
2299 : :
2300 [ # # ]: 0 : if (meter_ops != NULL)
2301 : 0 : nthw_eth_dev_ops.mtr_ops_get = meter_ops->eth_mtr_ops_get;
2302 : :
2303 : : else
2304 : 0 : NT_LOG(DBG, NTNIC, "Meter module is not initialized");
2305 : :
2306 : : /* Initialize the queue system */
2307 : 0 : sg_ops = get_sg_ops();
2308 : :
2309 [ # # ]: 0 : if (sg_ops != NULL) {
2310 : 0 : err = sg_ops->nthw_virt_queue_init(fpga_info);
2311 : :
2312 [ # # ]: 0 : if (err != 0) {
2313 : 0 : NT_LOG(ERR, NTNIC,
2314 : : "%s: Cannot initialize scatter-gather queues",
2315 : : p_nt_drv->adapter_info.mp_adapter_id_str);
2316 : :
2317 : : } else {
2318 : 0 : NT_LOG(DBG, NTNIC, "%s: Initialized scatter-gather queues",
2319 : : p_nt_drv->adapter_info.mp_adapter_id_str);
2320 : : }
2321 : :
2322 : : } else {
2323 : 0 : NT_LOG_DBGX(DBG, NTNIC, "SG module is not initialized");
2324 : : }
2325 : :
2326 : : /* Start ctrl, monitor, stat thread only for primary process. */
2327 [ # # ]: 0 : if (err == 0) {
2328 : : /* mp_adapter_id_str is initialized after nt4ga_adapter_init(p_nt_drv) */
2329 : 0 : const char *const p_adapter_id_str = p_nt_drv->adapter_info.mp_adapter_id_str;
2330 : : (void)p_adapter_id_str;
2331 [ # # ]: 0 : NT_LOG(DBG, NTNIC,
2332 : : "%s: %s: AdapterPCI=" PCIIDENT_PRINT_STR " Hw=0x%02X_rev%d PhyPorts=%d",
2333 : : (pci_dev->name[0] ? pci_dev->name : "NA"), p_adapter_id_str,
2334 : : PCIIDENT_TO_DOMAIN(p_nt_drv->adapter_info.fpga_info.pciident),
2335 : : PCIIDENT_TO_BUSNR(p_nt_drv->adapter_info.fpga_info.pciident),
2336 : : PCIIDENT_TO_DEVNR(p_nt_drv->adapter_info.fpga_info.pciident),
2337 : : PCIIDENT_TO_FUNCNR(p_nt_drv->adapter_info.fpga_info.pciident),
2338 : : p_hw_info->hw_platform_id, fpga_info->nthw_hw_info.hw_id,
2339 : : fpga_info->n_phy_ports);
2340 : :
2341 : : } else {
2342 [ # # ]: 0 : NT_LOG_DBGX(ERR, NTNIC, "%s: error=%d",
2343 : : (pci_dev->name[0] ? pci_dev->name : "NA"), err);
2344 : 0 : return -1;
2345 : : }
2346 : :
2347 [ # # # # ]: 0 : if (profile_inline_ops != NULL && fpga_info->profile == FPGA_INFO_PROFILE_INLINE) {
2348 : 0 : profile_inline_ops->flm_setup_queues();
2349 : 0 : res = THREAD_CTRL_CREATE(&p_nt_drv->flm_thread, "ntnic-nt_flm_update_thr",
2350 : : adapter_flm_update_thread_fn, (void *)p_drv);
2351 : :
2352 [ # # ]: 0 : if (res) {
2353 [ # # ]: 0 : NT_LOG_DBGX(ERR, NTNIC, "%s: error=%d",
2354 : : (pci_dev->name[0] ? pci_dev->name : "NA"), res);
2355 : 0 : return -1;
2356 : : }
2357 : : }
2358 : :
2359 : : rte_spinlock_init(&p_nt_drv->stat_lck);
2360 : 0 : res = THREAD_CTRL_CREATE(&p_nt_drv->stat_thread, "nt4ga_stat_thr", adapter_stat_thread_fn,
2361 : : (void *)p_drv);
2362 : :
2363 [ # # ]: 0 : if (res) {
2364 [ # # ]: 0 : NT_LOG(ERR, NTNIC, "%s: error=%d",
2365 : : (pci_dev->name[0] ? pci_dev->name : "NA"), res);
2366 : 0 : return -1;
2367 : : }
2368 : :
2369 : 0 : n_phy_ports = fpga_info->n_phy_ports;
2370 : :
2371 [ # # ]: 0 : for (int n_intf_no = 0; n_intf_no < n_phy_ports; n_intf_no++) {
2372 [ # # ]: 0 : const char *const p_port_id_str = p_nt_drv->adapter_info.mp_port_id_str[n_intf_no];
2373 : : (void)p_port_id_str;
2374 : : struct pmd_internals *internals = NULL;
2375 : : struct rte_eth_dev *eth_dev = NULL;
2376 : : char name[32];
2377 : : int i;
2378 : :
2379 : : if ((1 << n_intf_no) & ~n_port_mask) {
2380 : : NT_LOG_DBGX(DBG, NTNIC,
2381 : : "%s: interface #%d: skipping due to portmask 0x%02X",
2382 : : p_port_id_str, n_intf_no, n_port_mask);
2383 : : continue;
2384 : : }
2385 : :
2386 : : snprintf(name, sizeof(name), "ntnic%d", n_intf_no);
2387 [ # # ]: 0 : NT_LOG_DBGX(DBG, NTNIC, "%s: interface #%d: %s: '%s'", p_port_id_str,
2388 : : n_intf_no, (pci_dev->name[0] ? pci_dev->name : "NA"), name);
2389 : :
2390 : 0 : internals = rte_zmalloc_socket(name, sizeof(struct pmd_internals),
2391 : : RTE_CACHE_LINE_SIZE, pci_dev->device.numa_node);
2392 : :
2393 [ # # ]: 0 : if (!internals) {
2394 [ # # ]: 0 : NT_LOG_DBGX(ERR, NTNIC, "%s: %s: error=%d",
2395 : : (pci_dev->name[0] ? pci_dev->name : "NA"), name, -1);
2396 : 0 : return -1;
2397 : : }
2398 : :
2399 : 0 : internals->pci_dev = pci_dev;
2400 : 0 : internals->n_intf_no = n_intf_no;
2401 : 0 : internals->type = PORT_TYPE_PHYSICAL;
2402 : 0 : internals->port = n_intf_no;
2403 : 0 : internals->nb_rx_queues = nb_rx_queues;
2404 : 0 : internals->nb_tx_queues = nb_tx_queues;
2405 : :
2406 : : /* Not used queue index as dest port in bypass - use 0x80 + port nr */
2407 [ # # ]: 0 : for (i = 0; i < MAX_QUEUES; i++)
2408 : 0 : internals->vpq[i].hw_id = -1;
2409 : :
2410 : :
2411 : : /* Setup queue_ids */
2412 [ # # ]: 0 : if (nb_rx_queues > 1) {
2413 : 0 : NT_LOG(DBG, NTNIC,
2414 : : "(%i) NTNIC configured with Rx multi queues. %" PRIu32 " queues",
2415 : : internals->n_intf_no, nb_rx_queues);
2416 : : }
2417 : :
2418 [ # # ]: 0 : if (nb_tx_queues > 1) {
2419 : 0 : NT_LOG(DBG, NTNIC,
2420 : : "(%i) NTNIC configured with Tx multi queues. %" PRIu32 " queues",
2421 : : internals->n_intf_no, nb_tx_queues);
2422 : : }
2423 : :
2424 : 0 : int max_num_queues = (nb_rx_queues > nb_tx_queues) ? nb_rx_queues : nb_tx_queues;
2425 : 0 : int start_queue = allocate_queue(max_num_queues);
2426 : :
2427 [ # # ]: 0 : if (start_queue < 0)
2428 : : return -1;
2429 : :
2430 [ # # ]: 0 : for (i = 0; i < (int)max_num_queues; i++) {
2431 : 0 : queue_ids[i].id = i;
2432 : 0 : queue_ids[i].hw_id = start_queue + i;
2433 : :
2434 : 0 : internals->rxq_scg[i].queue = queue_ids[i];
2435 : : /* use same index in Rx and Tx rings */
2436 : 0 : internals->txq_scg[i].queue = queue_ids[i];
2437 : 0 : internals->rxq_scg[i].enabled = 0;
2438 : 0 : internals->txq_scg[i].type = internals->type;
2439 : 0 : internals->rxq_scg[i].type = internals->type;
2440 : 0 : internals->rxq_scg[i].port = internals->port;
2441 : : }
2442 : :
2443 : : /* no tx queues - tx data goes out on phy */
2444 : 0 : internals->vpq_nb_vq = 0;
2445 : :
2446 [ # # ]: 0 : for (i = 0; i < (int)nb_tx_queues; i++) {
2447 : 0 : internals->txq_scg[i].port = internals->port;
2448 : 0 : internals->txq_scg[i].enabled = 0;
2449 : : }
2450 : :
2451 : : /* Set MAC address (but only if the MAC address is permitted) */
2452 [ # # ]: 0 : if (n_intf_no < fpga_info->nthw_hw_info.vpd_info.mn_mac_addr_count) {
2453 : 0 : const uint64_t mac =
2454 : 0 : fpga_info->nthw_hw_info.vpd_info.mn_mac_addr_value + n_intf_no;
2455 : 0 : internals->eth_addrs[0].addr_bytes[0] = (mac >> 40) & 0xFFu;
2456 : 0 : internals->eth_addrs[0].addr_bytes[1] = (mac >> 32) & 0xFFu;
2457 : 0 : internals->eth_addrs[0].addr_bytes[2] = (mac >> 24) & 0xFFu;
2458 : 0 : internals->eth_addrs[0].addr_bytes[3] = (mac >> 16) & 0xFFu;
2459 : 0 : internals->eth_addrs[0].addr_bytes[4] = (mac >> 8) & 0xFFu;
2460 : 0 : internals->eth_addrs[0].addr_bytes[5] = (mac >> 0) & 0xFFu;
2461 : : }
2462 : :
2463 : 0 : eth_dev = rte_eth_dev_allocate(name);
2464 : :
2465 [ # # ]: 0 : if (!eth_dev) {
2466 [ # # ]: 0 : NT_LOG_DBGX(ERR, NTNIC, "%s: %s: error=%d",
2467 : : (pci_dev->name[0] ? pci_dev->name : "NA"), name, -1);
2468 : 0 : return -1;
2469 : : }
2470 : :
2471 [ # # ]: 0 : if (flow_filter_ops != NULL) {
2472 : 0 : internals->flw_dev = flow_filter_ops->flow_get_eth_dev(0, n_intf_no,
2473 : 0 : eth_dev->data->port_id, nb_rx_queues, queue_ids,
2474 : : &internals->txq_scg[0].rss_target_id, profile, exception_path);
2475 : :
2476 [ # # ]: 0 : if (!internals->flw_dev) {
2477 : 0 : NT_LOG(ERR, NTNIC,
2478 : : "Error creating port. Resource exhaustion in HW");
2479 : 0 : return -1;
2480 : : }
2481 : : }
2482 : :
2483 : : /* connect structs */
2484 : 0 : internals->p_drv = p_drv;
2485 : 0 : eth_dev->data->dev_private = internals;
2486 : 0 : eth_dev->data->mac_addrs = rte_malloc(NULL,
2487 : : NUM_MAC_ADDRS_PER_PORT * sizeof(struct rte_ether_addr), 0);
2488 : 0 : rte_memcpy(ð_dev->data->mac_addrs[0],
2489 [ # # ]: 0 : &internals->eth_addrs[0], RTE_ETHER_ADDR_LEN);
2490 : :
2491 : 0 : NT_LOG_DBGX(DBG, NTNIC, "Setting up RX functions for SCG");
2492 : 0 : eth_dev->rx_pkt_burst = eth_dev_rx_scg;
2493 : 0 : eth_dev->tx_pkt_burst = eth_dev_tx_scg;
2494 : 0 : eth_dev->tx_pkt_prepare = NULL;
2495 : :
2496 : : struct rte_eth_link pmd_link;
2497 : : pmd_link.link_speed = RTE_ETH_SPEED_NUM_NONE;
2498 : : pmd_link.link_duplex = RTE_ETH_LINK_FULL_DUPLEX;
2499 : : pmd_link.link_status = RTE_ETH_LINK_DOWN;
2500 : : pmd_link.link_autoneg = RTE_ETH_LINK_AUTONEG;
2501 : :
2502 : 0 : eth_dev->device = &pci_dev->device;
2503 : 0 : eth_dev->data->dev_link = pmd_link;
2504 : 0 : eth_dev->dev_ops = &nthw_eth_dev_ops;
2505 : :
2506 : : eth_dev_pci_specific_init(eth_dev, pci_dev);
2507 : 0 : rte_eth_dev_probing_finish(eth_dev);
2508 : :
2509 : : /* increase initialized ethernet devices - PF */
2510 : 0 : p_drv->n_eth_dev_init_count++;
2511 : :
2512 [ # # ]: 0 : if (get_flow_filter_ops() != NULL) {
2513 [ # # ]: 0 : if (fpga_info->profile == FPGA_INFO_PROFILE_INLINE &&
2514 [ # # ]: 0 : internals->flw_dev->ndev->be.tpe.ver >= 2) {
2515 : : RTE_ASSERT(nthw_eth_dev_ops.mtu_set == dev_set_mtu_inline ||
2516 : : nthw_eth_dev_ops.mtu_set == NULL);
2517 : 0 : nthw_eth_dev_ops.mtu_set = dev_set_mtu_inline;
2518 : 0 : dev_set_mtu_inline(eth_dev, MTUINITVAL);
2519 : 0 : NT_LOG_DBGX(DBG, NTNIC, "INLINE MTU supported, tpe version %d",
2520 : : internals->flw_dev->ndev->be.tpe.ver);
2521 : :
2522 : : } else {
2523 : 0 : NT_LOG(DBG, NTNIC, "INLINE MTU not supported");
2524 : : }
2525 : : }
2526 : :
2527 : : /* Port event thread */
2528 [ # # ]: 0 : if (fpga_info->profile == FPGA_INFO_PROFILE_INLINE) {
2529 : 0 : res = THREAD_CTRL_CREATE(&p_nt_drv->port_event_thread, "nt_port_event_thr",
2530 : : port_event_thread_fn, (void *)internals);
2531 : :
2532 [ # # ]: 0 : if (res) {
2533 [ # # ]: 0 : NT_LOG(ERR, NTNIC, "%s: error=%d",
2534 : : (pci_dev->name[0] ? pci_dev->name : "NA"), res);
2535 : 0 : return -1;
2536 : : }
2537 : : }
2538 : : }
2539 : :
2540 : : return 0;
2541 : : }
2542 : :
2543 : : static int
2544 : 0 : nthw_pci_dev_deinit(struct rte_eth_dev *eth_dev __rte_unused)
2545 : : {
2546 : 0 : NT_LOG_DBGX(DBG, NTNIC, "PCI device deinitialization");
2547 : :
2548 : : int i;
2549 : : char name[32];
2550 : :
2551 : 0 : struct pmd_internals *internals = eth_dev->data->dev_private;
2552 : 0 : ntdrv_4ga_t *p_ntdrv = &internals->p_drv->ntdrv;
2553 : : fpga_info_t *fpga_info = &p_ntdrv->adapter_info.fpga_info;
2554 : 0 : const int n_phy_ports = fpga_info->n_phy_ports;
2555 : :
2556 : : /* let running threads end Rx and Tx activity */
2557 [ # # ]: 0 : if (sg_ops != NULL) {
2558 : 0 : nt_os_wait_usec(1 * 1000 * 1000);
2559 : :
2560 [ # # ]: 0 : while (internals) {
2561 [ # # ]: 0 : for (i = internals->nb_tx_queues - 1; i >= 0; i--) {
2562 : 0 : sg_ops->nthw_release_mngd_tx_virt_queue(internals->txq_scg[i].vq);
2563 : : release_hw_virtio_queues(&internals->txq_scg[i].hwq);
2564 : : }
2565 : :
2566 [ # # ]: 0 : for (i = internals->nb_rx_queues - 1; i >= 0; i--) {
2567 : 0 : sg_ops->nthw_release_mngd_rx_virt_queue(internals->rxq_scg[i].vq);
2568 : : release_hw_virtio_queues(&internals->rxq_scg[i].hwq);
2569 : : }
2570 : :
2571 : 0 : internals = internals->next;
2572 : : }
2573 : : }
2574 : :
2575 [ # # ]: 0 : for (i = 0; i < n_phy_ports; i++) {
2576 : : sprintf(name, "ntnic%d", i);
2577 : 0 : eth_dev = rte_eth_dev_allocated(name);
2578 [ # # ]: 0 : if (eth_dev == NULL)
2579 : 0 : continue; /* port already released */
2580 : 0 : rte_eth_dev_release_port(eth_dev);
2581 : : }
2582 : :
2583 : 0 : nt_vfio_remove(EXCEPTION_PATH_HID);
2584 : 0 : return 0;
2585 : : }
2586 : :
2587 : : static int
2588 : 0 : nthw_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
2589 : : struct rte_pci_device *pci_dev)
2590 : : {
2591 : : int ret;
2592 : :
2593 : 0 : NT_LOG_DBGX(DBG, NTNIC, "pcidev: name: '%s'", pci_dev->name);
2594 : 0 : NT_LOG_DBGX(DBG, NTNIC, "devargs: name: '%s'", pci_dev->device.name);
2595 : :
2596 [ # # ]: 0 : if (pci_dev->device.devargs) {
2597 [ # # ]: 0 : NT_LOG_DBGX(DBG, NTNIC, "devargs: args: '%s'",
2598 : : (pci_dev->device.devargs->args ? pci_dev->device.devargs->args : "NULL"));
2599 [ # # ]: 0 : NT_LOG_DBGX(DBG, NTNIC, "devargs: data: '%s'",
2600 : : (pci_dev->device.devargs->data ? pci_dev->device.devargs->data : "NULL"));
2601 : : }
2602 : :
2603 : 0 : const int n_rte_vfio_no_io_mmu_enabled = rte_vfio_noiommu_is_enabled();
2604 : 0 : NT_LOG(DBG, NTNIC, "vfio_no_iommu_enabled=%d", n_rte_vfio_no_io_mmu_enabled);
2605 : :
2606 [ # # ]: 0 : if (n_rte_vfio_no_io_mmu_enabled) {
2607 : 0 : NT_LOG(ERR, NTNIC, "vfio_no_iommu_enabled=%d: this PMD needs VFIO IOMMU",
2608 : : n_rte_vfio_no_io_mmu_enabled);
2609 : 0 : return -1;
2610 : : }
2611 : :
2612 : 0 : const enum rte_iova_mode n_rte_io_va_mode = rte_eal_iova_mode();
2613 : 0 : NT_LOG(DBG, NTNIC, "iova mode=%d", n_rte_io_va_mode);
2614 : :
2615 [ # # # # : 0 : NT_LOG(DBG, NTNIC,
# # ]
2616 : : "busid=" PCI_PRI_FMT
2617 : : " pciid=%04x:%04x_%04x:%04x locstr=%s @ numanode=%d: drv=%s drvalias=%s",
2618 : : pci_dev->addr.domain, pci_dev->addr.bus, pci_dev->addr.devid,
2619 : : pci_dev->addr.function, pci_dev->id.vendor_id, pci_dev->id.device_id,
2620 : : pci_dev->id.subsystem_vendor_id, pci_dev->id.subsystem_device_id,
2621 : : pci_dev->name[0] ? pci_dev->name : "NA",
2622 : : pci_dev->device.numa_node,
2623 : : pci_dev->driver->driver.name ? pci_dev->driver->driver.name : "NA",
2624 : : pci_dev->driver->driver.alias ? pci_dev->driver->driver.alias : "NA");
2625 : :
2626 : :
2627 : 0 : ret = nthw_pci_dev_init(pci_dev);
2628 : :
2629 : : /*
2630 : : * 1 time calculation of 1 sec stat update rtc cycles to prevent stat poll
2631 : : * flooding by OVS from multiple virtual port threads - no need to be precise
2632 : : */
2633 : : uint64_t now_rtc = rte_get_tsc_cycles();
2634 : 0 : nt_os_wait_usec(10 * 1000);
2635 : 0 : rte_tsc_freq = 100 * (rte_get_tsc_cycles() - now_rtc);
2636 : :
2637 : 0 : NT_LOG_DBGX(DBG, NTNIC, "leave: ret=%d", ret);
2638 : 0 : return ret;
2639 : : }
2640 : :
2641 : : static int
2642 : 0 : nthw_pci_remove(struct rte_pci_device *pci_dev)
2643 : : {
2644 : 0 : NT_LOG_DBGX(DBG, NTNIC);
2645 : :
2646 : 0 : struct drv_s *p_drv = get_pdrv_from_pci(pci_dev->addr);
2647 : 0 : drv_deinit(p_drv);
2648 : :
2649 : 0 : return rte_eth_dev_pci_generic_remove(pci_dev, nthw_pci_dev_deinit);
2650 : : }
2651 : :
2652 : : static struct rte_pci_driver rte_nthw_pmd = {
2653 : : .id_table = nthw_pci_id_map,
2654 : : .drv_flags = RTE_PCI_DRV_NEED_MAPPING,
2655 : : .probe = nthw_pci_probe,
2656 : : .remove = nthw_pci_remove,
2657 : : };
2658 : :
2659 : 253 : RTE_PMD_REGISTER_PCI(net_ntnic, rte_nthw_pmd);
2660 : : RTE_PMD_REGISTER_PCI_TABLE(net_ntnic, nthw_pci_id_map);
2661 : : RTE_PMD_REGISTER_KMOD_DEP(net_ntnic, "* vfio-pci");
2662 : :
2663 [ - + ]: 253 : RTE_LOG_REGISTER_SUFFIX(nt_log_general, general, INFO);
2664 [ - + ]: 253 : RTE_LOG_REGISTER_SUFFIX(nt_log_nthw, nthw, INFO);
2665 [ - + ]: 253 : RTE_LOG_REGISTER_SUFFIX(nt_log_filter, filter, INFO);
2666 [ - + ]: 253 : RTE_LOG_REGISTER_SUFFIX(nt_log_ntnic, ntnic, INFO);
|
