Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
2a1d9b7f RD |
2 | * Copyright (c) 2004, 2005 Mellanox Technologies Ltd. All rights reserved. |
3 | * Copyright (c) 2004, 2005 Infinicon Corporation. All rights reserved. | |
4 | * Copyright (c) 2004, 2005 Intel Corporation. All rights reserved. | |
5 | * Copyright (c) 2004, 2005 Topspin Corporation. All rights reserved. | |
1bae4dbf | 6 | * Copyright (c) 2004-2007 Voltaire Corporation. All rights reserved. |
2a1d9b7f | 7 | * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved. |
1da177e4 LT |
8 | * |
9 | * This software is available to you under a choice of one of two | |
10 | * licenses. You may choose to be licensed under the terms of the GNU | |
11 | * General Public License (GPL) Version 2, available from the file | |
12 | * COPYING in the main directory of this source tree, or the | |
13 | * OpenIB.org BSD license below: | |
14 | * | |
15 | * Redistribution and use in source and binary forms, with or | |
16 | * without modification, are permitted provided that the following | |
17 | * conditions are met: | |
18 | * | |
19 | * - Redistributions of source code must retain the above | |
20 | * copyright notice, this list of conditions and the following | |
21 | * disclaimer. | |
22 | * | |
23 | * - Redistributions in binary form must reproduce the above | |
24 | * copyright notice, this list of conditions and the following | |
25 | * disclaimer in the documentation and/or other materials | |
26 | * provided with the distribution. | |
27 | * | |
28 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | |
29 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | |
30 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | |
31 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | |
32 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | |
33 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
34 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | |
35 | * SOFTWARE. | |
36 | * | |
1da177e4 LT |
37 | */ |
38 | ||
8c65b4a6 TS |
39 | #include <linux/slab.h> |
40 | #include <linux/string.h> | |
41 | ||
34816ad9 SH |
42 | #include "agent.h" |
43 | #include "smi.h" | |
1bae4dbf | 44 | #include "mad_priv.h" |
1da177e4 | 45 | |
34816ad9 | 46 | #define SPFX "ib_agent: " |
1da177e4 | 47 | |
34816ad9 SH |
48 | struct ib_agent_port_private { |
49 | struct list_head port_list; | |
50 | struct ib_mad_agent *agent[2]; | |
51 | }; | |
1da177e4 | 52 | |
34816ad9 | 53 | static DEFINE_SPINLOCK(ib_agent_port_list_lock); |
1da177e4 LT |
54 | static LIST_HEAD(ib_agent_port_list); |
55 | ||
34816ad9 | 56 | static struct ib_agent_port_private * |
73cdaaee | 57 | __ib_get_agent_port(const struct ib_device *device, int port_num) |
1da177e4 LT |
58 | { |
59 | struct ib_agent_port_private *entry; | |
60 | ||
34816ad9 | 61 | list_for_each_entry(entry, &ib_agent_port_list, port_list) { |
fac70d51 EC |
62 | if (entry->agent[1]->device == device && |
63 | entry->agent[1]->port_num == port_num) | |
34816ad9 | 64 | return entry; |
1da177e4 LT |
65 | } |
66 | return NULL; | |
67 | } | |
68 | ||
34816ad9 | 69 | static struct ib_agent_port_private * |
73cdaaee | 70 | ib_get_agent_port(const struct ib_device *device, int port_num) |
1da177e4 LT |
71 | { |
72 | struct ib_agent_port_private *entry; | |
73 | unsigned long flags; | |
74 | ||
75 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); | |
34816ad9 | 76 | entry = __ib_get_agent_port(device, port_num); |
1da177e4 | 77 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); |
1da177e4 LT |
78 | return entry; |
79 | } | |
80 | ||
c9082e51 | 81 | void agent_send_response(const struct ib_mad_hdr *mad_hdr, const struct ib_grh *grh, |
73cdaaee | 82 | const struct ib_wc *wc, const struct ib_device *device, |
8e4349d1 | 83 | int port_num, int qpn, size_t resp_mad_len, bool opa) |
1da177e4 | 84 | { |
34816ad9 SH |
85 | struct ib_agent_port_private *port_priv; |
86 | struct ib_mad_agent *agent; | |
87 | struct ib_mad_send_buf *send_buf; | |
88 | struct ib_ah *ah; | |
1bae4dbf HR |
89 | struct ib_mad_send_wr_private *mad_send_wr; |
90 | ||
4139032b | 91 | if (rdma_cap_ib_switch(device)) |
1bae4dbf HR |
92 | port_priv = ib_get_agent_port(device, 0); |
93 | else | |
94 | port_priv = ib_get_agent_port(device, port_num); | |
1da177e4 | 95 | |
34816ad9 | 96 | if (!port_priv) { |
7ef5d4b0 | 97 | dev_err(&device->dev, "Unable to find port agent\n"); |
8fc394b1 | 98 | return; |
1da177e4 LT |
99 | } |
100 | ||
34816ad9 SH |
101 | agent = port_priv->agent[qpn]; |
102 | ah = ib_create_ah_from_wc(agent->qp->pd, wc, grh, port_num); | |
103 | if (IS_ERR(ah)) { | |
7ef5d4b0 | 104 | dev_err(&device->dev, "ib_create_ah_from_wc error %ld\n", |
1eba843d | 105 | PTR_ERR(ah)); |
8fc394b1 | 106 | return; |
1da177e4 LT |
107 | } |
108 | ||
8e4349d1 IW |
109 | if (opa && mad_hdr->base_version != OPA_MGMT_BASE_VERSION) |
110 | resp_mad_len = IB_MGMT_MAD_SIZE; | |
111 | ||
34816ad9 | 112 | send_buf = ib_create_send_mad(agent, wc->src_qp, wc->pkey_index, 0, |
c9082e51 IW |
113 | IB_MGMT_MAD_HDR, |
114 | resp_mad_len - IB_MGMT_MAD_HDR, | |
da2dfaa3 | 115 | GFP_KERNEL, |
8e4349d1 | 116 | mad_hdr->base_version); |
34816ad9 | 117 | if (IS_ERR(send_buf)) { |
7ef5d4b0 | 118 | dev_err(&device->dev, "ib_create_send_mad error\n"); |
34816ad9 | 119 | goto err1; |
1da177e4 | 120 | } |
1da177e4 | 121 | |
c9082e51 | 122 | memcpy(send_buf->mad, mad_hdr, resp_mad_len); |
34816ad9 | 123 | send_buf->ah = ah; |
1bae4dbf | 124 | |
4139032b | 125 | if (rdma_cap_ib_switch(device)) { |
1bae4dbf HR |
126 | mad_send_wr = container_of(send_buf, |
127 | struct ib_mad_send_wr_private, | |
128 | send_buf); | |
e622f2f4 | 129 | mad_send_wr->send_wr.port_num = port_num; |
1bae4dbf HR |
130 | } |
131 | ||
8fc394b1 | 132 | if (ib_post_send_mad(send_buf, NULL)) { |
7ef5d4b0 | 133 | dev_err(&device->dev, "ib_post_send_mad error\n"); |
34816ad9 | 134 | goto err2; |
1da177e4 | 135 | } |
8fc394b1 | 136 | return; |
34816ad9 SH |
137 | err2: |
138 | ib_free_send_mad(send_buf); | |
139 | err1: | |
140 | ib_destroy_ah(ah); | |
1da177e4 LT |
141 | } |
142 | ||
1da177e4 LT |
143 | static void agent_send_handler(struct ib_mad_agent *mad_agent, |
144 | struct ib_mad_send_wc *mad_send_wc) | |
145 | { | |
34816ad9 SH |
146 | ib_destroy_ah(mad_send_wc->send_buf->ah); |
147 | ib_free_send_mad(mad_send_wc->send_buf); | |
1da177e4 LT |
148 | } |
149 | ||
150 | int ib_agent_port_open(struct ib_device *device, int port_num) | |
151 | { | |
1da177e4 LT |
152 | struct ib_agent_port_private *port_priv; |
153 | unsigned long flags; | |
34816ad9 | 154 | int ret; |
1da177e4 LT |
155 | |
156 | /* Create new device info */ | |
de6eb66b | 157 | port_priv = kzalloc(sizeof *port_priv, GFP_KERNEL); |
1da177e4 | 158 | if (!port_priv) { |
7ef5d4b0 | 159 | dev_err(&device->dev, "No memory for ib_agent_port_private\n"); |
1da177e4 LT |
160 | ret = -ENOMEM; |
161 | goto error1; | |
162 | } | |
1da177e4 | 163 | |
29541e3a | 164 | if (rdma_cap_ib_smi(device, port_num)) { |
fac70d51 EC |
165 | /* Obtain send only MAD agent for SMI QP */ |
166 | port_priv->agent[0] = ib_register_mad_agent(device, port_num, | |
167 | IB_QPT_SMI, NULL, 0, | |
168 | &agent_send_handler, | |
0f29b46d | 169 | NULL, NULL, 0); |
fac70d51 EC |
170 | if (IS_ERR(port_priv->agent[0])) { |
171 | ret = PTR_ERR(port_priv->agent[0]); | |
172 | goto error2; | |
173 | } | |
1da177e4 LT |
174 | } |
175 | ||
34816ad9 SH |
176 | /* Obtain send only MAD agent for GSI QP */ |
177 | port_priv->agent[1] = ib_register_mad_agent(device, port_num, | |
178 | IB_QPT_GSI, NULL, 0, | |
179 | &agent_send_handler, | |
0f29b46d | 180 | NULL, NULL, 0); |
34816ad9 SH |
181 | if (IS_ERR(port_priv->agent[1])) { |
182 | ret = PTR_ERR(port_priv->agent[1]); | |
1da177e4 LT |
183 | goto error3; |
184 | } | |
185 | ||
1da177e4 LT |
186 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); |
187 | list_add_tail(&port_priv->port_list, &ib_agent_port_list); | |
188 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
189 | ||
190 | return 0; | |
191 | ||
1da177e4 | 192 | error3: |
fac70d51 EC |
193 | if (port_priv->agent[0]) |
194 | ib_unregister_mad_agent(port_priv->agent[0]); | |
1da177e4 LT |
195 | error2: |
196 | kfree(port_priv); | |
197 | error1: | |
198 | return ret; | |
199 | } | |
200 | ||
201 | int ib_agent_port_close(struct ib_device *device, int port_num) | |
202 | { | |
203 | struct ib_agent_port_private *port_priv; | |
204 | unsigned long flags; | |
205 | ||
206 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); | |
34816ad9 | 207 | port_priv = __ib_get_agent_port(device, port_num); |
1da177e4 LT |
208 | if (port_priv == NULL) { |
209 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
7ef5d4b0 | 210 | dev_err(&device->dev, "Port %d not found\n", port_num); |
1da177e4 LT |
211 | return -ENODEV; |
212 | } | |
213 | list_del(&port_priv->port_list); | |
214 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
215 | ||
34816ad9 | 216 | ib_unregister_mad_agent(port_priv->agent[1]); |
fac70d51 EC |
217 | if (port_priv->agent[0]) |
218 | ib_unregister_mad_agent(port_priv->agent[0]); | |
219 | ||
1da177e4 | 220 | kfree(port_priv); |
1da177e4 LT |
221 | return 0; |
222 | } |