Syncd latest fixes in PurePursuitDrive.

Updated trclib, ftclib.
This commit is contained in:
Titan Robotics Club
2025-01-08 20:30:15 -08:00
parent 194ad0b280
commit bcc3343a1c
4 changed files with 7 additions and 5 deletions

View File

@ -320,7 +320,9 @@ public class FtcTest extends FtcTeleOp
// Set the current position as the absolute field origin so the path can be an absolute path. // Set the current position as the absolute field origin so the path can be an absolute path.
TrcPose2D startPose = new TrcPose2D(0.0, 0.0, 0.0); TrcPose2D startPose = new TrcPose2D(0.0, 0.0, 0.0);
robot.robotDrive.driveBase.setFieldPosition(startPose); robot.robotDrive.driveBase.setFieldPosition(startPose);
robot.robotDrive.purePursuitDrive.start(startPose, false, new TrcPose2D(0.0, 48.0, 90.0)); robot.robotDrive.purePursuitDrive.start(
false, robot.robotInfo.profiledMaxVelocity, robot.robotInfo.profiledMaxAcceleration,
robot.robotInfo.profiledMaxDeceleration, new TrcPose2D(0.0, 48.0, 90.0));
} }
break; break;
} }

View File

@ -101,8 +101,8 @@ public class RobotBase
profiledMaxAcceleration = robotMaxAcceleration; profiledMaxAcceleration = robotMaxAcceleration;
profiledMaxTurnRate = robotMaxTurnRate; profiledMaxTurnRate = robotMaxTurnRate;
// DriveBase PID Parameters // DriveBase PID Parameters
drivePidTolerance = 1.0; drivePidTolerance = 2.0;
turnPidTolerance = 1.0; turnPidTolerance = 2.0;
yDrivePidCoeffs = new TrcPidController.PidCoefficients(0.06, 0.0, 0.002, 0.0, 0.0); yDrivePidCoeffs = new TrcPidController.PidCoefficients(0.06, 0.0, 0.002, 0.0, 0.0);
yDrivePidPowerLimit = 1.0; yDrivePidPowerLimit = 1.0;
yDriveMaxPidRampRate = null; yDriveMaxPidRampRate = null;