drive_by_time_vision.h

Go to the documentation of this file.

 
 
#pragma once
 
#include <argos_lib/general/debouncer.h>
#include <frc2/command/Command.h>
#include <frc2/command/CommandHelper.h>
 
#include <chrono>
 
#include "Constants.h"
#include "constants/measure_up.h"
#include "subsystems/swerve_drive_subsystem.h"
#include "subsystems/vision_subsystem.h"
 
class DriveByTimeVisionCommand : public frc2::CommandHelper<frc2::Command, DriveByTimeVisionCommand> {
 public:
  DriveByTimeVisionCommand(SwerveDriveSubsystem& swerveDrive,
                           VisionSubsystem& visionSubsystem,
                           bool leftAlignment,
                           units::millisecond_t driveTime);
 
  void Initialize() override;
 
  void Execute() override;
 
  void End(bool interrupted) override;
 
  bool IsFinished() override;
 
 private:
  SwerveDriveSubsystem& m_swerveDrive;
  VisionSubsystem& m_visionSubsystem;
  bool LeftAlignment;
  units::millisecond_t m_driveTime;
  std::chrono::time_point<std::chrono::high_resolution_clock> m_startTime;
  argos_lib::Debouncer m_autoAimDebouncer;
};