Move motor back to initial position after it has been moved

Dependencies:   Encoder HIDScope QEI mbed