|
mirs_esp_pio
|
ロボット上位制御。RC/ROS2速度指令の統合・モード切替・ウォッチドッグ。 [詳解]
#include <RobotController.hpp>
公開型 | |
| enum | ControlMode : uint8_t { MODE_MANUAL , MODE_ROS2 } |
| 制御モード [詳解] | |
公開メンバ関数 | |
| RobotController (double wheel_base, float max_linear_speed, float max_angular_speed, uint32_t watchdog_timeout) | |
| コンストラクタ | |
| void | setWheelBase (double wheel_base) |
| 車輪間距離を設定 | |
| ControlMode | getControlMode () const |
| 制御モードを取得 | |
| void | setControlMode (ControlMode mode) |
| 制御モードを設定 | |
| void | updateRos2Command (float linear_x, float angular_z, uint32_t stamp_ms) |
| ROS2からの速度指令を更新 | |
| void | update (const RcControlInput &rc, uint32_t now_ms) |
| RC入力とモード切替を処理して速度指令を更新 | |
| double | getLeftVelCmd () const |
| 左輪速度指令を取得 | |
| double | getRightVelCmd () const |
| 右輪速度指令を取得 | |
ロボット上位制御。RC/ROS2速度指令の統合・モード切替・ウォッチドッグ。
RobotController.hpp の 24 行目に定義があります。
| enum application::RobotController::ControlMode : uint8_t |
| application::RobotController::RobotController | ( | double | wheel_base, |
| float | max_linear_speed, | ||
| float | max_angular_speed, | ||
| uint32_t | watchdog_timeout ) |
コンストラクタ
| wheel_base | 車輪間距離 [m] |
| max_linear_speed | 最大直進速度 [m/s] |
| max_angular_speed | 最大角速度 [rad/s] |
| watchdog_timeout | ウォッチドッグタイムアウト [ms] |
RobotController.cpp の 10 行目に定義があります。
|
inline |
|
inline |
|
inline |
|
inline |
| void application::RobotController::setWheelBase | ( | double | wheel_base | ) |
| void application::RobotController::update | ( | const RcControlInput & | rc, |
| uint32_t | now_ms ) |
RC入力とモード切替を処理して速度指令を更新
| rc | 正規化済みRC入力と有効状態 |
| now_ms | 現在時刻 [ms] |
手動モード時はRC入力から速度指令を生成します(RC信号喪失時は停止)。 ROS2モード時はRC信号を要求せず、ウォッチドッグのみで停止判定します。 モード切替スイッチの立ち上がりエッジでモードをトグルします (ROS2からのトグル先は必ずMANUAL。SW信号喪失中はトグル判定を凍結し現モード維持)。
RobotController.cpp の 40 行目に定義があります。
| void application::RobotController::updateRos2Command | ( | float | linear_x, |
| float | angular_z, | ||
| uint32_t | stamp_ms ) |
ROS2からの速度指令を更新
| linear_x | 直進速度 [m/s] |
| angular_z | 角速度 [rad/s] |
| stamp_ms | ESP32で受信した時刻 [ms] |
この関数を呼び出すとウォッチドッグタイマーがリセットされます。
RobotController.cpp の 34 行目に定義があります。