code to go straight with pid

Dependencies:   AVEncoder QEI mbed-src-AV

no such method: docs