mirror of https://github.com/ArduPilot/ardupilot
19 lines
636 B
C++
19 lines
636 B
C++
#include "AP_LeakDetector_Digital.h"
|
|
#include <AP_HAL/AP_HAL.h>
|
|
|
|
extern const AP_HAL::HAL& hal;
|
|
|
|
AP_LeakDetector_Digital::AP_LeakDetector_Digital(AP_LeakDetector &_leak_detector, AP_LeakDetector::LeakDetector_State &_state) :
|
|
AP_LeakDetector_Backend(_leak_detector, _state)
|
|
{}
|
|
|
|
void AP_LeakDetector_Digital::read()
|
|
{
|
|
if (leak_detector._pin[state.instance] >= 0) {
|
|
hal.gpio->pinMode(leak_detector._pin[state.instance], HAL_GPIO_INPUT);
|
|
state.status = hal.gpio->read(leak_detector._pin[state.instance])==leak_detector._default_reading[state.instance]?false:true;
|
|
} else {
|
|
state.status = false;
|
|
}
|
|
}
|