行为树概述

行为树的缺点

  1. 一个简单的操作都需要定义叶子节点,继承类并实现派生方法Init, OnTick, provide port,在工厂类中注册,导致在工程初期的代码量快速增大
  2. 当行为树规模变大,XML文件逻辑分散,很难追踪执行路径,复用性并没有想象中高,
  3. 最大缺陷:黑板变量,有的人在XML文件里赋值,有的人在C++里赋值,我如果用groot2看行为树,无法看到C++里赋值的情况
  4. 黑板机制的副作用:太灵活,没有强类型约束,没有作用域控制
  5. switch默认最多6个case,不能直接修改xml文件里的Switch,C++不识别。要想实现更多case,只能自己实现新的 Control 节点,或者说行为树不倾向这种用法
  6. C++的逻辑风格是大多数人熟悉的,比如if else, while, 设计模式等等,一个人看另一个人写的代码并不难上手。但是行为树的逻辑类型很多,有的人还会自己定义控制节点和修饰节点。同样的功能,不同人实现的逻辑会很不同,互相难理解,不利于团队协作,其他人难接手以前代码。也就是说行为树编程太灵活,缺乏规范

行为树的优点

  1. 有些逻辑,如果在C++里实现或者说用状态机,会非常难理解,代码量膨胀,比如修饰节点
  2. 也就是相对状态机的优点,比如这样的逻辑

    1
    2
    3
    4
    去目标点
    ├── 直走
    ├── 绕障
    └── 重新规划路径

    如果用状态机的话,需要考虑状态转移、错误处理、retry逻辑,处理起来比较复杂或者说不符合人的思维,如果用行为树,那就是普通的Fallback顺序节点,每个情况作为一个Fallback的分支,很容易理解

  3. 某些情况下可以实现节点复用

  4. 官方提供了与ROS2的接口,适合机器人的业务开发,而且是两套接口。

补充

  1. tick的运行方式,不符合C++程序员的思维。tick一般不会因为频率而造成CPU开销,sequence with memory 等节点可以跳过已运行完的节点。除非 tick 频率设为 100hz 甚至更高,树又非常深,才会成为性能瓶颈。
  2. AsyncNode,没帮你解决线程问题,cancel机制不统一,生命周期容易错

状态机的缺点

  1. 在项目中可能增加新状态、减少状态或者改变状态之间的迁移关系,如果状态越来越多,一点小修改都会产生很大的工作量,代码中会出现大量的判断跳转,耦合性太强。代码的逻辑会变得臃肿

状态机是由事件驱动的,状态与执行内容是绑定在一起的。当执行内容需要在多个状态中执行时,各个状态下都需要放置执行内容的逻辑。当业务逻辑代码分散在各处时就不太好维护了


行为树适合做任务调度层,控制复杂流程(回充 / 避障 / 任务切换),用它做所有的决策系统,很不合适。应当是行为树和状态机混合使用。

对于割草机的 直走—->绕障 —-> 重新规划路径,用行为树规划,其中的绕障内部用状态机,

1
2
3
4
去目标点
├── MoveStraightAction
├── AvoidObstacleAction <--- 内部是FSM
└── ReplanAction

在AvoidObstacleAction内部是 FSM:

1
2
3
4
5
6
7
INIT
↓
AVOID
↓
CHECK
↓
SUCCESS / FAIL / RECOVER

AvoidObstacleAction这个叶子节点可以复用,比如有走直线的避障、沿边的避障等等。

行为树不适合表达连续性的流程(如避障),因为它缺乏状态锁定机制,会导致执行不稳定和结构复杂化。

在上面这个例子里,如果避障部分也用行为树,会导致:

  1. 结构膨胀
  2. 在子树之间频繁切换
  3. 调试困难
  4. 子树不可复用

同样道理,脱困机制也该用状态机,而不是行为树。

总结

选策略用行为树,连续过程(执行细节)用状态机

  • 如果一个任务满足有明确步骤(1. 2. 3.)、中途不能被打断、需要记住进度,使用 FSM

  • 如果是存在多种行为选择、需要 fallback 或 retry、可以随时切换状态,使用 BT

1
2
3
4
5
BehaviorTree(高层调度)
↓
FSM / Planner(决策)
↓
Controller(控制)

频率控制

