/*
 * Copyright (c) Contributors to the Open 3D Engine Project.
 * For complete copyright and license terms please see the LICENSE at the root
 * of this distribution.
 *
 * SPDX-License-Identifier: Apache-2.0 OR MIT
 *
 */

#pragma once

#include <AzCore/Component/Component.h>
#include <AzCore/Component/Entity.h>
#include <AzToolsFramework/API/ToolsApplicationAPI.h>
#include <AzToolsFramework/ToolsComponents/EditorComponentBase.h>
#include <AzToolsFramework/ToolsComponents/GenericComponentWrapper.h>

#include <Clients/ROS2ControllersSystemComponent.h>
#include <ROS2Controllers/ROS2ControllersEditorBus.h>

namespace ROS2Controllers
{
    /// System component for ROS2Controllers editor
    class ROS2ControllersEditorSystemComponent
        : public ROS2ControllersSystemComponent
        , protected AzToolsFramework::EditorEvents::Bus::Handler
        , protected ROS2ControllersEditorRequestBus::Handler
    {
        using BaseSystemComponent = ROS2ControllersSystemComponent;

    public:
        AZ_COMPONENT_DECL(ROS2ControllersEditorSystemComponent);

        static void Reflect(AZ::ReflectContext* context);

        ROS2ControllersEditorSystemComponent();
        ~ROS2ControllersEditorSystemComponent();

    protected:
        ////////////////////////////////////////////////////////////////////////
        // ROS2ControllersEditorRequestBus interface implementation
        AZ::Component* CreateWheelControllerComponent(
            AZ::Entity& entity, const AZ::EntityId& steeringEntity, const float steeringScale) override;
        AZ::Component* CreateROS2RobotControlComponent(AZ::Entity& entity, const ControlConfiguration& configuration) override;
        AZ::Component* CreateAckermannVehicleModelComponent(
            AZ::Entity& entity,
            const VehicleDynamics::VehicleConfiguration& configuration,
            const float speedLimit,
            const float steeringLimit,
            const float acceleration,
            const PidConfiguration& steeringPid) override;
        AZ::Component* CreateAckermannControlComponent(AZ::Entity& entity) override;
        AZ::Component* CreateSkidSteeringModelComponent(
            AZ::Entity& entity,
            const VehicleDynamics::VehicleConfiguration& configuration,
            const float linearLimit,
            const float angularLimit,
            const float linearAcceleration,
            const float angularAcceleration) override;
        AZ::Component* CreateSkidSteeringControlComponent(AZ::Entity& entity) override;
        AZ::Component* CreateJointsArticulationControllerComponent(AZ::Entity& entity) override;
        AZ::Component* CreateJointsPIDControllerComponent(AZ::Entity& entity) override;
        AZ::Component* CreateJointsManipulationEditorComponent(
            AZ::Entity& entity, const ROS2::PublisherConfiguration& publisherConfig) override;
        AZ::Component* CreateJointsTrajectoryComponent(AZ::Entity& entity, const AZStd::string& actionName) override;
        ////////////////////////////////////////////////////////////////////////

    private:
        static void GetProvidedServices(AZ::ComponentDescriptor::DependencyArrayType& provided);
        static void GetIncompatibleServices(AZ::ComponentDescriptor::DependencyArrayType& incompatible);
        static void GetRequiredServices(AZ::ComponentDescriptor::DependencyArrayType& required);
        static void GetDependentServices(AZ::ComponentDescriptor::DependencyArrayType& dependent);

        // AZ::Component
        void Activate() override;
        void Deactivate() override;

        //! Create a component and attach the component to the entity.
        //! This method ensures that game components are wrapped into GenericComponentWrapper.
        //! @param entity entity to which the new component is added
        //! @param args constructor arguments used to create the new component
        //! @return A pointer to the component. Returns a null pointer if the component could not be created.
        template<class ComponentType, typename... Args>
        AZ::Component* CreateComponent(AZ::Entity& entity, Args&&... args)
        {
            // Do not create a component if the same type is already added.
            if (entity.FindComponent<ComponentType>())
            {
                return nullptr;
            }

            // Create component.
            // If it's not an "editor component" then wrap it in a GenericComponentWrapper.
            AZ::Component* component = nullptr;
            if (AZ::GetRttiHelper<ComponentType>() &&
                AZ::GetRttiHelper<ComponentType>()->IsTypeOf(AzToolsFramework::Components::EditorComponentBase::RTTI_Type()))
            {
                component = aznew ComponentType(AZStd::forward<Args>(args)...);
            }
            else
            {
                AZ::Component* gameComponent = aznew ComponentType(AZStd::forward<Args>(args)...);
                component = aznew AzToolsFramework::Components::GenericComponentWrapper(gameComponent);
            }

            AZ_Assert(component, "Failed to create component: %s", AZ::AzTypeInfo<ComponentType>::Name());
            if (component)
            {
                if (!entity.IsComponentReadyToAdd(component) || !entity.AddComponent(component))
                {
                    delete component;
                    component = nullptr;
                }
            }
            return component;
        }
    };
} // namespace ROS2Controllers