Commit | Line | Data |
---|---|---|
e586b3b0 AV |
1 | /* |
2 | * Copyright (c) 2013-2015, Mellanox Technologies, Ltd. 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/mlx5/driver.h> | |
34 | #include "wq.h" | |
35 | #include "mlx5_core.h" | |
36 | ||
4972e6fa | 37 | static u32 wq_get_byte_sz(u8 log_sz, u8 log_stride) |
e586b3b0 | 38 | { |
4972e6fa | 39 | return ((u32)1 << log_sz) << log_stride; |
e586b3b0 AV |
40 | } |
41 | ||
42 | int mlx5_wq_cyc_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param, | |
43 | void *wqc, struct mlx5_wq_cyc *wq, | |
44 | struct mlx5_wq_ctrl *wq_ctrl) | |
45 | { | |
4972e6fa TT |
46 | u8 log_wq_stride = MLX5_GET(wq, wqc, log_wq_stride); |
47 | u8 log_wq_sz = MLX5_GET(wq, wqc, log_wq_sz); | |
3a2f7033 | 48 | struct mlx5_frag_buf_ctrl *fbc = &wq->fbc; |
e586b3b0 AV |
49 | int err; |
50 | ||
311c7c71 | 51 | err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node); |
e586b3b0 | 52 | if (err) { |
f299a02d | 53 | mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err); |
e586b3b0 AV |
54 | return err; |
55 | } | |
56 | ||
4972e6fa TT |
57 | wq->db = wq_ctrl->db.db; |
58 | ||
59 | err = mlx5_frag_buf_alloc_node(mdev, wq_get_byte_sz(log_wq_sz, log_wq_stride), | |
3a2f7033 | 60 | &wq_ctrl->buf, param->buf_numa_node); |
e586b3b0 | 61 | if (err) { |
3a2f7033 | 62 | mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err); |
e586b3b0 AV |
63 | goto err_db_free; |
64 | } | |
65 | ||
4972e6fa TT |
66 | mlx5_init_fbc(wq_ctrl->buf.frags, log_wq_stride, log_wq_sz, fbc); |
67 | wq->sz = mlx5_wq_cyc_get_size(wq); | |
e586b3b0 AV |
68 | |
69 | wq_ctrl->mdev = mdev; | |
70 | ||
71 | return 0; | |
72 | ||
73 | err_db_free: | |
74 | mlx5_db_free(mdev, &wq_ctrl->db); | |
75 | ||
76 | return err; | |
77 | } | |
78 | ||
130c7b46 SM |
79 | void mlx5_wq_cyc_wqe_dump(struct mlx5_wq_cyc *wq, u16 ix, u8 nstrides) |
80 | { | |
81 | size_t len; | |
82 | void *wqe; | |
83 | ||
84 | if (!net_ratelimit()) | |
85 | return; | |
86 | ||
87 | nstrides = max_t(u8, nstrides, 1); | |
88 | ||
89 | len = nstrides << wq->fbc.log_stride; | |
90 | wqe = mlx5_wq_cyc_get_wqe(wq, ix); | |
91 | ||
ca9c74ae | 92 | pr_info("WQE DUMP: WQ size %d WQ cur size %d, WQE index 0x%x, len: %zu\n", |
130c7b46 SM |
93 | mlx5_wq_cyc_get_size(wq), wq->cur_sz, ix, len); |
94 | print_hex_dump(KERN_WARNING, "", DUMP_PREFIX_OFFSET, 16, 1, wqe, len, false); | |
95 | } | |
96 | ||
5ee090ed AL |
97 | void mlx5_wq_cyc_reset(struct mlx5_wq_cyc *wq) |
98 | { | |
99 | wq->wqe_ctr = 0; | |
100 | wq->cur_sz = 0; | |
101 | mlx5_wq_cyc_update_db_record(wq); | |
102 | } | |
103 | ||
3f2b7edd IT |
104 | int mlx5_wq_qp_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param, |
105 | void *qpc, struct mlx5_wq_qp *wq, | |
106 | struct mlx5_wq_ctrl *wq_ctrl) | |
107 | { | |
4972e6fa TT |
108 | u8 log_rq_stride = MLX5_GET(qpc, qpc, log_rq_stride) + 4; |
109 | u8 log_rq_sz = MLX5_GET(qpc, qpc, log_rq_size); | |
110 | u8 log_sq_stride = ilog2(MLX5_SEND_WQE_BB); | |
111 | u8 log_sq_sz = MLX5_GET(qpc, qpc, log_sq_size); | |
3f2b7edd | 112 | |
4972e6fa TT |
113 | u32 rq_byte_size; |
114 | int err; | |
d7037ad7 | 115 | |
d7037ad7 | 116 | |
3f2b7edd IT |
117 | |
118 | err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node); | |
119 | if (err) { | |
120 | mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err); | |
121 | return err; | |
122 | } | |
123 | ||
4972e6fa TT |
124 | err = mlx5_frag_buf_alloc_node(mdev, |
125 | wq_get_byte_sz(log_rq_sz, log_rq_stride) + | |
126 | wq_get_byte_sz(log_sq_sz, log_sq_stride), | |
3a2f7033 | 127 | &wq_ctrl->buf, param->buf_numa_node); |
3f2b7edd | 128 | if (err) { |
3a2f7033 | 129 | mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err); |
3f2b7edd IT |
130 | goto err_db_free; |
131 | } | |
132 | ||
4972e6fa TT |
133 | mlx5_init_fbc(wq_ctrl->buf.frags, log_rq_stride, log_rq_sz, &wq->rq.fbc); |
134 | ||
135 | rq_byte_size = wq_get_byte_sz(log_rq_sz, log_rq_stride); | |
136 | ||
137 | if (rq_byte_size < PAGE_SIZE) { | |
138 | /* SQ starts within the same page of the RQ */ | |
139 | u16 sq_strides_offset = rq_byte_size / MLX5_SEND_WQE_BB; | |
140 | ||
141 | mlx5_init_fbc_offset(wq_ctrl->buf.frags, | |
142 | log_sq_stride, log_sq_sz, sq_strides_offset, | |
143 | &wq->sq.fbc); | |
144 | } else { | |
145 | u16 rq_npages = rq_byte_size >> PAGE_SHIFT; | |
146 | ||
147 | mlx5_init_fbc(wq_ctrl->buf.frags + rq_npages, | |
148 | log_sq_stride, log_sq_sz, &wq->sq.fbc); | |
149 | } | |
3a2f7033 | 150 | |
3f2b7edd IT |
151 | wq->rq.db = &wq_ctrl->db.db[MLX5_RCV_DBR]; |
152 | wq->sq.db = &wq_ctrl->db.db[MLX5_SND_DBR]; | |
153 | ||
154 | wq_ctrl->mdev = mdev; | |
155 | ||
156 | return 0; | |
157 | ||
158 | err_db_free: | |
159 | mlx5_db_free(mdev, &wq_ctrl->db); | |
160 | ||
161 | return err; | |
162 | } | |
163 | ||
e586b3b0 AV |
164 | int mlx5_cqwq_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param, |
165 | void *cqc, struct mlx5_cqwq *wq, | |
3a2f7033 | 166 | struct mlx5_wq_ctrl *wq_ctrl) |
e586b3b0 | 167 | { |
939de57d DJ |
168 | /* CQE_STRIDE_128 and CQE_STRIDE_128_PAD both mean 128B stride */ |
169 | u8 log_wq_stride = MLX5_GET(cqc, cqc, cqe_sz) == CQE_STRIDE_64 ? 6 : 7; | |
4972e6fa | 170 | u8 log_wq_sz = MLX5_GET(cqc, cqc, log_cq_size); |
e586b3b0 AV |
171 | int err; |
172 | ||
311c7c71 | 173 | err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node); |
e586b3b0 | 174 | if (err) { |
f299a02d | 175 | mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err); |
e586b3b0 AV |
176 | return err; |
177 | } | |
178 | ||
4972e6fa TT |
179 | wq->db = wq_ctrl->db.db; |
180 | ||
181 | err = mlx5_frag_buf_alloc_node(mdev, wq_get_byte_sz(log_wq_sz, log_wq_stride), | |
3a2f7033 | 182 | &wq_ctrl->buf, |
1c1b5228 | 183 | param->buf_numa_node); |
e586b3b0 | 184 | if (err) { |
1c1b5228 TT |
185 | mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", |
186 | err); | |
e586b3b0 AV |
187 | goto err_db_free; |
188 | } | |
189 | ||
4972e6fa | 190 | mlx5_init_fbc(wq_ctrl->buf.frags, log_wq_stride, log_wq_sz, &wq->fbc); |
e586b3b0 AV |
191 | |
192 | wq_ctrl->mdev = mdev; | |
193 | ||
194 | return 0; | |
195 | ||
196 | err_db_free: | |
197 | mlx5_db_free(mdev, &wq_ctrl->db); | |
198 | ||
199 | return err; | |
200 | } | |
201 | ||
5ee090ed AL |
202 | static void mlx5_wq_ll_init_list(struct mlx5_wq_ll *wq) |
203 | { | |
204 | struct mlx5_wqe_srq_next_seg *next_seg; | |
205 | int i; | |
206 | ||
207 | for (i = 0; i < wq->fbc.sz_m1; i++) { | |
208 | next_seg = mlx5_wq_ll_get_wqe(wq, i); | |
209 | next_seg->next_wqe_index = cpu_to_be16(i + 1); | |
210 | } | |
211 | next_seg = mlx5_wq_ll_get_wqe(wq, i); | |
212 | wq->tail_next = &next_seg->next_wqe_index; | |
213 | } | |
214 | ||
e586b3b0 AV |
215 | int mlx5_wq_ll_create(struct mlx5_core_dev *mdev, struct mlx5_wq_param *param, |
216 | void *wqc, struct mlx5_wq_ll *wq, | |
217 | struct mlx5_wq_ctrl *wq_ctrl) | |
218 | { | |
4972e6fa TT |
219 | u8 log_wq_stride = MLX5_GET(wq, wqc, log_wq_stride); |
220 | u8 log_wq_sz = MLX5_GET(wq, wqc, log_wq_sz); | |
3a2f7033 | 221 | struct mlx5_frag_buf_ctrl *fbc = &wq->fbc; |
e586b3b0 | 222 | int err; |
e586b3b0 | 223 | |
311c7c71 | 224 | err = mlx5_db_alloc_node(mdev, &wq_ctrl->db, param->db_numa_node); |
e586b3b0 | 225 | if (err) { |
f299a02d | 226 | mlx5_core_warn(mdev, "mlx5_db_alloc_node() failed, %d\n", err); |
e586b3b0 AV |
227 | return err; |
228 | } | |
229 | ||
4972e6fa TT |
230 | wq->db = wq_ctrl->db.db; |
231 | ||
232 | err = mlx5_frag_buf_alloc_node(mdev, wq_get_byte_sz(log_wq_sz, log_wq_stride), | |
3a2f7033 | 233 | &wq_ctrl->buf, param->buf_numa_node); |
e586b3b0 | 234 | if (err) { |
3a2f7033 | 235 | mlx5_core_warn(mdev, "mlx5_frag_buf_alloc_node() failed, %d\n", err); |
e586b3b0 AV |
236 | goto err_db_free; |
237 | } | |
238 | ||
4972e6fa | 239 | mlx5_init_fbc(wq_ctrl->buf.frags, log_wq_stride, log_wq_sz, fbc); |
e586b3b0 | 240 | |
5ee090ed | 241 | mlx5_wq_ll_init_list(wq); |
e586b3b0 AV |
242 | wq_ctrl->mdev = mdev; |
243 | ||
244 | return 0; | |
245 | ||
246 | err_db_free: | |
247 | mlx5_db_free(mdev, &wq_ctrl->db); | |
248 | ||
249 | return err; | |
250 | } | |
251 | ||
5ee090ed AL |
252 | void mlx5_wq_ll_reset(struct mlx5_wq_ll *wq) |
253 | { | |
254 | wq->head = 0; | |
255 | wq->wqe_ctr = 0; | |
256 | wq->cur_sz = 0; | |
257 | mlx5_wq_ll_init_list(wq); | |
258 | mlx5_wq_ll_update_db_record(wq); | |
259 | } | |
260 | ||
e586b3b0 AV |
261 | void mlx5_wq_destroy(struct mlx5_wq_ctrl *wq_ctrl) |
262 | { | |
3a2f7033 | 263 | mlx5_frag_buf_free(wq_ctrl->mdev, &wq_ctrl->buf); |
e586b3b0 AV |
264 | mlx5_db_free(wq_ctrl->mdev, &wq_ctrl->db); |
265 | } | |
1c1b5228 | 266 |