net/bnxt: validate structs and pointers before use
[dpdk.git] / drivers / net / bnxt / bnxt_rxq.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2014-2018 Broadcom
3  * All rights reserved.
4  */
5
6 #include <inttypes.h>
7
8 #include <rte_malloc.h>
9
10 #include "bnxt.h"
11 #include "bnxt_cpr.h"
12 #include "bnxt_filter.h"
13 #include "bnxt_hwrm.h"
14 #include "bnxt_ring.h"
15 #include "bnxt_rxq.h"
16 #include "bnxt_rxr.h"
17 #include "bnxt_vnic.h"
18 #include "hsi_struct_def_dpdk.h"
19
20 /*
21  * RX Queues
22  */
23
24 void bnxt_free_rxq_stats(struct bnxt_rx_queue *rxq)
25 {
26         if (rxq && rxq->cp_ring && rxq->cp_ring->hw_stats)
27                 rxq->cp_ring->hw_stats = NULL;
28 }
29
30 int bnxt_mq_rx_configure(struct bnxt *bp)
31 {
32         struct rte_eth_conf *dev_conf = &bp->eth_dev->data->dev_conf;
33         const struct rte_eth_vmdq_rx_conf *conf =
34                     &dev_conf->rx_adv_conf.vmdq_rx_conf;
35         unsigned int i, j, nb_q_per_grp = 1, ring_idx = 0;
36         int start_grp_id, end_grp_id = 1, rc = 0;
37         struct bnxt_vnic_info *vnic;
38         struct bnxt_filter_info *filter;
39         enum rte_eth_nb_pools pools = bp->rx_cp_nr_rings, max_pools = 0;
40         struct bnxt_rx_queue *rxq;
41
42         bp->nr_vnics = 0;
43
44         /* Single queue mode */
45         if (bp->rx_cp_nr_rings < 2) {
46                 vnic = bnxt_alloc_vnic(bp);
47                 if (!vnic) {
48                         PMD_DRV_LOG(ERR, "VNIC alloc failed\n");
49                         rc = -ENOMEM;
50                         goto err_out;
51                 }
52                 vnic->flags |= BNXT_VNIC_INFO_BCAST;
53                 STAILQ_INSERT_TAIL(&bp->ff_pool[0], vnic, next);
54                 bp->nr_vnics++;
55
56                 rxq = bp->eth_dev->data->rx_queues[0];
57                 rxq->vnic = vnic;
58
59                 vnic->func_default = true;
60                 vnic->ff_pool_idx = 0;
61                 vnic->start_grp_id = 0;
62                 vnic->end_grp_id = vnic->start_grp_id;
63                 filter = bnxt_alloc_filter(bp);
64                 if (!filter) {
65                         PMD_DRV_LOG(ERR, "L2 filter alloc failed\n");
66                         rc = -ENOMEM;
67                         goto err_out;
68                 }
69                 STAILQ_INSERT_TAIL(&vnic->filter, filter, next);
70                 goto out;
71         }
72
73         /* Multi-queue mode */
74         if (dev_conf->rxmode.mq_mode & ETH_MQ_RX_VMDQ_DCB_RSS) {
75                 /* VMDq ONLY, VMDq+RSS, VMDq+DCB, VMDq+DCB+RSS */
76
77                 switch (dev_conf->rxmode.mq_mode) {
78                 case ETH_MQ_RX_VMDQ_RSS:
79                 case ETH_MQ_RX_VMDQ_ONLY:
80                         /* ETH_8/64_POOLs */
81                         pools = conf->nb_queue_pools;
82                         /* For each pool, allocate MACVLAN CFA rule & VNIC */
83                         max_pools = RTE_MIN(bp->max_vnics,
84                                             RTE_MIN(bp->max_l2_ctx,
85                                             RTE_MIN(bp->max_rsscos_ctx,
86                                                     ETH_64_POOLS)));
87                         if (pools > max_pools)
88                                 pools = max_pools;
89                         break;
90                 case ETH_MQ_RX_RSS:
91                         pools = 1;
92                         break;
93                 default:
94                         PMD_DRV_LOG(ERR, "Unsupported mq_mod %d\n",
95                                 dev_conf->rxmode.mq_mode);
96                         rc = -EINVAL;
97                         goto err_out;
98                 }
99         }
100
101         nb_q_per_grp = bp->rx_cp_nr_rings / pools;
102         start_grp_id = 0;
103         end_grp_id = nb_q_per_grp;
104
105         for (i = 0; i < pools; i++) {
106                 vnic = bnxt_alloc_vnic(bp);
107                 if (!vnic) {
108                         PMD_DRV_LOG(ERR, "VNIC alloc failed\n");
109                         rc = -ENOMEM;
110                         goto err_out;
111                 }
112                 vnic->flags |= BNXT_VNIC_INFO_BCAST;
113                 STAILQ_INSERT_TAIL(&bp->ff_pool[i], vnic, next);
114                 bp->nr_vnics++;
115
116                 for (j = 0; j < nb_q_per_grp; j++, ring_idx++) {
117                         rxq = bp->eth_dev->data->rx_queues[ring_idx];
118                         rxq->vnic = vnic;
119                 }
120                 if (i == 0) {
121                         if (dev_conf->rxmode.mq_mode & ETH_MQ_RX_VMDQ_DCB) {
122                                 bp->eth_dev->data->promiscuous = 1;
123                                 vnic->flags |= BNXT_VNIC_INFO_PROMISC;
124                         }
125                         vnic->func_default = true;
126                 }
127                 vnic->ff_pool_idx = i;
128                 vnic->start_grp_id = start_grp_id;
129                 vnic->end_grp_id = end_grp_id;
130
131                 if (i) {
132                         if (dev_conf->rxmode.mq_mode & ETH_MQ_RX_VMDQ_DCB ||
133                             !(dev_conf->rxmode.mq_mode & ETH_MQ_RX_RSS))
134                                 vnic->rss_dflt_cr = true;
135                         goto skip_filter_allocation;
136                 }
137                 filter = bnxt_alloc_filter(bp);
138                 if (!filter) {
139                         PMD_DRV_LOG(ERR, "L2 filter alloc failed\n");
140                         rc = -ENOMEM;
141                         goto err_out;
142                 }
143                 /*
144                  * TODO: Configure & associate CFA rule for
145                  * each VNIC for each VMDq with MACVLAN, MACVLAN+TC
146                  */
147                 STAILQ_INSERT_TAIL(&vnic->filter, filter, next);
148
149 skip_filter_allocation:
150                 start_grp_id = end_grp_id;
151                 end_grp_id += nb_q_per_grp;
152         }
153
154 out:
155         if (dev_conf->rxmode.mq_mode & ETH_MQ_RX_RSS_FLAG) {
156                 struct rte_eth_rss_conf *rss = &dev_conf->rx_adv_conf.rss_conf;
157                 uint16_t hash_type = 0;
158
159                 if (bp->flags & BNXT_FLAG_UPDATE_HASH) {
160                         rss = &bp->rss_conf;
161                         bp->flags &= ~BNXT_FLAG_UPDATE_HASH;
162                 }
163
164                 if (rss->rss_hf & ETH_RSS_IPV4)
165                         hash_type |= HWRM_VNIC_RSS_CFG_INPUT_HASH_TYPE_IPV4;
166                 if (rss->rss_hf & ETH_RSS_NONFRAG_IPV4_TCP)
167                         hash_type |= HWRM_VNIC_RSS_CFG_INPUT_HASH_TYPE_TCP_IPV4;
168                 if (rss->rss_hf & ETH_RSS_NONFRAG_IPV4_UDP)
169                         hash_type |= HWRM_VNIC_RSS_CFG_INPUT_HASH_TYPE_UDP_IPV4;
170                 if (rss->rss_hf & ETH_RSS_IPV6)
171                         hash_type |= HWRM_VNIC_RSS_CFG_INPUT_HASH_TYPE_IPV6;
172                 if (rss->rss_hf & ETH_RSS_NONFRAG_IPV6_TCP)
173                         hash_type |= HWRM_VNIC_RSS_CFG_INPUT_HASH_TYPE_TCP_IPV6;
174                 if (rss->rss_hf & ETH_RSS_NONFRAG_IPV6_UDP)
175                         hash_type |= HWRM_VNIC_RSS_CFG_INPUT_HASH_TYPE_UDP_IPV6;
176
177                 for (i = 0; i < bp->nr_vnics; i++) {
178                         STAILQ_FOREACH(vnic, &bp->ff_pool[i], next) {
179                         vnic->hash_type = hash_type;
180
181                         /*
182                          * Use the supplied key if the key length is
183                          * acceptable and the rss_key is not NULL
184                          */
185                         if (rss->rss_key &&
186                             rss->rss_key_len <= HW_HASH_KEY_SIZE)
187                                 memcpy(vnic->rss_hash_key,
188                                        rss->rss_key, rss->rss_key_len);
189                         }
190                 }
191         }
192
193         return rc;
194
195 err_out:
196         /* Free allocated vnic/filters */
197
198         return rc;
199 }
200
201 static void bnxt_rx_queue_release_mbufs(struct bnxt_rx_queue *rxq)
202 {
203         struct bnxt_sw_rx_bd *sw_ring;
204         struct bnxt_tpa_info *tpa_info;
205         uint16_t i;
206
207         if (rxq) {
208                 sw_ring = rxq->rx_ring->rx_buf_ring;
209                 if (sw_ring) {
210                         for (i = 0; i < rxq->nb_rx_desc; i++) {
211                                 if (sw_ring[i].mbuf) {
212                                         rte_pktmbuf_free_seg(sw_ring[i].mbuf);
213                                         sw_ring[i].mbuf = NULL;
214                                 }
215                         }
216                 }
217                 /* Free up mbufs in Agg ring */
218                 sw_ring = rxq->rx_ring->ag_buf_ring;
219                 if (sw_ring) {
220                         for (i = 0; i < rxq->nb_rx_desc; i++) {
221                                 if (sw_ring[i].mbuf) {
222                                         rte_pktmbuf_free_seg(sw_ring[i].mbuf);
223                                         sw_ring[i].mbuf = NULL;
224                                 }
225                         }
226                 }
227
228                 /* Free up mbufs in TPA */
229                 tpa_info = rxq->rx_ring->tpa_info;
230                 if (tpa_info) {
231                         for (i = 0; i < BNXT_TPA_MAX; i++) {
232                                 if (tpa_info[i].mbuf) {
233                                         rte_pktmbuf_free_seg(tpa_info[i].mbuf);
234                                         tpa_info[i].mbuf = NULL;
235                                 }
236                         }
237                 }
238         }
239 }
240
241 void bnxt_free_rx_mbufs(struct bnxt *bp)
242 {
243         struct bnxt_rx_queue *rxq;
244         int i;
245
246         for (i = 0; i < (int)bp->rx_nr_rings; i++) {
247                 rxq = bp->rx_queues[i];
248                 bnxt_rx_queue_release_mbufs(rxq);
249         }
250 }
251
252 void bnxt_rx_queue_release_op(void *rx_queue)
253 {
254         struct bnxt_rx_queue *rxq = (struct bnxt_rx_queue *)rx_queue;
255
256         if (rxq) {
257                 bnxt_rx_queue_release_mbufs(rxq);
258
259                 /* Free RX ring hardware descriptors */
260                 bnxt_free_ring(rxq->rx_ring->rx_ring_struct);
261                 /* Free RX Agg ring hardware descriptors */
262                 bnxt_free_ring(rxq->rx_ring->ag_ring_struct);
263
264                 /* Free RX completion ring hardware descriptors */
265                 bnxt_free_ring(rxq->cp_ring->cp_ring_struct);
266
267                 bnxt_free_rxq_stats(rxq);
268                 rte_memzone_free(rxq->mz);
269                 rxq->mz = NULL;
270
271                 rte_free(rxq);
272         }
273 }
274
275 int bnxt_rx_queue_setup_op(struct rte_eth_dev *eth_dev,
276                                uint16_t queue_idx,
277                                uint16_t nb_desc,
278                                unsigned int socket_id,
279                                const struct rte_eth_rxconf *rx_conf,
280                                struct rte_mempool *mp)
281 {
282         struct bnxt *bp = (struct bnxt *)eth_dev->data->dev_private;
283         uint64_t rx_offloads = eth_dev->data->dev_conf.rxmode.offloads;
284         struct bnxt_rx_queue *rxq;
285         int rc = 0;
286
287         if (queue_idx >= bp->max_rx_rings) {
288                 PMD_DRV_LOG(ERR,
289                         "Cannot create Rx ring %d. Only %d rings available\n",
290                         queue_idx, bp->max_rx_rings);
291                 return -EINVAL;
292         }
293
294         if (!nb_desc || nb_desc > MAX_RX_DESC_CNT) {
295                 PMD_DRV_LOG(ERR, "nb_desc %d is invalid\n", nb_desc);
296                 rc = -EINVAL;
297                 goto out;
298         }
299
300         if (eth_dev->data->rx_queues) {
301                 rxq = eth_dev->data->rx_queues[queue_idx];
302                 if (rxq)
303                         bnxt_rx_queue_release_op(rxq);
304         }
305         rxq = rte_zmalloc_socket("bnxt_rx_queue", sizeof(struct bnxt_rx_queue),
306                                  RTE_CACHE_LINE_SIZE, socket_id);
307         if (!rxq) {
308                 PMD_DRV_LOG(ERR, "bnxt_rx_queue allocation failed!\n");
309                 rc = -ENOMEM;
310                 goto out;
311         }
312         rxq->bp = bp;
313         rxq->mb_pool = mp;
314         rxq->nb_rx_desc = nb_desc;
315         rxq->rx_free_thresh = rx_conf->rx_free_thresh;
316
317         PMD_DRV_LOG(DEBUG, "RX Buf size is %d\n", rxq->rx_buf_use_size);
318         PMD_DRV_LOG(DEBUG, "RX Buf MTU %d\n", eth_dev->data->mtu);
319
320         rc = bnxt_init_rx_ring_struct(rxq, socket_id);
321         if (rc)
322                 goto out;
323
324         rxq->queue_id = queue_idx;
325         rxq->port_id = eth_dev->data->port_id;
326         rxq->crc_len = rx_offloads & DEV_RX_OFFLOAD_CRC_STRIP ?
327                 0 : ETHER_CRC_LEN;
328
329         eth_dev->data->rx_queues[queue_idx] = rxq;
330         /* Allocate RX ring hardware descriptors */
331         if (bnxt_alloc_rings(bp, queue_idx, NULL, rxq, rxq->cp_ring,
332                         "rxr")) {
333                 PMD_DRV_LOG(ERR,
334                         "ring_dma_zone_reserve for rx_ring failed!\n");
335                 bnxt_rx_queue_release_op(rxq);
336                 rc = -ENOMEM;
337                 goto out;
338         }
339         rte_atomic64_init(&rxq->rx_mbuf_alloc_fail);
340
341 out:
342         return rc;
343 }
344
345 int
346 bnxt_rx_queue_intr_enable_op(struct rte_eth_dev *eth_dev, uint16_t queue_id)
347 {
348         struct bnxt_rx_queue *rxq;
349         struct bnxt_cp_ring_info *cpr;
350         int rc = 0;
351
352         if (eth_dev->data->rx_queues) {
353                 rxq = eth_dev->data->rx_queues[queue_id];
354                 if (!rxq) {
355                         rc = -EINVAL;
356                         return rc;
357                 }
358                 cpr = rxq->cp_ring;
359                 B_CP_DB_ARM(cpr);
360         }
361         return rc;
362 }
363
364 int
365 bnxt_rx_queue_intr_disable_op(struct rte_eth_dev *eth_dev, uint16_t queue_id)
366 {
367         struct bnxt_rx_queue *rxq;
368         struct bnxt_cp_ring_info *cpr;
369         int rc = 0;
370
371         if (eth_dev->data->rx_queues) {
372                 rxq = eth_dev->data->rx_queues[queue_id];
373                 if (!rxq) {
374                         rc = -EINVAL;
375                         return rc;
376                 }
377                 cpr = rxq->cp_ring;
378                 B_CP_DB_DISARM(cpr);
379         }
380         return rc;
381 }
382
383 int bnxt_rx_queue_start(struct rte_eth_dev *dev, uint16_t rx_queue_id)
384 {
385         struct bnxt *bp = (struct bnxt *)dev->data->dev_private;
386         struct rte_eth_conf *dev_conf = &bp->eth_dev->data->dev_conf;
387         struct bnxt_rx_queue *rxq = bp->rx_queues[rx_queue_id];
388         struct bnxt_vnic_info *vnic = NULL;
389
390         if (rxq == NULL) {
391                 PMD_DRV_LOG(ERR, "Invalid Rx queue %d\n", rx_queue_id);
392                 return -EINVAL;
393         }
394
395         dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
396         rxq->rx_deferred_start = false;
397         PMD_DRV_LOG(INFO, "Rx queue started %d\n", rx_queue_id);
398         if (dev_conf->rxmode.mq_mode & ETH_MQ_RX_RSS_FLAG) {
399                 vnic = rxq->vnic;
400                 if (vnic->fw_grp_ids[rx_queue_id] != INVALID_HW_RING_ID)
401                         return 0;
402                 PMD_DRV_LOG(DEBUG, "vnic = %p fw_grp_id = %d\n",
403                         vnic, bp->grp_info[rx_queue_id + 1].fw_grp_id);
404                 vnic->fw_grp_ids[rx_queue_id] =
405                                         bp->grp_info[rx_queue_id + 1].fw_grp_id;
406                 return bnxt_vnic_rss_configure(bp, vnic);
407         }
408
409         return 0;
410 }
411
412 int bnxt_rx_queue_stop(struct rte_eth_dev *dev, uint16_t rx_queue_id)
413 {
414         struct bnxt *bp = (struct bnxt *)dev->data->dev_private;
415         struct rte_eth_conf *dev_conf = &bp->eth_dev->data->dev_conf;
416         struct bnxt_rx_queue *rxq = bp->rx_queues[rx_queue_id];
417         struct bnxt_vnic_info *vnic = NULL;
418
419         if (rxq == NULL) {
420                 PMD_DRV_LOG(ERR, "Invalid Rx queue %d\n", rx_queue_id);
421                 return -EINVAL;
422         }
423
424         dev->data->rx_queue_state[rx_queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
425         rxq->rx_deferred_start = true;
426         PMD_DRV_LOG(DEBUG, "Rx queue stopped\n");
427
428         if (dev_conf->rxmode.mq_mode & ETH_MQ_RX_RSS_FLAG) {
429                 vnic = rxq->vnic;
430                 vnic->fw_grp_ids[rx_queue_id] = INVALID_HW_RING_ID;
431                 return bnxt_vnic_rss_configure(bp, vnic);
432         }
433         return 0;
434 }