go_to_trap_position_command.h

Go to the documentation of this file.

 
 
#pragma once
 
#include <frc2/command/Command.h>
#include <frc2/command/CommandHelper.h>
 
#include "subsystems/elevator_subsystem.h"
#include "subsystems/shooter_subsystem.h"
 
class GoToTrapPositionCommand : public frc2::CommandHelper<frc2::Command, GoToTrapPositionCommand> {
 public:
  GoToTrapPositionCommand(ShooterSubsystem* shooter, ElevatorSubsystem* elevator);
 
  void Initialize() override;
 
  void Execute() override;
 
  void End(bool interrupted) override;
 
  bool IsFinished() override;
 
  bool GetIsTrapDone();
 
  void ResetIsTrapDone();
 
 private:
  ShooterSubsystem* m_pShooter;
  ElevatorSubsystem* m_pElevator;
 
  bool is_0_deg;
 
  bool is_trap_done;
};