refactoring, fixed motorControlTask
Changed Hysteresis