drivers/infiniband/sw/rdmavt/mad.c

   1 /*
   2  * Copyright(c) 2016 Intel Corporation.
   3  *
   4  * This file is provided under a dual BSD/GPLv2 license.  When using or
   5  * redistributing this file, you may do so under either license.
   6  *
   7  * GPL LICENSE SUMMARY
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of version 2 of the GNU General Public License as
  11  * published by the Free Software Foundation.
  12  *
  13  * This program is distributed in the hope that it will be useful, but
  14  * WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16  * General Public License for more details.
  17  *
  18  * BSD LICENSE
  19  *
  20  * Redistribution and use in source and binary forms, with or without
  21  * modification, are permitted provided that the following conditions
  22  * are met:
  23  *
  24  *  - Redistributions of source code must retain the above copyright
  25  *    notice, this list of conditions and the following disclaimer.
  26  *  - Redistributions in binary form must reproduce the above copyright
  27  *    notice, this list of conditions and the following disclaimer in
  28  *    the documentation and/or other materials provided with the
  29  *    distribution.
  30  *  - Neither the name of Intel Corporation nor the names of its
  31  *    contributors may be used to endorse or promote products derived
  32  *    from this software without specific prior written permission.
  33  *
  34  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  35  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  36  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  37  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  38  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  39  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  40  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  41  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  42  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  43  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  44  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  45  *
  46  */
  47
  48 #include <rdma/ib_mad.h>
  49 #include "mad.h"
  50 #include "vt.h"
  51
  52 /**
  53  * rvt_process_mad - process an incoming MAD packet
  54  * @ibdev: the infiniband device this packet came in on
  55  * @mad_flags: MAD flags
  56  * @port_num: the port number this packet came in on, 1 based from ib core
  57  * @in_wc: the work completion entry for this packet
  58  * @in_grh: the global route header for this packet
  59  * @in_mad: the incoming MAD
  60  * @out_mad: any outgoing MAD reply
  61  *
  62  * Note that the verbs framework has already done the MAD sanity checks,
  63  * and hop count/pointer updating for IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE
  64  * MADs.
  65  *
  66  * This is called by the ib_mad module.
  67  *
  68  * Return: IB_MAD_RESULT_SUCCESS or error
  69  */
  70 int rvt_process_mad(struct ib_device *ibdev, int mad_flags, u8 port_num,
  71                     const struct ib_wc *in_wc, const struct ib_grh *in_grh,
  72                     const struct ib_mad_hdr *in, size_t in_mad_size,
  73                     struct ib_mad_hdr *out, size_t *out_mad_size,
  74                     u16 *out_mad_pkey_index)
  75 {
  76         /*
  77          * MAD processing is quite different between hfi1 and qib. Therfore this
  78          * is expected to be provided by the driver. Other drivers in the future
  79          * may chose to implement this but it should not be made into a
  80          * requirement.
  81          */
  82         if (ibport_num_to_idx(ibdev, port_num) < 0)
  83                 return -EINVAL;
  84
  85         return IB_MAD_RESULT_FAILURE;
  86 }
  87
  88 static void rvt_send_mad_handler(struct ib_mad_agent *agent,
  89                                  struct ib_mad_send_wc *mad_send_wc)
  90 {
  91         ib_free_send_mad(mad_send_wc->send_buf);
  92 }
  93
  94 /**
  95  * rvt_create_mad_agents - create mad agents
  96  * @rdi: rvt dev struct
  97  *
  98  * If driver needs to be notified of mad agent creation then call back
  99  *
 100  * Return 0 on success
 101  */
 102 int rvt_create_mad_agents(struct rvt_dev_info *rdi)
 103 {
 104         struct ib_mad_agent *agent;
 105         struct rvt_ibport *rvp;
 106         int p;
 107         int ret;
 108
 109         for (p = 0; p < rdi->dparms.nports; p++) {
 110                 rvp = rdi->ports[p];
 111                 agent = ib_register_mad_agent(&rdi->ibdev, p + 1,
 112                                               IB_QPT_SMI,
 113                                               NULL, 0, rvt_send_mad_handler,
 114                                               NULL, NULL, 0);
 115                 if (IS_ERR(agent)) {
 116                         ret = PTR_ERR(agent);
 117                         goto err;
 118                 }
 119
 120                 rvp->send_agent = agent;
 121
 122                 if (rdi->driver_f.notify_create_mad_agent)
 123                         rdi->driver_f.notify_create_mad_agent(rdi, p);
 124         }
 125
 126         return 0;
 127
 128 err:
 129         for (p = 0; p < rdi->dparms.nports; p++) {
 130                 rvp = rdi->ports[p];
 131                 if (rvp->send_agent) {
 132                         agent = rvp->send_agent;
 133                         rvp->send_agent = NULL;
 134                         ib_unregister_mad_agent(agent);
 135                         if (rdi->driver_f.notify_free_mad_agent)
 136                                 rdi->driver_f.notify_free_mad_agent(rdi, p);
 137                 }
 138         }
 139
 140         return ret;
 141 }
 142
 143 /**
 144  * rvt_free_mad_agents - free up mad agents
 145  * @rdi: rvt dev struct
 146  *
 147  * If driver needs notification of mad agent removal make the call back
 148  */
 149 void rvt_free_mad_agents(struct rvt_dev_info *rdi)
 150 {
 151         struct ib_mad_agent *agent;
 152         struct rvt_ibport *rvp;
 153         int p;
 154
 155         for (p = 0; p < rdi->dparms.nports; p++) {
 156                 rvp = rdi->ports[p];
 157                 if (rvp->send_agent) {
 158                         agent = rvp->send_agent;
 159                         rvp->send_agent = NULL;
 160                         ib_unregister_mad_agent(agent);
 161                 }
 162                 if (rvp->sm_ah) {
 163                         ib_destroy_ah(&rvp->sm_ah->ibah);
 164                         rvp->sm_ah = NULL;
 165                 }
 166
 167                 if (rdi->driver_f.notify_free_mad_agent)
 168                         rdi->driver_f.notify_free_mad_agent(rdi, p);
 169         }
 170 }
 171