Added Teleop

Incorporated Teleop and integrated the old files. <3