mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
imu_publisher.hpp
[詳解]
1#pragma once
2#include <sensor_msgs/msg/imu.h>
3#include <sensor_msgs/msg/magnetic_field.h>
4
5#include "publish_divider.hpp"
7
12public:
13 const char *name() const override { return "imu"; }
14 bool advertise(rcl_node_t *node) override;
15 void publish(const SharedMotion &motion, const SharedSensor &sensor,
16 int32_t now_sec, uint32_t now_nsec) override;
17 void release(rcl_node_t *node) override;
18
19private:
20 static constexpr uint8_t kPublishDivider = 4; // [回] 4周期に1回発行
21 rcl_publisher_t imu_pub_{};
22 rcl_publisher_t mag_pub_{};
23 sensor_msgs__msg__Imu imu_msg_{};
24 sensor_msgs__msg__MagneticField mag_msg_{};
25 PublishDivider divider_{kPublishDivider};
26};
IMU発行(/imu/data_raw・/imu/mag。15ms周期の4回に1回=約17Hz)。
void release(rcl_node_t *node) override
publisher破棄+バッファ解放。未advertiseへの呼出しも安全にすること。
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生成+メッセージバッファ確保。
const char * name() const override
呼び出し回数を数え、指定した間隔で配信を実行する。
ROS配信処理の初期化と周期処理に使う共通の窓口を定義する。
運動系テレメトリ。
センサ系テレメトリ。