mirror of https://github.com/arendst/Tasmota.git
49 lines
1016 B
C
49 lines
1016 B
C
|
|
||
|
|
#include "compatibility.h"
|
||
|
|
|
||
|
|
static struct timeval start, end;
|
||
|
|
//static long mtime, seconds, useconds;
|
||
|
|
|
||
|
|
/**********************************************************************/
|
||
|
|
/**
|
||
|
|
* This function is added in order to simulate arduino delay() function
|
||
|
|
* @param milisec
|
||
|
|
*/
|
||
|
|
void __msleep(int milisec)
|
||
|
|
{
|
||
|
|
struct timespec req = {0};
|
||
|
|
req.tv_sec = 0;
|
||
|
|
req.tv_nsec = milisec * 1000000L;
|
||
|
|
nanosleep(&req, (struct timespec *)NULL);
|
||
|
|
//usleep(milisec*1000);
|
||
|
|
}
|
||
|
|
|
||
|
|
void __usleep(int milisec)
|
||
|
|
{
|
||
|
|
struct timespec req = {0};
|
||
|
|
req.tv_sec = 0;
|
||
|
|
req.tv_nsec = milisec * 1000L;
|
||
|
|
nanosleep(&req, (struct timespec *)NULL);
|
||
|
|
//usleep(milisec);
|
||
|
|
}
|
||
|
|
|
||
|
|
/**
|
||
|
|
* This function is added in order to simulate arduino millis() function
|
||
|
|
*/
|
||
|
|
void __start_timer()
|
||
|
|
{
|
||
|
|
gettimeofday(&start, NULL);
|
||
|
|
}
|
||
|
|
|
||
|
|
long __millis()
|
||
|
|
{
|
||
|
|
static long mtime, seconds, useconds;
|
||
|
|
|
||
|
|
gettimeofday(&end, NULL);
|
||
|
|
seconds = end.tv_sec - start.tv_sec;
|
||
|
|
useconds = end.tv_usec - start.tv_usec;
|
||
|
|
|
||
|
|
mtime = ((seconds) * 1000 + useconds/1000.0) + 0.5;
|
||
|
|
return mtime;
|
||
|
|
}
|