baldor control: working both directions! Now a PID controller, better response! Some bug fixes