Refactoring wall throttle PID
Moved attitude Failsafe to commands processor
Changed wall thrust ref to compensate the weight, and added a pitch cmd to counteract the moment introduced
Removed heading control in wall mode