1/*
2 * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved.
3 * Copyright (c) 2005, 2006, 2007, 2008 Mellanox Technologies.
4 * All rights reserved.
5 *
6 * This software is available to you under a choice of one of two
7 * licenses. You may choose to be licensed under the terms of the GNU
8 * General Public License (GPL) Version 2, available from the file
9 * COPYING in the main directory of this source tree, or the
10 * OpenIB.org BSD license below:
11 *
12 * Redistribution and use in source and binary forms, with or
13 * without modification, are permitted provided that the following
14 * conditions are met:
15 *
16 * - Redistributions of source code must retain the above
17 * copyright notice, this list of conditions and the following
18 * disclaimer.
19 *
20 * - Redistributions in binary form must reproduce the above
21 * copyright notice, this list of conditions and the following
22 * disclaimer in the documentation and/or other materials
23 * provided with the distribution.
24 *
25 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32 * SOFTWARE.
33 */
34
35#include <linux/export.h>
36#include "fw_qos.h"
37#include "fw.h"
38
39enum {
40 /* allocate vpp opcode modifiers */
41 MLX4_ALLOCATE_VPP_ALLOCATE = 0x0,
42 MLX4_ALLOCATE_VPP_QUERY = 0x1
43};
44
45enum {
46 /* set vport qos opcode modifiers */
47 MLX4_SET_VPORT_QOS_SET = 0x0,
48 MLX4_SET_VPORT_QOS_QUERY = 0x1
49};
50
51struct mlx4_set_port_prio2tc_context {
52 u8 prio2tc[4];
53};
54
55struct mlx4_port_scheduler_tc_cfg_be {
56 __be16 pg;
57 __be16 bw_precentage;
58 __be16 max_bw_units; /* 3-100Mbps, 4-1Gbps, other values - reserved */
59 __be16 max_bw_value;
60};
61
62struct mlx4_set_port_scheduler_context {
63 struct mlx4_port_scheduler_tc_cfg_be tc[MLX4_NUM_TC];
64};
65
66/* Granular Qos (per VF) section */
67struct mlx4_alloc_vpp_param {
68 __be32 available_vpp;
69 __be32 vpp_p_up[MLX4_NUM_UP];
70};
71
72struct mlx4_prio_qos_param {
73 __be32 bw_share;
74 __be32 max_avg_bw;
75 __be32 reserved;
76 __be32 enable;
77 __be32 reserved1[4];
78};
79
80struct mlx4_set_vport_context {
81 __be32 reserved[8];
82 struct mlx4_prio_qos_param qos_p_up[MLX4_NUM_UP];
83};
84
85int mlx4_SET_PORT_PRIO2TC(struct mlx4_dev *dev, u8 port, u8 *prio2tc)
86{
87 struct mlx4_cmd_mailbox *mailbox;
88 struct mlx4_set_port_prio2tc_context *context;
89 int err;
90 u32 in_mod;
91 int i;
92
93 mailbox = mlx4_alloc_cmd_mailbox(dev);
94 if (IS_ERR(ptr: mailbox))
95 return PTR_ERR(ptr: mailbox);
96
97 context = mailbox->buf;
98
99 for (i = 0; i < MLX4_NUM_UP; i += 2)
100 context->prio2tc[i >> 1] = prio2tc[i] << 4 | prio2tc[i + 1];
101
102 in_mod = MLX4_SET_PORT_PRIO2TC << 8 | port;
103 err = mlx4_cmd(dev, in_param: mailbox->dma, in_modifier: in_mod, op_modifier: 1, op: MLX4_CMD_SET_PORT,
104 timeout: MLX4_CMD_TIME_CLASS_B, native: MLX4_CMD_NATIVE);
105
106 mlx4_free_cmd_mailbox(dev, mailbox);
107 return err;
108}
109EXPORT_SYMBOL(mlx4_SET_PORT_PRIO2TC);
110
111int mlx4_SET_PORT_SCHEDULER(struct mlx4_dev *dev, u8 port, u8 *tc_tx_bw,
112 u8 *pg, u16 *ratelimit)
113{
114 struct mlx4_cmd_mailbox *mailbox;
115 struct mlx4_set_port_scheduler_context *context;
116 int err;
117 u32 in_mod;
118 int i;
119
120 mailbox = mlx4_alloc_cmd_mailbox(dev);
121 if (IS_ERR(ptr: mailbox))
122 return PTR_ERR(ptr: mailbox);
123
124 context = mailbox->buf;
125
126 for (i = 0; i < MLX4_NUM_TC; i++) {
127 struct mlx4_port_scheduler_tc_cfg_be *tc = &context->tc[i];
128 u16 r;
129
130 if (ratelimit && ratelimit[i]) {
131 if (ratelimit[i] <= MLX4_MAX_100M_UNITS_VAL) {
132 r = ratelimit[i];
133 tc->max_bw_units =
134 htons(MLX4_RATELIMIT_100M_UNITS);
135 } else {
136 r = ratelimit[i] / 10;
137 tc->max_bw_units =
138 htons(MLX4_RATELIMIT_1G_UNITS);
139 }
140 tc->max_bw_value = htons(r);
141 } else {
142 tc->max_bw_value = htons(MLX4_RATELIMIT_DEFAULT);
143 tc->max_bw_units = htons(MLX4_RATELIMIT_1G_UNITS);
144 }
145
146 tc->pg = htons(pg[i]);
147 tc->bw_precentage = htons(tc_tx_bw[i]);
148 }
149
150 in_mod = MLX4_SET_PORT_SCHEDULER << 8 | port;
151 err = mlx4_cmd(dev, in_param: mailbox->dma, in_modifier: in_mod, op_modifier: 1, op: MLX4_CMD_SET_PORT,
152 timeout: MLX4_CMD_TIME_CLASS_B, native: MLX4_CMD_NATIVE);
153
154 mlx4_free_cmd_mailbox(dev, mailbox);
155 return err;
156}
157EXPORT_SYMBOL(mlx4_SET_PORT_SCHEDULER);
158
159int mlx4_ALLOCATE_VPP_get(struct mlx4_dev *dev, u8 port,
160 u16 *available_vpp, u8 *vpp_p_up)
161{
162 int i;
163 int err;
164 struct mlx4_cmd_mailbox *mailbox;
165 struct mlx4_alloc_vpp_param *out_param;
166
167 mailbox = mlx4_alloc_cmd_mailbox(dev);
168 if (IS_ERR(ptr: mailbox))
169 return PTR_ERR(ptr: mailbox);
170
171 out_param = mailbox->buf;
172
173 err = mlx4_cmd_box(dev, in_param: 0, out_param: mailbox->dma, in_modifier: port,
174 op_modifier: MLX4_ALLOCATE_VPP_QUERY,
175 op: MLX4_CMD_ALLOCATE_VPP,
176 timeout: MLX4_CMD_TIME_CLASS_A,
177 native: MLX4_CMD_NATIVE);
178 if (err)
179 goto out;
180
181 /* Total number of supported VPPs */
182 *available_vpp = (u16)be32_to_cpu(out_param->available_vpp);
183
184 for (i = 0; i < MLX4_NUM_UP; i++)
185 vpp_p_up[i] = (u8)be32_to_cpu(out_param->vpp_p_up[i]);
186
187out:
188 mlx4_free_cmd_mailbox(dev, mailbox);
189
190 return err;
191}
192EXPORT_SYMBOL(mlx4_ALLOCATE_VPP_get);
193
194int mlx4_ALLOCATE_VPP_set(struct mlx4_dev *dev, u8 port, u8 *vpp_p_up)
195{
196 int i;
197 int err;
198 struct mlx4_cmd_mailbox *mailbox;
199 struct mlx4_alloc_vpp_param *in_param;
200
201 mailbox = mlx4_alloc_cmd_mailbox(dev);
202 if (IS_ERR(ptr: mailbox))
203 return PTR_ERR(ptr: mailbox);
204
205 in_param = mailbox->buf;
206
207 for (i = 0; i < MLX4_NUM_UP; i++)
208 in_param->vpp_p_up[i] = cpu_to_be32(vpp_p_up[i]);
209
210 err = mlx4_cmd(dev, in_param: mailbox->dma, in_modifier: port,
211 op_modifier: MLX4_ALLOCATE_VPP_ALLOCATE,
212 op: MLX4_CMD_ALLOCATE_VPP,
213 timeout: MLX4_CMD_TIME_CLASS_A,
214 native: MLX4_CMD_NATIVE);
215
216 mlx4_free_cmd_mailbox(dev, mailbox);
217 return err;
218}
219EXPORT_SYMBOL(mlx4_ALLOCATE_VPP_set);
220
221int mlx4_SET_VPORT_QOS_get(struct mlx4_dev *dev, u8 port, u8 vport,
222 struct mlx4_vport_qos_param *out_param)
223{
224 int i;
225 int err;
226 struct mlx4_cmd_mailbox *mailbox;
227 struct mlx4_set_vport_context *ctx;
228
229 mailbox = mlx4_alloc_cmd_mailbox(dev);
230 if (IS_ERR(ptr: mailbox))
231 return PTR_ERR(ptr: mailbox);
232
233 ctx = mailbox->buf;
234
235 err = mlx4_cmd_box(dev, in_param: 0, out_param: mailbox->dma, in_modifier: (vport << 8) | port,
236 op_modifier: MLX4_SET_VPORT_QOS_QUERY,
237 op: MLX4_CMD_SET_VPORT_QOS,
238 timeout: MLX4_CMD_TIME_CLASS_A,
239 native: MLX4_CMD_NATIVE);
240 if (err)
241 goto out;
242
243 for (i = 0; i < MLX4_NUM_UP; i++) {
244 out_param[i].bw_share = be32_to_cpu(ctx->qos_p_up[i].bw_share);
245 out_param[i].max_avg_bw =
246 be32_to_cpu(ctx->qos_p_up[i].max_avg_bw);
247 out_param[i].enable =
248 !!(be32_to_cpu(ctx->qos_p_up[i].enable) & 31);
249 }
250
251out:
252 mlx4_free_cmd_mailbox(dev, mailbox);
253
254 return err;
255}
256EXPORT_SYMBOL(mlx4_SET_VPORT_QOS_get);
257
258int mlx4_SET_VPORT_QOS_set(struct mlx4_dev *dev, u8 port, u8 vport,
259 struct mlx4_vport_qos_param *in_param)
260{
261 int i;
262 int err;
263 struct mlx4_cmd_mailbox *mailbox;
264 struct mlx4_set_vport_context *ctx;
265
266 mailbox = mlx4_alloc_cmd_mailbox(dev);
267 if (IS_ERR(ptr: mailbox))
268 return PTR_ERR(ptr: mailbox);
269
270 ctx = mailbox->buf;
271
272 for (i = 0; i < MLX4_NUM_UP; i++) {
273 ctx->qos_p_up[i].bw_share = cpu_to_be32(in_param[i].bw_share);
274 ctx->qos_p_up[i].max_avg_bw =
275 cpu_to_be32(in_param[i].max_avg_bw);
276 ctx->qos_p_up[i].enable =
277 cpu_to_be32(in_param[i].enable << 31);
278 }
279
280 err = mlx4_cmd(dev, in_param: mailbox->dma, in_modifier: (vport << 8) | port,
281 op_modifier: MLX4_SET_VPORT_QOS_SET,
282 op: MLX4_CMD_SET_VPORT_QOS,
283 timeout: MLX4_CMD_TIME_CLASS_A,
284 native: MLX4_CMD_NATIVE);
285
286 mlx4_free_cmd_mailbox(dev, mailbox);
287 return err;
288}
289EXPORT_SYMBOL(mlx4_SET_VPORT_QOS_set);
290

source code of linux/drivers/net/ethernet/mellanox/mlx4/fw_qos.c