Add encoder calibration function #54

* Add new module elementary_motions.c
* Add new function encoderCalibration()
* Add function encoderCalibration() to main.c