multirotor_pos_control fixes, introduced HARD control mode (disabled by default)