Teleop Code for square