allow further distance from target position
This commit is contained in:
parent
6aef0660a3
commit
ca8e5aac9b
|
@ -145,7 +145,7 @@ class ControlledRobot(Robot):
|
|||
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"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)
|
||||
print("target reached!")
|
||||
self.stop_control()
|
||||
|
|
Loading…
Reference in New Issue
Block a user