Pre test Teleop

Appears functional.