Bug-Fixing of manual Control & Navdata, gps-test needed