Starting to implement driving code to the robot.
finished implementing drive code.  To be tested next week.