#include "stdio.h"
#include "tools.h"

void hw_reset()
{	*(volatile unsigned*)0x900A0008=2;
}

int timer(int timesec)
{	volatile i=timesec*1000;
	int first=1;
	while(i>0 && !any_key_pressed()) {
		if(!(i%1000)) {
			if(first)
				first=0;
			else
				setConsoleCol(getConsoleCol()-1);
			dispi((i-1)/1000,0,0);
		}
		i--;
	}
	return i;
}

void wait(int timesec)
{	volatile i;
	for(i=0;i<timesec*10000;i++) {}
}

/*char* itoa (char *buf, unsigned int n, int base)
{
    unsigned int tmp;
    int i = 0, j;

    do
    {
        tmp = n % base;
        buf[i++] = (tmp < 10) ? (tmp + '0') : (tmp + 'A' - 10);
    } while (n /= base);
    buf[i--] = 0;

    for (j = 0; j < i; ++j, --i)
    {
        tmp = buf[j];
        buf[j] = buf[i];
        buf[i] = tmp;
    }
    return buf;
}*/

unsigned int readhexint(unsigned char* buf, int size, int bigendian)
{	int i;
	unsigned int r=0,t;
	for(i=0;i<size;i++)
	{	if(bigendian)	t=buf[size-1-i];
		else		t=buf[i];
		r=(r<<8)|t;
	}
	return r;
}

unsigned int maskright(unsigned int data, unsigned int mask)
{	data=data&mask;
	while(mask && !(mask&0b1))
	{	data=data>>1;
		mask=mask>>1;
	}
	return data;
}

int nbbits(unsigned int mask)
{	int n=0;
	while(mask)
	{	if(mask&0b1) n++;
		mask=mask>>1;
	}
	return n;
}