using Godot;

public class MoveNode : ProgramNode
{
    public Vector3 startPosition;
    public Vector3I targetPosition;
    public MoveNode()
    {
        DisplayText = "Move";
    }
    public override bool Execute(Robot robot, double delta)
    {
        Vector3 worldTarget = GameData.map[targetPosition.Y].tiles[targetPosition.X, targetPosition.Z].Position;
        GD.Print(startPosition + "/" + worldTarget);
        startPosition = robot.Position;
        Vector3 direction = worldTarget - startPosition;
        robot.Translate(direction.Normalized() * (float)delta * GameData.robotSpeed);
        float distance = direction.Length();
        if (distance < 0.1f)
        {
            robot.Position = worldTarget;
            return true;
        }
        return false;
    }

    public override void ReadParameters(NodeDisplay display)
    {
        HBoxContainer valueContainer = display.GetNode<HBoxContainer>("./EditorDisplay/HBoxContainer/");

        GD.Print(valueContainer.GetNode<SpinBox>("./CoordinateX").Value);
        int posX = (int)valueContainer.GetNode<SpinBox>("./CoordinateX").Value;
        int posY = (int)valueContainer.GetNode<SpinBox>("./CoordinateY").Value;
        int posZ = (int)valueContainer.GetNode<SpinBox>("./CoordinateZ").Value;
        targetPosition = new Vector3I(posX, posY, posZ);
    }

    public override ProgramNode Duplicate()
    {
        MoveNode duplicate = new MoveNode
        {
            targetPosition = targetPosition
        };
        return duplicate;
    }
}