fixed u ctrl
fixed controllers for baro control
Merge github.com:PenguPilot/PenguPilot