76 lines
1.7 KiB
C
76 lines
1.7 KiB
C
/*
|
|
Copyright 2008, 2009 Jakub Bednarski
|
|
|
|
This file is part of Minimig
|
|
|
|
Minimig is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
Minimig is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <ctype.h>
|
|
#include <time.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include "hardware.h"
|
|
#include "user_io.h"
|
|
|
|
uint8_t rstval = 0;
|
|
|
|
void hexdump(void *data, uint16_t size, uint16_t offset)
|
|
{
|
|
uint8_t i, b2c;
|
|
uint16_t n = 0;
|
|
char *ptr = data;
|
|
|
|
if (!size) return;
|
|
|
|
while (size>0) {
|
|
iprintf("%04x: ", n + offset);
|
|
|
|
b2c = (size>16) ? 16 : size;
|
|
for (i = 0; i<b2c; i++) iprintf("%02x ", 0xff & ptr[i]);
|
|
iprintf(" ");
|
|
for (i = 0; i<(16 - b2c); i++) iprintf(" ");
|
|
for (i = 0; i<b2c; i++) iprintf("%c", isprint(ptr[i]) ? ptr[i] : '.');
|
|
iprintf("\n");
|
|
ptr += b2c;
|
|
size -= b2c;
|
|
n += b2c;
|
|
}
|
|
}
|
|
|
|
unsigned long GetTimer(unsigned long offset)
|
|
{
|
|
struct timespec tp;
|
|
clock_gettime(CLOCK_BOOTTIME, &tp);
|
|
|
|
unsigned long long res;
|
|
|
|
res = tp.tv_sec;
|
|
res *= 1000;
|
|
res += (tp.tv_nsec / 1000000);
|
|
|
|
return (unsigned long)(res + offset);
|
|
}
|
|
|
|
unsigned long CheckTimer(unsigned long time)
|
|
{
|
|
return GetTimer(0) >= time;
|
|
}
|
|
|
|
void WaitTimer(unsigned long time)
|
|
{
|
|
time = GetTimer(time);
|
|
while (!CheckTimer(time));
|
|
}
|