Added thread for debugging. Tweaked speed, algo

It pretty much turns just in time to not hit the wall. Probably need
more tweaks or change the game plan.