This commit is contained in:
NikolajDanger
2022-10-31 14:48:20 +01:00
parent 8984fcf6af
commit 51b29110bc

View File

@ -296,7 +296,7 @@ def main():
print(est_pose)
particles, est_pose = turn_towards_landmark(noah, particles, est_pose, landmark)
drive_time = time_to_landmark(est_pose, landmark)
time_driven, est_pose, particles = drive_until_stopped(noah)
time_driven, est_pose, particles = drive_until_stopped(noah, particles)
if not abs(time_driven - drive_time) < 0.5:
# drunk_drive(noah)
est_pose, particles = turn_90_degrees(noah, est_pose, particles)