Skip to content

Commit bcdbb7e

Browse files
committed
chore: align "one turn only" rule priority
1 parent 961dedd commit bcdbb7e

File tree

1 file changed

+5
-5
lines changed

1 file changed

+5
-5
lines changed

smart-car/smart-car.ino

Lines changed: 5 additions & 5 deletions
Original file line numberDiff line numberDiff line change
@@ -98,11 +98,6 @@ int lDist() {
9898
}
9999

100100
char chooseDirection(int cdist, int rdist, int ldist) {
101-
// don't keep turning right or left more than one loop step
102-
if ((pdir == _RHT) or (pdir == _LFT)) {
103-
return _FWD;
104-
}
105-
106101
// below "0" is a sensor quirk: continue with previously chosen direction in this case
107102
if ((cdist <= 0) or (rdist <= 0) or (ldist <= 0)) {
108103
return pdir;
@@ -140,6 +135,11 @@ char chooseDirection(int cdist, int rdist, int ldist) {
140135
return _SPR;
141136
}
142137

138+
// don't keep turning right or left more than one loop step
139+
if ((pdir == _RHT) or (pdir == _LFT)) {
140+
return _FWD;
141+
}
142+
143143
// when obstacle detected: decide to turn left or right
144144
if (cdist < turnDist) {
145145
if (rdist < ldist) {

0 commit comments

Comments
 (0)