mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
odom_publisher.hpp
[詳解]
1#pragma once
2#include <nav_msgs/msg/odometry.h>
3
4#include "publish_divider.hpp"
6
11public:
12 const char *name() const override { return "odom"; }
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 rcl_publisher_t odom_pub_{};
21 nav_msgs__msg__Odometry odom_msg_{};
22 PublishDivider divider_{kPublishDivider};
23};
オドメトリ発行(/odom。15ms周期の4回に1回=約17Hz。frame: odom -> base_footprint)。
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
周期発行。データ不在時は無発行にすること。
bool advertise(rcl_node_t *node) override
publisher生成+メッセージバッファ確保。
呼び出し回数を数え、指定した間隔で配信を実行する。
ROS配信処理の初期化と周期処理に使う共通の窓口を定義する。
運動系テレメトリ。
センサ系テレメトリ。