minor stuff
Command node almost done
Map server stuff
Directional problem fix.
Directional Problem fix 2
Merge remote-tracking branch 'origin/master' into Ultrasonic-Testing