PID loop moved to timer interrupts (TIM7 OVF). Seems to work pretty well
at 40Hz update rate... need to fix some cornering issues and distance
tracking... -AG