|
//TODO: Implement better changes for changing motor behavior. |
FlightRecorder.write("MECANUM_PARAMS", PARAMS);
}
//TODO: Implement better changes for changing motor behavior.
public void setBrake() {
leftFront.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
leftBack.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
rightBack.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
rightFront.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
}
public void setCoast() {
leftFront.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.FLOAT);
leftBack.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.FLOAT);
rightBack.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.FLOAT);
rightFront.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.FLOAT);
}
public void setDrivePowers(PoseVelocity2d powers) {
MecanumKinematics.WheelVelocities<Time> wheelVels = new MecanumKinematics(1).inverse(
PoseVelocity2dDual.constant(powers, 1));
IntoTheDeep/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/roadrunner/MecanumDrive.java
Line 250 in 107a75e