78 lines
2.9 KiB
C++
78 lines
2.9 KiB
C++
/**
|
|
* @file event_registry.cpp
|
|
* @brief This data structure knows when to do what
|
|
*
|
|
* @date Nov 27, 2013
|
|
* @author Andrey Belomutskiy, (c) 2012-2020
|
|
*
|
|
*
|
|
* This file is part of rusEfi - see http://rusefi.com
|
|
*
|
|
* rusEfi 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.
|
|
*
|
|
* rusEfi 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 "pch.h"
|
|
|
|
#include "event_registry.h"
|
|
|
|
static void findTriggerPosition(TriggerWaveform *triggerShape,
|
|
TriggerFormDetails *details,
|
|
event_trigger_position_s *position,
|
|
angle_t angle) {
|
|
efiAssertVoid(CUSTOM_ERR_6574, !cisnan(angle), "findAngle#1");
|
|
assertAngleRange(angle, "findAngle#a1", CUSTOM_ERR_6545);
|
|
|
|
efiAssertVoid(CUSTOM_ERR_6575, !cisnan(triggerShape->tdcPosition), "tdcPos#1")
|
|
assertAngleRange(triggerShape->tdcPosition, "tdcPos#a1", CUSTOM_UNEXPECTED_TDC_ANGLE);
|
|
|
|
efiAssertVoid(CUSTOM_ERR_6576, !cisnan(engineConfiguration->globalTriggerAngleOffset), "tdcPos#2")
|
|
assertAngleRange(engineConfiguration->globalTriggerAngleOffset, "tdcPos#a2", CUSTOM_INVALID_GLOBAL_OFFSET);
|
|
|
|
// convert engine cycle angle into trigger cycle angle
|
|
angle += triggerShape->tdcPosition + engineConfiguration->globalTriggerAngleOffset;
|
|
efiAssertVoid(CUSTOM_ERR_6577, !cisnan(angle), "findAngle#2");
|
|
wrapAngle2(angle, "addFuel#2", CUSTOM_ERR_6555, getEngineCycle(triggerShape->getWheelOperationMode()));
|
|
|
|
int triggerEventIndex = triggerShape->findAngleIndex(details, angle);
|
|
angle_t triggerEventAngle = details->eventAngles[triggerEventIndex];
|
|
angle_t offsetFromTriggerEvent = angle - triggerEventAngle;
|
|
|
|
// Guarantee that we aren't going to try and schedule an event prior to the tooth
|
|
if (offsetFromTriggerEvent < 0) {
|
|
warning(CUSTOM_OBD_ANGLE_CONSTRAINT_VIOLATION, "angle constraint violation in findTriggerPosition(): %.2f/%.2f", angle, triggerEventAngle);
|
|
return;
|
|
}
|
|
|
|
{
|
|
// This must happen under lock so that the tooth and offset don't get partially read and mismatched
|
|
chibios_rt::CriticalSectionLocker csl;
|
|
|
|
position->triggerEventIndex = triggerEventIndex;
|
|
position->angleOffsetFromTriggerEvent = offsetFromTriggerEvent;
|
|
}
|
|
}
|
|
|
|
void event_trigger_position_s::setAngle(angle_t angle) {
|
|
findTriggerPosition(&engine->triggerCentral.triggerShape,
|
|
&engine->triggerCentral.triggerFormDetails,
|
|
this, angle);
|
|
}
|
|
|
|
IgnitionEvent::IgnitionEvent() {
|
|
memset(outputs, 0, sizeof(outputs));
|
|
}
|
|
|
|
IgnitionOutputPin * IgnitionEvent::getOutputForLoggins() {
|
|
return outputs[0];
|
|
}
|
|
|