Motor and IR Tested

Added new IR code, motor and turn code.
Encoders need more testing on real robot.