#include "os.h"
#include "config.h"

void wait(int timesec)
{
	sleep(timesec);
}

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

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;
}