Heuristical motion planning

Implement (x,y,theta)-planning for a polygonal robot moving with translation and rotations in 2D using one of:

What to turn in


Demos


Enjoy!