jsk-ros-pkg / jsk_control

jsk control ros packages
http://github.com/jsk-ros-pkg/jsk_control
13 stars 51 forks source link

[eus_qp/optmotiongen] dynamic motion generation with bspline #705

Closed mmurooka closed 5 years ago

mmurooka commented 5 years ago

Generate dynamic motion with sqp optimization. Motion trajectory is represented with bspline. Main file for this feature is bspline-dynamic-configuration-task.l. Manual with formula explanation is in Sec. 4.3 of manual.pdf. Samples with irteus sample-robot and HRP2 are added. Sample-robot one is executed in travis test. sample-robot-sqp-bspline-dynamic-config-task sample-sqp-optimization-bspline-dynamic Currently, angular momentum from joint motion is not considered correctly, ref :ang-moment-instant-task-value method doc. Also, optimization does not converge well, especially contact transition is complicated (such as motion with hand contact).

Other modifications: