Added SimpleRobot class code for testing purposes.

Note: This is making use of WindRivers SimpleRobot code. But I fully
intend to use command based programming for the actual robot.