1
2
3
4
5
BT tick(10Hz)
↓
FSM update(10~20Hz)
↓
Controller(50~100Hz)


添加 TreeNodesModel

使用Groot打开行为树文件,有时会报警一大堆:不识别某Action,这是因为xml文件必须具备 TreeNodesModel才能让Groot识别。显然xml的作者不太会用行为树。

此外它还需要:节点类型,端口的名称和类型(输入/输出)。我们不需要手动去添加,工作了太大了。行为树提供了函数来生成:

1
2
3
4
5
BT::BehaviorTreeFactory factory;  
// register here your user-defined Nodes

std::string xml_models = BT::writeTreeNodesModelXML(factory);
cout << xml_models <<endl;

可以将 XML 保存到文件中,然后点击 Groot2 中的导入模型按钮。或者手动将输出的 xml_models直接添加到 .xml文件中。

也就是需要先定义Node,然后注册。才能调用writeTreeNodesModelXML,否则不识别Action的名称。当然也必须在 createTreeFromFile之后。

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
#include <iostream>
#include "behaviortree_cpp_v3/action_node.h"
#include "behaviortree_cpp_v3/xml_parsing.h"
#include "behaviortree_cpp_v3/bt_factory.h"
#include "behaviortree_cpp_v3/behavior_tree.h"

using namespace std;
using namespace BT;

class MyClass : public BT::SyncActionNode
{
public:
MyClass(const std::string& name, [[maybe_unused]] const BT::NodeConfiguration& config):
BT::SyncActionNode(name, {})
{
}
~MyClass()
{
}
static BT::PortsList providedPorts()
{
return {BT::InputPort<string>("input_code","NULL_ERROR","error code "),
BT::InputPort<string>("input_action","NULL_ACTION","input action ")};
}
BT::NodeStatus tick()
{
return BT::NodeStatus::SUCCESS;
}
};

int main([[maybe_unused]] int argc, [[maybe_unused]] char ** argv)
{
BT::BehaviorTreeFactory factory;
factory.registerNodeType<MyClass>("ClassName");

auto tree = factory.createTreeFromFile("/home/user/bt.xml");

std::string xmlmodels = BT::writeTreeNodesModelXML(factory);
cout << endl << xmlmodels << endl;

return 0;
}

ROS2中的代价地图

代价地图是在 planner_server 和 controller_server中初始化的。

清除代价地图

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
<Action ID="ClearEntireCostmap">
<input_port name="service_name">Service name</input_port>
<input_port name="server_timeout">Server timeout</input_port>
</Action>

<Action ID="ClearCostmapExceptRegion">
<input_port name="service_name">Service name</input_port>
<input_port name="server_timeout">Server timeout</input_port>
<input_port name="reset_distance">Distance from the robot above which obstacles are cleared</input_port>
</Action>

<Action ID="ClearCostmapAroundRobot">
<input_port name="service_name">Service name</input_port>
<input_port name="server_timeout">Server timeout</input_port>
<input_port name="reset_distance">Distance from the robot under which obstacles are cleared</input_port>
</Action>

行为树节点部分在clear_costmap_service.cpp,三个类都继承了BtServiceNode

服务端在 clear_costmap_service.cpp, 这里创建了service,编译为 libnav2_costmap_2d_core.so. 构造函数部分可以看到三个service的创建及其名称

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
ClearCostmapService::ClearCostmapService(
const nav2_util::LifecycleNode::WeakPtr & parent,
Costmap2DROS & costmap)
: costmap_(costmap)
{
auto node = parent.lock();
logger_ = node->get_logger();
reset_value_ = costmap_.getCostmap()->getDefaultValue();

clear_except_service_ = node->create_service<ClearExceptRegion>(
"clear_except_" + costmap_.getName(),
std::bind(
&ClearCostmapService::clearExceptRegionCallback, this,
std::placeholders::_1, std::placeholders::_2, std::placeholders::_3));

clear_around_service_ = node->create_service<ClearAroundRobot>(
"clear_around_" + costmap.getName(),
std::bind(
&ClearCostmapService::clearAroundRobotCallback, this,
std::placeholders::_1, std::placeholders::_2, std::placeholders::_3));

clear_entire_service_ = node->create_service<ClearEntirely>(
"clear_entirely_" + costmap_.getName(),
std::bind(
&ClearCostmapService::clearEntireCallback, this,
std::placeholders::_1, std::placeholders::_2, std::placeholders::_3));
}

比如名称可以是 clear_around_local_costmap

对应3个service

1
2
3
/local_costmap/clear_around_local_costmap
/local_costmap/clear_entirely_local_costmap
/local_costmap/clear_except_local_costmap

问题

编译nav2_costmap_2d后,直接运行ros2 run nav2_costmap_2d nav2_costmap,结果报错

1
[pluginlib.ClassLoader]: Skipped loading plugin with error: XML Document '/home/user/project/install/nav2_costmap_2d/share/nav2_costmap_2d/costmap_plugins.xml' has no Root Element. This likely means the XML is malformed or missing..


如果行为树有节点是Nav2的客户端,在服务端没启动时,服务不可用,行为树运行时会直接报错,不会运行任何节点。

如果没启动服务端,客户端发起请求时会报错

1
2
3
[ERROR] [1754535646.216247848] [nav2_node]: "global_costmap/clear_entirely_global_costmap" service server not available after waiting for 1.00s
[nav2_node-1] terminate called after throwing an instance of 'std::length_error'
[nav2_node-1] what(): basic_string::_M_create

可以把 BtServiceNode构造函数的throw一行删掉,这样即使没有服务端,也不会报错


.png

Action和service_name不符合,加载行为树会报错

1
what():  could not create client: create_client() called for existing request topic name rq/global_costmap/clear_entirely_global_costmapRequest with incompatible type navit_msgs::srv::dds_::ClearEntireCostmap_Request_, at ./src/rmw_client.cpp:165, at ./src/rcl/client.c:146



Nav2中的map_server

又是和ROS1的有所不同

先执行:ros2 run nav2_map_server map_server --ros-args --param yaml_filename:=map/fishbot_map.yaml

再打开rviz2,把设置都改好
截图 2025-08-05 14-42-41.png

再手动激活和配置节点

1
2
ros2 lifecycle set /map_server configure  
ros2 lifecycle set /map_server activate

这样才能正常显示地图
在加载map成功后,如果再加载costmap,对应的Rviz里的 Durability Policy 可以不改为 Transient Local

跟ROS1有所不同,不会一直发布/map话题。而且/map不会显示所有地图数据,会用- '...'表示,估计是开发者觉得显示一大堆地图数据没有意义。

也可以在运行时使用load_map服务更改地图


Map Server是一个可组合的 ROS2 节点。默认情况下,有一个map_server可执行文件来实例化这些节点之一,但如果需要,也可以将多个地图服务器节点组合到一个进程中。

Nav2 使用 ROS2 参数机制来获取要使用的 YAML 文件名。这实际上引入了一个间接层来获取地图 yaml 文件名。例如,对于一个名为“map_server”的节点,参数文件看起来是这样的:

1
2
3
map_server:
ros__parameters:
yaml_filename: "map.yaml"

也可以在一个进程中运行多个地图服务器节点,此时参数文件会按节点名称分隔参数,例如:

1
2
3
4
5
6
7
8
# combined_params.yaml
map_server1:
ros__parameters:
yaml_filename: "some_map.yaml"

map_server2:
ros__parameters:
yaml_filename: "another_map.yaml"

然后,使用包含两个节点参数的参数文件来启动该进程:process_with_multiple_map_servers __params:=combined_params.yaml

保存地图

ros2 run nav2_map_server map_saver_cli [arguments] [--ros-args ROS remapping args]

比如:ros2 run nav2_map_server map_saver_cli -f test

两个 service

1
ros2 service call /map_server/load_map nav2_msgs/srv/LoadMap "{map_url: /ros/maps/map.yaml}"
1
ros2 service call /map_saver/save_map nav2_msgs/srv/SaveMap "{map_topic: map, map_url: my_map, image_format: pgm, map_mode: trinary, free_thresh: 0.25, occupied_thresh: 0.65}"

ROS2中的参数

ROS2 中没有一个像ROS 1 那样的集中式参数服务器。ROS 2 的参数是与每个节点绑定的,每个节点都有自己的参数管理系统。也就是说 节点私有: 参数与节点相关联,而不是全局共享。节点可以声明、获取和更新自己的参数,也可以通过客户端库(SyncParametersClient或AsyncParametersClient)访问和修改其他节点的参数,从而实现参数共享。参数可以在节点运行时动态地获取和更新,方便配置和调试.

ROS 2 提供了参数接口,可以用于在节点之间共享参数,实现参数的动态更新和访问。

  • ros2 param list
  • ros2 param describe
1
2
3
4
5
6
7
8
ros2 param describe /turtlesim background_r
Parameter name: background_r
Type: integer
Description: Red channel of the background color
Constraints:
Min value: 0
Max value: 255
Step: 1
  • ros2 param get node_name parameter_name
1
2
ros2 param get /turtlesim background_r
Integer value is: 69
  • ros2 param set (省略)

  • ros2 run + param

  • ros2 run —ros-args —params-file


  • 设置参数
1
2
3
4
5
6
7
8
9
10
11
12
13
14
node->declare_parameter("my_string_param", "default_value");

// nav2_util里实现了先判断参数是否存在,再设置
template<typename NodeT>
void declare_parameter_if_not_declared(
NodeT node,
const std::string & parameter_name,
const rclcpp::ParameterValue & default_value,
const ParameterDescriptor & parameter_descriptor = ParameterDescriptor())
{
if (!node->has_parameter(parameter_name)) {
node->declare_parameter(parameter_name, default_value, parameter_descriptor);
}
}
  • 获得参数
1
2
3
4
5
6
// Retrieve the parameter
rclcpp::Parameter param_obj = this->get_parameter("my_string_param");
printf("type name: %s\n", param_obj.get_type_name().c_str() );
// Extract the value
std::string param_value = param_obj.as_string();
std::vector<std::string> param_value = param_obj.as_string_array();

但是有时候参数类型不一定就是string,可能是string的vector,可以用get_type_name查看类型。

如果是vector<std::string>,其size仅为1,实际不如就让类型为string,这应当是ROS2的一个缺陷。

1
2
3
4
template<typename ParameterT >
bool rclcpp::Node::get_parameter_or(const std::string& name,
ParameterT& value, const ParameterT& alternative_value
) const

获取参数值,如果未设置,则获取alternative_value,并将其赋给value。

  • 删除参数
1
this->remove_parameter("example_param");

ROS2中的Action和Service

action

  • ros2 action list -t

  • ros2 action info /compute_path_to_pose

1
2
3
4
Action: /compute_path_to_pose
Action clients: 0
Action servers: 1
/planner_server
  • ros2 action type /compute_path_to_pose
    结果是 nav2_msgs/action/ComputePathToPose

  • ros2 interface show nav2_msgs/action/ComputePathToPose

结果是 action 文件的详细信息

  • ros2 action send_goal
1
2
3
4
5
6
7
8
9
10
nvidia@ubuntu:~$ ros2 interface show turtlesim/action/RotateAbsolute.action

# The desired heading in radians
float32 theta
---
# The angular displacement in radians to the starting position
float32 delta
---
# The remaining rotation in radians
float32 remaining

这三项依次是目标,结果,反馈

  • 发送操作目标: ros2 action send_goal <action_name> <action_type> <values>

比如 ros2 action send_goal /turtle1/rotate_absolute turtlesim/action/RotateAbsolute "{theta: 1.57}"

1
2
3
4
5
6
7
8
9
10
nvidia@ubuntu:~$ ros2 action send_goal /turtle1/rotate_absolute turtlesim/action/RotateAbsolute "{theta: 1.57}"
Waiting for an action server to become available...
Sending goal:
theta: 1.57
Goal accepted with ID: 5cd8eb561348477abbb532fc816ce792

Result:
delta: 1.5680029392242432

Goal finished with status: SUCCEEDED

当然结果与目标有一定误差

要查看此目标的反馈,请在上次运行的命令中添加 --feedback,会看到连续的打印输出,将继续收到反馈,直到目标完成。

interface

  • ros2 interface list

分类显示消息、动作、服务的所有类型

  • ros2 interface package pkg_name
1
2
3
4
5
user@robot:~$ ros2 interface package action_msgs
action_msgs/srv/CancelGoal
action_msgs/msg/GoalInfo
action_msgs/msg/GoalStatus
action_msgs/msg/GoalStatusArray

获知某个消息类型是谁在用,可以这样查

