Decoupled position and current control working.

Dependencies:   QEI mbed-src

PID.cpp/shortlog@5ae9f8b3a16f: not found in manifest