Advertisement
Guest User

Untitled

a guest
Jan 26th, 2020
94
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 1.19 KB | None | 0 0
  1.   // Testing for autonomous arm movement in teleop
  2.             if (gamepad2.dpad_left)
  3.             {
  4.                 int targetArm = 75; // ideal position for arm at top of cycle, provided arm starts at the lowest setting
  5.  
  6.                 robot.armDrive.setTargetPosition(targetArm);
  7.  
  8.                 robot.armDrive.setMode(DcMotor.RunMode.RUN_TO_POSITION);
  9.                 while(robot.armDrive.isBusy() && opModeIsActive())
  10.                 {
  11.                     robot.armDrive.setPower(1);
  12.                 }
  13.                 robot.armDrive.setPower(0);
  14.                 robot.armDrive.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
  15.             }
  16.  
  17.             if (gamepad2.dpad_right)
  18.             {
  19.                 int targetArm = 75;
  20.  
  21.                 robot.armDrive.setTargetPosition(robot.armDrive.getCurrentPosition() - targetArm);
  22.  
  23.                 robot.armDrive.setMode(DcMotor.RunMode.RUN_TO_POSITION);
  24.                 while(robot.armDrive.isBusy() && opModeIsActive())
  25.                 {
  26.                     robot.armDrive.setPower(1);
  27.                 }
  28.                 robot.armDrive.setPower(0);
  29.                 robot.armDrive.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
  30.             }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement