Implemented the new command class protocol on the Robot(Arduino) side. Also wrote two test classes to demonstrate functionality.