- heavily reworked structure of way-point sending/receiving (still not working)
- added more data packages (nav output, motor commands, scaled rc, scaled pressure)