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
+10 -6
View File
@@ -7,15 +7,15 @@
package frc4388.robot;
import frc4388.robot.subsystems.Vision;
import java.lang.System;
import java.lang.reflect.Array;
import java.util.Arrays;
import edu.wpi.first.wpilibj.TimedRobot;
import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.CommandScheduler;
import frc4388.utility.RobotTime;
import frc4388.robot.subsystems.Vision;
/**
* The VM is configured to automatically run this class, and to call the
@@ -29,7 +29,9 @@ public class Robot extends TimedRobot {
private RobotTime m_robotTime = RobotTime.getInstance();
private RobotContainer m_robotContainer;
private Vision Vision = new Vision();
//private Vision Apriltag = new Vision();
/**
* This function is run when the robot is first started up and should be
@@ -40,7 +42,6 @@ public class Robot extends TimedRobot {
// Instantiate our RobotContainer. This will perform all our button bindings, and put our
// autonomous chooser on the dashboard.
m_robotContainer = new RobotContainer();
}
/**
@@ -59,7 +60,10 @@ public class Robot extends TimedRobot {
// and running subsystem periodic() methods. This must be called from the robot's periodic
// block in order for anything in the Command-based framework to work.
CommandScheduler.getInstance().run();
System.out.println(Arrays.toString(Vision.getAprilTags()));
//final Object[] apriltagPos = Apriltag.getApriltagLocation();
//ystem.out.print(apriltagPos[0]);
}
/**