1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33#include "en.h"
34
35struct mlx5_cqe64 *mlx5e_get_cqe(struct mlx5e_cq *cq)
36{
37 struct mlx5_cqwq *wq = &cq->wq;
38 u32 ci = mlx5_cqwq_get_ci(wq);
39 struct mlx5_cqe64 *cqe = mlx5_cqwq_get_wqe(wq, ci);
40 int cqe_ownership_bit = cqe->op_own & MLX5_CQE_OWNER_MASK;
41 int sw_ownership_val = mlx5_cqwq_get_wrap_cnt(wq) & 1;
42
43 if (cqe_ownership_bit != sw_ownership_val)
44 return NULL;
45
46
47 rmb();
48
49 return cqe;
50}
51
52static void mlx5e_poll_ico_cq(struct mlx5e_cq *cq)
53{
54 struct mlx5e_sq *sq = container_of(cq, struct mlx5e_sq, cq);
55 struct mlx5_wq_cyc *wq;
56 struct mlx5_cqe64 *cqe;
57 u16 sqcc;
58
59 if (unlikely(!test_bit(MLX5E_SQ_STATE_ENABLED, &sq->state)))
60 return;
61
62 cqe = mlx5e_get_cqe(cq);
63 if (likely(!cqe))
64 return;
65
66 wq = &sq->wq;
67
68
69
70
71 sqcc = sq->cc;
72
73 do {
74 u16 ci = be16_to_cpu(cqe->wqe_counter) & wq->sz_m1;
75 struct mlx5e_ico_wqe_info *icowi = &sq->db.ico_wqe[ci];
76
77 mlx5_cqwq_pop(&cq->wq);
78 sqcc += icowi->num_wqebbs;
79
80 if (unlikely((cqe->op_own >> 4) != MLX5_CQE_REQ)) {
81 WARN_ONCE(true, "mlx5e: Bad OP in ICOSQ CQE: 0x%x\n",
82 cqe->op_own);
83 break;
84 }
85
86 switch (icowi->opcode) {
87 case MLX5_OPCODE_NOP:
88 break;
89 case MLX5_OPCODE_UMR:
90 mlx5e_post_rx_mpwqe(&sq->channel->rq);
91 break;
92 default:
93 WARN_ONCE(true,
94 "mlx5e: Bad OPCODE in ICOSQ WQE info: 0x%x\n",
95 icowi->opcode);
96 }
97
98 } while ((cqe = mlx5e_get_cqe(cq)));
99
100 mlx5_cqwq_update_db_record(&cq->wq);
101
102
103 wmb();
104
105 sq->cc = sqcc;
106}
107
108int mlx5e_napi_poll(struct napi_struct *napi, int budget)
109{
110 struct mlx5e_channel *c = container_of(napi, struct mlx5e_channel,
111 napi);
112 bool busy = false;
113 int work_done;
114 int i;
115
116 clear_bit(MLX5E_CHANNEL_NAPI_SCHED, &c->flags);
117
118 for (i = 0; i < c->num_tc; i++)
119 busy |= mlx5e_poll_tx_cq(&c->sq[i].cq, budget);
120
121 work_done = mlx5e_poll_rx_cq(&c->rq.cq, budget);
122 busy |= work_done == budget;
123
124 mlx5e_poll_ico_cq(&c->icosq.cq);
125
126 busy |= mlx5e_post_rx_wqes(&c->rq);
127
128 if (busy)
129 return budget;
130
131 napi_complete_done(napi, work_done);
132
133
134 if (test_bit(MLX5E_CHANNEL_NAPI_SCHED, &c->flags)) {
135 napi_schedule(napi);
136 return work_done;
137 }
138
139 for (i = 0; i < c->num_tc; i++)
140 mlx5e_cq_arm(&c->sq[i].cq);
141
142 if (test_bit(MLX5E_RQ_STATE_AM, &c->rq.state))
143 mlx5e_rx_am(&c->rq);
144
145 mlx5e_cq_arm(&c->rq.cq);
146 mlx5e_cq_arm(&c->icosq.cq);
147
148 return work_done;
149}
150
151void mlx5e_completion_event(struct mlx5_core_cq *mcq)
152{
153 struct mlx5e_cq *cq = container_of(mcq, struct mlx5e_cq, mcq);
154
155 cq->event_ctr++;
156 set_bit(MLX5E_CHANNEL_NAPI_SCHED, &cq->channel->flags);
157 napi_schedule(cq->napi);
158}
159
160void mlx5e_cq_error_event(struct mlx5_core_cq *mcq, enum mlx5_event event)
161{
162 struct mlx5e_cq *cq = container_of(mcq, struct mlx5e_cq, mcq);
163 struct mlx5e_channel *c = cq->channel;
164 struct mlx5e_priv *priv = c->priv;
165 struct net_device *netdev = priv->netdev;
166
167 netdev_err(netdev, "%s: cqn=0x%.6x event=0x%.2x\n",
168 __func__, mcq->cqn, event);
169}
170