mirror of https://github.com/rusefi/rusefi-1.git
123 lines
4.9 KiB
C++
123 lines
4.9 KiB
C++
/*
|
|
* @file trigger_simulator.cpp
|
|
*
|
|
* @date Sep 23, 2015
|
|
* @author Andrey Belomutskiy, (c) 2012-2018
|
|
*/
|
|
|
|
#include "global.h"
|
|
#include "engine.h"
|
|
#include "trigger_simulator.h"
|
|
#include "trigger_emulator_algo.h"
|
|
|
|
#define SIMULATION_CYCLE_PERIOD 720000
|
|
|
|
EXTERN_ENGINE;
|
|
|
|
// this is not the only place where we have 'isUpEvent'. todo: reuse
|
|
static const bool isRisingEdge[6] = { false, true, false, true, false, true };
|
|
|
|
// todo: should this method be invoked somewhere deeper? at the moment we have too many usages too high
|
|
bool isUsefulSignal(trigger_event_e signal DECLARE_ENGINE_PARAMETER_SUFFIX) {
|
|
return !engineConfiguration->useOnlyRisingEdgeForTrigger || isRisingEdge[(int) signal];
|
|
}
|
|
|
|
#if EFI_UNIT_TEST
|
|
extern bool printTriggerDebug;
|
|
#endif /* ! EFI_UNIT_TEST */
|
|
|
|
void TriggerStimulatorHelper::feedSimulatedEvent(const TriggerStateCallback triggerCycleCallback,
|
|
TriggerState *state, TriggerShape * shape, int i
|
|
DECLARE_ENGINE_PARAMETER_SUFFIX) {
|
|
efiAssertVoid(CUSTOM_ERR_6593, shape->getSize() > 0, "size not zero");
|
|
int stateIndex = i % shape->getSize();
|
|
int size = shape->getSize();
|
|
|
|
int loopIndex = i / shape->getSize();
|
|
|
|
int time = (int) (SIMULATION_CYCLE_PERIOD * (loopIndex + shape->wave.getSwitchTime(stateIndex)));
|
|
|
|
MultiChannelStateSequence *multiChannelStateSequence = &shape->wave;
|
|
|
|
#if EFI_UNIT_TEST
|
|
int prevIndex = getPreviousIndex(stateIndex, shape->getSize());
|
|
|
|
pin_state_t primaryWheelState = multiChannelStateSequence->getChannelState(0, prevIndex);
|
|
pin_state_t newPrimaryWheelState = multiChannelStateSequence->getChannelState(0, stateIndex);
|
|
|
|
pin_state_t secondaryWheelState = multiChannelStateSequence->getChannelState(1, prevIndex);
|
|
pin_state_t newSecondaryWheelState = multiChannelStateSequence->getChannelState(1, stateIndex);
|
|
|
|
// pin_state_t thirdWheelState = multiChannelStateSequence->getChannelState(2, prevIndex);
|
|
// pin_state_t new3rdWheelState = multiChannelStateSequence->getChannelState(2, stateIndex);
|
|
|
|
if (printTriggerDebug) {
|
|
printf("feedSimulatedEvent: %d>%d primary %d>%d secondary %d>%d\r\n", prevIndex, stateIndex, primaryWheelState, newPrimaryWheelState,
|
|
secondaryWheelState, newSecondaryWheelState );
|
|
}
|
|
#endif /* EFI_UNIT_TEST */
|
|
|
|
|
|
// todo: code duplication with TriggerEmulatorHelper::handleEmulatorCallback?
|
|
|
|
if (needEvent(stateIndex, size, multiChannelStateSequence, 0)) {
|
|
pin_state_t currentValue = multiChannelStateSequence->getChannelState(/*phaseIndex*/0, stateIndex);
|
|
trigger_event_e s = currentValue ? SHAFT_PRIMARY_RISING : SHAFT_PRIMARY_FALLING;
|
|
if (isUsefulSignal(s PASS_ENGINE_PARAMETER_SUFFIX))
|
|
state->decodeTriggerEvent(triggerCycleCallback, s, time PASS_ENGINE_PARAMETER_SUFFIX);
|
|
}
|
|
|
|
if (needEvent(stateIndex, size, multiChannelStateSequence, 1)) {
|
|
pin_state_t currentValue = multiChannelStateSequence->getChannelState(/*phaseIndex*/1, stateIndex);
|
|
trigger_event_e s = currentValue ? SHAFT_SECONDARY_RISING : SHAFT_SECONDARY_FALLING;
|
|
if (isUsefulSignal(s PASS_ENGINE_PARAMETER_SUFFIX))
|
|
state->decodeTriggerEvent(triggerCycleCallback, s, time PASS_ENGINE_PARAMETER_SUFFIX);
|
|
}
|
|
|
|
if (needEvent(stateIndex, size, multiChannelStateSequence, 2)) {
|
|
pin_state_t currentValue = multiChannelStateSequence->getChannelState(/*phaseIndex*/2, stateIndex);
|
|
trigger_event_e s = currentValue ? SHAFT_3RD_RISING : SHAFT_3RD_FALLING;
|
|
if (isUsefulSignal(s PASS_ENGINE_PARAMETER_SUFFIX))
|
|
state->decodeTriggerEvent(triggerCycleCallback, s, time PASS_ENGINE_PARAMETER_SUFFIX);
|
|
}
|
|
}
|
|
|
|
void TriggerStimulatorHelper::assertSyncPositionAndSetDutyCycle(const TriggerStateCallback triggerCycleCallback,
|
|
const uint32_t syncIndex, TriggerState *state, TriggerShape * shape
|
|
DECLARE_ENGINE_PARAMETER_SUFFIX) {
|
|
|
|
/**
|
|
* let's feed two more cycles to validate shape definition
|
|
*/
|
|
for (uint32_t i = syncIndex + 1; i <= syncIndex + GAP_TRACKING_LENGTH * shape->getSize(); i++) {
|
|
feedSimulatedEvent(triggerCycleCallback, state, shape, i PASS_ENGINE_PARAMETER_SUFFIX);
|
|
}
|
|
int revolutionCounter = state->getTotalRevolutionCounter();
|
|
if (revolutionCounter != GAP_TRACKING_LENGTH + 1) {
|
|
warning(CUSTOM_OBD_TRIGGER_SHAPE, "sync failed/wrong gap parameters trigger=%s rc=%d", getTrigger_type_e(engineConfiguration->trigger.type), revolutionCounter);
|
|
shape->setShapeDefinitionError(true);
|
|
return;
|
|
}
|
|
shape->shapeDefinitionError = false;
|
|
|
|
for (int i = 0; i < PWM_PHASE_MAX_WAVE_PER_PWM; i++) {
|
|
shape->expectedDutyCycle[i] = 1.0 * state->expectedTotalTime[i] / SIMULATION_CYCLE_PERIOD;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @return trigger synchronization point index, or error code if not found
|
|
*/
|
|
uint32_t TriggerStimulatorHelper::findTriggerSyncPoint(TriggerShape * shape,
|
|
TriggerState *state DECLARE_ENGINE_PARAMETER_SUFFIX) {
|
|
for (int i = 0; i < 4 * PWM_PHASE_MAX_COUNT; i++) {
|
|
feedSimulatedEvent(nullptr, state, shape, i PASS_ENGINE_PARAMETER_SUFFIX);
|
|
|
|
if (state->shaft_is_synchronized)
|
|
return i;
|
|
}
|
|
engine->triggerCentral.triggerShape.setShapeDefinitionError(true);
|
|
warning(CUSTOM_ERR_TRIGGER_SYNC, "findTriggerZeroEventIndex() failed");
|
|
return EFI_ERROR_CODE;
|
|
}
|