starting to implement own teleop
including basic logic