Trajectory Generation using Pontryagin’s minimum principle

ポントリャーギンの最小原理をもとに，3つのアクチュエータそれぞれで軌道を生成しました。
ROS2で実装し，Rvizで可視化しています。