Planning¶
Sdf-swept-sphere-based collision checker¶
Collision checker between swept spheres and sdf |
SQP-based trajectory planner¶
Gradient based trajectory optimization using scipy's SLSQP. |
Swept sphere generater¶
Compute swept spheres approximating a mesh |
Planner utils¶
Scipinize a function returning both f and jac |
|
A utility function for setting robot state |
|
A utility function for getting robot state |
|
Compute fk for multiple feature points |