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