Completely removed node, sending and receiving data directly in form the UDP packets. Fixed the blocking Xbee problem when sending commands in control loop. Working on parsing Navdata