mirror of
https://github.com/Team4388/2023WayOfTheRobot.git
synced 2026-06-09 00:37:59 -06:00
Make code work
Update basic functions for apriltags and outline for integration
This commit is contained in:
@@ -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]);
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
Reference in New Issue
Block a user