【toolschain algorithm cpp ros】cpp工厂模式实现--后续填充具体规划算法,控制器版的已填充了算法接入了仿真器

本文主要是介绍【toolschain algorithm cpp ros】cpp工厂模式实现--后续填充具体规划算法,控制器版的已填充了算法接入了仿真器,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

写在前面

现在局势危机,于是想复习一下之前写的设计模式,之前提到,做过一个闭环仿真器(借用ros),见https://blog.csdn.net/weixin_46479223/article/details/134864123我的控制器的建立遵循了工厂模式(多态、工厂、客户订阅)。 目前按照之前的设计,把规划器也改写成类似的模式。未来接入我的闭环仿真器械中。

本篇文章只设计框架的搭建,具体算法lattice搭建完毕填充以及其他算法为看时间缓慢的更新吧。

有错误和问题 还请大大们指点阿

基本结构

在这里插入图片描述
最外面是我的ros节点(目前刚建立没有接入ros以及控制器 用while先测试了

然后包一个planner的调度器(scheduler:planner.cpp)
传建一个基类然后动态多态的方式实现不同规划器的注册,把根据类型注册的规划器放入到一个哈希map,实现增删。(这里临时固定)。控制器和规划器的这个架构原来的设想是根据不同的场景可以有一个判断器自动实现合适的控制器和规划器的切换(也就是自动驾驶行泊一体啦)

对外接口是run和init和update,基本每行代码都有注释。

参数使用yaml管理

跑起来的样子

之前跑起来的并且接入了我的闭环无敌可进化仿真器的视频。我的git也放了一版。
这里不能贴视频。
仿真器想表现车辆追随一段轨迹,前面是轨迹(预瞄)。后面是我的车实不断更新的位置。(实现了闭环)
在这里插入图片描述
0 1 2 3 4 是假设的控制类型,这里先跑0.

部分重要代码

代码在git上

origin git@github.com:HerrQQ/MPotherSet.git (fetch)
origin git@github.com:HerrQQ/MPotherSet.git (push)
第一版如此
未来不断调整

工厂类

#ifndef _PlannerFactory_H_
#define _PlannerFactory_H_#include "planner_A.h"
#include "planner_B.h"
#include "planner_C.h"
#include "planner_D.h"/*** @brief PlannerFactory* @author kaifeng* @date 
*/
#include <memory>
namespace planner { 
class PlannerFactory//factory 
{
public :PlannerFactory()=default;~PlannerFactory()=default;/*** @brief creat planner* @param needed planner type*/std::shared_ptr<PlannerBase> fCreateplanner (const PlannerType& type){if (type == B) {return std::make_shared<planner_B>();}else if (type == A) {return std::make_shared<planner_A>();}else if (type == C) {return std::make_shared<planner_C>();}else if (type == D) {return std::make_shared<planner_D>();}else {return nullptr;}}};
}// class PlannerFactory_D :public PlannerFactory //factory son
// {
// public ://     PlannerFactory_D()=default;
//     virtual ~PlannerFactory_D() override
//     {
//         LOG(INFO)<<"D plannerBase created"<<std::endl;
//     }
//     virtual planner::plannerBase* fCreateplanner ()override
//     {
//         return new planner::planner_D();
//     }
// };// class PlannerFactory_A :public PlannerFactory //factory son
// {
// public ://     PlannerFactory_A()=default;
//     virtual ~PlannerFactory_A() override
//     {
//         LOG(INFO)<<"A plannerBase created"<<std::endl;
//     }
//     virtual planner::plannerBase* fCreateplanner ()override
//     {
//         return new planner::planner_A();
//     }
// };// class PlannerFactory_B :public PlannerFactory //factory son
// {
// public ://     PlannerFactory_B()=default;
//     virtual ~PlannerFactory_B() override
//     {
//         LOG(INFO)<<"B plannerBase created"<<std::endl;
//     }
//     virtual planner::plannerBase* fCreateplanner ()override
//     {
//         return new planner::planner_B();
//     }
// };// class PlannerFactory_B :public PlannerFactory //factory son
// {
// public ://     PlannerFactory_B()=default;
//     virtual ~PlannerFactory_B() override
//     {
//         LOG(INFO)<<"B plannerBase created"<<std::endl;
//     }
//     virtual planner::plannerBase* fCreateplanner ()override
//     {
//         return new planner::planner_B();
//     }
// };#endif

基类

#ifndef _PLANNER_H_
#define _PLANNER_H_
#include "structPlanner_t.h"
#include <Eigen/Dense>
#include <vector>
#include <map>
#include <unordered_map>
#include "glog/logging.h"
#include <yaml-cpp/yaml.h>/*** @brief Planner_base* @author kaifeng* @date 
*/namespace planner { /*** @brief base class for all planners.*/
class PlannerBase//client
{public:/*** @brief constructor*/PlannerBase() = default;/*** @brief destructor*/virtual ~PlannerBase() = default;/*** @brief initialize PlannerBase* @param config_path path of config file, yaml  * @return Status initialization status*/virtual uint8_t initialize(const std::string& config_path) = 0;/*** @brief compute planner command* @param PlannerDataFlow saving relativ infos of planning* @param locInfo reference of LocInfo instance* @param VehicleState reference of VehicleState instance* @return reference of Command instance, which is private member*/virtual void run( const Location& locInfo,const VehicleState& VehicleState,PlannerDataFlow& PlannerDataFlow) = 0;virtual void noRun(const Location& locInfo,const VehicleState& VehicleState) = 0;/*** @brief stop planner*/// virtual void stop();protected:double cmd_; //Command cmd_;//Debug debug_ptr_;
};}#endif

其中一个子class

#ifndef __A_planner_h__
#define __A_planner_h__#include "planner_base.h"
#include "glog/logging.h"
#include <vector>
#include <map>
#include <cmath>
#include <utility>/*** @brief A* @author kaifeng* @date 
*/
namespace planner
{class planner_A:public PlannerBase{ // product sonpublic:planner_A(){LOG(INFO)<<"A in progress"<<std::endl;}~planner_A(){LOG(INFO)<<"A stop"<<std::endl;}uint8_t initialize(const std::string& config_path)override;void run( const Location& locInfo,const VehicleState& VehicleState,PlannerDataFlow& PlannerDataFlow) override;void noRun(const Location& locInfo,const VehicleState& VehicleState) override;private:/*** @brief read configuration*/void readConfig(const std::string& path);private:// cost parametersstruct CostParameter {float Xxxx{0.f};float xXxx{0.f};float xxXx{0.f};float xxxX{0.f};};CostParameter* p_parameter_;// };}
#endif

调度

在这里插入图片描述

commen 内实现了几个filter 封装成了类

这篇关于【toolschain algorithm cpp ros】cpp工厂模式实现--后续填充具体规划算法,控制器版的已填充了算法接入了仿真器的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



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

相关文章

Springboot处理跨域的实现方式(附Demo)

《Springboot处理跨域的实现方式(附Demo)》:本文主要介绍Springboot处理跨域的实现方式(附Demo),具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不... 目录Springboot处理跨域的方式1. 基本知识2. @CrossOrigin3. 全局跨域设置4.

go中空接口的具体使用

《go中空接口的具体使用》空接口是一种特殊的接口类型,它不包含任何方法,本文主要介绍了go中空接口的具体使用,具有一定的参考价值,感兴趣的可以了解一下... 目录接口-空接口1. 什么是空接口?2. 如何使用空接口?第一,第二,第三,3. 空接口几个要注意的坑坑1:坑2:坑3:接口-空接口1. 什么是空接

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

基于SpringBoot实现文件秒传功能

《基于SpringBoot实现文件秒传功能》在开发Web应用时,文件上传是一个常见需求,然而,当用户需要上传大文件或相同文件多次时,会造成带宽浪费和服务器存储冗余,此时可以使用文件秒传技术通过识别重复... 目录前言文件秒传原理代码实现1. 创建项目基础结构2. 创建上传存储代码3. 创建Result类4.

SpringBoot日志配置SLF4J和Logback的方法实现

《SpringBoot日志配置SLF4J和Logback的方法实现》日志记录是不可或缺的一部分,本文主要介绍了SpringBoot日志配置SLF4J和Logback的方法实现,文中通过示例代码介绍的非... 目录一、前言二、案例一:初识日志三、案例二:使用Lombok输出日志四、案例三:配置Logback一

Python如何使用__slots__实现节省内存和性能优化

《Python如何使用__slots__实现节省内存和性能优化》你有想过,一个小小的__slots__能让你的Python类内存消耗直接减半吗,没错,今天咱们要聊的就是这个让人眼前一亮的技巧,感兴趣的... 目录背景:内存吃得满满的类__slots__:你的内存管理小助手举个大概的例子:看看效果如何?1.

Python+PyQt5实现多屏幕协同播放功能

《Python+PyQt5实现多屏幕协同播放功能》在现代会议展示、数字广告、展览展示等场景中,多屏幕协同播放已成为刚需,下面我们就来看看如何利用Python和PyQt5开发一套功能强大的跨屏播控系统吧... 目录一、项目概述:突破传统播放限制二、核心技术解析2.1 多屏管理机制2.2 播放引擎设计2.3 专

Python实现无痛修改第三方库源码的方法详解

《Python实现无痛修改第三方库源码的方法详解》很多时候,我们下载的第三方库是不会有需求不满足的情况,但也有极少的情况,第三方库没有兼顾到需求,本文将介绍几个修改源码的操作,大家可以根据需求进行选择... 目录需求不符合模拟示例 1. 修改源文件2. 继承修改3. 猴子补丁4. 追踪局部变量需求不符合很

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

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

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

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