/* This function is added in order to simulate arduino delay() function  */
void __msleep(int milisec)
/* This function is added in order to simulate arduino delay() function  */
void __msleep(int milisec)
{
	struct timespec req = {0};
	req.tv_sec = 0;
	req.tv_nsec = milisec * 1000000L;
	nanosleep(&req, (struct timespec *)NULL);
}