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