add encoder integration

**Describe Ideal Solution**
Encoder sensor data should be used in a close loop control for the motors. Autonomous movements and Radio Controller openings should use physical measures for refined control.