Implemented Teleop in RobotCode

Implemented the robot side of teleop, and fixed typos