Finished up shooter (still needs review), started working on Vision

This commit is contained in:
Pushkar9236
2022-01-21 20:58:13 -07:00
parent ed87f4deac
commit a1c9f0cef5
3 changed files with 100 additions and 6 deletions
@@ -6,10 +6,40 @@ package frc4388.robot.subsystems;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Vision extends SubsystemBase {
/** Creates a new Vision. */
public Vision() {}
public class Vision extends SubsystemBase {
//setup
Turret m_turret;
BoomBoom m_boomBoom;
Hood m_hood;
NetworkTableEntry xEntry;
IHandController m_driverController;
//Aiming
double turnAmount = 0;
double xAngle = 0;
double yAngle = 0;
double target = 0;
public double distance;
public double realDistance;
public static double fireVel;
public static double fireAngle;
public double m_hoodTrim;
public double m_turretTrim;
LimeLight m_limeLight;
public TrackTarget(ShooterAim aimSubsystem, LimeLight limeLight) {
m_turret = turretSubsystem;
m_boomBoom = m_turret.m_turretSubsystem;
m_hood = m_boomBoom.m_hoodSubsystem;
m_limeLight = limeLight;
addRequirements(m_turret);
}
@Override
public void periodic() {
// This method will be called once per scheduler run