2015-05-29 00:33:00 -07:00
|
|
|
/*
|
|
|
|
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
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
These functions over the PWM and stepper idle control
|
|
|
|
*/
|
|
|
|
|
2015-08-20 06:21:27 -07:00
|
|
|
/*
|
|
|
|
Idle Control
|
|
|
|
Currently limited to on/off control and open loop PWM and stepper drive
|
|
|
|
*/
|
2015-05-29 00:33:00 -07:00
|
|
|
void initialiseIdle()
|
|
|
|
{
|
2015-08-20 06:21:27 -07:00
|
|
|
//Initialising comprises of setting the 2D tables with the relevant values from the config pages
|
|
|
|
switch(configPage4.iacAlgorithm)
|
|
|
|
{
|
|
|
|
case 0:
|
|
|
|
//Case 0 is no idle control ('None')
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 1:
|
|
|
|
//Case 1 is on/off idle control
|
|
|
|
if (currentStatus.coolant < configPage4.iacFastTemp)
|
|
|
|
{
|
|
|
|
digitalWrite(pinIdle1, HIGH);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 2:
|
|
|
|
//Case 2 is PWM open loop
|
|
|
|
iacPWMTable.xSize = 10;
|
|
|
|
iacPWMTable.values = configPage4.iacOLPWMVal;
|
|
|
|
iacPWMTable.axisX = configPage4.iacBins;
|
|
|
|
|
|
|
|
iacCrankDutyTable.xSize = 4;
|
|
|
|
iacCrankDutyTable.values = configPage4.iacCrankDuty;
|
|
|
|
iacCrankDutyTable.axisX = configPage4.iacCrankBins;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 3:
|
|
|
|
//Case 3 is PWM closed loop
|
|
|
|
iacClosedLoopTable.xSize = 10;
|
|
|
|
iacClosedLoopTable.values = configPage4.iacCLValues;
|
|
|
|
iacClosedLoopTable.axisX = configPage4.iacBins;
|
|
|
|
|
|
|
|
iacCrankDutyTable.xSize = 4;
|
|
|
|
iacCrankDutyTable.values = configPage4.iacCrankDuty;
|
|
|
|
iacCrankDutyTable.axisX = configPage4.iacCrankBins;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 4:
|
|
|
|
//Case 2 is Stepper open loop
|
|
|
|
iacStepTable.xSize = 10;
|
|
|
|
iacStepTable.values = configPage4.iacOLStepVal;
|
|
|
|
iacStepTable.axisX = configPage4.iacBins;
|
|
|
|
|
|
|
|
iacCrankStepsTable.xSize = 4;
|
|
|
|
iacCrankStepsTable.values = configPage4.iacCrankSteps;
|
|
|
|
iacCrankStepsTable.axisX = configPage4.iacCrankBins;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 5:
|
|
|
|
//Case 5 is Stepper closed loop
|
|
|
|
iacClosedLoopTable.xSize = 10;
|
|
|
|
iacClosedLoopTable.values = configPage4.iacCLValues;
|
|
|
|
iacClosedLoopTable.axisX = configPage4.iacBins;
|
|
|
|
|
|
|
|
iacCrankStepsTable.xSize = 4;
|
|
|
|
iacCrankStepsTable.values = configPage4.iacCrankSteps;
|
|
|
|
iacCrankStepsTable.axisX = configPage4.iacCrankBins;
|
|
|
|
break;
|
|
|
|
}
|
2015-05-29 00:33:00 -07:00
|
|
|
|
|
|
|
}
|
|
|
|
|
2015-08-20 06:21:27 -07:00
|
|
|
void idleControl()
|
2015-05-29 00:33:00 -07:00
|
|
|
{
|
2015-08-20 06:21:27 -07:00
|
|
|
switch(configPage4.iacAlgorithm)
|
|
|
|
{
|
|
|
|
case 0: //Case 0 is no idle control ('None')
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 1: //Case 1 is on/off idle control
|
|
|
|
if ( (currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET) < configPage4.iacFastTemp) //All temps are offset by 40 degrees
|
|
|
|
{
|
|
|
|
digitalWrite(pinIdle1, HIGH);
|
|
|
|
idleOn = true;
|
|
|
|
}
|
|
|
|
else if (idleOn) { digitalWrite(pinIdle1, LOW); idleOn = false; }
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 2: //Case 2 is PWM open loop
|
|
|
|
//Check for cranking pulsewidth
|
|
|
|
if( BIT_CHECK(currentStatus.engine, BIT_ENGINE_CRANK) )
|
|
|
|
{
|
|
|
|
//Currently cranking. Use the cranking table
|
|
|
|
analogWrite(pinIdle1, table2D_getValue(&iacCrankDutyTable, currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET)); //All temps are offset by 40 degrees
|
|
|
|
idleOn = true;
|
|
|
|
}
|
|
|
|
else if( (currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET) < iacPWMTable.values[IDLE_TABLE_SIZE-1])
|
|
|
|
{
|
|
|
|
//Standard running
|
|
|
|
analogWrite(pinIdle1, table2D_getValue(&iacPWMTable, currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET)); //All temps are offset by 40 degrees
|
|
|
|
idleOn = true;
|
|
|
|
}
|
|
|
|
else if (idleOn) { digitalWrite(pinIdle1, LOW); idleOn = false; }
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 3: //Case 3 is PWM closed loop (Not currently implemented)
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 4: //Case 4 is open loop stepper control
|
|
|
|
//Check for cranking pulsewidth
|
|
|
|
if( BIT_CHECK(currentStatus.engine, BIT_ENGINE_CRANK) )
|
|
|
|
{
|
|
|
|
//Currently cranking. Use the cranking table
|
|
|
|
analogWrite(pinIdle1, table2D_getValue(&iacCrankStepsTable, currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET)); //All temps are offset by 40 degrees
|
|
|
|
idleOn = true;
|
|
|
|
}
|
|
|
|
else if( (currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET) < iacStepTable.values[IDLE_TABLE_SIZE-1])
|
|
|
|
{
|
|
|
|
//Standard running
|
|
|
|
analogWrite(pinIdle1, table2D_getValue(&iacStepTable, currentStatus.coolant + CALIBRATION_TEMPERATURE_OFFSET)); //All temps are offset by 40 degrees
|
|
|
|
idleOn = true;
|
|
|
|
}
|
|
|
|
else if (idleOn) { digitalWrite(pinIdle1, LOW); idleOn = false; }
|
|
|
|
break;
|
|
|
|
}
|
2015-05-29 00:33:00 -07:00
|
|
|
}
|