Class SwerveSimpleTrajectoryLogic
java.lang.Object
xbot.common.trajectory.SwerveSimpleTrajectoryLogic
-
Nested Class Summary
Nested Classes -
Constructor Summary
Constructors -
Method Summary
Modifier and TypeMethodDescriptionorg.wpilib.math.geometry.Twist2dcalculatePowers(org.wpilib.math.geometry.Pose2d currentPose, PIDManager positionalPid, HeadingModule headingModule) org.wpilib.math.geometry.Twist2dcalculatePowers(org.wpilib.math.geometry.Pose2d currentPose, PIDManager positionalPid, HeadingModule headingModule, double maximumVelocity) getGoalVector(org.wpilib.math.geometry.Pose2d currentPose) booleanrecommendIsFinished(org.wpilib.math.geometry.Pose2d currentPose, PIDManager positionalPid, HeadingModule headingModule) voidreset(org.wpilib.math.geometry.Pose2d currentPose) voidsetAimAtGoalDuringFinalLeg(boolean aimAtGoalDuringFinalLeg) voidsetAimAtIntermediateNonFinalLegs(boolean aimAtIntermediateNonFinalLegs) voidsetConstantVelocity(double constantVelocity) voidsetDistanceThresholdToPrioritizeRotation(double distanceThresholdToPrioritizeRotation) voidsetDriveBackwards(boolean driveBackwards) voidsetEnableSpecialAimDuringFinalLeg(boolean enableSpecialAimDuringFinalLeg) voidsetEnableSpecialAimTarget(boolean enableSpecialAimTarget) voidvoidsetFinishModeLoosePositionAndRotation(double position, double rotation) voidsetGlobalKinematicValues(SwervePointKinematics globalKinematics) voidsetKeyPoints(List<XbotSwervePoint> keyPoints) voidsetKeyPointsProvider(Supplier<List<XbotSwervePoint>> keyPointsProvider) voidsetMaxPower(double maxPower) voidsetMaxTurningPower(double maxTurningPower) voidsetPrioritizeRotationIfCloseToGoal(boolean prioritizeRotationIfCloseToGoal) setRotationPrioritizationScaleback(double rotationPrioritizationScaleback) voidsetSpecialAimTarget(org.wpilib.math.geometry.Pose2d specialAimTarget) voidvoidsetWaypointRouter(ProvidesWaypoints waypointRouter)
-
Constructor Details
-
SwerveSimpleTrajectoryLogic
public SwerveSimpleTrajectoryLogic()
-
-
Method Details
-
setEnableSpecialAimTarget
public void setEnableSpecialAimTarget(boolean enableSpecialAimTarget) -
setRotationPrioritizationScaleback
public SwerveSimpleTrajectoryLogic setRotationPrioritizationScaleback(double rotationPrioritizationScaleback) -
setEnableSpecialAimDuringFinalLeg
public void setEnableSpecialAimDuringFinalLeg(boolean enableSpecialAimDuringFinalLeg) -
setSpecialAimTarget
public void setSpecialAimTarget(org.wpilib.math.geometry.Pose2d specialAimTarget) -
setAimAtGoalDuringFinalLeg
public void setAimAtGoalDuringFinalLeg(boolean aimAtGoalDuringFinalLeg) -
setAimAtIntermediateNonFinalLegs
public void setAimAtIntermediateNonFinalLegs(boolean aimAtIntermediateNonFinalLegs) -
setDriveBackwards
public void setDriveBackwards(boolean driveBackwards) -
setWaypointRouter
-
setKeyPoints
-
setKeyPointsProvider
-
setMaxPower
public void setMaxPower(double maxPower) -
setMaxTurningPower
public void setMaxTurningPower(double maxTurningPower) -
getKeyPoints
-
getResolvedKeyPoints
-
setFinishModeLoosePositionAndRotation
public void setFinishModeLoosePositionAndRotation(double position, double rotation) -
setFinishModeBeAtPidTarget
public void setFinishModeBeAtPidTarget() -
setPrioritizeRotationIfCloseToGoal
public void setPrioritizeRotationIfCloseToGoal(boolean prioritizeRotationIfCloseToGoal) -
setDistanceThresholdToPrioritizeRotation
public void setDistanceThresholdToPrioritizeRotation(double distanceThresholdToPrioritizeRotation) -
setVelocityMode
-
setConstantVelocity
public void setConstantVelocity(double constantVelocity) -
setGlobalKinematicValues
-
reset
public void reset(org.wpilib.math.geometry.Pose2d currentPose) -
getGoalVector
-
calculatePowers
public org.wpilib.math.geometry.Twist2d calculatePowers(org.wpilib.math.geometry.Pose2d currentPose, PIDManager positionalPid, HeadingModule headingModule) -
calculatePowers
public org.wpilib.math.geometry.Twist2d calculatePowers(org.wpilib.math.geometry.Pose2d currentPose, PIDManager positionalPid, HeadingModule headingModule, double maximumVelocity) -
recommendIsFinished
public boolean recommendIsFinished(org.wpilib.math.geometry.Pose2d currentPose, PIDManager positionalPid, HeadingModule headingModule) -
getLastResult
-