158 lines
7.6 KiB
C++
158 lines
7.6 KiB
C++
/*
|
|
Speeduino - Simple engine management for the Arduino Mega 2560 platform
|
|
Copyright (C) Josh Stewart
|
|
A full copy of the license may be found in the projects root directory
|
|
*/
|
|
|
|
/*
|
|
This file contains the various crank and cam wheel decoder functions.
|
|
|
|
Each decoder must have the following 4 functions (Where xxxx is the decoder name):
|
|
|
|
* triggerSetup_xxx - Called once from within setup() and configures any required variables
|
|
* triggerPri_xxxx - Called each time the primary (No. 1) crank/cam signal is triggered (Called as an interrupt, so variables must be declared volatile)
|
|
* triggerSec_xxxx - Called each time the secondary (No. 2) crank/cam signal is triggered (Called as an interrupt, so variables must be declared volatile)
|
|
* getRPM_xxxx - Returns the current RPM, as calculated by the decoder
|
|
* getCrankAngle_xxxx - Returns the current crank angle, as calculated b the decoder
|
|
|
|
And each decoder must utlise at least the following variables:
|
|
toothLastToothTime - The time (In uS) that the last primary tooth was 'seen'
|
|
*
|
|
|
|
*/
|
|
|
|
/*
|
|
Name: Missing tooth wheel
|
|
Desc: A multi-tooth wheel with one of more 'missing' teeth. The first tooth after the missing one is considered number 1 and isthe basis for the trigger angle
|
|
Note: This does not currently support dual wheel (ie missing tooth + single tooth on cam)
|
|
*/
|
|
void triggerSetup_missingTooth()
|
|
{
|
|
triggerToothAngle = 360 / configPage2.triggerTeeth; //The number of degrees that passes from tooth to tooth
|
|
triggerActualTeeth = configPage2.triggerTeeth - configPage2.triggerMissingTeeth; //The number of physical teeth on the wheel. Doing this here saves us a calculation each time in the interrupt
|
|
}
|
|
|
|
void triggerPri_missingTooth()
|
|
{
|
|
// http://www.msextra.com/forums/viewtopic.php?f=94&t=22976
|
|
// http://www.megamanual.com/ms2/wheel.htm
|
|
noInterrupts(); //Turn off interrupts whilst in this routine
|
|
|
|
curTime = micros();
|
|
curGap = curTime - toothLastToothTime;
|
|
if ( curGap < triggerFilterTime ) { interrupts(); return; } //Debounce check. Pulses should never be less than triggerFilterTime, so if they are it means a false trigger. (A 36-1 wheel at 8000pm will have triggers approx. every 200uS)
|
|
toothCurrentCount++; //Increment the tooth counter
|
|
|
|
//High speed tooth logging history
|
|
toothHistory[toothHistoryIndex] = curGap;
|
|
if(toothHistoryIndex == 511)
|
|
{ toothHistoryIndex = 0; }
|
|
else
|
|
{ toothHistoryIndex++; }
|
|
|
|
//Begin the missing tooth detection
|
|
//If the time between the current tooth and the last is greater than 1.5x the time between the last tooth and the tooth before that, we make the assertion that we must be at the first tooth after the gap
|
|
//if ( (curTime - toothLastToothTime) > (1.5 * (toothLastToothTime - toothLastMinusOneToothTime))) { toothCurrentCount = 1; }
|
|
if(configPage2.triggerMissingTeeth == 1) { targetGap = (3 * (toothLastToothTime - toothLastMinusOneToothTime)) >> 1; } //Multiply by 1.5 (Checks for a gap 1.5x greater than the last one) (Uses bitshift to multiply by 3 then divide by 2. Much faster than multiplying by 1.5)
|
|
//else { targetGap = (10 * (toothLastToothTime - toothLastMinusOneToothTime)) >> 2; } //Multiply by 2.5 (Checks for a gap 2.5x greater than the last one)
|
|
else { targetGap = ((toothLastToothTime - toothLastMinusOneToothTime)) * 2; } //Multiply by 2 (Checks for a gap 2x greater than the last one)
|
|
if ( curGap > targetGap )
|
|
{
|
|
toothCurrentCount = 1;
|
|
toothOneMinusOneTime = toothOneTime;
|
|
toothOneTime = curTime;
|
|
currentStatus.hasSync = true;
|
|
startRevolutions++; //Counter
|
|
}
|
|
|
|
toothLastMinusOneToothTime = toothLastToothTime;
|
|
toothLastToothTime = curTime;
|
|
|
|
interrupts(); //Turn interrupts back on
|
|
}
|
|
|
|
void triggerSec_missingTooth(){ return; } //This function currently is not used
|
|
|
|
int getRPM_missingTooth()
|
|
{
|
|
noInterrupts();
|
|
unsigned long revolutionTime = (toothOneTime - toothOneMinusOneTime); //The time in uS that one revolution would take at current speed (The time tooth 1 was last seen, minus the time it was seen prior to that)
|
|
interrupts();
|
|
return ldiv(US_IN_MINUTE, revolutionTime).quot; //Calc RPM based on last full revolution time (uses ldiv rather than div as US_IN_MINUTE is a long)
|
|
}
|
|
|
|
int getCrankAngle_missingTooth(int timePerDegree)
|
|
{
|
|
//This is the current angle ATDC the engine is at. This is the last known position based on what tooth was last 'seen'. It is only accurate to the resolution of the trigger wheel (Eg 36-1 is 10 degrees)
|
|
int crankAngle = (toothCurrentCount - 1) * triggerToothAngle + configPage2.triggerAngle; //Number of teeth that have passed since tooth 1, multiplied by the angle each tooth represents, plus the angle that tooth 1 is ATDC. This gives accuracy only to the nearest tooth.
|
|
crankAngle += ldiv( (micros() - toothLastToothTime), timePerDegree).quot; //Estimate the number of degrees travelled since the last tooth
|
|
if (crankAngle > 360) { crankAngle -= 360; }
|
|
|
|
return crankAngle;
|
|
}
|
|
|
|
/*
|
|
Name: Missing tooth wheel
|
|
Desc: A multi-tooth wheel with one of more 'missing' teeth. The first tooth after the missing one is considered number 1 and isthe basis for the trigger angle
|
|
Note: This does not currently support dual wheel (ie missing tooth + single tooth on cam)
|
|
*/
|
|
void triggerPri_DualWheel()
|
|
{
|
|
return;
|
|
}
|
|
|
|
|
|
/*
|
|
Name: Basic Distributor
|
|
Desc: Tooth equal to the number of cylinders are evenly spaced on the cam. No position sensing (Distributor is retained) so crank angle is a made up figure based purely on the first teeth to be seen
|
|
Note: This is a very simple decoder. See http://www.megamanual.com/ms2/GM_7pinHEI.htm
|
|
*/
|
|
void triggerSetup_BasicDistributor()
|
|
{
|
|
triggerToothAngle = 360 / (configPage1.nCylinders / 2); //The number of degrees that passes from tooth to tooth
|
|
}
|
|
|
|
void triggerPri_BasicDistributor()
|
|
{
|
|
curTime = micros();
|
|
|
|
toothCurrentCount++; //Increment the tooth counter
|
|
if(toothCurrentCount > (configPage1.nCylinders >> 1) ) //Check if we're back to the beginning of a revolution
|
|
{
|
|
toothCurrentCount = 1; //Reset the counter
|
|
toothOneMinusOneTime = toothOneTime;
|
|
toothOneTime = curTime;
|
|
currentStatus.hasSync = true;
|
|
startRevolutions++; //Counter
|
|
}
|
|
|
|
//High speed tooth logging history
|
|
toothHistory[toothHistoryIndex] = curGap;
|
|
if(toothHistoryIndex == 511)
|
|
{ toothHistoryIndex = 0; }
|
|
else
|
|
{ toothHistoryIndex++; }
|
|
|
|
toothLastMinusOneToothTime = toothLastToothTime;
|
|
toothLastToothTime = curTime;
|
|
}
|
|
void triggerSec_BasicDistributor() { return; } //Not required
|
|
int getRPM_BasicDistributor()
|
|
{
|
|
noInterrupts();
|
|
unsigned long revolutionTime = (toothOneTime - toothOneMinusOneTime); //The time in uS that one revolution would take at current speed (The time tooth 1 was last seen, minus the time it was seen prior to that)
|
|
interrupts();
|
|
return ldiv(US_IN_MINUTE, revolutionTime).quot; //Calc RPM based on last full revolution time (uses ldiv rather than div as US_IN_MINUTE is a long)
|
|
}
|
|
int getCrankAngle_BasicDistributor(int timePerDegree)
|
|
{
|
|
//This is the current angle ATDC the engine is at. This is the last known position based on what tooth was last 'seen'. It is only accurate to the resolution of the trigger wheel (Eg 36-1 is 10 degrees)
|
|
int crankAngle = (toothCurrentCount - 1) * triggerToothAngle + configPage2.triggerAngle; //Number of teeth that have passed since tooth 1, multiplied by the angle each tooth represents, plus the angle that tooth 1 is ATDC. This gives accuracy only to the nearest tooth.
|
|
crankAngle += ldiv( (micros() - toothLastToothTime), timePerDegree).quot; //Estimate the number of degrees travelled since the last tooth
|
|
if (crankAngle > 360) { crankAngle -= 360; }
|
|
|
|
return crankAngle;
|
|
}
|
|
|
|
|