diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumDrive.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumDrive.java index 9ed9df9386e4..62ca369aef16 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumDrive.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/MecanumDrive.java @@ -41,6 +41,7 @@ import org.firstinspires.ftc.teamcode.util.OverflowEncoder; import org.firstinspires.ftc.teamcode.util.RawEncoder; +import java.lang.Math; import java.util.Arrays; import java.util.LinkedList; import java.util.List; @@ -199,11 +200,17 @@ public MecanumDrive(HardwareMap hardwareMap, Pose2d pose) { } public void setDrivePowers(Twist2d powers) { - MecanumKinematics.WheelVelocities