/*
    PIP - Platform Independent Primitives
    Timer
    Copyright (C) 2014  Ivan Pelipenko peri4ko@gmail.com

    This program is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/

#include "pitimer.h"
#include "pisystemtests.h"


/*! \class PITimer
 * \brief Timer
 * 
 * \section PITimer_sec0 Synopsis
 * This class implements timer function. PIP timers supports 3 way to tick notify,
 * frequency delimiters and time measurements.
 * \section PITimer_sec1 Notify variants
 *  Notify variants:
 * * "slot" - static function with format void func(void * data, int delimiter);
 * * event - \a void timeout(void * data, int delimiter);
 * * virtual function - \a void tick(void * data, int delimiter).
 * All this variant are equivalent, use most applicable.
 * \section PITimer_sec2 Frequency delimiters
 * Frequency delimiter is an integer number and "slot" function. If "slot" function is null
 * timer main "slot" will be used. Each delimiter numbers tick timer will be execute
 * delimiters or timer main "slot" function with \b delimiter value = delimiter number.
 * Example: \snippet pitimer.cpp delimiter
 * \section PITimer_sec3 Time measurements
 * PITimer can be used as time measurer. Function \a reset() set time mark to current
 * system time, then functions double elapsed_*() returns time elapsed from this mark.
 * These functions can returns nano-, micro-, milli- and seconds with suffixes "n", "u", "m"
 * and "s";
 * Example: \snippet pitimer.cpp elapsed
*/


#ifdef PIP_TIMER_RT
PITimer::TimerPool * pool = 0;
#endif


