Subversion Repositories openrisc

/* Support */
 
#include "spr-defs.h"
#include "support.h"
#include "common.h"
#include "int.h"
 
#include <ctype.h>
 
volatile unsigned long timestamp = 0;
 
void int_main(void);
 
/* return value by making a syscall */
void exit(int i)
{
asm("l.add r3,r0,%0": :"r"(i));
asm("l.nop %0": :"K"(NOP_EXIT));
	while (1) ;
}
 
/* activate printf support in simulator */
void __printf(const char *fmt, ...)
{
#if 0
	va_list args;
	va_start(args, fmt);
	__asm__ __volatile__("  l.addi\tr3,%1,0\n \
                           l.addi\tr4,%2,0\n \
                           l.nop %0"::"K"(NOP_PRINTF), "r"(fmt), "r"(args):"r3", "r4");
#endif
}
 
/* print long */
void report(unsigned long value)
{
asm("l.addi\tr3,%0,0": :"r"(value));
asm("l.nop %0": :"K"(NOP_REPORT));
}
 
/* just to satisfy linker */
void __main(void)
{
}
 
/* For writing into SPR. */
void mtspr(unsigned long spr, unsigned long value)
{
asm("l.mtspr\t\t%0,%1,0": :"r"(spr), "r"(value));
}
 
/* For reading SPR. */
unsigned long mfspr(unsigned long spr)
{
	unsigned long value;
asm("l.mfspr\t\t%0,%1,0": "=r"(value):"r"(spr));
	return value;
}
 
/* Parses hex or decimal number */
unsigned long strtoul(const char *str, char **endptr, int base)
{
 
	{
 
		unsigned long number = 0;
		char *pos = (char *)str;
		char *fail_char = (char *)str;
 
		while (isspace(*pos))
			pos++;	/* skip leading whitespace */
 
		if ((base == 16) && (*pos == '0')) {	/* handle option prefix */
			++pos;
			fail_char = pos;
			if ((*pos == 'x') || (*pos == 'X'))
				++pos;
		}
 
		if (base == 0) {	/* dynamic base */
			base = 10;	/* default is 10 */
			if (*pos == '0') {
				++pos;
				base -= 2;	/* now base is 8 (or 16) */
				fail_char = pos;
				if ((*pos == 'x') || (*pos == 'X')) {
					base += 8;	/* base is 16 */
					++pos;
				}
			}
		}
 
		/* check for illegal base */
		if (!((base < 2) || (base > 36)))
			while (1) {
				int digit = 40;
				if ((*pos >= '0') && (*pos <= '9')) {
					digit = (*pos - '0');
				} else if (*pos >= 'a') {
					digit = (*pos - 'a' + 10);
				} else if (*pos >= 'A') {
					digit = (*pos - 'A' + 10);
				} else
					break;
 
				if (digit >= base)
					break;
 
				fail_char = ++pos;
				number = number * base + digit;
			}
 
		if (endptr)
			*endptr = fail_char; {
			return number;
			}
	}
}
 
unsigned long get_timer(unsigned long base)
{
	/*
	   __printf("%s - %s: %d\n", __FILE__, __FUNCTION__, __LINE__);
	   __printf("   timestamp = %.8lx base = %.8lx\n", timestamp, base);
	 */
	return (timestamp - base);
}
 
void set_timer(unsigned long t)
{
	timestamp = t;
}