Made a lot of modifications to the robot class that it makes sense to the robotTemplate class