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