added initial motor calibration algorithm

no cache yet.