Parts of motor speed monitoring implemented, moving closer to goal implemented, calibration movement dealloc fixed