FailureDetector - New class, first working simple implementation. Outputs PX4_ERR messages if roll or pitch is exceeded.