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

#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;
        }
}