Uncommented Velocity PID

This commit is contained in:
aarav18
2020-01-24 17:20:15 -07:00
parent 7008ceb453
commit 0da2e35400
2 changed files with 4 additions and 4 deletions
@@ -40,9 +40,9 @@ public class DriveAtVelocityPID extends CommandBase {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
//m_drive.runVelocityPID(m_drive.m_rightFrontMotor, m_rightTarget);
//m_drive.runVelocityPID(m_drive.m_leftFrontMotor, m_leftTarget);
//m_drive.m_leftFrontMotor.follow(m_drive.m_rightFrontMotor, FollowerType.PercentOutput);
m_drive.runVelocityPID(m_rightTarget);
m_drive.runVelocityPID(m_leftTarget);
m_drive.m_leftFrontMotor.follow(m_drive.m_rightFrontMotor, FollowerType.PercentOutput);
}
// Called once the command ends or is interrupted.
@@ -311,7 +311,7 @@ public class Drive extends SubsystemBase {
m_rightFrontMotor.selectProfileSlot(DriveConstants.SLOT_TURNING, DriveConstants.PID_TURN);
m_rightFrontMotor.set(TalonFXControlMode.Velocity, 0, DemandType.AuxPID, targetAngle);
//m_leftFrontMotor.follow(m_rightFrontMotor, FollowerType.AuxOutput1);
m_rightFrontMotor.set(DemandType.AuxPID, 0);
//m_rightFrontMotor.set(DemandType.AuxPID, 0);
}
public double getGyroYaw() {