libibmad: updated based on merge feedback
[mirror/winof/.git] / ulp / libibmad / src / serv.c
1 /*
2  * Copyright (c) 2004,2005 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
42 #include <infiniband/umad.h>
43 #include <mad.h>
44
45 #undef DEBUG
46 #define DEBUG   if (ibdebug)    IBWARN
47
48 int
49 mad_send(ib_rpc_t *rpc, ib_portid_t *dport, ib_rmpp_hdr_t *rmpp, void *data)
50 {
51         uint8_t pktbuf[1024];
52         void *umad = pktbuf;
53
54         memset(pktbuf, 0, umad_size());
55
56         DEBUG("rmpp %p data %p", rmpp, data);
57
58         if (mad_build_pkt(umad, rpc, dport, rmpp, data) < 0)
59                 return 0;
60
61         if (ibdebug) {
62                 IBWARN("data offs %d sz %d", rpc->dataoffs, rpc->datasz);
63                 xdump(stderr, "mad send data\n",
64                         (char *)umad_get_mad(umad) + rpc->dataoffs, rpc->datasz);
65         }
66
67         if (umad_send(madrpc_portid(), mad_class_agent(rpc->mgtclass),
68                       umad, IB_MAD_SIZE, rpc->timeout, 0) < 0) {
69                 IBWARN("send failed; %m");
70                 return -1;
71         }
72
73         return 0;
74 }
75
76 int
77 mad_respond(void *umad, ib_portid_t *portid, uint32_t rstatus)
78 {
79         uint8_t *mad = umad_get_mad(umad);
80         ib_mad_addr_t *mad_addr;
81         ib_rpc_t rpc = {0};
82         ib_portid_t rport;
83         int is_smi;
84
85         if (!portid) {
86                 if (!(mad_addr = umad_get_mad_addr(umad)))
87                         return -1;
88
89                 memset(&rport, 0, sizeof(rport));
90
91                 rport.lid = ntohs(mad_addr->lid);
92                 rport.qp = ntohl(mad_addr->qpn);
93                 rport.qkey = ntohl(mad_addr->qkey);
94                 rport.sl = mad_addr->sl;
95
96                 portid = &rport;
97         }
98
99         DEBUG("dest %s", portid2str(portid));
100
101         rpc.mgtclass = mad_get_field(mad, 0, IB_MAD_MGMTCLASS_F);
102
103         rpc.method = mad_get_field(mad, 0, IB_MAD_METHOD_F);
104         if (rpc.method == IB_MAD_METHOD_SET)
105                 rpc.method = IB_MAD_METHOD_GET;
106         if (rpc.method != IB_MAD_METHOD_SEND)
107                 rpc.method |= IB_MAD_RESPONSE;
108
109         rpc.attr.id = mad_get_field(mad, 0, IB_MAD_ATTRID_F);
110         rpc.attr.mod = mad_get_field(mad, 0, IB_MAD_ATTRMOD_F);
111         if (rpc.mgtclass == IB_SA_CLASS)
112                 rpc.recsz = mad_get_field(mad, 0, IB_SA_ATTROFFS_F);
113         if (mad_is_vendor_range2(rpc.mgtclass))
114                 rpc.oui = mad_get_field(mad, 0, IB_VEND2_OUI_F);
115
116         rpc.trid = mad_get_field64(mad, 0, IB_MAD_TRID_F);
117
118         /* cleared by default: timeout, datasz, dataoffs, mkey, mask */
119
120         is_smi = rpc.mgtclass == IB_SMI_CLASS ||
121                  rpc.mgtclass == IB_SMI_DIRECT_CLASS;
122
123         if (is_smi)
124                 portid->qp = 0;
125         else if (!portid->qp)
126                  portid->qp = 1;
127
128         if (!portid->qkey && portid->qp == 1)
129                 portid->qkey = IB_DEFAULT_QP1_QKEY;
130
131         DEBUG("qp 0x%x class 0x%x method %d attr 0x%x mod 0x%x datasz %d off %d qkey %x",
132                 portid->qp, rpc.mgtclass, rpc.method, rpc.attr.id, rpc.attr.mod,
133                 rpc.datasz, rpc.dataoffs, portid->qkey);
134
135         if (mad_build_pkt(umad, &rpc, portid, 0, 0) < 0)
136                 return -1;
137
138         if (ibdebug > 1)
139                 xdump(stderr, "mad respond pkt\n", mad, IB_MAD_SIZE);
140
141         if (umad_send(madrpc_portid(), mad_class_agent(rpc.mgtclass), umad,
142                       IB_MAD_SIZE, rpc.timeout, 0) < 0) {
143                 DEBUG("send failed; %m");
144                 return -1;
145         }
146
147         return 0;
148 }
149
150 void *
151 mad_receive(void *umad, int timeout)
152 {
153         void *mad = umad ? umad : umad_alloc(1, umad_size() + IB_MAD_SIZE);
154         int agent;
155         int length = IB_MAD_SIZE;
156
157         if ((agent = umad_recv(madrpc_portid(), mad,
158                                &length, timeout)) < 0) {
159                 if (!umad)
160                         umad_free(mad);
161                 DEBUG("recv failed: %m");
162                 return 0;
163         }
164
165         return mad;
166 }
167
168 void *
169 mad_alloc(void)
170 {
171         return umad_alloc(1, umad_size() + IB_MAD_SIZE);
172 }
173
174 void
175 mad_free(void *umad)
176 {
177         umad_free(umad);
178 }