// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.

#pragma once

#include "Constants.hpp"
#include "commands/Autos.hpp"
#include "subsystems/DriveSubsystem.hpp"
#include "subsystems/HatchSubsystem.hpp"
#include "wpi/commands2/Command.hpp"
#include "wpi/commands2/Commands.hpp"
#include "wpi/commands2/button/CommandGamepad.hpp"
#include "wpi/smartdashboard/SendableChooser.hpp"

namespace ac = AutoConstants;

/**
 * This class is where the bulk of the robot should be declared.  Since
 * Command-based is a "declarative" paradigm, very little robot logic should
 * actually be handled in the {@link Robot} periodic methods (other than the
 * scheduler calls).  Instead, the structure of the robot (including subsystems,
 * commands, and button mappings) should be declared here.
 */
class RobotContainer {
 public:
  RobotContainer();

  wpi::cmd::Command* GetAutonomousCommand();

 private:
  // The driver's controller
  wpi::cmd::CommandGamepad driverController{OIConstants::kDriverControllerPort};

  // The robot's subsystems and commands are defined here...

  // The robot's subsystems
  DriveSubsystem drive;
  HatchSubsystem hatch;

  // Commands owned by RobotContainer

  // The autonomous routines
  wpi::cmd::CommandPtr simpleAuto = autos::SimpleAuto(&drive);
  wpi::cmd::CommandPtr complexAuto = autos::ComplexAuto(&drive, &hatch);

  // The chooser for the autonomous routines
  wpi::SendableChooser<wpi::cmd::Command*> chooser;

  void ConfigureButtonBindings();
};
