649675c1af61e848cdad0cb9c0549feef42566d1
[sfrench/cifs-2.6.git] / drivers / net / ethernet / mellanox / mlx5 / core / en / xdp.c
1 /*
2  * Copyright (c) 2018, Mellanox Technologies. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32
33 #include <linux/bpf_trace.h>
34 #include "en/xdp.h"
35
36 /* returns true if packet was consumed by xdp */
37 bool mlx5e_xdp_handle(struct mlx5e_rq *rq, struct mlx5e_dma_info *di,
38                       void *va, u16 *rx_headroom, u32 *len)
39 {
40         struct bpf_prog *prog = READ_ONCE(rq->xdp_prog);
41         struct xdp_buff xdp;
42         u32 act;
43         int err;
44
45         if (!prog)
46                 return false;
47
48         xdp.data = va + *rx_headroom;
49         xdp_set_data_meta_invalid(&xdp);
50         xdp.data_end = xdp.data + *len;
51         xdp.data_hard_start = va;
52         xdp.rxq = &rq->xdp_rxq;
53
54         act = bpf_prog_run_xdp(prog, &xdp);
55         switch (act) {
56         case XDP_PASS:
57                 *rx_headroom = xdp.data - xdp.data_hard_start;
58                 *len = xdp.data_end - xdp.data;
59                 return false;
60         case XDP_TX:
61                 if (unlikely(!mlx5e_xmit_xdp_frame(rq, di, &xdp)))
62                         trace_xdp_exception(rq->netdev, prog, act);
63                 return true;
64         case XDP_REDIRECT:
65                 /* When XDP enabled then page-refcnt==1 here */
66                 err = xdp_do_redirect(rq->netdev, &xdp, prog);
67                 if (!err) {
68                         __set_bit(MLX5E_RQ_FLAG_XDP_XMIT, rq->flags);
69                         rq->xdpsq.db.redirect_flush = true;
70                         mlx5e_page_dma_unmap(rq, di);
71                 }
72                 return true;
73         default:
74                 bpf_warn_invalid_xdp_action(act);
75         case XDP_ABORTED:
76                 trace_xdp_exception(rq->netdev, prog, act);
77         case XDP_DROP:
78                 rq->stats->xdp_drop++;
79                 return true;
80         }
81 }
82
83 bool mlx5e_xmit_xdp_frame(struct mlx5e_rq *rq, struct mlx5e_dma_info *di,
84                           const struct xdp_buff *xdp)
85 {
86         struct mlx5e_xdpsq       *sq   = &rq->xdpsq;
87         struct mlx5_wq_cyc       *wq   = &sq->wq;
88         u16                       pi   = mlx5_wq_cyc_ctr2ix(wq, sq->pc);
89         struct mlx5e_tx_wqe      *wqe  = mlx5_wq_cyc_get_wqe(wq, pi);
90
91         struct mlx5_wqe_ctrl_seg *cseg = &wqe->ctrl;
92         struct mlx5_wqe_eth_seg  *eseg = &wqe->eth;
93         struct mlx5_wqe_data_seg *dseg;
94
95         ptrdiff_t data_offset = xdp->data - xdp->data_hard_start;
96         dma_addr_t dma_addr  = di->addr + data_offset;
97         unsigned int dma_len = xdp->data_end - xdp->data;
98
99         struct mlx5e_rq_stats *stats = rq->stats;
100
101         prefetchw(wqe);
102
103         if (unlikely(dma_len < MLX5E_XDP_MIN_INLINE || rq->hw_mtu < dma_len)) {
104                 stats->xdp_drop++;
105                 return false;
106         }
107
108         if (unlikely(!mlx5e_wqc_has_room_for(wq, sq->cc, sq->pc, 1))) {
109                 if (sq->db.doorbell) {
110                         /* SQ is full, ring doorbell */
111                         mlx5e_xmit_xdp_doorbell(sq);
112                         sq->db.doorbell = false;
113                 }
114                 stats->xdp_tx_full++;
115                 return false;
116         }
117
118         dma_sync_single_for_device(sq->pdev, dma_addr, dma_len, PCI_DMA_TODEVICE);
119
120         cseg->fm_ce_se = 0;
121
122         dseg = (struct mlx5_wqe_data_seg *)eseg + 1;
123
124         /* copy the inline part if required */
125         if (sq->min_inline_mode != MLX5_INLINE_MODE_NONE) {
126                 memcpy(eseg->inline_hdr.start, xdp->data, MLX5E_XDP_MIN_INLINE);
127                 eseg->inline_hdr.sz = cpu_to_be16(MLX5E_XDP_MIN_INLINE);
128                 dma_len  -= MLX5E_XDP_MIN_INLINE;
129                 dma_addr += MLX5E_XDP_MIN_INLINE;
130                 dseg++;
131         }
132
133         /* write the dma part */
134         dseg->addr       = cpu_to_be64(dma_addr);
135         dseg->byte_count = cpu_to_be32(dma_len);
136
137         cseg->opmod_idx_opcode = cpu_to_be32((sq->pc << 8) | MLX5_OPCODE_SEND);
138
139         /* move page to reference to sq responsibility,
140          * and mark so it's not put back in page-cache.
141          */
142         __set_bit(MLX5E_RQ_FLAG_XDP_XMIT, rq->flags); /* non-atomic */
143         sq->db.di[pi] = *di;
144         sq->pc++;
145
146         sq->db.doorbell = true;
147
148         stats->xdp_tx++;
149         return true;
150 }
151
152 bool mlx5e_poll_xdpsq_cq(struct mlx5e_cq *cq)
153 {
154         struct mlx5e_xdpsq *sq;
155         struct mlx5_cqe64 *cqe;
156         struct mlx5e_rq *rq;
157         u16 sqcc;
158         int i;
159
160         sq = container_of(cq, struct mlx5e_xdpsq, cq);
161
162         if (unlikely(!test_bit(MLX5E_SQ_STATE_ENABLED, &sq->state)))
163                 return false;
164
165         cqe = mlx5_cqwq_get_cqe(&cq->wq);
166         if (!cqe)
167                 return false;
168
169         rq = container_of(sq, struct mlx5e_rq, xdpsq);
170
171         /* sq->cc must be updated only after mlx5_cqwq_update_db_record(),
172          * otherwise a cq overrun may occur
173          */
174         sqcc = sq->cc;
175
176         i = 0;
177         do {
178                 u16 wqe_counter;
179                 bool last_wqe;
180
181                 mlx5_cqwq_pop(&cq->wq);
182
183                 wqe_counter = be16_to_cpu(cqe->wqe_counter);
184
185                 do {
186                         struct mlx5e_dma_info *di;
187                         u16 ci;
188
189                         last_wqe = (sqcc == wqe_counter);
190
191                         ci = mlx5_wq_cyc_ctr2ix(&sq->wq, sqcc);
192                         di = &sq->db.di[ci];
193
194                         sqcc++;
195                         /* Recycle RX page */
196                         mlx5e_page_release(rq, di, true);
197                 } while (!last_wqe);
198         } while ((++i < MLX5E_TX_CQ_POLL_BUDGET) && (cqe = mlx5_cqwq_get_cqe(&cq->wq)));
199
200         rq->stats->xdp_tx_cqe += i;
201
202         mlx5_cqwq_update_db_record(&cq->wq);
203
204         /* ensure cq space is freed before enabling more cqes */
205         wmb();
206
207         sq->cc = sqcc;
208         return (i == MLX5E_TX_CQ_POLL_BUDGET);
209 }
210
211 void mlx5e_free_xdpsq_descs(struct mlx5e_xdpsq *sq)
212 {
213         struct mlx5e_rq *rq = container_of(sq, struct mlx5e_rq, xdpsq);
214         struct mlx5e_dma_info *di;
215         u16 ci;
216
217         while (sq->cc != sq->pc) {
218                 ci = mlx5_wq_cyc_ctr2ix(&sq->wq, sq->cc);
219                 di = &sq->db.di[ci];
220                 sq->cc++;
221
222                 mlx5e_page_release(rq, di, false);
223         }
224 }
225