mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-03 14:58:53 +08:00
esc_battery: several review fixes
Thanks @bkueng.
This commit is contained in:
@@ -32,7 +32,6 @@
|
|||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
#include "EscBattery.hpp"
|
#include "EscBattery.hpp"
|
||||||
#include <drivers/drv_hrt.h>
|
|
||||||
|
|
||||||
using namespace time_literals;
|
using namespace time_literals;
|
||||||
|
|
||||||
@@ -40,11 +39,6 @@ EscBattery::EscBattery() :
|
|||||||
ModuleParams(nullptr),
|
ModuleParams(nullptr),
|
||||||
WorkItem(MODULE_NAME, px4::wq_configurations::lp_default),
|
WorkItem(MODULE_NAME, px4::wq_configurations::lp_default),
|
||||||
_battery(1, this)
|
_battery(1, this)
|
||||||
{
|
|
||||||
parameters_updated();
|
|
||||||
}
|
|
||||||
|
|
||||||
EscBattery::~EscBattery()
|
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -84,11 +78,10 @@ EscBattery::Run()
|
|||||||
|
|
||||||
esc_status_s esc_status;
|
esc_status_s esc_status;
|
||||||
|
|
||||||
if (_esc_status_sub.update(&esc_status)) {
|
if (_esc_status_sub.copy(&esc_status)) {
|
||||||
|
|
||||||
if (hrt_elapsed_time(&esc_status.timestamp) > 500_ms ||
|
if (esc_status.esc_count == 0 ||
|
||||||
esc_status.esc_count == 0 ||
|
esc_status.esc_count > esc_status_s::CONNECTED_ESC_MAX) {
|
||||||
esc_status.esc_count > 8) {
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -51,7 +51,7 @@ class EscBattery : public ModuleBase<EscBattery>, public ModuleParams, public px
|
|||||||
{
|
{
|
||||||
public:
|
public:
|
||||||
EscBattery();
|
EscBattery();
|
||||||
~EscBattery() override;
|
~EscBattery() = default;
|
||||||
|
|
||||||
/** @see ModuleBase */
|
/** @see ModuleBase */
|
||||||
static int task_spawn(int argc, char *argv[]);
|
static int task_spawn(int argc, char *argv[]);
|
||||||
|
|||||||
Reference in New Issue
Block a user