For the station rev:
Check if it's not the same issue by adding 30 secondes on the state:
between OdoRampCompute(); and break;
add this line
MaxOdoStateDuration=MaxOdoStateDuration+30000;
Check if it's not the same issue by adding 30 secondes on the state:
Code:
case STATE_STATION_REV: //when start in auto mode the mower first reverse to leave the station
statusCurr = TRACK_TO_START;
if (RaspberryPIUse) MyRpi.SendStatusToPi();
UseAccelLeft = 1;
UseBrakeLeft = 1;
UseAccelRight = 1;
UseBrakeRight = 1;
motorLeftSpeedRpmSet = motorRightSpeedRpmSet = -motorSpeedMaxRpm / 2 ;
stateEndOdometryRight = odometryRight - (odometryTicksPerCm * stationRevDist);
stateEndOdometryLeft = odometryLeft - (odometryTicksPerCm * stationRevDist);
OdoRampCompute();
MaxOdoStateDuration=MaxOdoStateDuration+30000;
break;
between OdoRampCompute(); and break;
add this line
MaxOdoStateDuration=MaxOdoStateDuration+30000;