Advertisement
roll11226

teleop

Jun 11th, 2017
90
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.76 KB | None | 0 0
  1. package org.firstinspires.ftc.teamcode;
  2.  
  3. import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
  4. import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
  5. import com.qualcomm.robotcore.hardware.DcMotor;
  6.  
  7.  
  8. @TeleOp(name = "Teleop")
  9. public class Main_Teleop extends LinearOpMode {
  10. private HardWare11226 m_hardware = new HardWare11226();
  11.  
  12. private double left_Power, right_Power;
  13. @Override
  14. public void runOpMode() throws InterruptedException {
  15.  
  16.  
  17. m_hardware.init(hardwareMap);
  18. m_hardware.shootingServo.setPosition(0);
  19.  
  20. waitForStart();
  21.  
  22. while (opModeIsActive())
  23. {
  24. left_Power = gamepad1.left_stick_y;
  25. right_Power = gamepad1.right_stick_y;
  26. if (!gamepad1.left_bumper && !gamepad1.right_bumper)
  27. {
  28. driving();
  29. }
  30. else
  31. {
  32. straightdriving();
  33. }
  34. collect();
  35. movingball();
  36. shooting();
  37.  
  38.  
  39. }
  40.  
  41. }
  42.  
  43. private void driving()
  44. {
  45. m_hardware.leftMotor.setPower(left_Power);
  46. m_hardware.rightMotor.setPower(right_Power);
  47. }
  48.  
  49. private void collect()
  50. {
  51. if (gamepad2.right_trigger > 0.1) {
  52. m_hardware.collectMotor.setPower(gamepad2.right_trigger);
  53. }
  54. else if (gamepad2.left_trigger > 0.1) {
  55. m_hardware.collectMotor.setPower(-gamepad2.left_trigger);
  56. }
  57. else{
  58. m_hardware.collectMotor.setPower(0);
  59. }
  60.  
  61. }
  62.  
  63. public void beginf() {
  64.  
  65. m_hardware.leftMotor.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
  66. m_hardware.rightMotor.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
  67.  
  68. m_hardware.leftMotor.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
  69. m_hardware.rightMotor.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
  70.  
  71.  
  72. }
  73.  
  74.  
  75.  
  76. private void straightdriving()
  77. {
  78. if (gamepad1.right_bumper)
  79. {
  80. m_hardware.leftMotor.setPower(0.5);
  81. m_hardware.rightMotor.setPower(0.5);
  82. }
  83. else if (gamepad1.left_bumper)
  84. {
  85. m_hardware.leftMotor.setPower(-0.5);
  86. m_hardware.rightMotor.setPower(-0.5);
  87. }
  88.  
  89. }
  90.  
  91. private void movingball()
  92. {
  93. if (gamepad2.y)
  94. {
  95.  
  96. m_hardware.shootingServo.setPosition(0);
  97. }
  98. else
  99. {
  100. m_hardware.shootingServo.setPosition(1);
  101. }
  102. }
  103. private void shooting()
  104. {
  105. if (gamepad2.left_stick_y < -0.25)
  106. {
  107. m_hardware.shootingMotor.setPower(1);
  108. }
  109. else {
  110. m_hardware.shootingMotor.setPower(0);
  111. }
  112.  
  113. }
  114. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement