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