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.
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:
15 * Redistribution and use in source and binary forms, with or
16 * without modification, are permitted provided that the following
19 * - Redistributions of source code must retain the above
20 * copyright notice, this list of conditions and the following
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.
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
37 * $Id: agent.c 1389 2004-12-27 22:56:47Z roland $
40 #include <linux/slab.h>
41 #include <linux/string.h>
46 #define SPFX "ib_agent: "
48 struct ib_agent_port_private
{
49 struct list_head port_list
;
50 struct ib_mad_agent
*agent
[2];
53 static DEFINE_SPINLOCK(ib_agent_port_list_lock
);
54 static LIST_HEAD(ib_agent_port_list
);
56 static struct ib_agent_port_private
*
57 __ib_get_agent_port(struct ib_device
*device
, int port_num
)
59 struct ib_agent_port_private
*entry
;
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
)
69 static struct ib_agent_port_private
*
70 ib_get_agent_port(struct ib_device
*device
, int port_num
)
72 struct ib_agent_port_private
*entry
;
75 spin_lock_irqsave(&ib_agent_port_list_lock
, flags
);
76 entry
= __ib_get_agent_port(device
, port_num
);
77 spin_unlock_irqrestore(&ib_agent_port_list_lock
, flags
);
81 int smi_check_local_dr_smp(struct ib_smp
*smp
,
82 struct ib_device
*device
,
85 struct ib_agent_port_private
*port_priv
;
87 if (smp
->mgmt_class
!= IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE
)
90 port_priv
= ib_get_agent_port(device
, port_num
);
92 printk(KERN_DEBUG SPFX
"smi_check_local_dr_smp %s port %d "
93 "not open\n", device
->name
, port_num
);
97 return smi_check_local_smp(port_priv
->agent
[0], smp
);
100 int agent_send_response(struct ib_mad
*mad
, struct ib_grh
*grh
,
101 struct ib_wc
*wc
, struct ib_device
*device
,
102 int port_num
, int qpn
)
104 struct ib_agent_port_private
*port_priv
;
105 struct ib_mad_agent
*agent
;
106 struct ib_mad_send_buf
*send_buf
;
110 port_priv
= ib_get_agent_port(device
, port_num
);
112 printk(KERN_ERR SPFX
"Unable to find port agent\n");
116 agent
= port_priv
->agent
[qpn
];
117 ah
= ib_create_ah_from_wc(agent
->qp
->pd
, wc
, grh
, port_num
);
120 printk(KERN_ERR SPFX
"ib_create_ah_from_wc error:%d\n", ret
);
124 send_buf
= ib_create_send_mad(agent
, wc
->src_qp
, wc
->pkey_index
, 0,
125 IB_MGMT_MAD_HDR
, IB_MGMT_MAD_DATA
,
127 if (IS_ERR(send_buf
)) {
128 ret
= PTR_ERR(send_buf
);
129 printk(KERN_ERR SPFX
"ib_create_send_mad error:%d\n", ret
);
133 memcpy(send_buf
->mad
, mad
, sizeof *mad
);
135 if ((ret
= ib_post_send_mad(send_buf
, NULL
))) {
136 printk(KERN_ERR SPFX
"ib_post_send_mad error:%d\n", ret
);
141 ib_free_send_mad(send_buf
);
147 static void agent_send_handler(struct ib_mad_agent
*mad_agent
,
148 struct ib_mad_send_wc
*mad_send_wc
)
150 ib_destroy_ah(mad_send_wc
->send_buf
->ah
);
151 ib_free_send_mad(mad_send_wc
->send_buf
);
154 int ib_agent_port_open(struct ib_device
*device
, int port_num
)
156 struct ib_agent_port_private
*port_priv
;
160 /* Create new device info */
161 port_priv
= kzalloc(sizeof *port_priv
, GFP_KERNEL
);
163 printk(KERN_ERR SPFX
"No memory for ib_agent_port_private\n");
168 /* Obtain send only MAD agent for SMI QP */
169 port_priv
->agent
[0] = ib_register_mad_agent(device
, port_num
,
173 if (IS_ERR(port_priv
->agent
[0])) {
174 ret
= PTR_ERR(port_priv
->agent
[0]);
178 /* Obtain send only MAD agent for GSI QP */
179 port_priv
->agent
[1] = ib_register_mad_agent(device
, port_num
,
183 if (IS_ERR(port_priv
->agent
[1])) {
184 ret
= PTR_ERR(port_priv
->agent
[1]);
188 spin_lock_irqsave(&ib_agent_port_list_lock
, flags
);
189 list_add_tail(&port_priv
->port_list
, &ib_agent_port_list
);
190 spin_unlock_irqrestore(&ib_agent_port_list_lock
, flags
);
195 ib_unregister_mad_agent(port_priv
->agent
[0]);
202 int ib_agent_port_close(struct ib_device
*device
, int port_num
)
204 struct ib_agent_port_private
*port_priv
;
207 spin_lock_irqsave(&ib_agent_port_list_lock
, flags
);
208 port_priv
= __ib_get_agent_port(device
, port_num
);
209 if (port_priv
== NULL
) {
210 spin_unlock_irqrestore(&ib_agent_port_list_lock
, flags
);
211 printk(KERN_ERR SPFX
"Port %d not found\n", port_num
);
214 list_del(&port_priv
->port_list
);
215 spin_unlock_irqrestore(&ib_agent_port_list_lock
, flags
);
217 ib_unregister_mad_agent(port_priv
->agent
[1]);
218 ib_unregister_mad_agent(port_priv
->agent
[0]);