/*
 * 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;
	}
}