I think I made it better. Some issues with straighten still. Prop control is better than Binary search.
Guess I made motion even crazier.
That crazy thing with motion (duty cycle+other cool thing) didn't work out so well, but I'm gonna push for posterity and then revert manually.