yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 09:22:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

uavcan: skip beep if CBRK_BUZZER circuit breaker set

Browse Source
This commit is contained in:
Daniel Agar
2021-04-05 10:09:10 -04:00
parent 8e8826c516
commit e8d98c1f8a
1 changed files with 8 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
src/drivers/uavcan/beep.cpp
View File

@@ -39,6 +39,8 @@
#include "beep.hpp"
#include <lib/circuit_breaker/circuit_breaker.h>
UavcanBeep::UavcanBeep(uavcan::INode &node) :
_beep_pub(node),
_timer(node)
@@ -47,6 +49,11 @@ UavcanBeep::UavcanBeep(uavcan::INode &node) :
int UavcanBeep::init()
{
// don't initialize if CBRK_BUZZER circuit breaker is enabled.
if (circuit_breaker_enabled("CBRK_BUZZER", CBRK_BUZZER_KEY)) {
return 0;
}
/*
* Setup timer and call back function for periodic updates
*/
@@ -64,7 +71,7 @@ void UavcanBeep::periodic_update(const uavcan::TimerEvent &)
_tune_control_sub.copy(&_tune);
if (_tune.timestamp > 0) {
Tunes::ControlResult result = _tunes.set_control(_tune);
Tunes::ControlResult result = _tunes.set_control(_tune);
_play_tone = (result == Tunes::ControlResult::Success) || (result == Tunes::ControlResult::AlreadyPlaying);
}
}