diff --git a/scripts/idle_head.py b/scripts/idle_head.py index 548da64..6cbd512 100644 --- a/scripts/idle_head.py +++ b/scripts/idle_head.py @@ -32,26 +32,27 @@ hwi.turn_on() # hwi.set_position("head_roll", head_roll_pos_rad) # hwi.set_position("head_pitch", head_pitch_pos_rad) -t0 = time.time() -while time.time() - t0 < 10: - t = time.time() - t0 +while True: + t0 = time.time() + while time.time() - t0 < 10: + t = time.time() - t0 - hwi.set_position("head_yaw", np.deg2rad(30) * np.sin(2*np.pi*0.2*t)) + hwi.set_position("head_yaw", np.deg2rad(30) * np.sin(2*np.pi*0.2*t)) - time.sleep(0.01) + time.sleep(0.01) -t0 = time.time() -while time.time() - t0 < 10: - t = time.time() - t0 + t0 = time.time() + while time.time() - t0 < 10: + t = time.time() - t0 - hwi.set_position("head_pitch", np.deg2rad(30) * np.sin(2*np.pi*0.2*t)) + hwi.set_position("head_pitch", np.deg2rad(30) * np.sin(2*np.pi*0.2*t)) - time.sleep(0.01) + time.sleep(0.01) -t0 = time.time() -while time.time() - t0 < 10: - t = time.time() - t0 + t0 = time.time() + while time.time() - t0 < 10: + t = time.time() - t0 - hwi.set_position("head_roll", np.deg2rad(30) * np.sin(2*np.pi*0.2*t)) + hwi.set_position("head_roll", np.deg2rad(30) * np.sin(2*np.pi*0.2*t)) - time.sleep(0.01) + time.sleep(0.01)