diff --git a/tb3_challenge2.py b/tb3_challenge2.py index c22485a77167a551a00113d202da3a8da6b4ccf2..a749a22688cfcb15522c7d3b1c3e95f9a35a3650 100644 --- a/tb3_challenge2.py +++ b/tb3_challenge2.py @@ -28,7 +28,7 @@ class Tb3(Node): self.lin_vel_percent = 0 self.safe_distance = 0.4 self.drive_allowed = True - self.turn_allowed = False + self.turn_allowed = True def vel(self, lin_vel_percent, ang_vel_percent=0): """ publishes linear and angular velocities in percent @@ -52,13 +52,13 @@ class Tb3(Node): if msg.ranges[0] > self.safe_distance: self.vel(80, 0) else: - if msg.intensities[0] == 2.0 and not self.turn_allowed: + if msg.intensities[0] == 2.0 and self.turn_allowed: self.vel(0, 0) print("Red wall found! \nTurning...") self.vel(0, 85) sleep(1) self.vel(0, 0) - self.turn_allowed = True + self.turn_allowed = False pass elif msg.intensities[0] != 2.0: print("Wall found!")