Add PID and Motion Magic Commands

This commit is contained in:
Aarav
2020-01-16 20:22:50 -07:00
parent 6fc414ccb8
commit 9be99be0c3
4 changed files with 71 additions and 6 deletions
@@ -36,8 +36,8 @@ public class DriveToDistancePID extends CommandBase {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
m_drive.gotoPositionPID(m_drive.m_leftFrontMotor, m_leftTarget);
m_drive.gotoPositionPID(m_drive.m_rightFrontMotor, m_rightTarget);
m_drive.runPositionPID(m_drive.m_leftFrontMotor, m_leftTarget);
m_drive.runPositionPID(m_drive.m_rightFrontMotor, m_rightTarget);
}
// Called once the command ends or is interrupted.