Decoupled position and current control working.

Dependencies:   QEI mbed-src

main.cpp/shortlog@89bb6272869b: not found in manifest