Teleop work

Teleop work- added servo, motors, etc.