balance_charging_station.h

Go to the documentation of this file.

 
 
#pragma once
 
#include <frc2/command/CommandBase.h>
#include <frc2/command/CommandHelper.h>
#include <frc2/command/SequentialCommandGroup.h>
 
#include "subsystems/swerve_drive_subsystem.h"
 
class BalanceChargingStation : public frc2::CommandHelper<frc2::CommandBase, BalanceChargingStation> {
 public:
  BalanceChargingStation(SwerveDriveSubsystem* drive, units::degree_t approachAngle, units::degree_t robotYaw);
 
  void Initialize() override;
 
  void Execute() override;
 
  void End(bool interrupted) override;
 
  bool IsFinished() override;
 
 private:
  SwerveDriveSubsystem* m_pDrive;         
  const units::degree_t m_approachAngle;  
  units::degree_t m_robotYawAngle;        
  const bool m_approachForward;
  const int m_initialPitchSign;
  frc2::CommandPtr m_commands;  
};