1 /*
2 * Copyright (c) 2004-2009 Voltaire Inc. 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
34 #if HAVE_CONFIG_H
35 # include <config.h>
36 #endif /* HAVE_CONFIG_H */
37
38 #include <stdio.h>
39 #include <stdlib.h>
40 #include <string.h>
41 #include <errno.h>
42
43 #include <infiniband/umad.h>
44 #include <infiniband/mad.h>
45
46 #include "mad_internal.h"
47
48 #undef DEBUG
49 #define DEBUG if (ibdebug) IBWARN
50
mad_send(ib_rpc_t * rpc,ib_portid_t * dport,ib_rmpp_hdr_t * rmpp,void * data)51 int mad_send(ib_rpc_t * rpc, ib_portid_t * dport, ib_rmpp_hdr_t * rmpp,
52 void *data)
53 {
54 return mad_send_via(rpc, dport, rmpp, data, ibmp);
55 }
56
mad_send_via(ib_rpc_t * rpc,ib_portid_t * dport,ib_rmpp_hdr_t * rmpp,void * data,struct ibmad_port * srcport)57 int mad_send_via(ib_rpc_t * rpc, ib_portid_t * dport, ib_rmpp_hdr_t * rmpp,
58 void *data, struct ibmad_port *srcport)
59 {
60 uint8_t pktbuf[1024];
61 void *umad = pktbuf;
62
63 memset(pktbuf, 0, umad_size() + IB_MAD_SIZE);
64
65 DEBUG("rmpp %p data %p", rmpp, data);
66
67 if (mad_build_pkt(umad, rpc, dport, rmpp, data) < 0)
68 return -1;
69
70 if (ibdebug) {
71 IBWARN("data offs %d sz %d", rpc->dataoffs, rpc->datasz);
72 xdump(stderr, "mad send data\n",
73 (char *)umad_get_mad(umad) + rpc->dataoffs, rpc->datasz);
74 }
75
76 if (umad_send(srcport->port_id, srcport->class_agents[rpc->mgtclass & 0xff],
77 umad, IB_MAD_SIZE, mad_get_timeout(srcport, rpc->timeout),
78 0) < 0) {
79 IBWARN("send failed; %s", strerror(errno));
80 return -1;
81 }
82
83 return 0;
84 }
85
mad_respond(void * umad,ib_portid_t * portid,uint32_t rstatus)86 int mad_respond(void *umad, ib_portid_t * portid, uint32_t rstatus)
87 {
88 return mad_respond_via(umad, portid, rstatus, ibmp);
89 }
90
mad_respond_via(void * umad,ib_portid_t * portid,uint32_t rstatus,struct ibmad_port * srcport)91 int mad_respond_via(void *umad, ib_portid_t * portid, uint32_t rstatus,
92 struct ibmad_port *srcport)
93 {
94 uint8_t *mad = umad_get_mad(umad);
95 ib_mad_addr_t *mad_addr;
96 ib_rpc_t rpc = { 0 };
97 ib_portid_t rport;
98 int is_smi;
99
100 if (!portid) {
101 if (!(mad_addr = umad_get_mad_addr(umad))) {
102 errno = EINVAL;
103 return -1;
104 }
105
106 memset(&rport, 0, sizeof(rport));
107
108 rport.lid = ntohs(mad_addr->lid);
109 rport.qp = ntohl(mad_addr->qpn);
110 rport.qkey = ntohl(mad_addr->qkey);
111 rport.sl = mad_addr->sl;
112
113 if (mad_addr->grh_present) {
114 rport.grh_present = 1;
115 memcpy(&rport.gid, &mad_addr->gid, sizeof(rport.gid));
116 }
117
118 portid = &rport;
119 }
120
121 DEBUG("dest %s", portid2str(portid));
122
123 rpc.mgtclass = mad_get_field(mad, 0, IB_MAD_MGMTCLASS_F);
124
125 rpc.method = mad_get_field(mad, 0, IB_MAD_METHOD_F);
126 if (rpc.method == IB_MAD_METHOD_SET)
127 rpc.method = IB_MAD_METHOD_GET;
128 if (rpc.method != IB_MAD_METHOD_SEND)
129 rpc.method |= IB_MAD_RESPONSE;
130
131 rpc.attr.id = mad_get_field(mad, 0, IB_MAD_ATTRID_F);
132 rpc.attr.mod = mad_get_field(mad, 0, IB_MAD_ATTRMOD_F);
133 if (rpc.mgtclass == IB_SA_CLASS)
134 rpc.recsz = mad_get_field(mad, 0, IB_SA_ATTROFFS_F);
135 if (mad_is_vendor_range2(rpc.mgtclass))
136 rpc.oui = mad_get_field(mad, 0, IB_VEND2_OUI_F);
137
138 rpc.trid = mad_get_field64(mad, 0, IB_MAD_TRID_F);
139 rpc.rstatus = rstatus;
140
141 /* cleared by default: timeout, datasz, dataoffs, mkey, mask */
142
143 is_smi = rpc.mgtclass == IB_SMI_CLASS ||
144 rpc.mgtclass == IB_SMI_DIRECT_CLASS;
145
146 if (is_smi)
147 portid->qp = 0;
148 else if (!portid->qp)
149 portid->qp = 1;
150
151 if (!portid->qkey && portid->qp == 1)
152 portid->qkey = IB_DEFAULT_QP1_QKEY;
153
154 DEBUG
155 ("qp 0x%x class 0x%x method %d attr 0x%x mod 0x%x datasz %d off %d qkey %x",
156 portid->qp, rpc.mgtclass, rpc.method, rpc.attr.id, rpc.attr.mod,
157 rpc.datasz, rpc.dataoffs, portid->qkey);
158
159 if (mad_build_pkt(umad, &rpc, portid, 0, 0) < 0)
160 return -1;
161
162 if (ibdebug > 1)
163 xdump(stderr, "mad respond pkt\n", mad, IB_MAD_SIZE);
164
165 if (umad_send
166 (srcport->port_id, srcport->class_agents[rpc.mgtclass], umad,
167 IB_MAD_SIZE, mad_get_timeout(srcport, rpc.timeout), 0) < 0) {
168 DEBUG("send failed; %s", strerror(errno));
169 return -1;
170 }
171
172 return 0;
173 }
174
mad_receive(void * umad,int timeout)175 void *mad_receive(void *umad, int timeout)
176 {
177 return mad_receive_via(umad, timeout, ibmp);
178 }
179
mad_receive_via(void * umad,int timeout,struct ibmad_port * srcport)180 void *mad_receive_via(void *umad, int timeout, struct ibmad_port *srcport)
181 {
182 void *mad = umad ? umad : umad_alloc(1, umad_size() + IB_MAD_SIZE);
183 int agent;
184 int length = IB_MAD_SIZE;
185
186 if ((agent = umad_recv(srcport->port_id, mad, &length,
187 mad_get_timeout(srcport, timeout))) < 0) {
188 if (!umad)
189 umad_free(mad);
190 DEBUG("recv failed: %s", strerror(errno));
191 return 0;
192 }
193
194 return mad;
195 }
196
mad_alloc(void)197 void *mad_alloc(void)
198 {
199 return umad_alloc(1, umad_size() + IB_MAD_SIZE);
200 }
201
mad_free(void * umad)202 void mad_free(void *umad)
203 {
204 umad_free(umad);
205 }
206