Decoupled position and current control working.

Dependencies:   QEI mbed-src

main.cpp/shortlog@30696e4d196b: not found in manifest