【Apollo自动驾驶-从理论到代码】cyber/node模块

2023-10-11 18:20

本文主要是介绍【Apollo自动驾驶-从理论到代码】cyber/node模块,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

/* 作者水平有限,欢迎批评指正,内容持续完善中!!*/

Apollo Cyber Component

  • 主要文件
  • 类图
  • 处理流程
    • Node特点及须知
  • 代码详解
    • CreateNode函数的调用点
    • Node的构造函数
    • NodeChannelImpl的构造函数
    • NodeServiceImpl的构造函数
    • 创建Reader
    • 创建Writer、Service、Client
    • Reader的实质创建
      • Reader类型的选择
      • Reader的Init()过程

主要文件

文件名描述作用
reader_base.hReader的基类
reader.hReader类
writer_base.hWriter的基类
writer.hWriter类
node_channel_impl.hreader writer的具体实现
node_service_impl.hservice client的具体实现
node.cc节点是CyberRT中的基本单元,每个模块都包含一个节点,并且相互之间使用节点通信。一个模块可以定义不同的通信方式在一个节点中,如read/write or/and service/client。

类图

在这里插入图片描述

处理流程

Node特点及须知

  1. Node中可以创建Reader、Writer、Service、Client对象。
  2. 其中上面提到的Reader、Writer、Service、Client对象由对应的类创建。
  3. 根据要创建的类型,选择NodeChannelImpl或者NodeServiceImpl类进行Reader、Writer、Service、Client对象的创建。

代码详解

由于node目录和service目录的关联性较大,下面将会一起介绍两处的代码。

CreateNode函数的调用点

在Node类中,使用了友元函数CreateNode()。该函数位于命名空间apollo::cyber中,在模块代码中,会通过调用该函数创建节点Node,如:

./modules/canbus/tools/teleop.cc:97:    node_ = CreateNode("teleop");
./modules/data/tools/smart_recorder/realtime_record_processor.cc:120:  smart_recorder_node_ = CreateNode(absl::StrCat("smart_recorder_", getpid()));
./modules/routing/tools/routing_cast.cc:33:      apollo::cyber::CreateNode("routing_cast"));

那现在深入到CreateNode函数中,该函数位于cyber.cc中,cyber.cc文件中只定义了一个CreateNode函数,由此可见,Node和Cyber的密切关系:

