mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
application::RobotController クラス

ロボット上位制御。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 行目に定義があります。

列挙型メンバ詳解

◆ ControlMode

制御モード

列挙値
MODE_MANUAL 

手動制御モード(RC入力)

MODE_ROS2 

ROS2制御モード

RobotController.hpp の 27 行目に定義があります。

構築子と解体子

◆ RobotController()

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 行目に定義があります。

関数詳解

◆ getControlMode()

ControlMode application::RobotController::getControlMode ( ) const
inline

制御モードを取得

戻り値
現在の制御モード

RobotController.hpp の 56 行目に定義があります。

◆ getLeftVelCmd()

double application::RobotController::getLeftVelCmd ( ) const
inline

左輪速度指令を取得

戻り値
左輪速度指令 [m/s]

RobotController.hpp の 91 行目に定義があります。

◆ getRightVelCmd()

double application::RobotController::getRightVelCmd ( ) const
inline

右輪速度指令を取得

戻り値
右輪速度指令 [m/s]

RobotController.hpp の 97 行目に定義があります。

◆ setControlMode()

void application::RobotController::setControlMode ( ControlMode mode)
inline

制御モードを設定

本番はSWトグルで遷移する。試験・外部強制用に残す。

引数
mode制御モード

RobotController.hpp の 63 行目に定義があります。

◆ setWheelBase()

void application::RobotController::setWheelBase ( double wheel_base)

車輪間距離を設定

引数
wheel_base車輪間距離 [m]

RobotController.cpp の 30 行目に定義があります。

◆ update()

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 行目に定義があります。

◆ updateRos2Command()

void application::RobotController::updateRos2Command ( float linear_x,
float angular_z,
uint32_t stamp_ms )

ROS2からの速度指令を更新

引数
linear_x直進速度 [m/s]
angular_z角速度 [rad/s]
stamp_msESP32で受信した時刻 [ms]

この関数を呼び出すとウォッチドッグタイマーがリセットされます。

RobotController.cpp の 34 行目に定義があります。


このクラス詳解は次のファイルから抽出されました: