Refactored a method in MotionControl
Now better performance when pausing and resuming.
Merge branch 'development' of https://github.com/Hasselmannen/sleepfighter into development