1 /*
2 * Copyright (c) 2013-2015, Mellanox Technologies. 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/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
mlx5_core_mad_ifc(struct mlx5_core_dev * dev,const void * inb,void * outb,u16 opmod,u8 port)39 int mlx5_core_mad_ifc(struct mlx5_core_dev *dev, const void *inb, void *outb,
40 u16 opmod, u8 port)
41 {
42 int outlen = MLX5_ST_SZ_BYTES(mad_ifc_out);
43 int inlen = MLX5_ST_SZ_BYTES(mad_ifc_in);
44 int err = -ENOMEM;
45 void *data;
46 void *resp;
47 u32 *out;
48 u32 *in;
49
50 in = kzalloc(inlen, GFP_KERNEL);
51 out = kzalloc(outlen, GFP_KERNEL);
52 if (!in || !out)
53 goto out;
54
55 MLX5_SET(mad_ifc_in, in, opcode, MLX5_CMD_OP_MAD_IFC);
56 MLX5_SET(mad_ifc_in, in, op_mod, opmod);
57 MLX5_SET(mad_ifc_in, in, port, port);
58
59 data = MLX5_ADDR_OF(mad_ifc_in, in, mad);
60 memcpy(data, inb, MLX5_FLD_SZ_BYTES(mad_ifc_in, mad));
61
62 err = mlx5_cmd_exec(dev, in, inlen, out, outlen);
63 if (err)
64 goto out;
65
66 resp = MLX5_ADDR_OF(mad_ifc_out, out, response_mad_packet);
67 memcpy(outb, resp,
68 MLX5_FLD_SZ_BYTES(mad_ifc_out, response_mad_packet));
69
70 out:
71 kfree(out);
72 kfree(in);
73 return err;
74 }
75 EXPORT_SYMBOL_GPL(mlx5_core_mad_ifc);
76
