added teleop; fixed some bugs