1
2
3
4
5
6
7
8
user@robot:~$ ros2 interface packages | grep pendulum_msgs
pendulum_msgs
user@robot:~$ ros2 interface package pendulum_msgs
pendulum_msgs/msg/RttestResults
pendulum_msgs/msg/JointState
pendulum_msgs/msg/JointCommand

user@robot:~$ ros2 topic find pendulum_msgs/msg/RttestResults

  • 显示消息的成员
1
2
user@robot:~$ ros2 interface proto std_msgs/msg/String
"data: ''"

service

  • ros2 service type

可以看到服务的定义。

  • ros2 service find

找出指定类型的所有服务

  • ros2 service find std_srvs/srv/Empty

  • ros2 interface show

显示服务的定义

  • call命令比ROS1复杂了,需要指明service类型: ros2 service call service_name service_type

spdlog的使用

spdlog定义的日志级别最低为TRACE,最高为FATAL。当要发布程序时,把SPDLOG_ACTIVE_LEVEL宏的级别提高即可。

只有用SPDLOG_LOGGER_宏写日志,才能正常输出消息所在的文件、函数、行数。SPDLOG_LOGGER_宏本身支持format格式,比如 SPDLOG_LOGGER_DEBUG(console, "debug arg1={1}, arg2={0}", arg2, arg1)

代码中对spdlog进行了一次封装,即quick_log.h的类QUICK_LOG,使用时用LOG_TRACE, LOG_INFO等等,也可以用TRACE, INFO或者 LOG_T的形式


行为树注册Action函数

registerSimpleAction

1
2
3
4
5
6
void BT::BehaviorTreeFactory::registerSimpleAction (const std::string&  ID,
const SimpleActionNode::TickFunctor & tick_functor,
PortsList ports = {}
)

typedef std::function<NodeStatus(TreeNode&)> BT::SimpleActionNode::TickFunctor

registerSimpleAction help you register nodes of type SimpleActionNode.

其实就是std::bind的用法,如果在类内的成员函数里注册,应该如下使用

1
2
3
4
5
6
7
8
9
10
BT::NodeStatus TestBT()
{
printf("TestBT\n");
return BT::NodeStatus::SUCCESS;
}

void memberFunc()
{
this->registerSimpleAction("TestBT", std::bind(&BtFactory::TestBT, this) );
}

外部调用时,将类对象本身的地址作为this指针传入

1
2
Class a;
obj.registerSimpleAction(std::bind(&Class::TestBT, &a, placeholders::_1, placeholders::_2));

registerNodeType

行为树注册时,是注册节点的ModelName,而不是InstanceName

报错

  1. 不识别新添加的Action类

factory.registerNodeType<ActionReportError>("ReportError");报了很多错,都是undefine error。解决方法:到CMake里先把对应的cpp文件去掉,编译后报错,再添加回来,成功


BehaviorCPP版本从3到4.6的变化

可以使用convert_v3_to_v4.py将版本3的xml文件转为版本4,没发现反过来转换的。

  • classes / XML tags 发生的变化
Name in 3.8+ Name in 4.x Where
NodeConfiguration NodeConfig C++
SequenceStar SequenceWithMemory C++ and XML
AsyncActionNode ThreadedAction C++
BT::Optional BT::Expected C++
  • <root> 变成了 <root BTCPP_format="4">

  • ControlNodes and Decorators 必须支持新的节点状态 NodeStatus:SKIPPED

The purpose of this new status is to be returned when a PreCondition is not met. When a Node returns SKIPPED, it is notifying to its parent (ControlNode or Decorator) that it hasn’t been executed.

  • Ticking in a While Loop

版本3常常是这样进行tick的

1
2
3
4
5
while(status != NodeStatus::SUCCESS || status == NodeStatus::FAILURE)
{
tree.tickRoot();
std::this_thread::sleep_for(sleep_ms);
}

版本4引入新的sleep函数

1
Tree::sleep(std::chrono::milliseconds timeout)

This particular implementation of sleepcan be interrupted if any node in the tree invokes the method TreeNode::emitWakeUpSignal. This allows the loop to re-tick the tree immediately.

Tree::tickRoot() 已经消失了

1
2
3
4
5
6
7
8
//  status = tree.tickOnce();
while(!BT::isStatusCompleted(status) )
{
//---- or, even better ------
// tree.tickWhileRunning(sleep_ms);
tree.tickOnce();
tree.sleep(sleep_ms);
}

Tree::tickWhileRunning is the new default and it has its own internal loop; the first argument is a timeout of the sleep inside the loop.

或者这两个:

  • Tree::tickExactlyOnce(): equivalent to the old behavior in 3.8+
  • Tree::tickOnce() is roughly equivalent to tickWhileRunning(0ms). It may potentially tick more than once.
  • getInput的变化
1
BT::Optional<std::string> port_plugin_name = getInput<std::string>("plugin_name");

原型: Result BT::TreeNode::getInput(const std::string& key, T& destination ) const [inline]

Read an input port, which, in practice, is an entry in the blackboard. If the blackboard contains a std::string and T is not a string, convertFromString<T>() is used automatically to parse the text.

如果没有默认值的InputPort,不能获取值,运行会报错

1
2
3
BT::Expected<int> t = getInput<int>("ttt");
if(t)
cout << "Expected ttt: " << t.value() << endl;
  • SequenceWithMemory 取代 SequenceStar

Use this ControlNode when you don’t want to tick children again that already returned SUCCESS.

加载行为树的方式变化

1
2
3
4
5
6
7
Tree BT::BehaviorTreeFactory::createTree(const std::string& tree_name,
Blackboard::Ptr blackboard = Blackboard::create() )

Tree BT::BehaviorTreeFactory::createTreeFromFile(const std::string& file_path, Blackboard::Ptr blackboard = Blackboard::create() )

Tree BT::BehaviorTreeFactory::createTreeFromText(const std::string& text,
Blackboard::Ptr blackboard = Blackboard::create() )


1
- void BT::BehaviorTreeFactory::registerBehaviorTreeFromFile(const std::string&  filename)

Load the definition of an entire behavior tree, but don’t instantiate it. You can instantiate it later with BehaviorTreeFactory::createTree(tree_id), where “tree_id” come from the XML attribute <BehaviorTree id="tree_id">

1
void BT::BehaviorTreeFactory::registerBehaviorTreeFromText(const std::string &_xml_text_)

Same of registerBehaviorTreeFromFile, but passing the XML text, instead of the filename

  • 版本3的用法

auto tree = factory.createTreeFromFile("test.xml", maintree_bb);

版本4的用法如下:

1
2
3
4
factory.registerBehaviorTreeFromFile("test.xml");

// xml文件的开头是 <root BTCPP_format="4" main_tree_to_execute = "test" >
auto tree = factory.createTree("test", maintree_bb);

main_tree_to_execute的值一定要和createTree的第一个参数一致,否则会出错,出错的根源在 Tree XMLParser::instantiateTree(const Blackboard::Ptr& root_blackboard, std::string main_tree_ID)

每次在Groot2里修改行为树后,保存会让main_tree_to_execute部分消失,我认为这是个设计上的bug

tick系列函数

  • 版本4不再有函数 BT::Tree::tickRoot(TickOption opt, std::chrono::milliseconds sleep_time)
1
2
3
4
5
6
7
enum BT::Tree::TickOption
{
Enumerator
EXACTLY_ONCE
ONCE_UNLESS_WOKEN_UP
WHILE_RUNNING
}

版本4使用下面3个函数

  • BT::NodeStatus BT::Tree::tickWhileRunning(std::chrono::milliseconds sleep_time = std::chrono::milliseconds(10) )

Call tickOnce until the status is different from RUNNING. Note that between one tick and the following one, a Tree::sleep() is used

  • BT::NodeStatus BT::Tree::tickExactlyOnce()

Tick the root of the tree once, even if a node invoked emitWakeUpSignal()

  • BT::NodeStatus BT::Tree::tickOnce()

by default, tickOnce() sends a single tick, But as long as there is at least one node of the tree invoking TreeNode::emitWakeUpSignal(), it will be ticked again.


类BT::Tree在版本3里有两个成员变量

1
2
3
std::vector<Blackboard::Ptr>  blackboard_stack

std::vector<TreeNode::Ptr> nodes

在版本4里这两个都消失了,增加了成员std::vector<Subtree::Ptr> subtrees,可能会造成不便。


Gazebo Harmonic 配置仿真环境

按照这个包的步骤来,最后启动

1
ros2 launch gazebo_differential_drive_robot robot.launch.py

手动控制还是用cmd