/* * Licensed under the GNU General Public License version 2 with exceptions. See * LICENSE file in the project root for full license information */ #include #include #include "osal_win32.h" static int64_t sysfrequency; static double qpc2usec; #define USECS_PER_SEC 1000000 int osal_gettimeofday (struct timeval *tv, struct timezone *tz) { int64_t wintime, usecs; if(!sysfrequency) { timeBeginPeriod(1); QueryPerformanceFrequency((LARGE_INTEGER *)&sysfrequency); qpc2usec = 1000000.0 / sysfrequency; } QueryPerformanceCounter((LARGE_INTEGER *)&wintime); usecs = (int64_t)((double)wintime * qpc2usec); tv->tv_sec = (long)(usecs / 1000000); tv->tv_usec = (long)(usecs - (tv->tv_sec * 1000000)); return 1; } ec_timet osal_current_time (void) { struct timeval current_time; ec_timet return_value; osal_gettimeofday (¤t_time, 0); return_value.sec = current_time.tv_sec; return_value.usec = current_time.tv_usec; return return_value; } void osal_time_diff(ec_timet *start, ec_timet *end, ec_timet *diff) { diff->sec = end->sec - start->sec; diff->usec = end->usec - start->usec; if (diff->usec < 0) { --diff->sec; diff->usec += 1000000; } } void osal_timer_start (osal_timert *self, uint32 timeout_usec) { struct timeval start_time; struct timeval timeout; struct timeval stop_time; osal_gettimeofday (&start_time, 0); timeout.tv_sec = timeout_usec / USECS_PER_SEC; timeout.tv_usec = timeout_usec % USECS_PER_SEC; timeradd (&start_time, &timeout, &stop_time); self->stop_time.sec = stop_time.tv_sec; self->stop_time.usec = stop_time.tv_usec; } boolean osal_timer_is_expired (osal_timert *self) { struct timeval current_time; struct timeval stop_time; int is_not_yet_expired; osal_gettimeofday (¤t_time, 0); stop_time.tv_sec = self->stop_time.sec; stop_time.tv_usec = self->stop_time.usec; is_not_yet_expired = timercmp (¤t_time, &stop_time, <); return is_not_yet_expired == FALSE; } int osal_usleep(uint32 usec) { osal_timert qtime; osal_timer_start(&qtime, usec); if(usec >= 1000) { SleepEx(usec / 1000, FALSE); } while(!osal_timer_is_expired(&qtime)); return 1; } void *osal_malloc(size_t size) { return malloc(size); } void osal_free(void *ptr) { free(ptr); } int osal_thread_create(void **thandle, int stacksize, void *func, void *param) { *thandle = CreateThread(NULL, stacksize, func, param, 0, NULL); if(!thandle) { return 0; } return 1; } int osal_thread_create_rt(void **thandle, int stacksize, void *func, void *param) { int ret; ret = osal_thread_create(thandle, stacksize, func, param); if (ret) { ret = SetThreadPriority(*thandle, THREAD_PRIORITY_TIME_CRITICAL); } return ret; }