fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

RPMCapture: Detect rpm sensing timeout

Browse Source
This commit is contained in:
Matthias Grob 2024-11-27 14:39:00 +01:00
parent 1bcdb3ef8c
commit 41b55724bc
2 changed files with 18 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
src/drivers/rpm_capture/RPMCapture.cpp
View File

@ -43,6 +43,7 @@ RPMCapture::RPMCapture() :
ScheduledWorkItem(MODULE_NAME, px4::wq_configurations::hp_default)
{
_pwm_input_pub.advertise();
ScheduleOnInterval(1_s);
}
RPMCapture::~RPMCapture()
@ -100,21 +101,27 @@ void RPMCapture::Run()
}
hrt_abstime now = hrt_absolute_time();
const hrt_abstime period = _hrt_timestamp - _hrt_timestamp_prev;
pwm_input_s pwm_input{};
pwm_input.timestamp = now;
pwm_input.period = period;
pwm_input.error_count = _error_count;
_hrt_timestamp_prev = _hrt_timestamp;
_value_processed.store(true);
_pwm_input_pub.publish(pwm_input);
if (!_value_processed.load()) {
_period = _hrt_timestamp - _hrt_timestamp_prev;
_hrt_timestamp_prev = _hrt_timestamp;
_value_processed.store(true);
pwm_input_s pwm_input{};
pwm_input.timestamp = now;
pwm_input.period = _period;
pwm_input.error_count = _error_count;
_pwm_input_pub.publish(pwm_input);
} else if (now > _hrt_timestamp_prev + 1_s) {
_period = 0;
}
float rpm_raw{0.f};
if ((1 < period) && (period < 1_s)) {
if ((1 < _period) && (_period < 1_s)) {
// 1'000'000 / [us] -> pulses per second * 60 -> pulses per minute
rpm_raw = 60.f * 1e6f / (static_cast<float>(period) * 1.f);
rpm_raw = 60.f * 1e6f / (static_cast<float>(_period) * 1.f);
}
const float dt = math::constrain((now - _timestamp_last_update) * 1e-6f, 0.01f, 1.f);

1
src/drivers/rpm_capture/RPMCapture.hpp
View File

@ -77,6 +77,7 @@ private:
hrt_abstime _hrt_timestamp{0};
hrt_abstime _hrt_timestamp_prev{0};
uint32_t _period{0};
uint32_t _error_count{0};
px4::atomic<bool> _value_processed{true};