PITimer::PITimer(TimerEvent slot, void * data_, bool threaded_)
#ifndef PIP_TIMER_RT
: PIThread() {
#else
: PIObject() {
#endif
	ret_func = slot;
	data = data_;
	running_ = false;
	interval_ = 0.;
#ifdef PIP_TIMER_RT
	piMonitor.timers++;
	ti = -1;
	threaded = threaded_;
	memset(&se, 0, sizeof(se));
	se.sigev_notify = SIGEV_THREAD;
	se.sigev_value.sival_ptr = this;
	se.sigev_notify_function = PITimer::timer_event;
	se.sigev_notify_attributes = 0;
	lockRun = false;
#else
	deferred_ = false;
#endif
	reset();
}


PITimer::PITimer(bool threaded_)
#ifndef PIP_TIMER_RT
: PIThread() {
#else
: PIObject() {
#endif
	ret_func = 0;
	data = 0;
	running_ = false;
	interval_ = 0.;
#ifdef PIP_TIMER_RT
	piMonitor.timers++;
	ti = -1;
	threaded = threaded_;
	memset(&se, 0, sizeof(se));
	se.sigev_notify = SIGEV_THREAD;
	se.sigev_value.sival_ptr = this;
	se.sigev_notify_function = PITimer::timer_event;
	se.sigev_notify_attributes = 0;
	lockRun = false;
#else
	deferred_ = false;
#endif
	reset();
}


PITimer::~PITimer() {
#ifdef PIP_TIMER_RT
	piMonitor.timers--;
#endif
	stop();
}


#ifdef PIP_TIMER_RT
void PITimer::start(double msecs) {
	if (ti != -1 || msecs < 0 || running_) return;
	interval_ = msecs;
	if (!threaded) {
		ticks = int(msecs);
		if (pool == 0) pool = new TimerPool();
		pool->add(this);
		//cout << "not threaded timer start " << msecs << " msecs\n";
		if (!pool->isRunning()) pool->start();
		running_ = true;
		return;
	}
	spec.it_interval.tv_nsec = ((int)(msecs * 1000) % 1000000) * 1000;
	spec.it_interval.tv_sec = (time_t)(msecs / 1000);
	spec.it_value = spec.it_interval;
	ti = timer_create(CLOCK_REALTIME, &se, &timer);
	//cout << "***create timer " << msecs << " msecs\n";
	if (ti == -1) {
		piCoutObj << "Can`t create timer for " << msecs << " msecs: " << errorString();
		return;
	}
	timer_settime(timer, 0, &spec, 0);
	running_ = true;
}


void PITimer::deferredStart(double interval_msecs, double delay_msecs) {
	if (ti != -1 || interval_msecs < 0 || running_) return;
	interval_ = interval_msecs;
	spec.it_interval.tv_nsec = ((int)(interval_msecs * 1000) % 1000000) * 1000;
	spec.it_interval.tv_sec = (time_t)(interval_msecs / 1000);
	spec.it_value.tv_nsec = ((int)(delay_msecs * 1000) % 1000000) * 1000;
	spec.it_value.tv_sec = (time_t)(delay_msecs / 1000);
	ti = timer_create(CLOCK_REALTIME, &se, &timer);
	//cout << "***create timer\n";
	if (ti == -1) {
		piCoutObj << "Can`t create timer for " << interval_msecs << " msecs: " << errorString();
		return;
	}
	timer_settime(timer, 0, &spec, 0);
	running_ = true;
}


void PITimer::deferredStart(double interval_msecs, const PIDateTime & start_datetime) {
	if (ti != -1 || interval_msecs < 0 || running_) return;
	interval_ = interval_msecs;
	spec.it_interval.tv_nsec = ((int)(interval_msecs * 1000) % 1000000) * 1000;
	spec.it_interval.tv_sec = (time_t)(interval_msecs / 1000);
	struct tm dtm;
	memset(&dtm, 0, sizeof(dtm));
	dtm.tm_sec = start_datetime.seconds;
	dtm.tm_min = start_datetime.minutes;
	dtm.tm_hour = start_datetime.hours;
	dtm.tm_mday = start_datetime.day;
	dtm.tm_mon = start_datetime.month - 1;
	dtm.tm_year = start_datetime.year - 1900;
	spec.it_value.tv_nsec = 0;
	spec.it_value.tv_sec = mktime(&dtm);
	ti = timer_create(CLOCK_REALTIME, &se, &timer);
	//cout << "***create timer\n";
	if (ti == -1) {
		piCoutObj << "Can`t create timer for " << interval_msecs << " msecs: " << errorString();
		return;
	}
	timer_settime(timer, TIMER_ABSTIME, &spec, 0);
	running_ = true;
}



void PITimer::TimerPool::remove(PITimer * t) {
	mutex.lock();
	for (int i = 0; i < timers.size_s(); ++i)
		if (timers[i].first == t) {
			timers.remove(i);
			mutex.unlock();
			return;
		}
	mutex.unlock();
}


void PITimer::TimerPool::begin() {
	//cout << "pool begin\n";
	/*struct sigaction sa;
	sa.sa_flags = 0;
	sa.sa_handler = empty_handler;
	sigemptyset(&sa.sa_mask);
	if (sigaction(SIGALRM, &sa, 0) == -1) {
		piCoutObj << "sigaction error: " << errorString();
		stop();
		return;
	}*/
	sigemptyset(&ss);
	sigaddset(&ss, SIGALRM);
	memset(&se, 0, sizeof(se));
	se.sigev_notify = SIGEV_SIGNAL;
	se.sigev_signo = SIGALRM;
	spec.it_interval.tv_nsec = 1000000;
	spec.it_interval.tv_sec = 0;
	spec.it_value = spec.it_interval;
	//cout << "***create pool timer\n";
	if (timer_create(CLOCK_REALTIME, &se, &timer) == -1) {
		piCoutObj << "Can`t create timer for pool: " << errorString();
		stop();
		return;
	}
	if (timer_settime(timer, 0, &spec, 0) == -1) {
		piCoutObj << "Can`t set timer for pool: " << errorString();
		stop();
		return;
	}
	ti = 1;
}


void PITimer::TimerPool::run() {
	//cout << "wait ...\n";
	sigwait(&ss, &si);
	//cout << "ok\n";
	mutex.lock();
	//cout << "* pool tick , pool = " << this <<", timers = " << timers.size()<<"\n";
	for (int i = 0; i < timers.size_s(); ++i) {
		TimerPair & ct(timers[i]);
		sv.sival_ptr = ct.first;
		ct.second++;
		//cout << "** pool tick for " << ct.first << ", cnt " << ct.second << ", " << ct.first->ticks << "\n";
		if (ct.second >= ct.first->ticks) {
			//cout << "*** timer "<<ct.first<<" tick start\n";
			PITimer::timer_event(sv);
			//cout << "*** timer "<<ct.first<<" tick end\n";
			ct.second = 0;
		}
	}
	mutex.unlock();
}



void PITimer::stop() {
	if (!running_) return;
	running_ = false;
	if (!threaded) {
		if (pool != 0) {
			pool->remove(this);
			if (pool->isEmpty()) pool->terminate();
		}
	}
	if (ti != -1) timer_delete(timer);
	ti = -1;
	interval_ = 0.;
}


void PITimer::timer_event(sigval e) {
	PITimer * ct = (PITimer * )e.sival_ptr;
	if (!ct->running_) return;
	if (ct->lockRun) ct->lock();
	if (ct->ret_func != 0) ct->ret_func(ct->data, 1);
	ct->timeout(ct->data, 1);
	ct->tick(ct->data, 1);
	piForeach (TimerSlot & i, ct->ret_funcs) {
		if (i.delim > ++(i.tick)) continue;
		i.tick = 0;
		if (i.slot != 0) i.slot(ct->data, i.delim);
		else if (ct->ret_func != 0) ct->ret_func(ct->data, i.delim);
		ct->timeout(ct->data, i.delim);
		ct->tick(ct->data, i.delim);
	}
	if (ct->lockRun) ct->unlock();
}


bool PITimer::waitForFinish(int timeout_msecs) {
	if (timeout_msecs < 0) {
		while (running_)
			msleep(1);
		return true;
	}
	int cnt = 0;
	while (running_ && cnt < timeout_msecs) {
		msleep(1);
		++cnt;
	}
	return cnt < timeout_msecs;
}

#else

void PITimer::start(double msecs) {
	if (msecs < 0 || running_) return;
	interval_ = msecs;
	inc_time = PISystemTime::fromMilliseconds(msecs);
	st_time = PISystemTime::current() + inc_time;
	deferred_ = false;
	running_ = true;
	PIThread::start();
}


void PITimer::deferredStart(double interval_msecs, double delay_msecs) {
	//piCoutObj << "defStart exec with" << delay_msecs << interval_msecs;
	if (interval_msecs < 0 || running_) return;
	interval_ = interval_msecs;
	PISystemTime cst = PISystemTime::current();
	inc_time = PISystemTime::fromMilliseconds(interval_msecs);
	st_time = PISystemTime::current() + PISystemTime::fromMilliseconds(delay_msecs);
	if (st_time < cst) st_time = cst;
	running_ = deferred_ = true;
	PIThread::start();
	//piCoutObj << "timer start def";
}


void PITimer::deferredStart(double interval_msecs, const PIDateTime & start_datetime) {
	//piCoutObj << "defStart exec to" << start_datetime.toString() << interval_msecs;
	if (interval_msecs < 0 || running_) return;
	interval_ = interval_msecs;
	PISystemTime cst = PISystemTime::current();
	inc_time = PISystemTime::fromMilliseconds(interval_msecs);
	st_time = start_datetime.toSystemTime();
	if (st_time < cst) st_time = cst;
	running_ = deferred_ = true;
	PIThread::start();
	//piCoutObj << "timer start def";
}


void PITimer::run() {
	if (!running_) return;
	while (deferred_) {
		PISystemTime tst = st_time - PISystemTime::current();
		if (tst.seconds > 0) {
			piMSleep(100);
			if (!running_) return;
			continue;
		}
		if (tst.nanoseconds > 100000000) {
			piMSleep(100);
			if (!running_) return;
			continue;
		}
		tst.sleep();
		deferred_ = false;
		if (!running_) return;
	}
#ifdef WINDOWS
	tt_st = __PIQueryPerformanceCounter();
#else
	(st_time - PISystemTime::current()).sleep();
	st_time += inc_time;
#endif
	//if (lockRun) lock();
	if (ret_func != 0) ret_func(data, 1);
	timeout(data, 1);
	tick(data, 1);
	piForeach (TimerSlot & i, ret_funcs) {
		if (i.delim > ++(i.tick)) continue;
		i.tick = 0;
		if (i.slot != 0) i.slot(data, i.delim);
		else if (ret_func != 0) ret_func(data, i.delim);
		timeout(data, i.delim);
		tick(data, i.delim);
	}
#ifdef WINDOWS
	tt_cur = __PIQueryPerformanceCounter();
	double cdelay = interval_ - ((tt_cur - tt_st) / double(__pi_perf_freq) * 1.E+3);
	if (cdelay > 0.) Sleep(piRoundd(cdelay));
#endif
	//if (lockRun) unlock();
}

#endif

double PITimer::elapsed_n() {
#ifdef WINDOWS
	pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? ((pc_cur - pc_st) / double(__pi_perf_freq) * 1.E+9) : -1.);
	//t_cur = GetCurrentTime();
	//return (t_cur - t_st) * 1000000.;
#else
#  ifdef MAC_OS
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec - t_st.tv_sec) * 1.e+9 + (t_cur.tv_nsec - t_st.tv_nsec - PISystemTests::time_elapsed_ns);
#endif
}


