Blame libibnetdisc/src/ibnetdisc.c

Packit db064d
/*
Packit db064d
 * Copyright (c) 2004-2009 Voltaire Inc.  All rights reserved.
Packit db064d
 * Copyright (c) 2007 Xsigo Systems Inc.  All rights reserved.
Packit db064d
 * Copyright (c) 2008 Lawrence Livermore National Laboratory
Packit db064d
 * Copyright (c) 2010-2011 Mellanox Technologies LTD.  All rights reserved.
Packit db064d
 *
Packit db064d
 * This software is available to you under a choice of one of two
Packit db064d
 * licenses.  You may choose to be licensed under the terms of the GNU
Packit db064d
 * General Public License (GPL) Version 2, available from the file
Packit db064d
 * COPYING in the main directory of this source tree, or the
Packit db064d
 * OpenIB.org BSD license below:
Packit db064d
 *
Packit db064d
 *     Redistribution and use in source and binary forms, with or
Packit db064d
 *     without modification, are permitted provided that the following
Packit db064d
 *     conditions are met:
Packit db064d
 *
Packit db064d
 *      - Redistributions of source code must retain the above
Packit db064d
 *        copyright notice, this list of conditions and the following
Packit db064d
 *        disclaimer.
Packit db064d
 *
Packit db064d
 *      - Redistributions in binary form must reproduce the above
Packit db064d
 *        copyright notice, this list of conditions and the following
Packit db064d
 *        disclaimer in the documentation and/or other materials
Packit db064d
 *        provided with the distribution.
Packit db064d
 *
Packit db064d
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
Packit db064d
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
Packit db064d
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
Packit db064d
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
Packit db064d
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
Packit db064d
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
Packit db064d
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
Packit db064d
 * SOFTWARE.
Packit db064d
 *
Packit db064d
 */
Packit db064d
Packit db064d
#if HAVE_CONFIG_H
Packit db064d
#include <config.h>
Packit db064d
#endif				/* HAVE_CONFIG_H */
Packit db064d
Packit db064d
#define _GNU_SOURCE
Packit db064d
#include <stdio.h>
Packit db064d
#include <stdlib.h>
Packit db064d
#include <unistd.h>
Packit db064d
#include <string.h>
Packit db064d
#include <errno.h>
Packit db064d
#include <inttypes.h>
Packit db064d
Packit db064d
#include <infiniband/umad.h>
Packit db064d
#include <infiniband/mad.h>
Packit db064d
Packit db064d
#include <infiniband/ibnetdisc.h>
Packit db064d
#include <complib/cl_nodenamemap.h>
Packit db064d
Packit db064d
#include "internal.h"
Packit db064d
#include "chassis.h"
Packit db064d
Packit db064d
#define container_of(ptr, type, member)                                        \
Packit db064d
	((type *)((uint8_t *)(ptr)-offsetof(type, member)))
