Advertisement
yuval092

4 omni wheels driving system - ftc velcoity vortex 2017

Jan 18th, 2017
82
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.42 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. import com.qualcomm.robotcore.hardware.DcMotorSimple;
  7. import com.qualcomm.robotcore.robocol.TelemetryMessage;
  8. import com.qualcomm.robotcore.util.Range;
  9.  
  10. /*
  11. an ftc program from 2017 velocity vortex season
  12. which describes how to program an 4 omni wheels driving system.
  13. */
  14. @TeleOp (name ="controller", group = "Tests")
  15. public class Chassis_Test extends LinearOpMode
  16. {
  17. float frontLeft = 0, frontRight = 0, backLeft = 0, backRight = 0;
  18. float gamepad1LeftY = 0, gamepad1LeftX =0, gamepad1RightX = 0;
  19. DcMotor motorFrontRight;
  20. DcMotor motorFrontLeft;
  21. DcMotor motorBackRight;
  22. DcMotor motorBackLeft;
  23.  
  24. hardware Chassis = new hardware();
  25.  
  26. public void runOpMode() throws InterruptedException
  27. {
  28. motorFrontRight = hardwareMap.dcMotor.get("motor front right");
  29. motorFrontLeft = hardwareMap.dcMotor.get("motor front left");
  30. motorBackLeft = hardwareMap.dcMotor.get("motor back left");
  31. motorBackRight = hardwareMap.dcMotor.get("motor back right");
  32.  
  33. motorFrontLeft.setDirection(DcMotor.Direction.FORWARD);
  34. motorFrontRight.setDirection(DcMotor.Direction.FORWARD);
  35. motorBackLeft.setDirection(DcMotor.Direction.FORWARD);
  36. motorBackRight.setDirection(DcMotor.Direction.FORWARD);
  37. waitForStart();
  38. while (opModeIsActive())
  39. {
  40. gamepad1LeftY = gamepad1.left_stick_y;
  41. gamepad1LeftX = -gamepad1.left_stick_x;
  42. gamepad1RightX = -gamepad1.right_stick_x;
  43.  
  44. frontLeft = gamepad1LeftY + gamepad1LeftX + gamepad1RightX;
  45. frontRight = -gamepad1LeftY + gamepad1LeftX + gamepad1RightX;
  46. backRight = -gamepad1LeftY - gamepad1LeftX + gamepad1RightX;
  47. backLeft = gamepad1LeftY - gamepad1LeftX + gamepad1RightX;
  48.  
  49.  
  50. frontLeft = Range.clip(frontLeft, -1, 1);
  51. frontRight = Range.clip(frontRight, -1, 1);
  52. backLeft = Range.clip(backLeft, -1, 1);
  53. backRight = Range.clip(backRight, -1, 1);
  54.  
  55. motorFrontRight.setPower(frontRight);
  56. motorFrontLeft.setPower(frontLeft);
  57. motorBackLeft.setPower(backLeft);
  58. motorBackRight.setPower(backRight);
  59.  
  60.  
  61. }
  62. }
  63. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement