EMILE/second/misc.c
2005-09-22 23:04:43 +00:00

119 lines
1.9 KiB
C

/*
*
* (c) 2004 Laurent Vivier <LaurentVivier@wanadoo.fr>
*
*/
#include <unistd.h>
#include <stdio.h>
#include "misc.h"
#include "console.h"
int strlen(const char* s)
{
int len;
if (!s) return 0;
len = 0;
while (*s++) len++;
return len;
}
void* memset(void* s, int c, size_t n)
{
int i;
char *ss = (char*)s;
for (i=0;i<n;i++) ss[i] = c;
return s;
}
void* memcpy(void* __dest, __const void* __src,
size_t __n)
{
int i;
char *d = (char *)__dest, *s = (char *)__src;
for (i=0;i<__n;i++) d[i] = s[i];
return __dest;
}
char *strcpy (char *__restrict __dest,
__const char *__restrict __src)
{
while ( (*__dest ++ = *__src++) );
return __dest;
}
char *strncpy (char *__restrict __dest,
__const char *__restrict __src, size_t __n)
{
while ( (*__dest ++ = *__src++) && __n--);
return __dest;
}
unsigned char *c2pstring(char* s)
{
int len = strlen(s);
int i;
for (i = len; i > 0; i--)
s[i] = s[i - 1];
s[0] = len;
return (unsigned char*)s;
}
static char buffer[256];
unsigned char *p2cstring(unsigned char* s)
{
memcpy(buffer, s + 1, s[0]);
buffer[(int)s[0]] = (char)0;
return buffer;
}
void error(char *x)
{
console_putstring("\n\n");
console_putstring(x);
console_putstring("\n\n -- System halted\n");
while(1); /* Halt */
}
void memdump(unsigned char* addr, unsigned long size)
{
int i = 0;
int j;
while ( i < size)
{
printf("%08lx ", (unsigned long)addr + i);
for (j = 0; (j < 8) && (i + j < size); j++)
printf("%02x ", addr[i+j]);
printf(" ");
for (j = 8; (j < 16) && (i + j < size); j++)
printf("%02x ", addr[i+j]);
printf(" |");
for (j = 0; (j < 16) && (i + j < size); j++)
{
if ( (addr[i+j] > 31) && (addr[i+j] < 128) )
printf("%c", addr[i+j]);
else
printf(".");
}
printf("|\n");
i += j;
}
}