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

2023-12-23 17:04
文章标签 算法 规划 实现 模式 控制器 填充 ros 接入 具体 工厂 仿真器 algorithm 后续 cpp toolschain

本文主要是介绍【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。

相关文章

golang版本升级如何实现

golang版本升级如何实现

《golang版本升级如何实现》：本文主要介绍golang版本升级如何实现问题,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录golanwww.chinasem.cng版本升级linux上golang版本升级删除golang旧版本安装golang最新版本总结gola
阅读更多...
SpringBoot中SM2公钥加密、私钥解密的实现示例详解

SpringBoot中SM2公钥加密、私钥解密的实现示例详解

《SpringBoot中SM2公钥加密、私钥解密的实现示例详解》本文介绍了如何在SpringBoot项目中实现SM2公钥加密和私钥解密的功能,通过使用Hutool库和BouncyCastle依赖,简化... 目录一、前言1、加密信息(示例)2、加密结果(示例)二、实现代码1、yml文件配置2、创建SM2工具
阅读更多...
Mysql实现范围分区表(新增、删除、重组、查看)

Mysql实现范围分区表(新增、删除、重组、查看)

《Mysql实现范围分区表(新增、删除、重组、查看)》MySQL分区表的四种类型（范围、哈希、列表、键值）,主要介绍了范围分区的创建、查询、添加、删除及重组织操作,具有一定的参考价值,感兴趣的可以了解... 目录一、mysql分区表分类二、范围分区（Range Partitioning1、新建分区表：2、分
阅读更多...
MySQL 定时新增分区的实现示例

MySQL 定时新增分区的实现示例

《MySQL定时新增分区的实现示例》本文主要介绍了通过存储过程和定时任务实现MySQL分区的自动创建,解决大数据量下手动维护的繁琐问题,具有一定的参考价值,感兴趣的可以了解一下... mysql创建好分区之后，有时候会需要自动创建分区。比如，一些表数据量非常大，有些数据是热点数据，按照日期分区MululbU
阅读更多...
MySQL中查找重复值的实现

MySQL中查找重复值的实现

《MySQL中查找重复值的实现》查找重复值是一项常见需求,比如在数据清理、数据分析、数据质量检查等场景下,我们常常需要找出表中某列或多列的重复值,具有一定的参考价值,感兴趣的可以了解一下... 目录技术背景实现步骤方法一：使用GROUP BY和HAVING子句方法二：仅返回重复值方法三：返回完整记录方法四：
阅读更多...
IDEA中新建/切换Git分支的实现步骤

IDEA中新建/切换Git分支的实现步骤

《IDEA中新建/切换Git分支的实现步骤》本文主要介绍了IDEA中新建/切换Git分支的实现步骤,通过菜单创建新分支并选择是否切换,创建后在Git详情或右键Checkout中切换分支,感兴趣的可以了... 前提：项目已被Git托管1、点击上方栏Git->NewBrancjsh...2、输入新的分支的
阅读更多...
Python实现对阿里云OSS对象存储的操作详解

Python实现对阿里云OSS对象存储的操作详解

《Python实现对阿里云OSS对象存储的操作详解》这篇文章主要为大家详细介绍了Python实现对阿里云OSS对象存储的操作相关知识,包括连接,上传,下载,列举等功能,感兴趣的小伙伴可以了解下... 目录一、直接使用代码二、详细使用1. 环境准备2. 初始化配置3. bucket配置创建4. 文件上传到os
阅读更多...
Java设计模式---迭代器模式(Iterator)解读

Java设计模式---迭代器模式(Iterator)解读

《Java设计模式---迭代器模式(Iterator)解读》：本文主要介绍Java设计模式---迭代器模式(Iterator),具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,... 目录1、迭代器（Iterator）1.1、结构1.2、常用方法1.3、本质1、解耦集合与遍历逻辑2、统一
阅读更多...
Java 线程安全与 volatile与单例模式问题及解决方案

Java 线程安全与 volatile与单例模式问题及解决方案

《Java线程安全与volatile与单例模式问题及解决方案》文章主要讲解线程安全问题的五个成因（调度随机、变量修改、非原子操作、内存可见性、指令重排序）及解决方案,强调使用volatile关键字... 目录什么是线程安全线程安全问题的产生与解决方案线程的调度是随机的多个线程对同一个变量进行修改线程的修改操
阅读更多...
关于集合与数组转换实现方法

关于集合与数组转换实现方法

《关于集合与数组转换实现方法》：本文主要介绍关于集合与数组转换实现方法,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录1、Arrays.asList()1.1、方法作用1.2、内部实现1.3、修改元素的影响1.4、注意事项2、list.toArray()2.1、方
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2