t03_sequence_star.cpp

Go to the documentation of this file.

#include "behaviortree_cpp/xml_parsing.h"

#include "dummy_nodes.h"
#include "movebase_node.h"

using namespace BT;

// clang-format off

const std::string xml_text_sequence = R"(

 <root main_tree_to_execute = "MainTree" >

     <BehaviorTree ID="MainTree">
        <Sequence name="root">
            <BatteryOK/>
            <TemperatureOK />
            <SaySomething   message="mission started..." />
            <MoveBase goal="1;2;3"/>
            <SaySomething   message="mission completed!" />
        </Sequence>
     </BehaviorTree>

 </root>
 )";

const std::string xml_text_sequence_star = R"(

 <root main_tree_to_execute = "MainTree" >

     <BehaviorTree ID="MainTree">
        <SequenceStar name="root">
            <BatteryOK/>
            <TemperatureOK />
            <SaySomething   message="mission started..." />
            <MoveBase goal="1;2;3"/>
            <SaySomething   message="mission completed!" />
        </SequenceStar>
     </BehaviorTree>

 </root>
 )";

// clang-format on

void Assert(bool condition)
{
    if (!condition)
        throw std::runtime_error("this is not what I expected");
}

int main()
{
    using namespace DummyNodes;

    BehaviorTreeFactory factory;
    factory.registerSimpleCondition("TemperatureOK", std::bind(CheckBattery));
    factory.registerSimpleCondition("BatteryOK", std::bind(CheckTemperature));
    factory.registerNodeType<MoveBaseAction>("MoveBase");
    factory.registerNodeType<SaySomething>("SaySomething");

    // Compare the state transitions and messages using either
    // xml_text_sequence and xml_text_sequence_star

    // The main difference that you should notice is:
    //  1) When Sequence is used, BatteryOK and TempearaturOK is executed at each tick()
    //  2) When SequenceStar is used, those ConditionNodes are executed only once.

    for (auto& xml_text : {xml_text_sequence, xml_text_sequence_star})
    {
        std::cout << "\n------------ BUILDING A NEW TREE ------------" << std::endl;

        auto tree = buildTreeFromText(factory, xml_text);

        NodeStatus status;

        std::cout << "\n--- 1st executeTick() ---" << std::endl;
        status = tree.root_node->executeTick();
        Assert(status == NodeStatus::RUNNING);

        SleepMS(150);
        std::cout << "\n--- 2nd executeTick() ---" << std::endl;
        status = tree.root_node->executeTick();
        Assert(status == NodeStatus::RUNNING);

        SleepMS(150);
        std::cout << "\n--- 3rd executeTick() ---" << std::endl;
        status = tree.root_node->executeTick();
        Assert(status == NodeStatus::SUCCESS);

        std::cout << std::endl;
    }
    return 0;
}

/*
 Expected output:

------------ BUILDING A NEW TREE ------------

--- 1st executeTick() ---
[ Temperature: OK ]
[ Battery: OK ]
Robot says: "mission started..."
[ MoveBase: STARTED ]. goal: x=1 y=2.0 theta=3.00

--- 2nd executeTick() ---
[ Temperature: OK ]
[ Battery: OK ]
[ MoveBase: FINISHED ]

--- 3rd executeTick() ---
[ Temperature: OK ]
[ Battery: OK ]
Robot says: "mission completed!"


------------ BUILDING A NEW TREE ------------

--- 1st executeTick() ---
[ Temperature: OK ]
[ Battery: OK ]
Robot says: "mission started..."
[ MoveBase: STARTED ]. goal: x=1 y=2.0 theta=3.00

--- 2nd executeTick() ---
[ MoveBase: FINISHED ]

--- 3rd executeTick() ---
Robot says: "mission completed!"

*/