mirs_esp_pio
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
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
"
6
#include "
publisher_plugin.hpp
"
7
11
class
ImuPublisher
:
public
IPublisherPlugin
{
12
public
:
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
19
private
:
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
};
IPublisherPlugin
定義
publisher_plugin.hpp:17
ImuPublisher
IMU発行(/imu/data_raw・/imu/mag。15ms周期の4回に1回=約17Hz)。
定義
imu_publisher.hpp:11
ImuPublisher::release
void release(rcl_node_t *node) override
publisher破棄+バッファ解放。未advertiseへの呼出しも安全にすること。
定義
imu_publisher.cpp:81
ImuPublisher::publish
void publish(const SharedMotion &motion, const SharedSensor &sensor, int32_t now_sec, uint32_t now_nsec) override
周期発行。データ不在時は無発行にすること。
定義
imu_publisher.cpp:45
ImuPublisher::advertise
bool advertise(rcl_node_t *node) override
publisher生成+メッセージバッファ確保。
定義
imu_publisher.cpp:7
ImuPublisher::name
const char * name() const override
定義
imu_publisher.hpp:13
publish_divider.hpp
呼び出し回数を数え、指定した間隔で配信を実行する。
publisher_plugin.hpp
ROS配信処理の初期化と周期処理に使う共通の窓口を定義する。
SharedMotion
運動系テレメトリ。
定義
SystemContext.hpp:43
SharedSensor
センサ系テレメトリ。
定義
SystemContext.hpp:61
src
publishers
imu_publisher.hpp
構築:
1.18.0