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 39int 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 70out: 71 kfree(out); 72 kfree(in); 73 return err; 74} 75EXPORT_SYMBOL_GPL(mlx5_core_mad_ifc); 76