mirror of
https://github.com/Team4388/RiseOfRidgebotics2020.git
synced 2026-06-09 08:48:01 -06:00
Uncommented Velocity PID
This commit is contained in:
@@ -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() {
|
||||
|
||||
Reference in New Issue
Block a user