Advertisement
roll11226

Autonumous red side new

Jan 16th, 2017
88
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.12 KB | None | 0 0
  1. package org.firstinspires.ftc.teamcode;
  2.  
  3. import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
  4. import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
  5.  
  6.  
  7. @Autonomous(name = "autonomous red side")
  8. public class autonomous_red_side extends LinearOpMode
  9. {
  10. HardWare11226 m_hardware = new HardWare11226();
  11. boolean runOneTime;
  12. @Override
  13. public void runOpMode() throws InterruptedException
  14. {
  15. m_hardware.init(hardwareMap);
  16. waitForStart();
  17.  
  18. while (opModeIsActive())
  19. {
  20. if (runOneTime == false)
  21. {
  22. m_hardware.collectMotor.setPower(0);
  23. /*
  24. m_hardware.leftMotor.setPower(-0.5);
  25. m_hardware.rightMotor.setPower(-0.5);
  26. sleep(1600);
  27. m_hardware.leftMotor.setPower(0);
  28. m_hardware.rightMotor.setPower(0);
  29. sleep(500);
  30. m_hardware.leftMotor.setPower(0.5);
  31. m_hardware.rightMotor.setPower(0.5);
  32. sleep (2200);
  33. m_hardware.leftMotor.setPower(0);
  34. m_hardware.rightMotor.setPower(0);*/
  35.  
  36. m_hardware.leftMotor.setPower(-0.5);
  37. m_hardware.rightMotor.setPower(-0.5);
  38. sleep(1050);
  39.  
  40. m_hardware.leftMotor.setPower(0);
  41. m_hardware.rightMotor.setPower(0);
  42. sleep(900);
  43.  
  44. m_hardware.leftMotor.setPower(0.5);
  45. m_hardware.rightMotor.setPower(-0.5);
  46. sleep(695);
  47.  
  48. m_hardware.leftMotor.setPower(0);
  49. m_hardware.rightMotor.setPower(0);
  50. sleep(900);
  51.  
  52. m_hardware.leftMotor.setPower(-0.5);
  53. m_hardware.rightMotor.setPower(-0.5);
  54. sleep(3600);
  55.  
  56. m_hardware.leftMotor.setPower(0);
  57. m_hardware.rightMotor.setPower(0);
  58.  
  59. m_hardware.collectMotor.setPower(-1);
  60. sleep(3500);
  61. m_hardware.collectMotor.setPower(0);
  62. runOneTime = true;
  63. }
  64.  
  65. }
  66. }
  67. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement