/**
 * @file	state_sequence.cpp
 *
 * @date May 18, 2014
 * @author Andrey Belomutskiy, (c) 2012-2020
 */

#include "pch.h"
#include "state_sequence.h"
#include "trigger_structure.h"

void MultiChannelStateSequence::checkSwitchTimes(const float scale) const {
	efiAssertVoid(CUSTOM_ERR_WAVE_1, phaseCount > 0, "StateSequence cannot be empty");
	if (getSwitchTime(phaseCount - 1) != 1) {
#if EFI_UNIT_TEST
		for (int index = 0;index < phaseCount;index ++) {
			printf("switch time index=%d angle=%f\n", index, getSwitchTime(index));
		}
#endif // EFI_UNIT_TEST

		firmwareError(CUSTOM_ERR_WAVE_1, "[count=%d] last switch time has to be 1/%f not %.2f/%f",
				phaseCount,
			      scale, getSwitchTime(phaseCount - 1),
			      scale * getSwitchTime(phaseCount - 1));
		return;
	}
	for (int i = 0; i < phaseCount - 1; i++) {
		if (getSwitchTime(i) >= getSwitchTime(i + 1)) {
			firmwareError(CUSTOM_ERR_WAVE_2, "invalid switchTimes @%d: %.2f/%.2f",
				      i, getSwitchTime(i), getSwitchTime(i + 1));
		}
	}
}

int MultiChannelStateSequence::findInsertionAngle(const float angle) const {
	for (int i = phaseCount - 1; i >= 0; i--) {
		if (angle > getSwitchTime(i))
			return i + 1;
	}
	return 0;
}

int MultiChannelStateSequence::findAngleMatch(const float angle) const {
	for (int i = 0; i < phaseCount; i++) {
		if (isSameF(getSwitchTime(i), angle))
			return i;
	}
	return EFI_ERROR_CODE;
}