Package frc.alotobots.util
Class LocalADStarAK
java.lang.Object
frc.alotobots.util.LocalADStarAK
- All Implemented Interfaces:
com.pathplanner.lib.pathfinding.Pathfinder
-
Constructor Summary
-
Method Summary
Modifier and TypeMethodDescriptioncom.pathplanner.lib.path.PathPlannerPath
getCurrentPath
(com.pathplanner.lib.path.PathConstraints constraints, com.pathplanner.lib.path.GoalEndState goalEndState) Get the most recently calculated pathboolean
Get if a new path has been calculated since the last time a path was retrievedvoid
setDynamicObstacles
(List<Pair<Translation2d, Translation2d>> obs, Translation2d currentRobotPos) Set the dynamic obstacles that should be avoided while pathfinding.void
setGoalPosition
(Translation2d goalPosition) Set the goal position to pathfind tovoid
setStartPosition
(Translation2d startPosition) Set the start position to pathfind from
-
Constructor Details
-
LocalADStarAK
public LocalADStarAK()
-
-
Method Details
-
isNewPathAvailable
public boolean isNewPathAvailable()Get if a new path has been calculated since the last time a path was retrieved- Specified by:
isNewPathAvailable
in interfacecom.pathplanner.lib.pathfinding.Pathfinder
- Returns:
- True if a new path is available
-
getCurrentPath
public com.pathplanner.lib.path.PathPlannerPath getCurrentPath(com.pathplanner.lib.path.PathConstraints constraints, com.pathplanner.lib.path.GoalEndState goalEndState) Get the most recently calculated path- Specified by:
getCurrentPath
in interfacecom.pathplanner.lib.pathfinding.Pathfinder
- Parameters:
constraints
- The path constraints to use when creating the pathgoalEndState
- The goal end state to use when creating the path- Returns:
- The PathPlannerPath created from the points calculated by the pathfinder
-
setStartPosition
Set the start position to pathfind from- Specified by:
setStartPosition
in interfacecom.pathplanner.lib.pathfinding.Pathfinder
- Parameters:
startPosition
- Start position on the field. If this is within an obstacle it will be moved to the nearest non-obstacle node.
-
setGoalPosition
Set the goal position to pathfind to- Specified by:
setGoalPosition
in interfacecom.pathplanner.lib.pathfinding.Pathfinder
- Parameters:
goalPosition
- Goal position on the field. f this is within an obstacle it will be moved to the nearest non-obstacle node.
-
setDynamicObstacles
public void setDynamicObstacles(List<Pair<Translation2d, Translation2d>> obs, Translation2d currentRobotPos) Set the dynamic obstacles that should be avoided while pathfinding.- Specified by:
setDynamicObstacles
in interfacecom.pathplanner.lib.pathfinding.Pathfinder
- Parameters:
obs
- A List of Translation2d pairs representing obstacles. Each Translation2d represents opposite corners of a bounding box.currentRobotPos
- The current position of the robot. This is needed to change the start position of the path to properly avoid obstacles
-