Updates for move_head_to_point.py