Implement wheel odometry

[yambati03]

This has a few requirements to be considered done

• Ensure that we can receive encoder values from firmware
• Ensure that the ROS 2 control state interface is correctly updated with the most update encoder values
• Ensure that the odometry is consistent with actual movement (this needs to be tested on the physical rover)