/*
 * HMT Tool
 * (c) af123, 2011
 */

#include <stdio.h>
#include <errno.h>
#include <ctype.h>
#include <string.h>
#include <stdlib.h>
#include <stdint.h>
#ifndef _WIN32
#include <unistd.h>
#endif
#include <time.h>
#include <strings.h>
#include <stdarg.h>

#include "lint.h"

uint32_t
read_uint32(uint8_t *p, int le)
{
	if (le)
		return p[3] << 24 | p[2] << 16 | p[1] << 8 | p[0];
	else
		return p[0] << 24 | p[1] << 16 | p[2] << 8 | p[3];
}

uint16_t
read_uint16(uint8_t *p, int le)
{
	if (le)
		return p[1] << 8 | p[0];
	else
		return p[0] << 8 | p[1];
}

void
write_uint32(uint8_t *p, uint32_t val)
{
	*p++ = val & 0xff;
	*p++ = val >> 8 & 0xff;
	*p++ = val >> 16 & 0xff;
	*p++ = val >> 24 & 0xff;
}

void
write_uint16(uint8_t *p, uint16_t val)
{
	*p++ = val & 0xff;
	*p++ = val >> 8 & 0xff;
}

uint8_t *
memmem(register uint8_t *mem, uint32_t mlen,
    register uint8_t *pat, uint32_t plen)
{
	while (mlen >= plen)
	{
		if (!memcmp(mem, pat, plen))
			return mem;
		mem++, mlen--;
	}
	return (uint8_t *)NULL;
}

void
hexdump(uint8_t *s, uint32_t len, uint32_t o)
{
	uint16_t off;

	if (!s)
		return;

	if (!len)
		len = strlen((char *)s);

	for (off = 0; off < len; off += 16)
	{
		uint32_t i;

		printf("%08lx: ", (unsigned long)off + o);

		for (i = off; i - off < 16; i++)
		{
			if (i < len)
				printf("%02x ", s[i] & 0xff);
			else
				printf("   ");
		}

		printf(" ");

		for (i = off; i < len && i - off < 16; i++)
			printf("%c", isprint((int)s[i]) ? s[i] : '.');

		printf("\n");
	}
}

void
hexstr(uint8_t *s, uint32_t len)
{
	uint16_t off;

	if (!s)
		return;

	if (!len)
		len = strlen((char *)s);

	for (off = 0; off < len; off += 16)
	{
		uint32_t i;

		for (i = off; i - off < 16; i++)
		{
			if (i < len)
				printf("%02x", s[i] & 0xff);
		}
	}
}

void
hexdump_fd(int fd, uint32_t len)
{
	off_t pos = lseek(fd, 0, SEEK_CUR);

	uint8_t *buffer;

	buffer = (uint8_t *)malloc(len);

	read(fd, buffer, len);
	hexdump(buffer, len, 0);

	lseek(fd, pos, SEEK_SET);
}

void
error(char *fmt, ...)
{
	char buf[0x400];
        va_list argp;

        va_start(argp, fmt);
	vsprintf(buf, fmt, argp);

	fprintf(stderr, "%s\n", buf);
        va_end(argp);
	exit(1);
}

#if defined(__MINGW32__) || defined(__linux__)

size_t
strlcpy(char *s, const char *t, size_t n)
{
	const char	*o = t;

	if (n)
		do
		{
			if (!--n)
			{
				*s = 0;
				break;
			}
		} while ((*s++ = *t++));
	if (!n)
		while (*t++);
	return t - o - 1;
}

#endif