minor changes
successful test with gps and ultrasonic stabilization
Merge branch 'master' of github.com:PenguPilot/PenguPilot