Advertisement
Guest User

Untitled

a guest
Mar 20th, 2019
63
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.12 KB | None | 0 0
  1.  
  2. if( (m_encoder.getDistance() < 3) || (m_encoder.getDistance() >25) || (Math.abs(m_encoder.getDistance()-targetDistance) < 3) ){
  3. elevatorSpeedAct = elevatorSpeedSlow;
  4. }
  5. else{
  6. elevatorSpeedAct = elevatorSpeedFast;
  7. }
  8.  
  9. boolean elevatorButtonPressed = (m_joystick2.getRawButton(bHomeLevel)) || (m_joystick2.getRawButton(bHatchLevel2)) || (m_joystick2.getRawButton(bHatchLevel3)) || (m_joystick.getRawButton(bDriveLevel));
  10.  
  11. if(m_joystick2.getRawButton(bHomeLevel)){
  12. targetDistance = homeLevel;
  13. }
  14. if(m_joystick2.getRawButton(bHatchLevel2)){
  15. targetDistance = hatchLevel2;
  16. }
  17. if(m_joystick2.getRawButton(bHatchLevel3)){
  18. targetDistance = hatchLevel3;
  19. }
  20. if(m_joystick.getRawButton(bDriveLevel)){
  21. targetDistance = driveLevel;
  22. }
  23.  
  24.  
  25. if(elevatorButtonPressed){
  26.  
  27. boolean TooLow = (m_encoder.getDistance()-targetDistance) < -0.5;
  28. boolean TooHigh = (m_encoder.getDistance()-targetDistance) > 0.5;
  29.  
  30. if (TooLow) {
  31. elevatorSpark.set(elevatorSpeedAct);
  32. }
  33. else if (TooHigh){
  34. elevatorSpark.set(-elevatorSpeedAct);
  35. }
  36. else {
  37. elevatorSpark.set(elevatorSpeedStop);
  38. }
  39. }
  40. else{
  41. elevatorSpark.set(0);
  42. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement