![]() |
RogiStandard-hal
STM32 向けサークル共通ライブラリ
|
機体の目標速度から、各車輪の目標回転速度を求める [詳解]
#include <OmniWheelController.hpp>
公開メンバ関数 | |
| OmniWheelController (std::array< MotorWheel, Nz > &motor_wheels) | |
| 車輪の配置から変換行列を計算する | |
| std::array< float, Nz > | getTargetRps (Twist2D twist) |
| 機体の目標速度から、各車輪の目標回転速度を求める | |
機体の目標速度から、各車輪の目標回転速度を求める
構築時に車輪の配置から変換行列 (N×3) を1回だけ計算し、 getTargetRps() では行列とベクトルの積だけを行う。
データの流れ:
| N | 駆動輪の数 |
OmniWheelController.hpp の 56 行目に定義があります。
|
inline |
車輪の配置から変換行列を計算する
| motor_wheels | 各駆動輪の設定。配置 (positions) だけを使う |
OmniWheelController.hpp の 65 行目に定義があります。
|
inline |
機体の目標速度から、各車輪の目標回転速度を求める
| twist | 機体の目標速度 (vx, vy [m/s], ω [rad/s]) |
OmniWheelController.hpp の 79 行目に定義があります。