Syntax check in FollowShore, FindFinishLine
Added PTZ control
Added ROS_INFO in GoTo