/*
 * DeviceHandlerFDIR.cpp
 *
 *  Created on: 09.09.2015
 *      Author: baetz
 */

#include <framework/devicehandlers/DeviceHandlerBase.h>
#include <framework/devicehandlers/DeviceHandlerFDIR.h>
#include <framework/health/HealthTableIF.h>
#include <framework/serviceinterface/ServiceInterfaceStream.h>
#include <mission/controllers/power/Fuse.h>
#include <mission/controllers/tcs/ThermalComponentIF.h>

//TODO: Mechanisms have no power FDIR..
DeviceHandlerFDIR::DeviceHandlerFDIR(object_id_t owner, object_id_t parent) :
		FDIRBase(owner, parent), strangeReplyCount(MAX_STRANGE_REPLIES,
				STRANGE_REPLIES_TIME_MS, parameterDomainBase++), missedReplyCount(
				MAX_MISSED_REPLY_COUNT, MISSED_REPLY_TIME_MS,
				parameterDomainBase++), recoveryCounter(MAX_REBOOT,
				REBOOT_TIME_MS, parameterDomainBase++), fdirState(NONE), powerConfirmation(
				0) {
}

DeviceHandlerFDIR::~DeviceHandlerFDIR() {
}

ReturnValue_t DeviceHandlerFDIR::eventReceived(EventMessage* event) {
	if (fdirState != NONE) {
		//Only wait for those events, ignore all others.
		if (event->getParameter1() == HasHealthIF::HEALTHY
				&& event->getEvent() == HasHealthIF::HEALTH_INFO) {
			setFdirState(NONE);
		}
		if (event->getEvent() == HasModesIF::MODE_INFO
				&& fdirState != RECOVERY_ONGOING) {
			setFdirState(NONE);
		}
		return RETURN_OK;
	}
	if (owner->getHealth() == HasHealthIF::FAULTY
			|| owner->getHealth() == HasHealthIF::PERMANENT_FAULTY) {
		//Ignore all events in case device is already faulty.
		return RETURN_OK;
	}
	ReturnValue_t result = RETURN_FAILED;
	switch (event->getEvent()) {
	case HasModesIF::MODE_TRANSITION_FAILED:
	case HasModesIF::OBJECT_IN_INVALID_MODE:
		//We'll try a recovery as long as defined in MAX_REBOOT.
		//Might cause some AssemblyBase cycles, so keep number low.
		handleRecovery(event->getEvent());
		break;
	case DeviceHandlerIF::DEVICE_INTERPRETING_REPLY_FAILED:
	case DeviceHandlerIF::DEVICE_READING_REPLY_FAILED:
	case DeviceHandlerIF::DEVICE_UNREQUESTED_REPLY:
	case DeviceHandlerIF::DEVICE_UNKNOWN_REPLY: //Some DH's generate generic reply-ids.
	case DeviceHandlerIF::DEVICE_BUILDING_COMMAND_FAILED:
		//These faults all mean that there were stupid replies from a device.
		if (strangeReplyCount.incrementAndCheck()) {
			handleRecovery(event->getEvent());
		}
		break;
	case DeviceHandlerIF::DEVICE_SENDING_COMMAND_FAILED:
	case DeviceHandlerIF::DEVICE_REQUESTING_REPLY_FAILED:
		//The two above should never be confirmed.
	case DeviceHandlerIF::DEVICE_MISSED_REPLY:
		result = sendConfirmationRequest(event);
		if (result == HasReturnvaluesIF::RETURN_OK) {
			break;
		}
		//else
		if (missedReplyCount.incrementAndCheck()) {
			handleRecovery(event->getEvent());
		}
		break;
	case StorageManagerIF::GET_DATA_FAILED:
	case StorageManagerIF::STORE_DATA_FAILED:
	case MessageQueue::SEND_MSG_FAILED:
		//Rather strange bugs, occur in RAW mode only. TODO:? By now: Ignore.
		break;
	case DeviceHandlerIF::INVALID_DEVICE_COMMAND:
		//Ignore, is bad configuration. We can't do anything in flight.
		break;
	case DeviceHandlerIF::MONITORING_AMBIGUOUS:
	case HasHealthIF::HEALTH_INFO:
	case HasModesIF::MODE_INFO:
	case HasModesIF::CHANGING_MODE:
		//Do nothing, but mark as handled.
		break;
		//****Power*****
	case PowerSwitchIF::SWITCH_WENT_OFF:
		result = sendConfirmationRequest(event, powerConfirmation);
		if (result == RETURN_OK) {
			setFdirState(DEVICE_MIGHT_BE_OFF);
		}
		break;
	case Fuse::FUSE_WENT_OFF:
		//Not so good, because PCDU reacted.
	case Fuse::POWER_ABOVE_HIGH_LIMIT:
		//Better, because software detected over-current.
		setFaulty(event->getEvent());
		break;
	case Fuse::POWER_BELOW_LOW_LIMIT:
		//Device might got stuck during boot, retry.
		handleRecovery(event->getEvent());
		break;
		//****Thermal*****
	case ThermalComponentIF::COMPONENT_TEMP_LOW:
	case ThermalComponentIF::COMPONENT_TEMP_HIGH:
	case ThermalComponentIF::COMPONENT_TEMP_OOL_LOW:
	case ThermalComponentIF::COMPONENT_TEMP_OOL_HIGH:
		//Well, the device is not really faulty, but it is required to stay off as long as possible.
		//*******ACS*****
	case DeviceHandlerIF::MONITORING_LIMIT_EXCEEDED:
		setFaulty(event->getEvent());
		break;
	case ThermalComponentIF::TEMP_NOT_IN_OP_RANGE:
		//Ignore, is information only.
		break;
	default:
		//We don't know the event, someone else should handle it.
		return RETURN_FAILED;
	}
	return RETURN_OK;
}

