/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License, Version 1.0 only
 * (the "License").  You may not use this file except in compliance
 * with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright (c) 1999-2000 by Sun Microsystems, Inc.
 * All rights reserved.
 */

#include <sys/mdb_modapi.h>
#include <sys/dditypes.h>
#include <sys/sysinfo.h>
#include <sys/1394/s1394.h>

static int print_node_info(s1394_hal_t *hal);

/*
 * speedmap()
 *    is used to print node information (speed map, node number, GUID, etc.)
 *    about the 1394 devices currently attached to the 1394 bus.
 */
static int
speedmap(uintptr_t addr, uint_t flags, int argc, const mdb_arg_t *argv)
{
	s1394_hal_t	hal;
	int		ret;

	if (flags & DCMD_ADDRSPEC) {
		if (mdb_vread(&hal, sizeof (s1394_hal_t), addr) == -1) {
			mdb_warn("failed to read the HAL structure");
			return (DCMD_ERR);
		}

		ret = print_node_info(&hal);
		if (ret == DCMD_ERR)
		    return (DCMD_ERR);
	} else {
		(void) mdb_walk_dcmd("speedmap", "speedmap", argc, argv);
	}

	return (DCMD_OK);
}

static int
speedmap_walk_init(mdb_walk_state_t *wsp)
{
	s1394_state_t	*statep;
	s1394_state_t	state;

	if (wsp->walk_addr == 0) {
		if (mdb_readvar(&statep, "s1394_statep") == -1) {
			mdb_warn("failed to find the s1394_statep pointer");
			return (WALK_ERR);
		}
		if (mdb_vread(&state, sizeof (s1394_state_t),
		    (uintptr_t)statep) == -1) {
			mdb_warn("failed to read the s1394_statep structure");
			return (WALK_ERR);
		}
		wsp->walk_addr = (uintptr_t)state.hal_head;
	}

	return (WALK_NEXT);
}

static int
speedmap_walk_step(mdb_walk_state_t *wsp)
{
	s1394_hal_t	hal;
	uintptr_t	addr = wsp->walk_addr;

	if (addr == 0)
		return (WALK_DONE);

	if (mdb_vread(&hal, sizeof (s1394_hal_t), addr) == -1) {
		mdb_warn("failed to read the HAL structure");
		return (WALK_ERR);
	}

	wsp->walk_addr = (uintptr_t)hal.hal_next;
	return (wsp->walk_callback(addr, &hal, wsp->walk_cbdata));
}

/*ARGSUSED*/
static void
speedmap_walk_fini(mdb_walk_state_t *wsp)
{
	/* Nothing to do here */
}

static const mdb_dcmd_t dcmds[] = {
	{ "speedmap", NULL, "print 1394 bus information", speedmap },
	{ NULL }
};

static const mdb_walker_t walkers[] = {
	{ "speedmap", "iterate over HAL structures", speedmap_walk_init,
		speedmap_walk_step, speedmap_walk_fini },
	{ NULL }
};

static const mdb_modinfo_t modinfo = {
	MDB_API_VERSION, dcmds, walkers
};

const mdb_modinfo_t *
_mdb_init(void)
{
	return (&modinfo);
}

/*
 * print_node_info()
 *    is used to do the actual printing, given a HAL pointer.
 */
static int
print_node_info(s1394_hal_t *hal)
{
	s1394_node_t	node[IEEE1394_MAX_NODES];
	uint32_t	cfgrom[IEEE1394_CONFIG_ROM_QUAD_SZ];
	char		str[512], tmp[512];
	uint_t		hal_node_num, num_nodes;
	int		i, j;

	num_nodes = hal->number_of_nodes;
	if (mdb_vread(node, (num_nodes * sizeof (s1394_node_t)),
	    (uintptr_t)hal->topology_tree) == -1) {
		mdb_warn("failed to read the node structures");
		return (DCMD_ERR);
	}

	hal_node_num = IEEE1394_NODE_NUM(hal->node_id);

	mdb_printf("Speed Map:\n");

	(void) strcpy(str, "    |");
	for (i = 0; i < num_nodes; i++) {
		(void) mdb_snprintf(tmp, sizeof (tmp), " %2d ", i);
		(void) strcat(str, tmp);
	}
	(void) strcat(str, "  |       GUID\n");
	mdb_printf("%s", str);

	(void) strcpy(str, "----|");
	for (i = 0; i < hal->number_of_nodes; i++) {
		(void) mdb_snprintf(tmp, sizeof (tmp), "----");
		(void) strcat(str, tmp);
	}
	(void) strcat(str, "--|------------------\n");
	mdb_printf("%s", str);

	for (i = 0; i < num_nodes; i++) {
		if (node[i].cfgrom != NULL) {
			if (mdb_vread(&cfgrom, IEEE1394_CONFIG_ROM_SZ,
			    (uintptr_t)node[i].cfgrom) == -1) {
				mdb_warn("failed to read Config ROM");
				return (DCMD_ERR);
			}
		}

		(void) mdb_snprintf(str, sizeof (str), " %2d |", i);

		for (j = 0; j < num_nodes; j++) {
			(void) mdb_snprintf(tmp, sizeof (tmp), " %3d",
			    hal->speed_map[i][j]);
			(void) strcat(str, tmp);
		}

		if (i == hal_node_num) {
			(void) strcat(str, "  | Local OHCI Card\n");

		} else if (node[i].link_active == 0) {
			(void) strcat(str, "  | Link off\n");

		} else if (CFGROM_BIB_READ(&node[i])) {
			(void) mdb_snprintf(tmp, sizeof (tmp),
			    "  | %08x%08x\n", cfgrom[3], cfgrom[4]);
			(void) strcat(str, tmp);

		} else {
			(void) strcat(str, "  | ????????????????\n");
		}
		mdb_printf("%s", str);
	}
	mdb_printf("\n");
	return (DCMD_OK);
}