meco-group / omg-tools

Optimal Motion Generation-tools: motion planning made easy
GNU Lesser General Public License v3.0
563 stars 97 forks source link

(basic) rotation for obstacles #16

Closed rubenvanparys closed 8 years ago

rubenvanparys commented 8 years ago

Rotation for obstacles is possible (multiple revolutions). The rotational speed can not change over time and it is only supported for fixed time horizons (p2p fixedT). The basic idea behind the rotation is the (exact) nurbs representation of a cosine and sine. The shift of the time horizon can be done by using goniometric identities of the cosine/sine of a sum. Pushed an example with a revolving door. This problem is however very complex and suffers from local optima.