void DeviceHandlerFDIR::eventConfirmed(EventMessage* event) {
	switch (event->getEvent()) {
	case DeviceHandlerIF::DEVICE_SENDING_COMMAND_FAILED:
	case DeviceHandlerIF::DEVICE_REQUESTING_REPLY_FAILED:
	case DeviceHandlerIF::DEVICE_MISSED_REPLY:
		if (missedReplyCount.incrementAndCheck()) {
			handleRecovery(event->getEvent());
		}
		break;
	case PowerSwitchIF::SWITCH_WENT_OFF:
		//This means the switch went off only for one device.
		handleRecovery(event->getEvent());
		break;
	default:
		break;
	}
}

void DeviceHandlerFDIR::decrementFaultCounters() {
	strangeReplyCount.checkForDecrement();
	missedReplyCount.checkForDecrement();
	recoveryCounter.checkForDecrement();
}

void DeviceHandlerFDIR::handleRecovery(Event reason) {
	clearFaultCounters();
	if (!recoveryCounter.incrementAndCheck()) {
		startRecovery(reason);
	} else {
		setFaulty(reason);
	}
}

void DeviceHandlerFDIR::wasParentsFault(EventMessage* event) {
	//We'll better ignore the SWITCH_WENT_OFF event and await a system-wide reset.
	//This means, no fault message will come through until a MODE_ or HEALTH_INFO message comes through -> Is that ok?
	//Same issue in TxFailureIsolation!
//	if ((event->getEvent() == PowerSwitchIF::SWITCH_WENT_OFF)
//			&& (fdirState != RECOVERY_ONGOING)) {
//		setFdirState(NONE);
//	}
}

void DeviceHandlerFDIR::clearFaultCounters() {
	strangeReplyCount.clear();
	missedReplyCount.clear();
}

ReturnValue_t DeviceHandlerFDIR::initialize() {
	ReturnValue_t result = FDIRBase::initialize();
	if (result != HasReturnvaluesIF::RETURN_OK) {
		return result;
	}
	ConfirmsFailuresIF* power = objectManager->get<ConfirmsFailuresIF>(
			objects::PCDU_HANDLER);
	if (power == NULL) {
		return RETURN_FAILED;
	}
	powerConfirmation = power->getEventReceptionQueue();
	return RETURN_OK;
}

void DeviceHandlerFDIR::setFdirState(FDIRState state) {
	FDIRBase::throwFdirEvent(FDIR_CHANGED_STATE, state, fdirState);
	fdirState = state;
}

void DeviceHandlerFDIR::triggerEvent(Event event, uint32_t parameter1,
		uint32_t parameter2) {
	//Do not throw error events if fdirState != none.
	//This will still forward MODE and HEALTH INFO events in any case.
	if (fdirState == NONE || EVENT::getSeverity(event) == SEVERITY::INFO) {
		FDIRBase::triggerEvent(event, parameter1, parameter2);
	}
}

bool DeviceHandlerFDIR::isFdirActionInProgress() {
	return (fdirState != NONE);
}

void DeviceHandlerFDIR::startRecovery(Event reason) {
	throwFdirEvent(FDIR_STARTS_RECOVERY, EVENT::getEventId(reason));
	setOwnerHealth(HasHealthIF::NEEDS_RECOVERY);
	setFdirState(RECOVERY_ONGOING);
}

ReturnValue_t DeviceHandlerFDIR::getParameter(uint8_t domainId,
		uint16_t parameterId, ParameterWrapper* parameterWrapper,
		const ParameterWrapper* newValues, uint16_t startAtIndex) {
	ReturnValue_t result = strangeReplyCount.getParameter(domainId, parameterId,
			parameterWrapper, newValues, startAtIndex);
	if (result != INVALID_DOMAIN_ID) {
		return result;
	}
	result = missedReplyCount.getParameter(domainId, parameterId,
			parameterWrapper, newValues, startAtIndex);
	if (result != INVALID_DOMAIN_ID) {
		return result;
	}
	result = recoveryCounter.getParameter(domainId, parameterId,
			parameterWrapper, newValues, startAtIndex);
	if (result != INVALID_DOMAIN_ID) {
		return result;
	}
	return INVALID_DOMAIN_ID;
}

void DeviceHandlerFDIR::setFaulty(Event reason) {
	throwFdirEvent(FDIR_TURNS_OFF_DEVICE, EVENT::getEventId(reason));
	setOwnerHealth(HasHealthIF::FAULTY);
	setFdirState(AWAIT_SHUTDOWN);
}