Added CurrentWay message support to the telemetry class.  Added ability to send waypoint commands to the LLP with the telemetry class. Added node to read waypoint commands from a csv and publish them as they are carried out.