Fixing nao_path_follower for paths with a single pose
Cleaning up nao_path_follower, more parameters
Cleaning up unused code