modules/s1394/s1394.c

/*
 * 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.
 */

#pragma ident   "%Z%%M% %I% %E% SMI"

#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 == NULL) {
        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 == NULL)
        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);
}