Added SetWaypoint and WaypointCommand initializations to telemetry constructor. Added blank function definitions to bottom of telemetry.cpp
Merge branch 'groovy-devel' of https://github.com/smd-ros-devel/asctec_drivers into groovy-devel