mirs_esp_pio
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
SystemContext.cpp
[詳解]
1
#include "
SystemContext.hpp
"
2
3
SystemContext
g_sys
;
4
5
void
SystemContext::begin
() {
6
// 二重beginのリーク防止。main setup()から1回のみ想定だが安全側に倒す
7
if
(ros_cmd_queue_ ==
nullptr
) {
8
ros_cmd_queue_ = xQueueCreate(1,
sizeof
(
RosVelocityCmd
));
// 最新値のみ保持のmailbox
9
}
10
params_.create();
11
motion_.create();
12
sensor_.create();
13
}
14
15
bool
SystemContext::pushRosCmd
(
const
RosVelocityCmd
&cmd) {
16
if
(ros_cmd_queue_ ==
nullptr
) {
17
return
false
;
18
}
19
// mailbox運用:常に最新値で上書きする。溢れ時の黙殺は発生しない
20
return
xQueueOverwrite(ros_cmd_queue_, &cmd) == pdTRUE;
21
}
22
23
bool
SystemContext::popRosCmd
(
RosVelocityCmd
&cmd) {
24
if
(ros_cmd_queue_ ==
nullptr
) {
25
return
false
;
26
}
27
return
xQueueReceive(ros_cmd_queue_, &cmd, 0) == pdTRUE;
28
}
g_sys
SystemContext g_sys
定義
SystemContext.cpp:3
SystemContext.hpp
制御・通信・センサのタスク間で、指令と計測値を排他制御して受け渡す。
SystemContext
タスク間共有ストア。
定義
SystemContext.hpp:117
SystemContext::begin
void begin()
キュー・mutex生成。
定義
SystemContext.cpp:5
SystemContext::pushRosCmd
bool pushRosCmd(const RosVelocityCmd &cmd)
定義
SystemContext.cpp:15
SystemContext::popRosCmd
bool popRosCmd(RosVelocityCmd &cmd)
定義
SystemContext.cpp:23
RosVelocityCmd
ROS速度指令メールボックス要素。
定義
SystemContext.hpp:14
lib
SystemContext
SystemContext.cpp
構築:
1.18.0