軌道生成

Pontryaginの最小原理を用いて，Hamiltonianを最小化する軌道を解析的に求めました。 障害物は考慮せず，計算コストを小さくする軌道生成を目的とします。