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 SH |
56 | static struct ib_agent_port_private * |
57 | __ib_get_agent_port(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 SH |
69 | static struct ib_agent_port_private * |
70 | ib_get_agent_port(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 | ||
8fc394b1 HR |
81 | void agent_send_response(struct ib_mad *mad, struct ib_grh *grh, |
82 | struct ib_wc *wc, struct ib_device *device, | |
83 | int port_num, int qpn) | |
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 | ||
91 | if (device->node_type == RDMA_NODE_IB_SWITCH) | |
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 | ||
34816ad9 SH |
109 | send_buf = ib_create_send_mad(agent, wc->src_qp, wc->pkey_index, 0, |
110 | IB_MGMT_MAD_HDR, IB_MGMT_MAD_DATA, | |
111 | GFP_KERNEL); | |
112 | if (IS_ERR(send_buf)) { | |
7ef5d4b0 | 113 | dev_err(&device->dev, "ib_create_send_mad error\n"); |
34816ad9 | 114 | goto err1; |
1da177e4 | 115 | } |
1da177e4 | 116 | |
34816ad9 SH |
117 | memcpy(send_buf->mad, mad, sizeof *mad); |
118 | send_buf->ah = ah; | |
1bae4dbf HR |
119 | |
120 | if (device->node_type == RDMA_NODE_IB_SWITCH) { | |
121 | mad_send_wr = container_of(send_buf, | |
122 | struct ib_mad_send_wr_private, | |
123 | send_buf); | |
124 | mad_send_wr->send_wr.wr.ud.port_num = port_num; | |
125 | } | |
126 | ||
8fc394b1 | 127 | if (ib_post_send_mad(send_buf, NULL)) { |
7ef5d4b0 | 128 | dev_err(&device->dev, "ib_post_send_mad error\n"); |
34816ad9 | 129 | goto err2; |
1da177e4 | 130 | } |
8fc394b1 | 131 | return; |
34816ad9 SH |
132 | err2: |
133 | ib_free_send_mad(send_buf); | |
134 | err1: | |
135 | ib_destroy_ah(ah); | |
1da177e4 LT |
136 | } |
137 | ||
1da177e4 LT |
138 | static void agent_send_handler(struct ib_mad_agent *mad_agent, |
139 | struct ib_mad_send_wc *mad_send_wc) | |
140 | { | |
34816ad9 SH |
141 | ib_destroy_ah(mad_send_wc->send_buf->ah); |
142 | ib_free_send_mad(mad_send_wc->send_buf); | |
1da177e4 LT |
143 | } |
144 | ||
145 | int ib_agent_port_open(struct ib_device *device, int port_num) | |
146 | { | |
1da177e4 LT |
147 | struct ib_agent_port_private *port_priv; |
148 | unsigned long flags; | |
34816ad9 | 149 | int ret; |
1da177e4 LT |
150 | |
151 | /* Create new device info */ | |
de6eb66b | 152 | port_priv = kzalloc(sizeof *port_priv, GFP_KERNEL); |
1da177e4 | 153 | if (!port_priv) { |
7ef5d4b0 | 154 | dev_err(&device->dev, "No memory for ib_agent_port_private\n"); |
1da177e4 LT |
155 | ret = -ENOMEM; |
156 | goto error1; | |
157 | } | |
1da177e4 | 158 | |
fac70d51 EC |
159 | if (rdma_port_get_link_layer(device, port_num) == IB_LINK_LAYER_INFINIBAND) { |
160 | /* Obtain send only MAD agent for SMI QP */ | |
161 | port_priv->agent[0] = ib_register_mad_agent(device, port_num, | |
162 | IB_QPT_SMI, NULL, 0, | |
163 | &agent_send_handler, | |
164 | NULL, NULL); | |
165 | if (IS_ERR(port_priv->agent[0])) { | |
166 | ret = PTR_ERR(port_priv->agent[0]); | |
167 | goto error2; | |
168 | } | |
1da177e4 LT |
169 | } |
170 | ||
34816ad9 SH |
171 | /* Obtain send only MAD agent for GSI QP */ |
172 | port_priv->agent[1] = ib_register_mad_agent(device, port_num, | |
173 | IB_QPT_GSI, NULL, 0, | |
174 | &agent_send_handler, | |
175 | NULL, NULL); | |
176 | if (IS_ERR(port_priv->agent[1])) { | |
177 | ret = PTR_ERR(port_priv->agent[1]); | |
1da177e4 LT |
178 | goto error3; |
179 | } | |
180 | ||
1da177e4 LT |
181 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); |
182 | list_add_tail(&port_priv->port_list, &ib_agent_port_list); | |
183 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
184 | ||
185 | return 0; | |
186 | ||
1da177e4 | 187 | error3: |
fac70d51 EC |
188 | if (port_priv->agent[0]) |
189 | ib_unregister_mad_agent(port_priv->agent[0]); | |
1da177e4 LT |
190 | error2: |
191 | kfree(port_priv); | |
192 | error1: | |
193 | return ret; | |
194 | } | |
195 | ||
196 | int ib_agent_port_close(struct ib_device *device, int port_num) | |
197 | { | |
198 | struct ib_agent_port_private *port_priv; | |
199 | unsigned long flags; | |
200 | ||
201 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); | |
34816ad9 | 202 | port_priv = __ib_get_agent_port(device, port_num); |
1da177e4 LT |
203 | if (port_priv == NULL) { |
204 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
7ef5d4b0 | 205 | dev_err(&device->dev, "Port %d not found\n", port_num); |
1da177e4 LT |
206 | return -ENODEV; |
207 | } | |
208 | list_del(&port_priv->port_list); | |
209 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
210 | ||
34816ad9 | 211 | ib_unregister_mad_agent(port_priv->agent[1]); |
fac70d51 EC |
212 | if (port_priv->agent[0]) |
213 | ib_unregister_mad_agent(port_priv->agent[0]); | |
214 | ||
1da177e4 | 215 | kfree(port_priv); |
1da177e4 LT |
216 | return 0; |
217 | } |