#include "RobotContainer.h"
#include <argos_lib/commands/swap_controllers_command.h>
#include <argos_lib/controller/trigger_composition.h>
#include <argos_lib/general/angle_utils.h>
#include <argos_lib/general/color.h>
#include <argos_lib/general/swerve_utils.h>
#include <frc/DriverStation.h>
#include <frc/RobotBase.h>
#include <frc/RobotState.h>
#include <frc/shuffleboard/Shuffleboard.h>
#include <frc/smartdashboard/SmartDashboard.h>
#include <frc2/command/CommandScheduler.h>
#include <frc2/command/InstantCommand.h>
#include <frc2/command/ParallelCommandGroup.h>
#include <frc2/command/RunCommand.h>
#include <frc2/command/SequentialCommandGroup.h>
#include <frc2/command/WaitCommand.h>
#include <frc2/command/WaitUntilCommand.h>
#include <frc2/command/button/Trigger.h>
#include <units/angular_velocity.h>
#include <units/length.h>
#include <functional>
#include "commands/climb_command.h"
#include "commands/go_to_position_command.h"
#include "commands/l1_coral_placement_command.h"
#include "commands/l4_coral_placement_command.h"
#include "commands/middle_coral_placement_command.h"
#include "constants/position.h"
#include <constants/feature_flags.h>
#include <Constants.h>
#include <cmath>
#include <memory>
#include <optional>
#include "utils/custom_units.h"