double PITimer::elapsed_u() {
#ifdef WINDOWS
	pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? ((pc_cur - pc_st) / double(__pi_perf_freq) * 1.E+6) : -1.);
	//t_cur = GetCurrentTime();
	//return (t_cur - t_st) * 1000.;
#else
#  ifdef MAC_OS
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec - t_st.tv_sec) * 1.e+6 + (t_cur.tv_nsec - t_st.tv_nsec - PISystemTests::time_elapsed_ns) / 1.e+3;
#endif
}


double PITimer::elapsed_m() {
#ifdef WINDOWS
	pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? ((pc_cur - pc_st) / double(__pi_perf_freq) * 1.E+3) : -1.);
	//t_cur = GetCurrentTime();
	//return (double)(t_cur - t_st);
#else
#  ifdef MAC_OS
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec - t_st.tv_sec) * 1.e+3 + (t_cur.tv_nsec - t_st.tv_nsec - PISystemTests::time_elapsed_ns) / 1.e+6;
#endif
}


double PITimer::elapsed_s() {
#ifdef WINDOWS
	pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? ((pc_cur - pc_st) / double(__pi_perf_freq)) : -1.);
	//t_cur = GetCurrentTime();
	//return (t_cur - t_st) / 1000.;
#else
#  ifdef MAC_OS
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec - t_st.tv_sec) + (t_cur.tv_nsec - t_st.tv_nsec - PISystemTests::time_elapsed_ns) / 1.e+9;
#endif
}


