Teleop code written

Not tested; includes drivetrain and manipulator configurations in
initial robot design