loco-3d / crocoddyl

Crocoddyl is an optimal control library for robot control under contact sequence. Its solver is based on various efficient Differential Dynamic Programming (DDP)-like algorithms
BSD 3-Clause "New" or "Revised" License
854 stars 174 forks source link

[actuation] fixed thrust direction for calculation of thrust jacobian #1310

Open sugikazu75 opened 1 month ago

sugikazu75 commented 1 month ago

I fixed the direction of thrust which is required for calculation of thrust jacobian. When the orientation of thruster is not identical to that of parent link, this patch is required.

Since rotational moment generated by thrust is $\lambda p \times u$, where $\lambda$, $p$, and $u$ are thrust, position of thruster, and direction of thrust, respectively.