Change the method for checking the communication disconnection
Use the value of the encoder
Merge pull request #20 from open-rdc/fix-calc-odom

Use the value of the encoder