Completely modified the robot subsystem and command structure

Lots of changes.