multirotor_pos_control: minor cleanup
multirotor_pos_control: some refactoring and cleanup, attitude-thrust correction moved to thrust_pid
position_estimator_inav: accelerometer bias estimation for Z, default weights for GPS updated