mirror of
https://github.com/Team4388/2023WayOfTheRobot.git
synced 2026-06-09 08:38:02 -06:00
Make code work
Update basic functions for apriltags and outline for integration
This commit is contained in:
@@ -0,0 +1,44 @@
|
||||
package frc4388.robot.subsystems;
|
||||
|
||||
import frc4388.robot.subsystems.Apriltags;
|
||||
|
||||
public class Location {
|
||||
final Apriltags Apriltag = new Apriltags();
|
||||
|
||||
public boolean isLimelight = false;
|
||||
public boolean isApriltag = false;
|
||||
|
||||
//Determines which source to get pos and rot from and also resets
|
||||
public void reoderPrio(){
|
||||
isLimelight = false; //If limelight gets position and if within a certain range of poles
|
||||
isApriltag = Apriltag.isAprilTag();
|
||||
}
|
||||
|
||||
public Object[] getPosition() {
|
||||
Object[] Position = {};
|
||||
|
||||
if(isLimelight){
|
||||
//Return Limelight Position
|
||||
}else if(isApriltag){
|
||||
return Apriltag.getApriltagPosition();
|
||||
}else{
|
||||
//Return odometry Position, last resort
|
||||
}
|
||||
|
||||
return Position;
|
||||
}
|
||||
|
||||
public Object[] getRotation() {
|
||||
Object[] Rotation = {};
|
||||
|
||||
if(isLimelight){
|
||||
//Return Limelight Rotation
|
||||
}else if(isApriltag){
|
||||
return Apriltag.getApriltagRotation();
|
||||
}else{
|
||||
//Return odometry Rotation, last resort
|
||||
}
|
||||
|
||||
return Rotation;
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user