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. | |
6 | * Copyright (c) 2004, 2005 Voltaire Corporation. All rights reserved. | |
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 | * | |
37 | * $Id: agent.c 1389 2004-12-27 22:56:47Z roland $ | |
38 | */ | |
39 | ||
8c65b4a6 TS |
40 | #include <linux/slab.h> |
41 | #include <linux/string.h> | |
42 | ||
34816ad9 SH |
43 | #include "agent.h" |
44 | #include "smi.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 SH |
61 | list_for_each_entry(entry, &ib_agent_port_list, port_list) { |
62 | if (entry->agent[0]->device == device && | |
63 | entry->agent[0]->port_num == port_num) | |
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 | ||
34816ad9 SH |
81 | int 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; | |
89 | int ret; | |
1da177e4 | 90 | |
34816ad9 SH |
91 | port_priv = ib_get_agent_port(device, port_num); |
92 | if (!port_priv) { | |
93 | printk(KERN_ERR SPFX "Unable to find port agent\n"); | |
94 | return -ENODEV; | |
1da177e4 LT |
95 | } |
96 | ||
34816ad9 SH |
97 | agent = port_priv->agent[qpn]; |
98 | ah = ib_create_ah_from_wc(agent->qp->pd, wc, grh, port_num); | |
99 | if (IS_ERR(ah)) { | |
100 | ret = PTR_ERR(ah); | |
101 | printk(KERN_ERR SPFX "ib_create_ah_from_wc error:%d\n", ret); | |
102 | return ret; | |
1da177e4 LT |
103 | } |
104 | ||
34816ad9 SH |
105 | send_buf = ib_create_send_mad(agent, wc->src_qp, wc->pkey_index, 0, |
106 | IB_MGMT_MAD_HDR, IB_MGMT_MAD_DATA, | |
107 | GFP_KERNEL); | |
108 | if (IS_ERR(send_buf)) { | |
109 | ret = PTR_ERR(send_buf); | |
110 | printk(KERN_ERR SPFX "ib_create_send_mad error:%d\n", ret); | |
111 | goto err1; | |
1da177e4 | 112 | } |
1da177e4 | 113 | |
34816ad9 SH |
114 | memcpy(send_buf->mad, mad, sizeof *mad); |
115 | send_buf->ah = ah; | |
116 | if ((ret = ib_post_send_mad(send_buf, NULL))) { | |
117 | printk(KERN_ERR SPFX "ib_post_send_mad error:%d\n", ret); | |
118 | goto err2; | |
1da177e4 | 119 | } |
34816ad9 SH |
120 | return 0; |
121 | err2: | |
122 | ib_free_send_mad(send_buf); | |
123 | err1: | |
124 | ib_destroy_ah(ah); | |
1da177e4 LT |
125 | return ret; |
126 | } | |
127 | ||
1da177e4 LT |
128 | static void agent_send_handler(struct ib_mad_agent *mad_agent, |
129 | struct ib_mad_send_wc *mad_send_wc) | |
130 | { | |
34816ad9 SH |
131 | ib_destroy_ah(mad_send_wc->send_buf->ah); |
132 | ib_free_send_mad(mad_send_wc->send_buf); | |
1da177e4 LT |
133 | } |
134 | ||
135 | int ib_agent_port_open(struct ib_device *device, int port_num) | |
136 | { | |
1da177e4 LT |
137 | struct ib_agent_port_private *port_priv; |
138 | unsigned long flags; | |
34816ad9 | 139 | int ret; |
1da177e4 LT |
140 | |
141 | /* Create new device info */ | |
de6eb66b | 142 | port_priv = kzalloc(sizeof *port_priv, GFP_KERNEL); |
1da177e4 LT |
143 | if (!port_priv) { |
144 | printk(KERN_ERR SPFX "No memory for ib_agent_port_private\n"); | |
145 | ret = -ENOMEM; | |
146 | goto error1; | |
147 | } | |
1da177e4 | 148 | |
34816ad9 SH |
149 | /* Obtain send only MAD agent for SMI QP */ |
150 | port_priv->agent[0] = ib_register_mad_agent(device, port_num, | |
151 | IB_QPT_SMI, NULL, 0, | |
1da177e4 | 152 | &agent_send_handler, |
34816ad9 SH |
153 | NULL, NULL); |
154 | if (IS_ERR(port_priv->agent[0])) { | |
155 | ret = PTR_ERR(port_priv->agent[0]); | |
1da177e4 LT |
156 | goto error2; |
157 | } | |
158 | ||
34816ad9 SH |
159 | /* Obtain send only MAD agent for GSI QP */ |
160 | port_priv->agent[1] = ib_register_mad_agent(device, port_num, | |
161 | IB_QPT_GSI, NULL, 0, | |
162 | &agent_send_handler, | |
163 | NULL, NULL); | |
164 | if (IS_ERR(port_priv->agent[1])) { | |
165 | ret = PTR_ERR(port_priv->agent[1]); | |
1da177e4 LT |
166 | goto error3; |
167 | } | |
168 | ||
1da177e4 LT |
169 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); |
170 | list_add_tail(&port_priv->port_list, &ib_agent_port_list); | |
171 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
172 | ||
173 | return 0; | |
174 | ||
1da177e4 | 175 | error3: |
34816ad9 | 176 | ib_unregister_mad_agent(port_priv->agent[0]); |
1da177e4 LT |
177 | error2: |
178 | kfree(port_priv); | |
179 | error1: | |
180 | return ret; | |
181 | } | |
182 | ||
183 | int ib_agent_port_close(struct ib_device *device, int port_num) | |
184 | { | |
185 | struct ib_agent_port_private *port_priv; | |
186 | unsigned long flags; | |
187 | ||
188 | spin_lock_irqsave(&ib_agent_port_list_lock, flags); | |
34816ad9 | 189 | port_priv = __ib_get_agent_port(device, port_num); |
1da177e4 LT |
190 | if (port_priv == NULL) { |
191 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
192 | printk(KERN_ERR SPFX "Port %d not found\n", port_num); | |
193 | return -ENODEV; | |
194 | } | |
195 | list_del(&port_priv->port_list); | |
196 | spin_unlock_irqrestore(&ib_agent_port_list_lock, flags); | |
197 | ||
34816ad9 SH |
198 | ib_unregister_mad_agent(port_priv->agent[1]); |
199 | ib_unregister_mad_agent(port_priv->agent[0]); | |
1da177e4 | 200 | kfree(port_priv); |
1da177e4 LT |
201 | return 0; |
202 | } |