fsfw/timemanager/ClockCommon.cpp

/*
 * ClockCommon.cpp
 *
 *  Created on: Jun 15, 2021
 *      Author: steffen
 */

#include "Clock.h"
#include "../ipc/MutexGuard.h"

ReturnValue_t Clock::convertUTCToTT(timeval utc, timeval *tt) {
	uint16_t leapSeconds;
	ReturnValue_t result = getLeapSeconds(&leapSeconds);
	if (result != HasReturnvaluesIF::RETURN_OK) {
		return result;
	}
	timeval leapSeconds_timeval = { 0, 0 };
	leapSeconds_timeval.tv_sec = leapSeconds;

	//initial offset between UTC and TAI
	timeval UTCtoTAI1972 = { 10, 0 };

	timeval TAItoTT = { 32, 184000 };

	*tt = utc + leapSeconds_timeval + UTCtoTAI1972 + TAItoTT;

	return HasReturnvaluesIF::RETURN_OK;
}

ReturnValue_t Clock::setLeapSeconds(const uint16_t leapSeconds_) {
	if (checkOrCreateClockMutex() != HasReturnvaluesIF::RETURN_OK) {
		return HasReturnvaluesIF::RETURN_FAILED;
	}
	MutexGuard helper(timeMutex);

	leapSeconds = leapSeconds_;

	return HasReturnvaluesIF::RETURN_OK;
}

ReturnValue_t Clock::getLeapSeconds(uint16_t *leapSeconds_) {
	if (timeMutex == nullptr) {
		return HasReturnvaluesIF::RETURN_FAILED;
	}
	MutexGuard helper(timeMutex);

	*leapSeconds_ = leapSeconds;

	return HasReturnvaluesIF::RETURN_OK;
}

static ReturnValue_t Clock::checkOrCreateClockMutex() {
	if (timeMutex == nullptr) {
		MutexFactory *mutexFactory = MutexFactory::instance();
		if (mutexFactory == nullptr) {
			return HasReturnvaluesIF::RETURN_FAILED;
		}
		timeMutex = mutexFactory->createMutex();
		if (timeMutex == nullptr) {
			return HasReturnvaluesIF::RETURN_FAILED;
		}
	}
	return HasReturnvaluesIF::RETURN_OK;
}