Initial version
Now testing setting waypoints
Removed mavlink to videre formatting, now in seperate js, incorporated logic for writing waypoints