Skip to content

Instantly share code, notes, and snippets.

@Xevion

Xevion/old_mechanum.java

Created November 11, 2020 21:52
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save Xevion/2e14978eac91a9ef2e55abe1b09033a2 to your computer and use it in GitHub Desktop.
Save Xevion/2e14978eac91a9ef2e55abe1b09033a2 to your computer and use it in GitHub Desktop.
Download ZIP
Raw
old_mechanum.java
double v1 = (radius * Math.cos(ang) + turnCon) * getMultiplier();
double v2 = (radius * Math.sin(ang) - turnCon) * getMultiplier();
double v3 = (radius * Math.sin(ang) + turnCon) * getMultiplier();
double v4 = (radius * Math.cos(ang) - turnCon) * getMultiplier();
robot.motorLeftFront.setPower(v1);
robot.motorRightFront.setPower(v2);
robot.motorLeftRear.setPower(v3);
robot.motorRightRear.setPower(v4);
if (addTelemetry && telemetry != null) {
telemetry.addLine(Util.createLevel((float) v1));
telemetry.addLine(Util.createLevel((float) v2));
telemetry.addLine(Util.createLevel((float) v3));
telemetry.addLine(Util.createLevel((float) v4));
}
@Xevion
Copy link
Author

Xevion commented Nov 11, 2020

https://github.com/TWHS-Pastabots/ultimate-goal/blob/042c75a01a5d204ab0e4aeaa5b2a2f588f45fa93/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/DriveTrain.java#L254-L269

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment