working version of two axis correlator with correct homing and pretty good servo loop.  Need to now work on the control interface