changes for fixed waypoint update functions. minor errors fixed.
localnav_gui disabled because of error, and impending port to rviz