mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
SystemContext.cpp
[詳解]
1#include "SystemContext.hpp"
2
4
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
16 if (ros_cmd_queue_ == nullptr) {
17 return false;
18 }
19 // mailbox運用:常に最新値で上書きする。溢れ時の黙殺は発生しない
20 return xQueueOverwrite(ros_cmd_queue_, &cmd) == pdTRUE;
21}
22
24 if (ros_cmd_queue_ == nullptr) {
25 return false;
26 }
27 return xQueueReceive(ros_cmd_queue_, &cmd, 0) == pdTRUE;
28}
SystemContext g_sys
制御・通信・センサのタスク間で、指令と計測値を排他制御して受け渡す。
タスク間共有ストア。
void begin()
キュー・mutex生成。
bool pushRosCmd(const RosVelocityCmd &cmd)
bool popRosCmd(RosVelocityCmd &cmd)
ROS速度指令メールボックス要素。