hungpham2511 / toppra

robotic motion planning library
https://hungpham2511.github.io/toppra/index.html
MIT License
625 stars 170 forks source link

Per Waypoint Time Constraint #19

Closed EdsterG closed 5 years ago

EdsterG commented 5 years ago

Commit 74b99fa adds the ability to specify a total time for the whole trajectory. Is it possible to specify an exact time for multiple way-points and fail if the request isn't feasible?

hungpham2511 commented 5 years ago

This is not possible with the TOPPRA algorithm per se. If I am not wrong, however, the problem you are looking to solve can be solved by formulating the retiming problem as a convex optimization problem and solve it directly. Please note that technique might have a significantly higher computational cost, probably in the range of seconds.

In fact I have planned to implement this functionality in TOPPRA for sometimes. If you implement something I would love to merge it to TOPPRA.