namespace apollo {
namespace cyber {using apollo::cyber::common::GlobalData;
using apollo::cyber::proto::RunMode;std::unique_ptr<Node> CreateNode(const std::string& node_name,const std::string& name_space) {bool is_reality_mode = GlobalData::Instance()->IsRealityMode();if (is_reality_mode && !OK()) {// add some hint logAERROR << "please initialize cyber firstly.";return nullptr;}return std::unique_ptr<Node>(new Node(node_name, name_space));
}

如上,在CreateNode函数中,直接返回了Node类型的对象,这里真正创建了Node对象。并且传入了node_name、name_space作为参数。下面进入到node.h文件中,关注节点的实际创建过程。

Node的构造函数

首先在Node的构造函数中,使用node_name创建了NodeChannelImpl和NodeServiceImpl对象。后面会分析二者的创建与执行过程。

Node::Node(const std::string& node_name, const std::string& name_space): node_name_(node_name), name_space_(name_space) {node_channel_impl_.reset(new NodeChannelImpl(node_name));node_service_impl_.reset(new NodeServiceImpl(node_name));
}

NodeChannelImpl的构造函数

此处只是做了简单的初始化工作。如果是真实模式的话,会启动node_manager。

  /*** @brief Construct a new Node Channel Impl object** @param node_name node name*/explicit NodeChannelImpl(const std::string& node_name): is_reality_mode_(true), node_name_(node_name) {node_attr_.set_host_name(common::GlobalData::Instance()->HostName());node_attr_.set_host_ip(common::GlobalData::Instance()->HostIp());node_attr_.set_process_id(common::GlobalData::Instance()->ProcessId());node_attr_.set_node_name(node_name);uint64_t node_id = common::GlobalData::RegisterNode(node_name);node_attr_.set_node_id(node_id);is_reality_mode_ = common::GlobalData::Instance()->IsRealityMode();if (is_reality_mode_) {node_manager_ =service_discovery::TopologyManager::Instance()->node_manager();node_manager_->Join(node_attr_, RoleType::ROLE_NODE);}}

NodeServiceImpl的构造函数

创建Reader

下面以teleop.cc文件为例,介绍如何创建reader及writer。同时带大家进入相关底层代码一探究竟。如下代码,分别调用了node_对象的两个接口CreateReader和CreateWriter创建reader和writer。

./modules/canbus/tools/teleop.cc:97:    node_ = CreateNode("teleop");chassis_reader_ = node_->CreateReader<Chassis>(FLAGS_chassis_topic, [this](const std::shared_ptr<Chassis> &chassis) {OnChassis(*chassis);});control_command_writer_ =node_->CreateWriter<ControlCommand>(FLAGS_control_command_topic);

在node.h文件中,CreateReader函数共有三个重载函数,意味着会根据创建时刻的传递类型,进行重载。如下为三个函数的实现,三者的区别为第一个参数分别为RoleAttributes、ReaderConfig、string。具体差别见代码中的注释。由此可知,这里主要做了配置参数的初始化。最终使用模板函数node_channel_impl_->template CreateReader()创建reader。

//使用RoleAttributes创建Reader。
//config: 包括channel name, qos
//reader_func: 当消息到达时的回调函数
template <typename MessageT>
auto Node::CreateReader(const proto::RoleAttributes& role_attr,const CallbackFunc<MessageT>& reader_func)-> std::shared_ptr<Reader<MessageT>> {std::lock_guard<std::mutex> lg(readers_mutex_);if (readers_.find(role_attr.channel_name()) != readers_.end()) {AWARN << "Failed to create reader: reader with the same channel already ""exists.";return nullptr;}auto reader = node_channel_impl_->template CreateReader<MessageT>(role_attr, reader_func);if (reader != nullptr) {readers_.emplace(std::make_pair(role_attr.channel_name(), reader));}return reader;
}//使用reader config创建Reader。
//config: 包括channel name, qos ,pending queue size
//reader_func: 当消息到达时的回调函数
template <typename MessageT>
auto Node::CreateReader(const ReaderConfig& config,const CallbackFunc<MessageT>& reader_func)-> std::shared_ptr<cyber::Reader<MessageT>> {std::lock_guard<std::mutex> lg(readers_mutex_);if (readers_.find(config.channel_name) != readers_.end()) {AWARN << "Failed to create reader: reader with the same channel already ""exists.";return nullptr;}auto reader =node_channel_impl_->template CreateReader<MessageT>(config, reader_func);if (reader != nullptr) {readers_.emplace(std::make_pair(config.channel_name, reader));}return reader;
}//使用channel name创建Reader。qos和其他配置使用默认。
//channel_name: reader订阅的channel
//reader_func: 当消息到达时的回调函数
template <typename MessageT>
auto Node::CreateReader(const std::string& channel_name,const CallbackFunc<MessageT>& reader_func)-> std::shared_ptr<Reader<MessageT>> {std::lock_guard<std::mutex> lg(readers_mutex_);if (readers_.find(channel_name) != readers_.end()) {AWARN << "Failed to create reader: reader with the same channel already ""exists.";return nullptr;}auto reader = node_channel_impl_->template CreateReader<MessageT>(channel_name, reader_func);if (reader != nullptr) {readers_.emplace(std::make_pair(channel_name, reader));}return reader;
}

对于上面三个接口,可用表格总结如下:

参数参数内容
channel_namechannel名字,采用默认qos、其他配置
ReaderConfigchannel名字、qos、pending queue size
RoleAttributeschannel名字、qos等

创建Writer、Service、Client

结合上面Reader的创建过程,Writer、Service、Client的创建类似。总的来说,会根据不同的参数类型,选择不同的重载函数,从而创建不同的对象。下面用表格方式进行全局展示,前文中各概念的关系。

文件名函数作用
cyber.hCreateNode(const std::string& node_name,const std::string& name_space)创建节点,返回Node类型对象_node
node.hCreateWriter(const proto::RoleAttributes& role_attr)根据RoleAttributes创建writer,_node调用时指定
node.hCreateWriter(const std::string& channel_name)根据channel_name创建writer,_node调用时指定
node.hCreateReader(const ReaderConfig& config, reader_func)根据ReaderConfig创建reader,_node调用时指定
node.hCreateReader(const std::string& channel_name, reader_func)根据channel_name创建reader,_node调用时指定
node.hCreateReader(const proto::RoleAttributes& role_attr, reader_func)根据RoleAttributes创建reader,_node调用时指定
node.hCreateService(const std::string& service_name, service_callback)根据string创建service,_node调用时指定
node.hCreateClient(const std::string& service_name,)根据string创建client,_node调用时指定
node_channel_impl.hCreateWriter(const proto::RoleAttributes& role_attr)根据RoleAttributes创建
node_channel_impl.hCreateWriter(const std::string& channel_name)根据channel_name创建
node_channel_impl.hCreateReader(const std::string& channel_name)根据channel_name创建
node_channel_impl.hCreateReader(const ReaderConfig& config)根据ReaderConfig创建
node_channel_impl.hCreateReader(const proto::RoleAttributes& role_attr)根据RoleAttributes创建
node_service_impl.hCreateService(const std::string& service_name)根据string创建
node_service_impl.hCreateClient(const std::string& service_name)根据string创建

Reader的实质创建

Reader类型的选择

在node_channel_impl.h中经过函数重载,最终的Reader的创建使用下面函数,参数有三个:

参数名含义
const proto::RoleAttributes& role_attr主要包括通道名、QOS规则之类的
const CallbackFunc<MessageT>& reader_func消息到达的回调执行函数
uint32_t pending_queue_size挂起队列大小

根据是否为实时模式,使用不同的Reader类创建对象,然后执行reader的Init函数。

template <typename MessageT>
auto NodeChannelImpl::CreateReader(const proto::RoleAttributes& role_attr,const CallbackFunc<MessageT>& reader_func,uint32_t pending_queue_size)-> std::shared_ptr<Reader<MessageT>> {if (!role_attr.has_channel_name() || role_attr.channel_name().empty()) {AERROR << "Can't create a reader with empty channel name!";return nullptr;}proto::RoleAttributes new_attr(role_attr);FillInAttr<MessageT>(&new_attr);std::shared_ptr<Reader<MessageT>> reader_ptr = nullptr;if (!is_reality_mode_) {reader_ptr =std::make_shared<blocker::IntraReader<MessageT>>(new_attr, reader_func);} else {reader_ptr = std::make_shared<Reader<MessageT>>(new_attr, reader_func,pending_queue_size);}RETURN_VAL_IF_NULL(reader_ptr, nullptr);RETURN_VAL_IF(!reader_ptr->Init(), nullptr);return reader_ptr;
}

Reader的Init()过程

在Reader的构造函数中,除了处理入参外,还对blocker_进行了初始化。对象构造完成后,会调用Init()函数进行初始化。下面在代码中进行注释说明初始化的过程。

template <typename MessageT>
bool Reader<MessageT>::Init() {if (init_.exchange(true)) {return true;}//此处根据reader_func创建lamba表达式(未命名的内联函数),其实就是消息真正执行者。std::function<void(const std::shared_ptr<MessageT>&)> func;if (reader_func_ != nullptr) {func = [this](const std::shared_ptr<MessageT>& msg) {this->Enqueue(msg);this->reader_func_(msg);};} else {func = [this](const std::shared_ptr<MessageT>& msg) { this->Enqueue(msg); };}//重点介绍:
//这里调用了单实例的sched,全局调度模块。使用节点名称和通道名称作为协程的ID。
//通过协程工厂,将前面的func函数和dv进行关联,并放入sched创建Task。auto sched = scheduler::Instance();croutine_name_ = role_attr_.node_name() + "_" + role_attr_.channel_name();auto dv = std::make_shared<data::DataVisitor<MessageT>>(role_attr_.channel_id(), pending_queue_size_);// Using factory to wrap templates.croutine::RoutineFactory factory =croutine::CreateRoutineFactory<MessageT>(std::move(func), dv);if (!sched->CreateTask(factory, )) {AERROR << "Create Task Failed!";init_.store(false);return false;}//创建当前Node的receiver,并且加入拓扑网络中,后面会介绍TopologyManager的具体作用,在Topo中如何进行发现与通信。receiver_ = ReceiverManager<MessageT>::Instance()->GetReceiver(role_attr_);this->role_attr_.set_id(receiver_->id().HashValue());channel_manager_ =service_discovery::TopologyManager::Instance()->channel_manager();JoinTheTopology();return true;
}

/未完待续/

这篇关于【Apollo自动驾驶-从理论到代码】cyber/node模块的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/189963

相关文章

Python的time模块一些常用功能(各种与时间相关的函数)

《Python的time模块一些常用功能(各种与时间相关的函数)》Python的time模块提供了各种与时间相关的函数,包括获取当前时间、处理时间间隔、执行时间测量等,:本文主要介绍Python的... 目录1. 获取当前时间2. 时间格式化3. 延时执行4. 时间戳运算5. 计算代码执行时间6. 转换为指

利用Python调试串口的示例代码

《利用Python调试串口的示例代码》在嵌入式开发、物联网设备调试过程中,串口通信是最基础的调试手段本文将带你用Python+ttkbootstrap打造一款高颜值、多功能的串口调试助手,需要的可以了... 目录概述:为什么需要专业的串口调试工具项目架构设计1.1 技术栈选型1.2 关键类说明1.3 线程模

Python Transformers库(NLP处理库)案例代码讲解

《PythonTransformers库(NLP处理库)案例代码讲解》本文介绍transformers库的全面讲解,包含基础知识、高级用法、案例代码及学习路径,内容经过组织,适合不同阶段的学习者,对... 目录一、基础知识1. Transformers 库简介2. 安装与环境配置3. 快速上手示例二、核心模

Python正则表达式语法及re模块中的常用函数详解

《Python正则表达式语法及re模块中的常用函数详解》这篇文章主要给大家介绍了关于Python正则表达式语法及re模块中常用函数的相关资料,正则表达式是一种强大的字符串处理工具,可以用于匹配、切分、... 目录概念、作用和步骤语法re模块中的常用函数总结 概念、作用和步骤概念: 本身也是一个字符串,其中

Python中的getopt模块用法小结

《Python中的getopt模块用法小结》getopt.getopt()函数是Python中用于解析命令行参数的标准库函数,该函数可以从命令行中提取选项和参数,并对它们进行处理,本文详细介绍了Pyt... 目录getopt模块介绍getopt.getopt函数的介绍getopt模块的常用用法getopt模

Java的栈与队列实现代码解析

《Java的栈与队列实现代码解析》栈是常见的线性数据结构,栈的特点是以先进后出的形式,后进先出,先进后出,分为栈底和栈顶,栈应用于内存的分配,表达式求值,存储临时的数据和方法的调用等,本文给大家介绍J... 目录栈的概念(Stack)栈的实现代码队列(Queue)模拟实现队列(双链表实现)循环队列(循环数组

IDEA自动生成注释模板的配置教程

《IDEA自动生成注释模板的配置教程》本文介绍了如何在IntelliJIDEA中配置类和方法的注释模板,包括自动生成项目名称、包名、日期和时间等内容,以及如何定制参数和返回值的注释格式,需要的朋友可以... 目录项目场景配置方法类注释模板定义类开头的注释步骤类注释效果方法注释模板定义方法开头的注释步骤方法注

使用Java将DOCX文档解析为Markdown文档的代码实现

《使用Java将DOCX文档解析为Markdown文档的代码实现》在现代文档处理中,Markdown(MD)因其简洁的语法和良好的可读性,逐渐成为开发者、技术写作者和内容创作者的首选格式,然而,许多文... 目录引言1. 工具和库介绍2. 安装依赖库3. 使用Apache POI解析DOCX文档4. 将解析

C++使用printf语句实现进制转换的示例代码

《C++使用printf语句实现进制转换的示例代码》在C语言中,printf函数可以直接实现部分进制转换功能,通过格式说明符(formatspecifier)快速输出不同进制的数值,下面给大家分享C+... 目录一、printf 原生支持的进制转换1. 十进制、八进制、十六进制转换2. 显示进制前缀3. 指

pytorch自动求梯度autograd的实现

《pytorch自动求梯度autograd的实现》autograd是一个自动微分引擎,它可以自动计算张量的梯度,本文主要介绍了pytorch自动求梯度autograd的实现,具有一定的参考价值,感兴趣... autograd是pytorch构建神经网络的核心。在 PyTorch 中,结合以下代码例子,当你