stop on tracking loss
This commit is contained in:
parent
d3b9bd3ae5
commit
dd7ff23be4
1 changed files with 6 additions and 2 deletions
|
@ -97,7 +97,7 @@ void Robot::EnterLineFollowing(float speed)
|
|||
robotState = ROBOT_LINING;
|
||||
}
|
||||
|
||||
int lineLostFrames = 7;
|
||||
int lineLostFrames = 24;
|
||||
|
||||
void Robot::LineFollowingUpdate(void)
|
||||
{
|
||||
|
@ -129,10 +129,14 @@ void Robot::LineFollowingUpdate(void)
|
|||
rollingTurnRate = 0;
|
||||
turnEffort = 0;
|
||||
speed = 0;
|
||||
chassis.Stop();
|
||||
return;
|
||||
} else {
|
||||
speed *= 0.97;
|
||||
}
|
||||
}
|
||||
else {
|
||||
lineLostFrames = 7;
|
||||
lineLostFrames = 24;
|
||||
}
|
||||
|
||||
chassis.SetTwist(speed, turnEffort);
|
||||
|
|
Loading…
Reference in a new issue