Cleaning up nao_path_follower, more parameters