Initial commit of OpenSPARC T2 architecture model.

[OpenSPARC-T2-SAM] / hypervisor / src / common / src / support.c

/*
* ========== Copyright Header Begin ==========================================
*
* Hypervisor Software File: support.c
* 
* Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved.
* 
*  - Do no alter or remove copyright notices
* 
*  - Redistribution and use of this software in source and binary forms, with 
*    or without modification, are permitted provided that the following 
*    conditions are met: 
* 
*  - Redistribution of source code must retain the above copyright notice, 
*    this list of conditions and the following disclaimer.
* 
*  - Redistribution in binary form must reproduce the above copyright notice,
*    this list of conditions and the following disclaimer in the
*    documentation and/or other materials provided with the distribution. 
* 
*    Neither the name of Sun Microsystems, Inc. or the names of contributors 
* may be used to endorse or promote products derived from this software 
* without specific prior written permission. 
* 
*     This software is provided "AS IS," without a warranty of any kind. 
* ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, 
* INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A 
* PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN 
* MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR 
* ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR 
* DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN 
* OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR 
* FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE 
* DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY, 
* ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF 
* SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES.
* 
* You acknowledge that this software is not designed, licensed or
* intended for use in the design, construction, operation or maintenance of
* any nuclear facility. 
* 
* ========== Copyright Header End ============================================
*/
/*
 * Copyright 2007 Sun Microsystems, Inc.	 All rights reserved.
 * Use is subject to license terms.
 */

#pragma ident	"@(#)support.c	1.5	07/07/09 SMI"

#include <stdarg.h>

#include <sys/htypes.h>
#include <support.h>
#include <vdev_intr.h>
#include <config.h>

/*
 * Basic printf capability for debugging output.
 */
void
c_printf(char *strp, ...)
{
	va_list argsp;
	int i, ch;
	char buf[2];

	va_start(argsp, strp);

	buf[1] = '\0';
#define	PUTC(_x)	do { buf[0] = (_x); c_puts(buf); } while (0)

	for (i = 0; (ch = strp[i]) != '\0'; i++) {
		switch (ch) {
		case '%':
			ch = strp[++i];
			switch (ch) {
			case '\0':
				goto done;
			case 'x':
			case 'p':
				c_putn(va_arg(argsp, uint64_t), 16);
				break;
			case 'd':
				c_putn(va_arg(argsp, uint64_t), 10);
				break;
			case 's':
				c_puts(va_arg(argsp, char *));
				break;
			case '%':
				goto def;
			default:
				break;
			}
			break;
		case '\n':
			PUTC('\r');
		default:
def:;
			PUTC(ch);
			break;
		}
	}

done:;
	va_end(argsp);
}


/*
 * HV console output a number in the specified base
 */
void
c_putn(uint64_t val, int base)
{
	uint64_t num;
	static char ch[] = "0123456789abcdef";
	char buf[2];

	buf[1] = '\0';

	if (base == 10 && ((int64_t)val) < 0LL) {
		PUTC('-');
		val = 0 - val;
	}

	num = 1;
	while ((val / num) >= base) {
		num *= base;
	}

	do {
		PUTC(ch[ val / num ]);
		val = val % num;
		num = num / base;
	} while (num != 0);
}


/*
 * Brain dead bzero ...
 * ... do properly if we ever need to bzero large chunks of memory
 */
void
c_bzero(void *ptr, uint64_t size)
{
	uint8_t *p = ptr;
	uint64_t i;

	for (i = 0; i < size; i++) p[i] = 0;
}

/*
 * Brain dead memcpy ...
 * ... do properly if we ever need to copy large chunks of memory
 */
void
c_memcpy(void *dest, void *src, uint64_t size)
{
	uint8_t *destp = dest;
	uint8_t *srcp = src;
	uint64_t i;

	for (i = 0; i < size; i++)
		destp[i] = srcp[i];
}

void
c_usleep(uint64_t usecs)
{

	uint64_t delay, old;

#ifdef	DEBUG
	/*
	 * Make sure the MD has been parsed/read in before using
	 * stickfrequency
	 */
	if (config.stickfrequency == 0) {
	c_hvabort();
	}
#endif

	delay = (usecs * config.stickfrequency) / 1000000ll;

	for (old = c_get_stick(); (c_get_stick() - old ) < delay; )
		/* LINTED */
		;
}