【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

相关文章

微信公众号脚本-获取热搜自动新建草稿并发布文章

《微信公众号脚本-获取热搜自动新建草稿并发布文章》本来想写一个自动化发布微信公众号的小绿书的脚本,但是微信公众号官网没有小绿书的接口,那就写一个获取热搜微信普通文章的脚本吧,:本文主要介绍微信公众... 目录介绍思路前期准备环境要求获取接口token获取热搜获取热搜数据下载热搜图片给图片加上标题文字上传图片

springboot循环依赖问题案例代码及解决办法

《springboot循环依赖问题案例代码及解决办法》在SpringBoot中,如果两个或多个Bean之间存在循环依赖(即BeanA依赖BeanB,而BeanB又依赖BeanA),会导致Spring的... 目录1. 什么是循环依赖?2. 循环依赖的场景案例3. 解决循环依赖的常见方法方法 1:使用 @La

使用C#代码在PDF文档中添加、删除和替换图片

《使用C#代码在PDF文档中添加、删除和替换图片》在当今数字化文档处理场景中,动态操作PDF文档中的图像已成为企业级应用开发的核心需求之一,本文将介绍如何在.NET平台使用C#代码在PDF文档中添加、... 目录引言用C#添加图片到PDF文档用C#删除PDF文档中的图片用C#替换PDF文档中的图片引言在当

C#使用SQLite进行大数据量高效处理的代码示例

《C#使用SQLite进行大数据量高效处理的代码示例》在软件开发中,高效处理大数据量是一个常见且具有挑战性的任务,SQLite因其零配置、嵌入式、跨平台的特性,成为许多开发者的首选数据库,本文将深入探... 目录前言准备工作数据实体核心技术批量插入:从乌龟到猎豹的蜕变分页查询:加载百万数据异步处理:拒绝界面

用js控制视频播放进度基本示例代码

《用js控制视频播放进度基本示例代码》写前端的时候,很多的时候是需要支持要网页视频播放的功能,下面这篇文章主要给大家介绍了关于用js控制视频播放进度的相关资料,文中通过代码介绍的非常详细,需要的朋友可... 目录前言html部分:JavaScript部分:注意:总结前言在javascript中控制视频播放

Spring Boot 3.4.3 基于 Spring WebFlux 实现 SSE 功能(代码示例)

《SpringBoot3.4.3基于SpringWebFlux实现SSE功能(代码示例)》SpringBoot3.4.3结合SpringWebFlux实现SSE功能,为实时数据推送提供... 目录1. SSE 简介1.1 什么是 SSE?1.2 SSE 的优点1.3 适用场景2. Spring WebFlu

java之Objects.nonNull用法代码解读

《java之Objects.nonNull用法代码解读》:本文主要介绍java之Objects.nonNull用法代码,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录Java之Objects.nonwww.chinasem.cnNull用法代码Objects.nonN

SpringBoot中封装Cors自动配置方式

《SpringBoot中封装Cors自动配置方式》:本文主要介绍SpringBoot中封装Cors自动配置方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录SpringBoot封装Cors自动配置背景实现步骤1. 创建 GlobalCorsProperties

idea中创建新类时自动添加注释的实现

《idea中创建新类时自动添加注释的实现》在每次使用idea创建一个新类时,过了一段时间发现看不懂这个类是用来干嘛的,为了解决这个问题,我们可以设置在创建一个新类时自动添加注释,帮助我们理解这个类的用... 目录前言:详细操作:步骤一:点击上方的 文件(File),点击&nbmyHIgsp;设置(Setti

SpringBoot实现MD5加盐算法的示例代码

《SpringBoot实现MD5加盐算法的示例代码》加盐算法是一种用于增强密码安全性的技术,本文主要介绍了SpringBoot实现MD5加盐算法的示例代码,文中通过示例代码介绍的非常详细,对大家的学习... 目录一、什么是加盐算法二、如何实现加盐算法2.1 加盐算法代码实现2.2 注册页面中进行密码加盐2.