/* 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;
	req.tv_sec = (time_t) milisec / 1000;
	req.tv_nsec = (milisec % 1000 ) * 1000000L;
	clock_nanosleep(CLOCK_REALTIME, 0, &req, NULL);
}