io/hxge/hpi.c

/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (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 2008 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

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

#include <hpi.h>
#include <hxge_impl.h>

static hxge_os_mutex_t hpidebuglock;
static int hpi_debug_init = 0;
uint64_t hpi_debug_level = 0x0;

void
hpi_debug_msg(hpi_handle_function_t function, uint64_t level, char *fmt, ...)
{
    char        msg_buffer[1024];
    char        prefix_buffer[32];
    int     cmn_level = CE_CONT;
    va_list     ap;

    if ((level & hpi_debug_level) ||
        (level & HPI_REG_CTL) || (level & HPI_ERR_CTL)) {

        if (hpi_debug_init == 0) {
            MUTEX_INIT(&hpidebuglock, NULL, MUTEX_DRIVER, NULL);
            hpi_debug_init = 1;
        }

        MUTEX_ENTER(&hpidebuglock);

        if (level & HPI_ERR_CTL) {
            cmn_level = CE_WARN;
        }

        va_start(ap, fmt);
        (void) vsprintf(msg_buffer, fmt, ap);
        va_end(ap);

        (void) sprintf(prefix_buffer, "%s%d(%d):", "hpi",
            function.instance, function.function);

        cmn_err(cmn_level, "%s %s\n", prefix_buffer, msg_buffer);
        MUTEX_EXIT(&hpidebuglock);
    }
}

void
hpi_rtrace_buf_init(rtrace_t *rt)
{
    int i;

    rt->next_idx = 0;
    rt->last_idx = MAX_RTRACE_ENTRIES - 1;
    rt->wrapped = B_FALSE;
    for (i = 0; i < MAX_RTRACE_ENTRIES; i++) {
        rt->buf[i].ctl_addr = TRACE_CTL_INVALID;
        rt->buf[i].val_l32 = 0;
        rt->buf[i].val_h32 = 0;
    }
}

void
hpi_rtrace_update(hpi_handle_t handle, boolean_t wr, rtrace_t *rt,
    uint32_t addr, uint64_t val)
{
    int idx;
    idx = rt->next_idx;
    if (wr == B_TRUE)
        rt->buf[idx].ctl_addr = (addr & TRACE_ADDR_MASK) | TRACE_CTL_WR;
    else
        rt->buf[idx].ctl_addr = (addr & TRACE_ADDR_MASK);
    rt->buf[idx].ctl_addr |= (((handle.function.function
        << TRACE_FUNC_SHIFT) & TRACE_FUNC_MASK) |
        ((handle.function.instance << TRACE_INST_SHIFT) & TRACE_INST_MASK));
    rt->buf[idx].val_l32 = val & 0xFFFFFFFF;
    rt->buf[idx].val_h32 = (val >> 32) & 0xFFFFFFFF;
    rt->next_idx++;
    if (rt->next_idx > rt->last_idx) {
        rt->next_idx = 0;
        rt->wrapped = B_TRUE;
    }
}