field_drift_command.hpp

Go to the documentation of this file.

#ifndef FANG_ROBOTICS_MCB_CONTROL_CHASSIS_HOLONOMIC_COMMAND_FIELD_DRIFT_COMMAND_HPP
#define FANG_ROBOTICS_MCB_CONTROL_CHASSIS_HOLONOMIC_COMMAND_FIELD_DRIFT_COMMAND_HPP
#include "control/chassis/chassis_input_handler.hpp"
#include "control/chassis/drive/holonomic/holonomic_subsystem.hpp"
 
#include "tap/control/command.hpp"
 
namespace fang::chassis
{
    class FieldDriftCommand : public tap::control::Command
    {
    public:
        struct Config
        {
            physics::Velocity2D maxTranslation;
            RPM maxRotation;
        };
 
        FieldDriftCommand
        (
            HolonomicSubsystem& holonomicSubsystem,
            ChassisInputHandler& inputHandler,
            const Config& config
        );
 
        virtual ~FieldDriftCommand() = default;
 
        const char* getName() const override;
        void initialize() override;
        void execute() override;
        void end(bool interrupted) override;
        bool isFinished() const;
 
    protected:
        physics::Velocity2D getFieldTranslation() const;
 
        RPM getFieldRotation() const;
 
        static constexpr const char* kName{"Field Drift"};
 
        HolonomicSubsystem& holonomicSubsystem_;
        ChassisInputHandler& chassisInput_;
        const Config kConfig_;
 
    private:
        static void assertConfigValues(const Config& config);
        static void assertGetFieldTranslationUniformSigns
        (
            const math::AbstractVector2D& abstractFieldTranslation,
            const physics::Velocity2D& fieldTranslation
        );
    };
}//namespace chassis
#endif