Disable filter temporarily after seeing cam signal on dual wheel to prevent tooth #1 from being filtered out. Fixes #713

This commit is contained in:
Josh Stewart 2022-01-05 15:01:23 +11:00
parent a05057c194
commit 14e26069af
1 changed files with 2 additions and 1 deletions

View File

@ -763,11 +763,12 @@ void triggerSec_DualWheel()
toothLastSecToothTime = curTime2;
triggerSecFilterTime = curGap2 >> 2; //Set filter at 25% of the current speed
if(currentStatus.hasSync == false)
if( (currentStatus.hasSync == false) || (currentStatus.startRevolutions <= configPage4.StgCycles) )
{
toothLastToothTime = micros();
toothLastMinusOneToothTime = micros() - (6000000 / configPage4.triggerTeeth); //Fixes RPM at 10rpm until a full revolution has taken place
toothCurrentCount = configPage4.triggerTeeth;
triggerFilterTime = 0; //Need to turn the filter off here otherwise the first primary tooth after achieving sync is ignored
currentStatus.hasSync = true;
}