Old working code

Dependencies:   mbed QEI ros_lib_melodic

no such method: docs