Combined the coordinate methods
First Draft of teleop