fixed the planner's stitching!

we fixed some major bugs and now things are more happy.
more slow. more boring, but more safe.
new motion primitives with turn in place back in

turn in place is probably too cheap, but it does appear to work
otherwise.
changed error debugging to debug debugging. for less bugging.