add support for outputting only waypoints, not velocity commands from RRT controller (so that an external pathfollower can be used if desired); some refactoring
enable sending of waypoints to c# side