code to go straight with pid

Dependencies:   AVEncoder QEI mbed-src-AV

main.cpp/shortlog@b9485bb1ca69: not found in manifest