mini/utils.c

75 lines
1.2 KiB
C
Raw Normal View History

2008-12-28 14:35:37 +01:00
#include "types.h"
#include "utils.h"
#include "gecko.h"
#include "vsprintf.h"
2009-01-08 23:27:22 +01:00
#include "start.h"
#include "hollywood.h"
2008-12-28 14:35:37 +01:00
static char ascii(char s) {
if(s < 0x20) return '.';
if(s > 0x7E) return '.';
return s;
}
void hexdump(void *d, int len) {
u8 *data;
int i, off;
data = (u8*)d;
for (off=0; off<len; off += 16) {
gecko_printf("%08x ",off);
for(i=0; i<16; i++)
if((i+off)>=len) gecko_printf(" ");
else gecko_printf("%02x ",data[off+i]);
gecko_printf(" ");
for(i=0; i<16; i++)
if((i+off)>=len) gecko_printf(" ");
else gecko_printf("%c",ascii(data[off+i]));
gecko_printf("\n");
}
}
int sprintf(char *str, const char *fmt, ...)
{
va_list args;
int i;
va_start(args, fmt);
i = vsprintf(str, fmt, args);
va_end(args);
return i;
}
2009-01-08 23:27:22 +01:00
void udelay(u32 d)
{
// should be good to max .2% error
u32 ticks = d * 19 / 10;
if(ticks < 2)
ticks = 2;
u32 now = read32(HW_TIMER);
u32 then = now + ticks;
if(then < now) {
while(read32(HW_TIMER) >= now);
now = read32(HW_TIMER);
}
while(now < then) {
now = read32(HW_TIMER);
}
}
void panic(u8 v)
{
while(1) {
debug_output(v);
udelay(500000);
debug_output(0);
udelay(500000);
}
}