mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
telemetry_publisher.hpp
[詳解]
1#pragma once
2#include <std_msgs/msg/float64_multi_array.h>
3#include <std_msgs/msg/int32_multi_array.h>
4
5#include "publish_divider.hpp"
7
11public:
12 const char *name() const override { return "telemetry"; }
13 bool advertise(rcl_node_t *node) override;
14 void publish(const SharedMotion &motion, const SharedSensor &sensor,
15 int32_t now_sec, uint32_t now_nsec) override;
16 void release(rcl_node_t *node) override;
17
18private:
19 static constexpr uint8_t kPublishDivider = 4; // [回] 4周期に1回発行
20 bool allocBuffers();
21 void freeBuffers();
22
23 rcl_publisher_t enc_pub_{};
24 rcl_publisher_t vel_pub_{};
25 rcl_publisher_t vlt_pub_{};
26 rcl_publisher_t rc_debug_pub_{};
27 std_msgs__msg__Int32MultiArray enc_msg_{};
28 std_msgs__msg__Float64MultiArray vel_msg_{};
29 std_msgs__msg__Float64MultiArray vlt_msg_{};
30 std_msgs__msg__Float64MultiArray rc_debug_msg_{};
31 PublishDivider divider_{kPublishDivider};
32};
低頻度テレメトリ一括発行(/encoder・/vel・/vlt・/rc_debug)。
bool advertise(rcl_node_t *node) override
publisher生成+メッセージバッファ確保。
void release(rcl_node_t *node) override
publisher破棄+バッファ解放。未advertiseへの呼出しも安全にすること。
const char * name() const override
void publish(const SharedMotion &motion, const SharedSensor &sensor, int32_t now_sec, uint32_t now_nsec) override
周期発行。データ不在時は無発行にすること。
呼び出し回数を数え、指定した間隔で配信を実行する。
ROS配信処理の初期化と周期処理に使う共通の窓口を定義する。
運動系テレメトリ。
センサ系テレメトリ。