Make code work

Update basic functions for apriltags and outline for integration
This commit is contained in:
Astatin3
2023-02-16 18:46:43 -07:00
parent dd8209d8c5
commit a91d334e2c
10 changed files with 282 additions and 206 deletions
@@ -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;
}
}