double PITimer::reset_time_n() {
#ifdef WINDOWS
	return t_st * 1.e+6;
#else
	return t_st.tv_sec * 1.e+9 + t_st.tv_nsec;
#endif
}


double PITimer::reset_time_u() {
#ifdef WINDOWS
	return t_st * 1.e+3;
#else
	return t_st.tv_sec * 1.e+6 + t_st.tv_nsec / 1.e+3;
#endif
}


double PITimer::reset_time_m() {
#ifdef WINDOWS
	return (double)t_st;
#else
	return t_st.tv_sec * 1.e+3 + t_st.tv_nsec / 1.e+6;
#endif
}


double PITimer::reset_time_s() {
#ifdef WINDOWS
	return t_st / 1000.;
#else
	return t_st.tv_sec + t_st.tv_nsec / 1.e+9;
#endif
}


PISystemTime PITimer::reset_time() {
#ifdef WINDOWS
	return PISystemTime(t_st / 1000, (t_st % 1000) * 1000000);
#else
	return PISystemTime(t_st.tv_sec, t_st.tv_nsec);
#endif
}


double PITimer::elapsed_system_n() {
#ifdef WINDOWS
	llong pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? (pc_cur / double(__pi_perf_freq) * 1.E+9) : -1.);
	//long t_cur = GetCurrentTime();
	//return (t_cur * 1000000.);
#else
#  ifdef MAC_OS
	mach_timespec_t t_cur;
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	timespec t_cur;
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec * 1.e+9 + t_cur.tv_nsec);
#endif
}


double PITimer::elapsed_system_u() {
#ifdef WINDOWS
	llong pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? (pc_cur / double(__pi_perf_freq) * 1.E+6) : -1.);
	//long t_cur = GetCurrentTime();
	//return (t_cur * 1000.);
#else
#  ifdef MAC_OS
	mach_timespec_t t_cur;
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	timespec t_cur;
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec * 1.e+6 + (t_cur.tv_nsec / 1.e+3));
#endif
}


double PITimer::elapsed_system_m() {
#ifdef WINDOWS
	llong pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? (pc_cur / double(__pi_perf_freq) * 1.E+3) : -1.);
	//long t_cur = GetCurrentTime();
	//return (double)t_cur;
#else
#  ifdef MAC_OS
	mach_timespec_t t_cur;
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	timespec t_cur;
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec * 1.e+3 + (t_cur.tv_nsec / 1.e+6));
#endif
}


double PITimer::elapsed_system_s() {
#ifdef WINDOWS
	llong pc_cur = __PIQueryPerformanceCounter();
	return ((__pi_perf_freq > 0) ? (pc_cur / double(__pi_perf_freq)) : -1.);
	//long t_cur = GetCurrentTime();
	//return (t_cur / 1000.);
#else
#  ifdef MAC_OS
	mach_timespec_t t_cur;
	clock_get_time(__pi_mac_clock, &t_cur);
#  else
	timespec t_cur;
	clock_gettime(0, &t_cur);
#  endif
	return (t_cur.tv_sec + (t_cur.tv_nsec / 1.e+9));
#endif
}