Packit db064d
Packit db064d
/* forward declarations */
Packit db064d
struct ni_cbdata
Packit db064d
{
Packit db064d
	ibnd_node_t *node;
Packit db064d
	int port_num;
Packit db064d
};
Packit db064d
static int query_node_info(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			   struct ni_cbdata * cbdata);
Packit db064d
static int query_port_info(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			   ibnd_node_t * node, int portnum);
Packit db064d
Packit db064d
static int recv_switch_info(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
			    uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	uint8_t *switch_info = mad + IB_SMP_DATA_OFFS;
Packit db064d
	ibnd_node_t *node = cb_data;
Packit db064d
	memcpy(node->switchinfo, switch_info, sizeof(node->switchinfo));
Packit db064d
	mad_decode_field(node->switchinfo, IB_SW_ENHANCED_PORT0_F,
Packit db064d
			 &node->smaenhsp0);
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
static int query_switch_info(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			     ibnd_node_t * node)
Packit db064d
{
Packit db064d
	node->smaenhsp0 = 0;	/* assume base SP0 */
Packit db064d
	return issue_smp(engine, portid, IB_ATTR_SWITCH_INFO, 0,
Packit db064d
			 recv_switch_info, node);
Packit db064d
}
Packit db064d
Packit db064d
static int add_port_to_dpath(ib_dr_path_t * path, int nextport)
Packit db064d
{
Packit db064d
	if (path->cnt > sizeof(path->p) - 2)
Packit db064d
		return -1;
Packit db064d
	++path->cnt;
Packit db064d
	path->p[path->cnt] = (uint8_t) nextport;
Packit db064d
	return path->cnt;
Packit db064d
}
Packit db064d
Packit db064d
static int retract_dpath(smp_engine_t * engine, ib_portid_t * portid)
Packit db064d
{
Packit db064d
	ibnd_scan_t *scan = engine->user_data;
Packit db064d
	f_internal_t *f_int = scan->f_int;
Packit db064d
Packit db064d
	if (scan->cfg->max_hops &&
Packit db064d
	    f_int->fabric.maxhops_discovered > scan->cfg->max_hops)
Packit db064d
		return 0;
Packit db064d
Packit db064d
	/* this may seem wrong but the only time we would retract the path is
Packit db064d
	 * if the user specified a CA for the DR path and we are retracting
Packit db064d
	 * from that to find the node it is connected to.  This counts as a
Packit db064d
	 * positive hop discovered
Packit db064d
	 */
Packit db064d
	f_int->fabric.maxhops_discovered++;
Packit db064d
	portid->drpath.p[portid->drpath.cnt] = 0;
Packit db064d
	portid->drpath.cnt--;
Packit db064d
	return 1;
Packit db064d
}
Packit db064d
Packit db064d
static int extend_dpath(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			int nextport)
Packit db064d
{
Packit db064d
	ibnd_scan_t *scan = engine->user_data;
Packit db064d
	f_internal_t *f_int = scan->f_int;
Packit db064d
Packit db064d
	if (scan->cfg->max_hops &&
Packit db064d
	    f_int->fabric.maxhops_discovered > scan->cfg->max_hops)
Packit db064d
		return 0;
Packit db064d
Packit db064d
	if (portid->lid) {
Packit db064d
		/* If we were LID routed we need to set up the drslid */
Packit db064d
		portid->drpath.drslid = (uint16_t) scan->selfportid.lid;
Packit db064d
		portid->drpath.drdlid = 0xFFFF;
Packit db064d
	}
Packit db064d
Packit db064d
	if (add_port_to_dpath(&portid->drpath, nextport) < 0) {
Packit db064d
		IBND_ERROR("add port %d to DR path failed; %s\n", nextport,
Packit db064d
			   portid2str(portid));
Packit db064d
		return -1;
Packit db064d
	}
Packit db064d
Packit db064d
	if (((unsigned) portid->drpath.cnt - scan->initial_hops) >
Packit db064d
	    f_int->fabric.maxhops_discovered)
Packit db064d
		f_int->fabric.maxhops_discovered++;
Packit db064d
Packit db064d
	return 1;
Packit db064d
}
Packit db064d
Packit db064d
static int recv_node_desc(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
			  uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	uint8_t *node_desc = mad + IB_SMP_DATA_OFFS;
Packit db064d
	ibnd_node_t *node = cb_data;
Packit db064d
	memcpy(node->nodedesc, node_desc, sizeof(node->nodedesc));
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
static int query_node_desc(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			   ibnd_node_t * node)
Packit db064d
{
Packit db064d
	return issue_smp(engine, portid, IB_ATTR_NODE_DESC, 0,
Packit db064d
			 recv_node_desc, node);
Packit db064d
}
Packit db064d
Packit db064d
static void debug_port(ib_portid_t * portid, ibnd_port_t * port)
Packit db064d
{
Packit db064d
	char width[64], speed[64];
Packit db064d
	int iwidth;
Packit db064d
	int ispeed, fdr10, espeed;
Packit db064d
	uint8_t *info;
Packit db064d
	uint32_t cap_mask;
Packit db064d
Packit db064d
	iwidth = mad_get_field(port->info, 0, IB_PORT_LINK_WIDTH_ACTIVE_F);
Packit db064d
	ispeed = mad_get_field(port->info, 0, IB_PORT_LINK_SPEED_ACTIVE_F);
Packit db064d
	fdr10 = mad_get_field(port->ext_info, 0,
Packit db064d
			      IB_MLNX_EXT_PORT_LINK_SPEED_ACTIVE_F);
Packit db064d
Packit db064d
	if (port->node->type == IB_NODE_SWITCH)
Packit db064d
		info = (uint8_t *)&port->node->ports[0]->info;
Packit db064d
	else
Packit db064d
		info = (uint8_t *)&port->info;
Packit db064d
	cap_mask = mad_get_field(info, 0, IB_PORT_CAPMASK_F);
Packit db064d
	if (cap_mask & be32toh(IB_PORT_CAP_HAS_EXT_SPEEDS))
Packit db064d
		espeed = mad_get_field(port->info, 0, IB_PORT_LINK_SPEED_EXT_ACTIVE_F);
Packit db064d
	else
Packit db064d
		espeed = 0;
Packit db064d
	IBND_DEBUG
Packit db064d
	    ("portid %s portnum %d: base lid %d state %d physstate %d %s %s %s %s\n",
Packit db064d
	     portid2str(portid), port->portnum, port->base_lid,
Packit db064d
	     mad_get_field(port->info, 0, IB_PORT_STATE_F),
Packit db064d
	     mad_get_field(port->info, 0, IB_PORT_PHYS_STATE_F),
Packit db064d
	     mad_dump_val(IB_PORT_LINK_WIDTH_ACTIVE_F, width, 64, &iwidth),
Packit db064d
	     mad_dump_val(IB_PORT_LINK_SPEED_ACTIVE_F, speed, 64, &ispeed),
Packit db064d
	     (fdr10 & FDR10) ? "FDR10"  : "",
Packit db064d
	     mad_dump_val(IB_PORT_LINK_SPEED_EXT_ACTIVE_F, speed, 64, &espeed));
Packit db064d
}
Packit db064d
Packit db064d
static int is_mlnx_ext_port_info_supported(ibnd_port_t * port)
Packit db064d
{
Packit db064d
	uint16_t devid = (uint16_t) mad_get_field(port->node->info, 0, IB_NODE_DEVID_F);
Packit db064d
	uint32_t vendorid = (uint32_t) mad_get_field(port->node->info, 0, IB_NODE_VENDORID_F);
Packit db064d
Packit db064d
	if ((devid >= 0xc738 && devid <= 0xc73b) ||
Packit db064d
	    devid == 0xc839 || devid == 0xcb20 || devid == 0xcf08 ||
Packit db064d
	    devid == 0xcf09 || devid == 0xd2f0 ||
Packit db064d
	    ((vendorid == 0x119f) &&
Packit db064d
	     /* Bull SwitchX */
Packit db064d
	     (devid == 0x1b02 || devid == 0x1b50 ||
Packit db064d
	      /* Bull SwitchIB and SwitchIB2 */
Packit db064d
	      devid == 0x1ba0 ||
Packit db064d
	      (devid >= 0x1bd0 && devid <= 0x1bd5) ||
Packit db064d
	      /* Bull Quantum */
Packit db064d
	      devid == 0x1bf0)))
Packit db064d
		return 1;
Packit db064d
	if ((devid >= 0x1003 && devid <= 0x101b) || (devid == 0xa2d2) ||
Packit db064d
	    ((vendorid == 0x119f) &&
Packit db064d
	     /* Bull ConnectX3 */
Packit db064d
	     (devid == 0x1b33 || devid == 0x1b73 ||
Packit db064d
	      devid == 0x1b40 || devid == 0x1b41 ||
Packit db064d
	      devid == 0x1b60 || devid == 0x1b61 ||
Packit db064d
	     /* Bull ConnectIB */
Packit db064d
	      devid == 0x1b83 ||
Packit db064d
	      devid == 0x1b93 || devid == 0x1b94 ||
Packit db064d
	      /* Bull ConnectX4, Sequana HDR and HDR100 */
Packit db064d
	      devid == 0x1bb4 || devid == 0x1bb5 ||
Packit db064d
	      (devid >= 0x1bc4 && devid <= 0x1bc6))))
Packit db064d
		return 1;
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
int mlnx_ext_port_info_err(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
			   uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	f_internal_t *f_int = ((ibnd_scan_t *) engine->user_data)->f_int;
Packit db064d
	ibnd_node_t *node = cb_data;
Packit db064d
	ibnd_port_t *port;
Packit db064d
	uint8_t port_num, local_port;
Packit db064d
Packit db064d
	port_num = (uint8_t) mad_get_field(mad, 0, IB_MAD_ATTRMOD_F);
Packit db064d
	port = node->ports[port_num];
Packit db064d
	if (!port) {
Packit db064d
		IBND_ERROR("Failed to find 0x%" PRIx64 " port %u\n",
Packit db064d
			   node->guid, port_num);
Packit db064d
		return -1;
Packit db064d
	}
Packit db064d
Packit db064d
	local_port = (uint8_t) mad_get_field(port->info, 0, IB_PORT_LOCAL_PORT_F);
Packit db064d
	debug_port(&smp->path, port);
Packit db064d
Packit db064d
	if (port_num && mad_get_field(port->info, 0, IB_PORT_PHYS_STATE_F)
Packit db064d
	    == IB_PORT_PHYS_STATE_LINKUP
Packit db064d
	    && ((node->type == IB_NODE_SWITCH && port_num != local_port) ||
Packit db064d
		(node == f_int->fabric.from_node && port_num == f_int->fabric.from_portnum))) {
Packit db064d
		int rc = 0;
Packit db064d
		ib_portid_t path = smp->path;
Packit db064d
Packit db064d
		if (node->type != IB_NODE_SWITCH &&
Packit db064d
		    node == f_int->fabric.from_node &&
Packit db064d
		    path.drpath.cnt > 1)
Packit db064d
			rc = retract_dpath(engine, &path);
Packit db064d
		else {
Packit db064d
			/* we can't proceed through an HCA with DR */
Packit db064d
			if (path.lid == 0 || node->type == IB_NODE_SWITCH)
Packit db064d
				rc = extend_dpath(engine, &path, port_num);
Packit db064d
		}
Packit db064d
Packit db064d
		if (rc > 0) {
Packit db064d
			struct ni_cbdata * cbdata = malloc(sizeof(*cbdata));
Packit db064d
			cbdata->node = node;
Packit db064d
			cbdata->port_num = port_num;
Packit db064d
			query_node_info(engine, &path, cbdata);
Packit db064d
		}
Packit db064d
	}
Packit db064d
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
static int recv_mlnx_ext_port_info(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
				   uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	f_internal_t *f_int = ((ibnd_scan_t *) engine->user_data)->f_int;
Packit db064d
	ibnd_node_t *node = cb_data;
Packit db064d
	ibnd_port_t *port;
Packit db064d
	uint8_t *ext_port_info = mad + IB_SMP_DATA_OFFS;
Packit db064d
	uint8_t port_num, local_port;
Packit db064d
Packit db064d
	port_num = (uint8_t) mad_get_field(mad, 0, IB_MAD_ATTRMOD_F);
Packit db064d
	port = node->ports[port_num];
Packit db064d
	if (!port) {
Packit db064d
		IBND_ERROR("Failed to find 0x%" PRIx64 " port %u\n",
Packit db064d
			   node->guid, port_num);
Packit db064d
		return -1;
Packit db064d
	}
Packit db064d
Packit db064d
	memcpy(port->ext_info, ext_port_info, sizeof(port->ext_info));
Packit db064d
	local_port = (uint8_t) mad_get_field(port->info, 0, IB_PORT_LOCAL_PORT_F);
Packit db064d
	debug_port(&smp->path, port);
Packit db064d
Packit db064d
	if (port_num && mad_get_field(port->info, 0, IB_PORT_PHYS_STATE_F)
Packit db064d
	    == IB_PORT_PHYS_STATE_LINKUP
Packit db064d
	    && ((node->type == IB_NODE_SWITCH && port_num != local_port) ||
Packit db064d
		(node == f_int->fabric.from_node && port_num == f_int->fabric.from_portnum))) {
Packit db064d
		int rc = 0;
Packit db064d
		ib_portid_t path = smp->path;
Packit db064d
Packit db064d
		if (node->type != IB_NODE_SWITCH &&
Packit db064d
		    node == f_int->fabric.from_node &&
Packit db064d
		    path.drpath.cnt > 1)
Packit db064d
			rc = retract_dpath(engine, &path);
Packit db064d
		else {
Packit db064d
			/* we can't proceed through an HCA with DR */
Packit db064d
			if (path.lid == 0 || node->type == IB_NODE_SWITCH)
Packit db064d
				rc = extend_dpath(engine, &path, port_num);
Packit db064d
		}
Packit db064d
Packit db064d
		if (rc > 0) {
Packit db064d
			struct ni_cbdata * cbdata = malloc(sizeof(*cbdata));
Packit db064d
			cbdata->node = node;
Packit db064d
			cbdata->port_num = port_num;
Packit db064d
			query_node_info(engine, &path, cbdata);
Packit db064d
		}
Packit db064d
	}
Packit db064d
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
static int query_mlnx_ext_port_info(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
				    ibnd_node_t * node, int portnum)
Packit db064d
{
Packit db064d
	IBND_DEBUG("Query MLNX Extended Port Info; %s (0x%" PRIx64 "):%d\n",
Packit db064d
		   portid2str(portid), node->guid, portnum);
Packit db064d
	return issue_smp(engine, portid, IB_ATTR_MLNX_EXT_PORT_INFO, portnum,
Packit db064d
			 recv_mlnx_ext_port_info, node);
Packit db064d
}
Packit db064d
Packit db064d
static int recv_port_info(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
			  uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	ibnd_scan_t *scan = (ibnd_scan_t *)engine->user_data;
Packit db064d
	f_internal_t *f_int = scan->f_int;
Packit db064d
	ibnd_node_t *node = cb_data;
Packit db064d
	ibnd_port_t *port;
Packit db064d
	uint8_t *port_info = mad + IB_SMP_DATA_OFFS;
Packit db064d
	uint8_t port_num, local_port;
Packit db064d
	int phystate, ispeed, espeed;
Packit db064d
	uint8_t *info;
Packit db064d
	uint32_t cap_mask;
Packit db064d
Packit db064d
	port_num = (uint8_t) mad_get_field(mad, 0, IB_MAD_ATTRMOD_F);
Packit db064d
	local_port = (uint8_t) mad_get_field(port_info, 0, IB_PORT_LOCAL_PORT_F);
Packit db064d
Packit db064d
	/* this may have been created before */
Packit db064d
	port = node->ports[port_num];
Packit db064d
	if (!port) {
Packit db064d
		port = node->ports[port_num] = calloc(1, sizeof(*port));
Packit db064d
		if (!port) {
Packit db064d
			IBND_ERROR("Failed to allocate 0x%" PRIx64 " port %u\n",
Packit db064d
				    node->guid, port_num);
Packit db064d
			return -1;
Packit db064d
		}
Packit db064d
		port->guid =
Packit db064d
		    mad_get_field64(node->info, 0, IB_NODE_PORT_GUID_F);
Packit db064d
	}
Packit db064d
Packit db064d
	memcpy(port->info, port_info, sizeof(port->info));
Packit db064d
	port->node = node;
Packit db064d
	port->portnum = port_num;
Packit db064d
	port->ext_portnum = 0;
Packit db064d
	port->base_lid = (uint16_t) mad_get_field(port->info, 0, IB_PORT_LID_F);
Packit db064d
	port->lmc = (uint8_t) mad_get_field(port->info, 0, IB_PORT_LMC_F);
Packit db064d
Packit db064d
	if (port_num == 0) {
Packit db064d
		node->smalid = port->base_lid;
Packit db064d
		node->smalmc = port->lmc;
Packit db064d
	} else if (node->type == IB_NODE_SWITCH) {
Packit db064d
		port->base_lid = node->smalid;
Packit db064d
		port->lmc = node->smalmc;
Packit db064d
	}
Packit db064d
Packit db064d
	int rc1 = add_to_portguid_hash(port, f_int->fabric.portstbl);
Packit db064d
	if (rc1)
Packit db064d
		IBND_ERROR("Error Occurred when trying"
Packit db064d
			   " to insert new port guid 0x%016" PRIx64 " to DB\n",
Packit db064d
			   port->guid);
Packit db064d
Packit db064d
	add_to_portlid_hash(port, f_int);
Packit db064d
Packit db064d
	if ((scan->cfg->flags & IBND_CONFIG_MLX_EPI)
Packit db064d
	    && is_mlnx_ext_port_info_supported(port)) {
Packit db064d
		phystate = mad_get_field(port->info, 0, IB_PORT_PHYS_STATE_F);
Packit db064d
		ispeed = mad_get_field(port->info, 0, IB_PORT_LINK_SPEED_ACTIVE_F);
Packit db064d
		if (port->node->type == IB_NODE_SWITCH)
Packit db064d
			info = (uint8_t *)&port->node->ports[0]->info;
Packit db064d
		else
Packit db064d
			info = (uint8_t *)&port->info;
Packit db064d
		cap_mask = mad_get_field(info, 0, IB_PORT_CAPMASK_F);
Packit db064d
		if (cap_mask & be32toh(IB_PORT_CAP_HAS_EXT_SPEEDS))
Packit db064d
			espeed = mad_get_field(port->info, 0, IB_PORT_LINK_SPEED_EXT_ACTIVE_F);
Packit db064d
		else
Packit db064d
			espeed = 0;
Packit db064d
Packit db064d
		if (phystate == IB_PORT_PHYS_STATE_LINKUP &&
Packit db064d
		    ispeed == IB_LINK_SPEED_ACTIVE_10 &&
Packit db064d
		    espeed == IB_LINK_SPEED_EXT_ACTIVE_NONE) {	/* LinkUp/QDR */
Packit db064d
			query_mlnx_ext_port_info(engine, &smp->path,
Packit db064d
						 node, port_num);
Packit db064d
			return 0;
Packit db064d
		}
Packit db064d
	}
Packit db064d
Packit db064d
	debug_port(&smp->path, port);
Packit db064d
Packit db064d
	if (port_num && mad_get_field(port->info, 0, IB_PORT_PHYS_STATE_F)
Packit db064d
	    == IB_PORT_PHYS_STATE_LINKUP
Packit db064d
	    && ((node->type == IB_NODE_SWITCH && port_num != local_port) ||
Packit db064d
		(node == f_int->fabric.from_node && port_num == f_int->fabric.from_portnum))) {
Packit db064d
Packit db064d
		int rc = 0;
Packit db064d
		ib_portid_t path = smp->path;
Packit db064d
Packit db064d
		if (node->type != IB_NODE_SWITCH &&
Packit db064d
		    node == f_int->fabric.from_node &&
Packit db064d
		    path.drpath.cnt > 1)
Packit db064d
			rc = retract_dpath(engine, &path);
Packit db064d
		else {
Packit db064d
			/* we can't proceed through an HCA with DR */
Packit db064d
			if (path.lid == 0 || node->type == IB_NODE_SWITCH)
Packit db064d
				rc = extend_dpath(engine, &path, port_num);
Packit db064d
		}
Packit db064d
Packit db064d
		if (rc > 0) {
Packit db064d
			struct ni_cbdata * cbdata = malloc(sizeof(*cbdata));
Packit db064d
			cbdata->node = node;
Packit db064d
			cbdata->port_num = port_num;
Packit db064d
			query_node_info(engine, &path, cbdata);
Packit db064d
		}
Packit db064d
	}
Packit db064d
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
static int recv_port0_info(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
			   uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	ibnd_node_t *node = cb_data;
Packit db064d
	int i, status;
Packit db064d
Packit db064d
	status = recv_port_info(engine, smp, mad, cb_data);
Packit db064d
	/* Query PortInfo on switch external/physical ports */
Packit db064d
	for (i = 1; i <= node->numports; i++)
Packit db064d
		query_port_info(engine, &smp->path, node, i);
Packit db064d
Packit db064d
	return status;
Packit db064d
}
Packit db064d
Packit db064d
static int query_port_info(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			   ibnd_node_t * node, int portnum)
Packit db064d
{
Packit db064d
	IBND_DEBUG("Query Port Info; %s (0x%" PRIx64 "):%d\n",
Packit db064d
		   portid2str(portid), node->guid, portnum);
Packit db064d
	return issue_smp(engine, portid, IB_ATTR_PORT_INFO, portnum,
Packit db064d
			 portnum ? recv_port_info : recv_port0_info, node);
Packit db064d
}
Packit db064d
Packit db064d
static ibnd_node_t *create_node(smp_engine_t * engine, ib_portid_t * path,
Packit db064d
				uint8_t * node_info)
Packit db064d
{
Packit db064d
	f_internal_t *f_int = ((ibnd_scan_t *) engine->user_data)->f_int;
Packit db064d
	ibnd_node_t *rc = calloc(1, sizeof(*rc));
Packit db064d
	if (!rc) {
Packit db064d
		IBND_ERROR("OOM: node creation failed\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	/* decode just a couple of fields for quicker reference. */
Packit db064d
	mad_decode_field(node_info, IB_NODE_GUID_F, &rc->guid);
Packit db064d
	mad_decode_field(node_info, IB_NODE_TYPE_F, &rc->type);
Packit db064d
	mad_decode_field(node_info, IB_NODE_NPORTS_F, &rc->numports);
Packit db064d
Packit db064d
	rc->ports = calloc(rc->numports + 1, sizeof(*rc->ports));
Packit db064d
	if (!rc->ports) {
Packit db064d
		free(rc);
Packit db064d
		IBND_ERROR("OOM: Failed to allocate the ports array\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	rc->path_portid = *path;
Packit db064d
	memcpy(rc->info, node_info, sizeof(rc->info));
Packit db064d
Packit db064d
	int rc1 = add_to_nodeguid_hash(rc, f_int->fabric.nodestbl);
Packit db064d
	if (rc1)
Packit db064d
		IBND_ERROR("Error Occurred when trying"
Packit db064d
			   " to insert new node guid 0x%016" PRIx64 " to DB\n",
Packit db064d
			   rc->guid);
Packit db064d
Packit db064d
	/* add this to the all nodes list */
Packit db064d
	rc->next = f_int->fabric.nodes;
Packit db064d
	f_int->fabric.nodes = rc;
Packit db064d
Packit db064d
	add_to_type_list(rc, f_int);
Packit db064d
Packit db064d
	return rc;
Packit db064d
}
Packit db064d
Packit db064d
static void link_ports(ibnd_node_t * node, ibnd_port_t * port,
Packit db064d
		       ibnd_node_t * remotenode, ibnd_port_t * remoteport)
Packit db064d
{
Packit db064d
	IBND_DEBUG("linking: 0x%" PRIx64 " %p->%p:%u and 0x%" PRIx64
Packit db064d
		   " %p->%p:%u\n", node->guid, node, port, port->portnum,
Packit db064d
		   remotenode->guid, remotenode, remoteport,
Packit db064d
		   remoteport->portnum);
Packit db064d
	if (port->remoteport)
Packit db064d
		port->remoteport->remoteport = NULL;
Packit db064d
	if (remoteport->remoteport)
Packit db064d
		remoteport->remoteport->remoteport = NULL;
Packit db064d
	port->remoteport = remoteport;
Packit db064d
	remoteport->remoteport = port;
Packit db064d
}
Packit db064d
Packit db064d
static void dump_endnode(ib_portid_t *path, const char *prompt,
Packit db064d
			 ibnd_node_t *node, ibnd_port_t *port)
Packit db064d
{
Packit db064d
	char type[64];
Packit db064d
	mad_dump_node_type(type, sizeof(type), &node->type, sizeof(int));
Packit db064d
	printf("%s -> %s %s {%016" PRIx64 "} portnum %d lid %d-%d \"%s\"\n",
Packit db064d
	       portid2str(path), prompt, type, node->guid,
Packit db064d
	       node->type == IB_NODE_SWITCH ? 0 : port->portnum,
Packit db064d
	       port->base_lid, port->base_lid + (1 << port->lmc) - 1,
Packit db064d
	       node->nodedesc);
Packit db064d
}
Packit db064d
Packit db064d
static int recv_node_info(smp_engine_t * engine, ibnd_smp_t * smp,
Packit db064d
			  uint8_t * mad, void *cb_data)
Packit db064d
{
Packit db064d
	ibnd_scan_t *scan = engine->user_data;
Packit db064d
	f_internal_t *f_int = scan->f_int;
Packit db064d
	uint8_t *node_info = mad + IB_SMP_DATA_OFFS;
Packit db064d
	struct ni_cbdata *ni_cbdata = (struct ni_cbdata *)cb_data;
Packit db064d
	ibnd_node_t *rem_node = NULL;
Packit db064d
	int rem_port_num = 0;
Packit db064d
	ibnd_node_t *node;
Packit db064d
	int node_is_new = 0;
Packit db064d
	uint64_t node_guid = mad_get_field64(node_info, 0, IB_NODE_GUID_F);
Packit db064d
	uint64_t port_guid = mad_get_field64(node_info, 0, IB_NODE_PORT_GUID_F);
Packit db064d
	int port_num = mad_get_field(node_info, 0, IB_NODE_LOCAL_PORT_F);
Packit db064d
	ibnd_port_t *port = NULL;
Packit db064d
Packit db064d
	if (ni_cbdata) {
Packit db064d
		rem_node = ni_cbdata->node;
Packit db064d
		rem_port_num = ni_cbdata->port_num;
Packit db064d
		free(ni_cbdata);
Packit db064d
	}
Packit db064d
Packit db064d
	node = ibnd_find_node_guid(&f_int->fabric, node_guid);
Packit db064d
	if (!node) {
Packit db064d
		node = create_node(engine, &smp->path, node_info);
Packit db064d
		if (!node)
Packit db064d
			return -1;
Packit db064d
		node_is_new = 1;
Packit db064d
	}
Packit db064d
	IBND_DEBUG("Found %s node GUID 0x%" PRIx64 " (%s)\n",
Packit db064d
		   node_is_new ? "new" : "old", node->guid,
Packit db064d
		   portid2str(&smp->path));
Packit db064d
Packit db064d
	port = node->ports[port_num];
Packit db064d
	if (!port) {
Packit db064d
		/* If we have not see this port before create a shell for it */
Packit db064d
		port = node->ports[port_num] = calloc(1, sizeof(*port));
Packit db064d
		if (!port)
Packit db064d
			return -1;
Packit db064d
		port->node = node;
Packit db064d
		port->portnum = port_num;
Packit db064d
	}
Packit db064d
	port->guid = port_guid;
Packit db064d
Packit db064d
	if (scan->cfg->show_progress)
Packit db064d
		dump_endnode(&smp->path, node_is_new ? "new" : "known",
Packit db064d
			     node, port);
Packit db064d
Packit db064d
	if (rem_node == NULL) {	/* this is the start node */
Packit db064d
		f_int->fabric.from_node = node;
Packit db064d
		f_int->fabric.from_portnum = port_num;
Packit db064d
	} else {
Packit db064d
		/* link ports... */
Packit db064d
		if (!rem_node->ports[rem_port_num]) {
Packit db064d
			IBND_ERROR("Internal Error; "
Packit db064d
				   "Node(%p) 0x%" PRIx64
Packit db064d
				   " Port %d no port created!?!?!?\n\n",
Packit db064d
				   rem_node, rem_node->guid, rem_port_num);
Packit db064d
			return -1;
Packit db064d
		}
Packit db064d
Packit db064d
		link_ports(node, port, rem_node, rem_node->ports[rem_port_num]);
Packit db064d
	}
Packit db064d
Packit db064d
	if (node_is_new) {
Packit db064d
		query_node_desc(engine, &smp->path, node);
Packit db064d
Packit db064d
		if (node->type == IB_NODE_SWITCH) {
Packit db064d
			query_switch_info(engine, &smp->path, node);
Packit db064d
			/* Query PortInfo on Switch Port 0 first */
Packit db064d
			query_port_info(engine, &smp->path, node, 0);
Packit db064d
		}
Packit db064d
	}
Packit db064d
Packit db064d
	if (node->type != IB_NODE_SWITCH)
Packit db064d
		query_port_info(engine, &smp->path, node, port_num);
Packit db064d
Packit db064d
	return 0;
Packit db064d
}
Packit db064d
Packit db064d
static int query_node_info(smp_engine_t * engine, ib_portid_t * portid,
Packit db064d
			   struct ni_cbdata * cbdata)
Packit db064d
{
Packit db064d
	IBND_DEBUG("Query Node Info; %s\n", portid2str(portid));
Packit db064d
	return issue_smp(engine, portid, IB_ATTR_NODE_INFO, 0,
Packit db064d
			 recv_node_info, (void *)cbdata);
Packit db064d
}
Packit db064d
Packit db064d
ibnd_node_t *ibnd_find_node_guid(ibnd_fabric_t * fabric, uint64_t guid)
Packit db064d
{
Packit db064d
	int hash = HASHGUID(guid) % HTSZ;
Packit db064d
	ibnd_node_t *node;
Packit db064d
Packit db064d
	if (!fabric) {
Packit db064d
		IBND_DEBUG("fabric parameter NULL\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	for (node = fabric->nodestbl[hash]; node; node = node->htnext)
Packit db064d
		if (node->guid == guid)
Packit db064d
			return node;
Packit db064d
Packit db064d
	return NULL;
Packit db064d
}
Packit db064d
Packit db064d
ibnd_node_t *ibnd_find_node_dr(ibnd_fabric_t * fabric, char *dr_str)
Packit db064d
{
Packit db064d
	ibnd_port_t *rc = ibnd_find_port_dr(fabric, dr_str);
Packit db064d
	return rc->node;
Packit db064d
}
Packit db064d
Packit db064d
int add_to_nodeguid_hash(ibnd_node_t * node, ibnd_node_t * hash[])
Packit db064d
{
Packit db064d
	int rc = 0;
Packit db064d
	ibnd_node_t *tblnode;
Packit db064d
	int hash_idx = HASHGUID(node->guid) % HTSZ;
Packit db064d
Packit db064d
	for (tblnode = hash[hash_idx]; tblnode; tblnode = tblnode->htnext) {
Packit db064d
		if (tblnode == node) {
Packit db064d
			IBND_ERROR("Duplicate Node: Node with guid 0x%016"
Packit db064d
				   PRIx64 " already exists in nodes DB\n",
Packit db064d
				   node->guid);
Packit db064d
			return 1;
Packit db064d
		}
Packit db064d
	}
Packit db064d
	node->htnext = hash[hash_idx];
Packit db064d
	hash[hash_idx] = node;
Packit db064d
	return rc;
Packit db064d
}
Packit db064d
Packit db064d
int add_to_portguid_hash(ibnd_port_t * port, ibnd_port_t * hash[])
Packit db064d
{
Packit db064d
	int rc = 0;
Packit db064d
	ibnd_port_t *tblport;
Packit db064d
	int hash_idx = HASHGUID(port->guid) % HTSZ;
Packit db064d
Packit db064d
	for (tblport = hash[hash_idx]; tblport; tblport = tblport->htnext) {
Packit db064d
		if (tblport == port) {
Packit db064d
			IBND_ERROR("Duplicate Port: Port with guid 0x%016"
Packit db064d
				   PRIx64 " already exists in ports DB\n",
Packit db064d
				   port->guid);
Packit db064d
			return 1;
Packit db064d
		}
Packit db064d
	}
Packit db064d
	port->htnext = hash[hash_idx];
Packit db064d
	hash[hash_idx] = port;
Packit db064d
	return rc;
Packit db064d
}
Packit db064d
Packit db064d
struct lid2guid_item {
Packit db064d
	cl_map_item_t cl_map;
Packit db064d
	ibnd_port_t *port;
Packit db064d
};
Packit db064d
Packit db064d
void create_lid2guid(f_internal_t *f_int)
Packit db064d
{
Packit db064d
	cl_qmap_init(&f_int->lid2guid);
Packit db064d
}
Packit db064d
Packit db064d
void destroy_lid2guid(f_internal_t *f_int)
Packit db064d
{
Packit db064d
	cl_map_item_t *item;
Packit db064d
Packit db064d
	for (item = cl_qmap_head(&f_int->lid2guid); item != cl_qmap_end(&f_int->lid2guid);
Packit db064d
	     item = cl_qmap_head(&f_int->lid2guid)) {
Packit db064d
		cl_qmap_remove_item(&f_int->lid2guid, item);
Packit db064d
		free(container_of(item, struct lid2guid_item, cl_map));
Packit db064d
	}
Packit db064d
}
Packit db064d
Packit db064d
void add_to_portlid_hash(ibnd_port_t * port, f_internal_t *f_int)
Packit db064d
{
Packit db064d
	uint16_t base_lid = port->base_lid;
Packit db064d
	uint16_t lid_mask = ((1 << port->lmc) -1);
Packit db064d
	uint16_t lid = 0;
Packit db064d
	/* 0 < valid lid <= 0xbfff */
Packit db064d
	if (base_lid > 0 && base_lid <= 0xbfff) {
Packit db064d
		/* We add the port for all lids
Packit db064d
		 * so it is easier to find any "random" lid specified */
Packit db064d
		for (lid = base_lid; lid <= (base_lid + lid_mask); lid++) {
Packit db064d
			struct lid2guid_item *item;
Packit db064d
Packit db064d
			item = malloc(sizeof(*item));
Packit db064d
			if (item) {
Packit db064d
				item->port = port;
Packit db064d
				cl_qmap_insert(&f_int->lid2guid, lid,
Packit db064d
					       &item->cl_map);
Packit db064d
			}
Packit db064d
		}
Packit db064d
	}
Packit db064d
}
Packit db064d
Packit db064d
void add_to_type_list(ibnd_node_t * node, f_internal_t * f_int)
Packit db064d
{
Packit db064d
	ibnd_fabric_t *fabric = &f_int->fabric;
Packit db064d
	switch (node->type) {
Packit db064d
	case IB_NODE_CA:
Packit db064d
		node->type_next = fabric->ch_adapters;
Packit db064d
		fabric->ch_adapters = node;
Packit db064d
		break;
Packit db064d
	case IB_NODE_SWITCH:
Packit db064d
		node->type_next = fabric->switches;
Packit db064d
		fabric->switches = node;
Packit db064d
		break;
Packit db064d
	case IB_NODE_ROUTER:
Packit db064d
		node->type_next = fabric->routers;
Packit db064d
		fabric->routers = node;
Packit db064d
		break;
Packit db064d
	}
Packit db064d
}
Packit db064d
Packit db064d
static int set_config(struct ibnd_config *config, struct ibnd_config *cfg)
Packit db064d
{
Packit db064d
	if (!config)
Packit db064d
		return (-EINVAL);
Packit db064d
Packit db064d
	if (cfg)
Packit db064d
		memcpy(config, cfg, sizeof(*config));
Packit db064d
Packit db064d
	if (!config->max_smps)
Packit db064d
		config->max_smps = DEFAULT_MAX_SMP_ON_WIRE;
Packit db064d
	if (!config->timeout_ms)
Packit db064d
		config->timeout_ms = DEFAULT_TIMEOUT;
Packit db064d
	if (!config->retries)
Packit db064d
		config->retries = DEFAULT_RETRIES;
Packit db064d
Packit db064d
	return (0);
Packit db064d
}
Packit db064d
Packit db064d
f_internal_t *allocate_fabric_internal(void)
Packit db064d
{
Packit db064d
	f_internal_t *f = calloc(1, sizeof(*f));
Packit db064d
	if (f)
Packit db064d
		create_lid2guid(f);
Packit db064d
Packit db064d
	return (f);
Packit db064d
}
Packit db064d
Packit db064d
ibnd_fabric_t *ibnd_discover_fabric(char * ca_name, int ca_port,
Packit db064d
				    ib_portid_t * from,
Packit db064d
				    struct ibnd_config *cfg)
Packit db064d
{
Packit db064d
	struct ibnd_config config = { 0 };
Packit db064d
	f_internal_t *f_int = NULL;
Packit db064d
	ib_portid_t my_portid = { 0 };
Packit db064d
	smp_engine_t engine;
Packit db064d
	ibnd_scan_t scan;
Packit db064d
	struct ibmad_port *ibmad_port;
Packit db064d
	int nc = 2;
Packit db064d
	int mc[2] = { IB_SMI_CLASS, IB_SMI_DIRECT_CLASS };
Packit db064d
Packit db064d
	/* If not specified start from "my" port */
Packit db064d
	if (!from)
Packit db064d
		from = &my_portid;
Packit db064d
Packit db064d
	if (set_config(&config, cfg)) {
Packit db064d
		IBND_ERROR("Invalid ibnd_config\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	f_int = allocate_fabric_internal();
Packit db064d
	if (!f_int) {
Packit db064d
		IBND_ERROR("OOM: failed to calloc ibnd_fabric_t\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	memset(&scan.selfportid, 0, sizeof(scan.selfportid));
Packit db064d
	scan.f_int = f_int;
Packit db064d
	scan.cfg = &config;
Packit db064d
	scan.initial_hops = from->drpath.cnt;
Packit db064d
Packit db064d
	ibmad_port = mad_rpc_open_port(ca_name, ca_port, mc, nc);
Packit db064d
	if (!ibmad_port) {
Packit db064d
		IBND_ERROR("can't open MAD port (%s:%d)\n", ca_name, ca_port);
Packit db064d
		return (NULL);
Packit db064d
	}
Packit db064d
	mad_rpc_set_timeout(ibmad_port, cfg->timeout_ms);
Packit db064d
	mad_rpc_set_retries(ibmad_port, cfg->retries);
Packit db064d
	smp_mkey_set(ibmad_port, cfg->mkey);
Packit db064d
Packit db064d
	if (ib_resolve_self_via(&scan.selfportid,
Packit db064d
				NULL, NULL, ibmad_port) < 0) {
Packit db064d
		IBND_ERROR("Failed to resolve self\n");
Packit db064d
		mad_rpc_close_port(ibmad_port);
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
	mad_rpc_close_port(ibmad_port);
Packit db064d
Packit db064d
	if (smp_engine_init(&engine, ca_name, ca_port, &scan, &config)) {
Packit db064d
		free(f_int);
Packit db064d
		return (NULL);
Packit db064d
	}
Packit db064d
Packit db064d
	IBND_DEBUG("from %s\n", portid2str(from));
Packit db064d
Packit db064d
	if (!query_node_info(&engine, from, NULL))
Packit db064d
		if (process_mads(&engine) != 0)
Packit db064d
			goto error;
Packit db064d
Packit db064d
	f_int->fabric.total_mads_used = engine.total_smps;
Packit db064d
	f_int->fabric.maxhops_discovered += scan.initial_hops;
Packit db064d
Packit db064d
	if (group_nodes(&f_int->fabric))
Packit db064d
		goto error;
Packit db064d
Packit db064d
	smp_engine_destroy(&engine);
Packit db064d
	return (ibnd_fabric_t *)f_int;
Packit db064d
error:
Packit db064d
	smp_engine_destroy(&engine);
Packit db064d
	ibnd_destroy_fabric(&f_int->fabric);
Packit db064d
	return NULL;
Packit db064d
}
Packit db064d
Packit db064d
void destroy_node(ibnd_node_t * node)
Packit db064d
{
Packit db064d
	int p = 0;
Packit db064d
Packit db064d
	if (node->ports) {
Packit db064d
		for (p = 0; p <= node->numports; p++)
Packit db064d
			free(node->ports[p]);
Packit db064d
		free(node->ports);
Packit db064d
	}
Packit db064d
	free(node);
Packit db064d
}
Packit db064d
Packit db064d
void ibnd_destroy_fabric(ibnd_fabric_t * fabric)
Packit db064d
{
Packit db064d
	ibnd_node_t *node = NULL;
Packit db064d
	ibnd_node_t *next = NULL;
Packit db064d
	ibnd_chassis_t *ch, *ch_next;
Packit db064d
Packit db064d
	if (!fabric)
Packit db064d
		return;
Packit db064d
Packit db064d
	ch = fabric->chassis;
Packit db064d
	while (ch) {
Packit db064d
		ch_next = ch->next;
Packit db064d
		free(ch);
Packit db064d
		ch = ch_next;
Packit db064d
	}
Packit db064d
	node = fabric->nodes;
Packit db064d
	while (node) {
Packit db064d
		next = node->next;
Packit db064d
		destroy_node(node);
Packit db064d
		node = next;
Packit db064d
	}
Packit db064d
	destroy_lid2guid((f_internal_t *)fabric);
Packit db064d
	free(fabric);
Packit db064d
}
Packit db064d
Packit db064d
void ibnd_iter_nodes(ibnd_fabric_t * fabric, ibnd_iter_node_func_t func,
Packit db064d
		     void *user_data)
Packit db064d
{
Packit db064d
	ibnd_node_t *cur = NULL;
Packit db064d
Packit db064d
	if (!fabric) {
Packit db064d
		IBND_DEBUG("fabric parameter NULL\n");
Packit db064d
		return;
Packit db064d
	}
Packit db064d
Packit db064d
	if (!func) {
Packit db064d
		IBND_DEBUG("func parameter NULL\n");
Packit db064d
		return;
Packit db064d
	}
Packit db064d
Packit db064d
	for (cur = fabric->nodes; cur; cur = cur->next)
Packit db064d
		func(cur, user_data);
Packit db064d
}
Packit db064d
Packit db064d
void ibnd_iter_nodes_type(ibnd_fabric_t * fabric, ibnd_iter_node_func_t func,
Packit db064d
			  int node_type, void *user_data)
Packit db064d
{
Packit db064d
	ibnd_node_t *list = NULL;
Packit db064d
	ibnd_node_t *cur = NULL;
Packit db064d
Packit db064d
	if (!fabric) {
Packit db064d
		IBND_DEBUG("fabric parameter NULL\n");
Packit db064d
		return;
Packit db064d
	}
Packit db064d
Packit db064d
	if (!func) {
Packit db064d
		IBND_DEBUG("func parameter NULL\n");
Packit db064d
		return;
Packit db064d
	}
Packit db064d
Packit db064d
	switch (node_type) {
Packit db064d
	case IB_NODE_SWITCH:
Packit db064d
		list = fabric->switches;
Packit db064d
		break;
Packit db064d
	case IB_NODE_CA:
Packit db064d
		list = fabric->ch_adapters;
Packit db064d
		break;
Packit db064d
	case IB_NODE_ROUTER:
Packit db064d
		list = fabric->routers;
Packit db064d
		break;
Packit db064d
	default:
Packit db064d
		IBND_DEBUG("Invalid node_type specified %d\n", node_type);
Packit db064d
		break;
Packit db064d
	}
Packit db064d
Packit db064d
	for (cur = list; cur; cur = cur->type_next)
Packit db064d
		func(cur, user_data);
Packit db064d
}
Packit db064d
Packit db064d
ibnd_port_t *ibnd_find_port_lid(ibnd_fabric_t * fabric,
Packit db064d
				uint16_t lid)
Packit db064d
{
Packit db064d
	f_internal_t *f = (f_internal_t *)fabric;
Packit db064d
Packit db064d
	return container_of(cl_qmap_get(&f->lid2guid, lid),
Packit db064d
			    struct lid2guid_item, cl_map)
Packit db064d
		->port;
Packit db064d
}
Packit db064d
Packit db064d
ibnd_port_t *ibnd_find_port_guid(ibnd_fabric_t * fabric, uint64_t guid)
Packit db064d
{
Packit db064d
	int hash = HASHGUID(guid) % HTSZ;
Packit db064d
	ibnd_port_t *port;
Packit db064d
Packit db064d
	if (!fabric) {
Packit db064d
		IBND_DEBUG("fabric parameter NULL\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	for (port = fabric->portstbl[hash]; port; port = port->htnext)
Packit db064d
		if (port->guid == guid)
Packit db064d
			return port;
Packit db064d
Packit db064d
	return NULL;
Packit db064d
}
Packit db064d
Packit db064d
ibnd_port_t *ibnd_find_port_dr(ibnd_fabric_t * fabric, char *dr_str)
Packit db064d
{
Packit db064d
	int i = 0;
Packit db064d
	ibnd_node_t *cur_node;
Packit db064d
	ibnd_port_t *rc = NULL;
Packit db064d
	ib_dr_path_t path;
Packit db064d
Packit db064d
	if (!fabric) {
Packit db064d
		IBND_DEBUG("fabric parameter NULL\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	if (!dr_str) {
Packit db064d
		IBND_DEBUG("dr_str parameter NULL\n");
Packit db064d
		return NULL;
Packit db064d
	}
Packit db064d
Packit db064d
	cur_node = fabric->from_node;
Packit db064d
Packit db064d
	if (str2drpath(&path, dr_str, 0, 0) == -1)
Packit db064d
		return NULL;
Packit db064d
Packit db064d
	for (i = 0; i <= path.cnt; i++) {
Packit db064d
		ibnd_port_t *remote_port = NULL;
Packit db064d
		if (path.p[i] == 0)
Packit db064d
			continue;
Packit db064d
		if (!cur_node->ports)
Packit db064d
			return NULL;
Packit db064d
Packit db064d
		remote_port = cur_node->ports[path.p[i]]->remoteport;
Packit db064d
		if (!remote_port)
Packit db064d
			return NULL;
Packit db064d
Packit db064d
		rc = remote_port;
Packit db064d
		cur_node = remote_port->node;
Packit db064d
	}
Packit db064d
Packit db064d
	return rc;
Packit db064d
}
Packit db064d
Packit db064d
void ibnd_iter_ports(ibnd_fabric_t * fabric, ibnd_iter_port_func_t func,
Packit db064d
			void *user_data)
Packit db064d
{
Packit db064d
	int i = 0;
Packit db064d
	ibnd_port_t *cur = NULL;
Packit db064d
Packit db064d
	if (!fabric) {
Packit db064d
		IBND_DEBUG("fabric parameter NULL\n");
Packit db064d
		return;
Packit db064d
	}
Packit db064d
Packit db064d
	if (!func) {
Packit db064d
		IBND_DEBUG("func parameter NULL\n");
Packit db064d
		return;
Packit db064d
	}
Packit db064d
Packit db064d
	for (i = 0; i
Packit db064d
		for (cur = fabric->portstbl[i]; cur; cur = cur->htnext)
Packit db064d
			func(cur, user_data);
Packit db064d
}