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 <linux/kernel.h>
34#include <linux/module.h>
35#include <linux/mlx5/driver.h>
36#include <linux/mlx5/cmd.h>
37#include "mlx5_core.h"
38
39void mlx5_init_mkey_table(struct mlx5_core_dev *dev)
40{
41 struct mlx5_mkey_table *table = &dev->priv.mkey_table;
42
43 memset(table, 0, sizeof(*table));
44 rwlock_init(&table->lock);
45 INIT_RADIX_TREE(&table->tree, GFP_ATOMIC);
46}
47
48void mlx5_cleanup_mkey_table(struct mlx5_core_dev *dev)
49{
50}
51
52int mlx5_core_create_mkey(struct mlx5_core_dev *dev,
53 struct mlx5_core_mkey *mkey,
54 struct mlx5_create_mkey_mbox_in *in, int inlen,
55 mlx5_cmd_cbk_t callback, void *context,
56 struct mlx5_create_mkey_mbox_out *out)
57{
58 struct mlx5_mkey_table *table = &dev->priv.mkey_table;
59 struct mlx5_create_mkey_mbox_out lout;
60 int err;
61 u8 key;
62
63 memset(&lout, 0, sizeof(lout));
64 spin_lock_irq(&dev->priv.mkey_lock);
65 key = dev->priv.mkey_key++;
66 spin_unlock_irq(&dev->priv.mkey_lock);
67 in->seg.qpn_mkey7_0 |= cpu_to_be32(key);
68 in->hdr.opcode = cpu_to_be16(MLX5_CMD_OP_CREATE_MKEY);
69 if (callback) {
70 err = mlx5_cmd_exec_cb(dev, in, inlen, out, sizeof(*out),
71 callback, context);
72 return err;
73 } else {
74 err = mlx5_cmd_exec(dev, in, inlen, &lout, sizeof(lout));
75 }
76
77 if (err) {
78 mlx5_core_dbg(dev, "cmd exec failed %d\n", err);
79 return err;
80 }
81
82 if (lout.hdr.status) {
83 mlx5_core_dbg(dev, "status %d\n", lout.hdr.status);
84 return mlx5_cmd_status_to_err(&lout.hdr);
85 }
86
87 mkey->iova = be64_to_cpu(in->seg.start_addr);
88 mkey->size = be64_to_cpu(in->seg.len);
89 mkey->key = mlx5_idx_to_mkey(be32_to_cpu(lout.mkey) & 0xffffff) | key;
90 mkey->pd = be32_to_cpu(in->seg.flags_pd) & 0xffffff;
91
92 mlx5_core_dbg(dev, "out 0x%x, key 0x%x, mkey 0x%x\n",
93 be32_to_cpu(lout.mkey), key, mkey->key);
94
95
96 write_lock_irq(&table->lock);
97 err = radix_tree_insert(&table->tree, mlx5_base_mkey(mkey->key), mkey);
98 write_unlock_irq(&table->lock);
99 if (err) {
100 mlx5_core_warn(dev, "failed radix tree insert of mkey 0x%x, %d\n",
101 mlx5_base_mkey(mkey->key), err);
102 mlx5_core_destroy_mkey(dev, mkey);
103 }
104
105 return err;
106}
107EXPORT_SYMBOL(mlx5_core_create_mkey);
108
109int mlx5_core_destroy_mkey(struct mlx5_core_dev *dev,
110 struct mlx5_core_mkey *mkey)
111{
112 struct mlx5_mkey_table *table = &dev->priv.mkey_table;
113 struct mlx5_destroy_mkey_mbox_in in;
114 struct mlx5_destroy_mkey_mbox_out out;
115 struct mlx5_core_mkey *deleted_mkey;
116 unsigned long flags;
117 int err;
118
119 memset(&in, 0, sizeof(in));
120 memset(&out, 0, sizeof(out));
121
122 write_lock_irqsave(&table->lock, flags);
123 deleted_mkey = radix_tree_delete(&table->tree, mlx5_base_mkey(mkey->key));
124 write_unlock_irqrestore(&table->lock, flags);
125 if (!deleted_mkey) {
126 mlx5_core_warn(dev, "failed radix tree delete of mkey 0x%x\n",
127 mlx5_base_mkey(mkey->key));
128 return -ENOENT;
129 }
130
131 in.hdr.opcode = cpu_to_be16(MLX5_CMD_OP_DESTROY_MKEY);
132 in.mkey = cpu_to_be32(mlx5_mkey_to_idx(mkey->key));
133 err = mlx5_cmd_exec(dev, &in, sizeof(in), &out, sizeof(out));
134 if (err)
135 return err;
136
137 if (out.hdr.status)
138 return mlx5_cmd_status_to_err(&out.hdr);
139
140 return err;
141}
142EXPORT_SYMBOL(mlx5_core_destroy_mkey);
143
144int mlx5_core_query_mkey(struct mlx5_core_dev *dev, struct mlx5_core_mkey *mkey,
145 struct mlx5_query_mkey_mbox_out *out, int outlen)
146{
147 struct mlx5_query_mkey_mbox_in in;
148 int err;
149
150 memset(&in, 0, sizeof(in));
151 memset(out, 0, outlen);
152
153 in.hdr.opcode = cpu_to_be16(MLX5_CMD_OP_QUERY_MKEY);
154 in.mkey = cpu_to_be32(mlx5_mkey_to_idx(mkey->key));
155 err = mlx5_cmd_exec(dev, &in, sizeof(in), out, outlen);
156 if (err)
157 return err;
158
159 if (out->hdr.status)
160 return mlx5_cmd_status_to_err(&out->hdr);
161
162 return err;
163}
164EXPORT_SYMBOL(mlx5_core_query_mkey);
165
166int mlx5_core_dump_fill_mkey(struct mlx5_core_dev *dev, struct mlx5_core_mkey *_mkey,
167 u32 *mkey)
168{
169 struct mlx5_query_special_ctxs_mbox_in in;
170 struct mlx5_query_special_ctxs_mbox_out out;
171 int err;
172
173 memset(&in, 0, sizeof(in));
174 memset(&out, 0, sizeof(out));
175
176 in.hdr.opcode = cpu_to_be16(MLX5_CMD_OP_QUERY_SPECIAL_CONTEXTS);
177 err = mlx5_cmd_exec(dev, &in, sizeof(in), &out, sizeof(out));
178 if (err)
179 return err;
180
181 if (out.hdr.status)
182 return mlx5_cmd_status_to_err(&out.hdr);
183
184 *mkey = be32_to_cpu(out.dump_fill_mkey);
185
186 return err;
187}
188EXPORT_SYMBOL(mlx5_core_dump_fill_mkey);
189
190int mlx5_core_create_psv(struct mlx5_core_dev *dev, u32 pdn,
191 int npsvs, u32 *sig_index)
192{
193 struct mlx5_allocate_psv_in in;
194 struct mlx5_allocate_psv_out out;
195 int i, err;
196
197 if (npsvs > MLX5_MAX_PSVS)
198 return -EINVAL;
199
200 memset(&in, 0, sizeof(in));
201 memset(&out, 0, sizeof(out));
202
203 in.hdr.opcode = cpu_to_be16(MLX5_CMD_OP_CREATE_PSV);
204 in.npsv_pd = cpu_to_be32((npsvs << 28) | pdn);
205 err = mlx5_cmd_exec(dev, &in, sizeof(in), &out, sizeof(out));
206 if (err) {
207 mlx5_core_err(dev, "cmd exec failed %d\n", err);
208 return err;
209 }
210
211 if (out.hdr.status) {
212 mlx5_core_err(dev, "create_psv bad status %d\n",
213 out.hdr.status);
214 return mlx5_cmd_status_to_err(&out.hdr);
215 }
216
217 for (i = 0; i < npsvs; i++)
218 sig_index[i] = be32_to_cpu(out.psv_idx[i]) & 0xffffff;
219
220 return err;
221}
222EXPORT_SYMBOL(mlx5_core_create_psv);
223
224int mlx5_core_destroy_psv(struct mlx5_core_dev *dev, int psv_num)
225{
226 struct mlx5_destroy_psv_in in;
227 struct mlx5_destroy_psv_out out;
228 int err;
229
230 memset(&in, 0, sizeof(in));
231 memset(&out, 0, sizeof(out));
232
233 in.psv_number = cpu_to_be32(psv_num);
234 in.hdr.opcode = cpu_to_be16(MLX5_CMD_OP_DESTROY_PSV);
235 err = mlx5_cmd_exec(dev, &in, sizeof(in), &out, sizeof(out));
236 if (err) {
237 mlx5_core_err(dev, "destroy_psv cmd exec failed %d\n", err);
238 goto out;
239 }
240
241 if (out.hdr.status) {
242 mlx5_core_err(dev, "destroy_psv bad status %d\n",
243 out.hdr.status);
244 err = mlx5_cmd_status_to_err(&out.hdr);
245 goto out;
246 }
247
248out:
249 return err;
250}
251EXPORT_SYMBOL(mlx5_core_destroy_psv);
252
