AP_HAL: add force_safety_on method
HAL_PX4: implement force_safety_on
HAL_VRBrain: implement force_safety_on