allow further distance from target position

This commit is contained in:
Simon Pirkelmann 2021-09-10 01:23:14 +02:00
parent 6aef0660a3
commit ca8e5aac9b

View File

@ -145,7 +145,7 @@ class ControlledRobot(Robot):
e_pos = np.linalg.norm(v[0:2]) e_pos = np.linalg.norm(v[0:2])
#print(f"target_pos = {target_pos}, current_pos = {current_pos}, e_pos = {e_pos}, e_ang = {e_angle}") #print(f"target_pos = {target_pos}, current_pos = {current_pos}, e_pos = {e_pos}, e_ang = {e_angle}")
print(f"e_pos = {e_pos}, e_ang = {e_angle}") print(f"e_pos = {e_pos}, e_ang = {e_angle}")
close_to_target = e_pos < 0.05 and abs(e_angle) < 0.1 close_to_target = e_pos < 0.075 and abs(e_angle) < 0.1
time.sleep(0.1) time.sleep(0.1)
print("target reached!") print("target reached!")
self.stop_control() self.stop_control()