当前位置：首页 > news >正文

ROS应用之SwarmSim在ROS 中的协同路径规划

news 来源：原创 2025/5/16 14:45:35

SwarmSim 在 ROS 中的协同路径规划

前言

在多机器人系统（Multi-Robot Systems, MRS）中，SwarmSim 是一个常用的模拟工具，可以对多机器人进行仿真以实现复杂任务的协同。除了任务分配逻辑以外，SwarmSim 在协同路径规划方面也具有重要意义。协同路径规划是指多机器人在同一环境中找到彼此不发生冲突的最优路径，以完成各自的目标任务。本文将从理论到实现详细解析 SwarmSim 在协同路径规划中的应用。

原理介绍

1. 基本概念

协同路径规划的核心在于 避免冲突 和 优化路径：

避免冲突：确保机器人不会因路径交叉而发生碰撞。
优化路径：基于最短路径、最小时间消耗或其他优化目标，找到机器人从起点到终点的最佳路线。

在 SwarmSim 中，协同路径规划常基于以下模型：

A* 算法：单机器人路径规划的基础。
CBS 算法（Conflict-Based Search）：解决多机器人冲突的扩展。
时间-空间网络模型：将机器人路径规划扩展到时间维度。

2. 整体流程

SwarmSim 的协同路径规划包括以下步骤：

环境建模：
- 将机器人运行的空间划分为栅格地图。
- 地图中每个单元格表示一个可能的机器人位置。
单机器人路径规划：
- 每个机器人独立计算从起点到终点的最优路径（例如通过 A* 算法）。
冲突检测：
- 检测多个机器人路径是否存在冲突（例如同时占用同一单元格）。
冲突解决：
- 若存在冲突，通过 CBS 算法为冲突机器人重新规划路径。
路径优化：
- 综合考虑路径长度和时间约束，优化整体路径。

3. 关键特点

分布式与集中式协作：
- SwarmSim 支持分布式路径规划（机器人独立决策）和集中式路径规划（统一决策）。
动态环境适应性：
- 在动态环境中，机器人能够根据新出现的障碍物或动态任务重新规划路径。
可扩展性：
- SwarmSim 能够模拟多达数百个机器人的协同路径规划任务。

4. 算法流程

以下为 CBS 算法的基本步骤：

初始化：
- 每个机器人独立生成一条无冲突路径。
冲突检测：
- 遍历所有机器人路径，记录冲突信息（如时间、位置）。
冲突分解：
- 根据冲突信息创建约束，限制机器人使用冲突位置。
- 重新生成冲突机器人的路径。
路径优化：
- 综合路径总长度和其他优化目标，生成最终的路径规划结果。

公式描述如下：

路径总代价：

其中，N 为机器人总数，Cost(Pi) 表示第 i 个机器人的路径代价。
冲突检测函数：

部署环境介绍

操作系统：Ubuntu 20.04
ROS 版本：ROS 2 Humble
依赖工具：
- SwarmSim
- RViz（用于可视化）
- Python 或 C++（用于算法实现）

部署流程

安装 SwarmSim：

git clone https://github.com/swarm-sim/swarm-sim.git
cd swarm-sim
colcon build
source install/setup.bash

准备地图文件：

使用 YAML 格式定义环境地图：

resolution: 0.05
origin: [0.0, 0.0, 0.0]
occupancy_grid: map.pgm

启动仿真环境：

ros2 launch swarm_sim launch_simulation.launch.py

启动协同路径规划节点：
- 运行示例代码，完成机器人路径规划。

代码示例

以下为 CBS 算法的简化实现：

import heapq

class CBSPlanner:def __init__(self, robots, environment):self.robots = robotsself.environment = environmentself.open_list = []
def plan_paths(self):# Step 1: Initialize pathspaths = {robot: self.plan_individual_path(robot) for robot in self.robots}heapq.heappush(self.open_list, (self.calculate_cost(paths), paths, []))return self.resolve_conflicts()
def plan_individual_path(self, robot):# Basic A* implementation# Returns path for a single robotpass
def calculate_cost(self, paths):return sum(len(path) for path in paths.values())
def resolve_conflicts(self):while self.open_list:cost, paths, constraints = heapq.heappop(self.open_list)conflicts = self.detect_conflicts(paths)if not conflicts:return pathsfor conflict in conflicts:new_constraints = constraints + [self.create_constraint(conflict)]new_paths = self.replan_with_constraints(new_constraints)heapq.heappush(self.open_list, (self.calculate_cost(new_paths), new_paths, new_constraints))
def detect_conflicts(self, paths):# Detect conflicts in the pathspass
def create_constraint(self, conflict):# Create new constraints based on conflictpass
def replan_with_constraints(self, constraints):# Replan paths with updated constraintspass

代码解读

1. 初始化路径规划

函数
```
plan_individual_path
```
- 调用单机器人路径规划算法（如 A*）计算初始路径。
- 输出为机器人从起点到终点的路径。

2. 冲突检测

函数
```
detect_conflicts
```
- 遍历所有路径，检测是否存在同时访问同一单元格的情况。

3. 冲突分解

函数
```
create_constraint
```
- 根据冲突生成约束，例如禁止机器人在特定时间访问某单元格。

4. 路径优化

函数
```
calculate_cost
```
- 计算当前路径的总代价，用于比较不同路径规划结果的优劣。

运行效果说明

1. 实验环境设置

地图设置：10x10 栅格地图，障碍物随机分布，部分区域设置为高代价区域。
机器人数量：3 台机器人，分别从不同的起点（如 (1,1),(3,5),(8,8)）出发，到达各自目标点（如 (9,9),(1,8),(5,3)）。
初始路径规划：每台机器人独立运行 A* 算法生成路径，不考虑冲突。
规划目标：消除冲突，最小化路径总长度，同时保持实时性。

2. 实验步骤记录

运行初始路径规划节点：

点击三木地带你手搓ROS应用之SwarmSim在ROS 中的协同路径规划查看全文。

ROS应用之SwarmSim在ROS 中的协同路径规划

SwarmSim 在 ROS 中的协同路径规划前言在多机器人系统（Multi-Robot Systems, MRS）中，SwarmSim 是一个常用的模拟工具，可以对多机器人进行仿真以实现复杂任务的协同。除了任务分配逻辑以外，SwarmSim 在协同路径规划方…...

编程日记 2025/5/16 14:45:35

Shell特殊位置变量以及常用内置变量总结

目录 1. 特殊的状态变量 1.1 $?（上一个命令的退出状态） 1.2 $$（当前进程的 PID） 1.3 $!（后台进程的 PID） 1.4 $_（上一条命令的最后一个参数） 2.常用shell内置变量 2.1 echo&…...

编程日记 2025/5/16 14:18:14

【ollama通过命令行启动后如何在网页端查看运行】

ollama通过命令行启动后如何在网页端查看运行 http://localhost:11434/...

编程日记 2025/5/7 0:13:23

【MySQL】初始MySQL、库与表的操作

目录基本使用使用案例 SQL分类存储引擎库的操作字符集和校验规则查看系统默认字符集和校验规则查看数据库支持的字符集查看数据库支持的字符集校验规则指定编码常见数据库校验规则对数据库的影响操纵数据库库的备份与恢复表的操作创建表查看表 …...

编程日记 2025/5/16 9:37:32

信息学奥赛一本通 1342：【例4-1】最短路径问题

【题目描述】平面上有n个点（n<100），每个点的坐标均在-10000~10000之间。其中的一些点之间有连线。若有连线，则表示可从一个点到达另一个点，即两点间有通路，通路的距离为两点间的直线距离。现在的任务是…...

编程日记 2025/5/16 2:24:23

芯片AI深度实战：基础篇之langchain

基于ollama, langchain,可以构建一个自己的知识库，比如这个 Build Your Own RAG App: A Step-by-Step Guide to Setup LLM locally using Ollama, Python, and ChromaDB | HackerNoon 这是因为： 以上范例就实现了这样一个流程： 系列文章&…...

编程日记 2025/5/16 13:46:35

Autogen_core 测试代码：test_cache_store.py

目录原始代码测试代码代码中用到的typing注解原始代码 from typing import Dict, Generic, Optional, Protocol, TypeVarT TypeVar("T")class CacheStore(Protocol, Generic[T]):"""This protocol defines the basic interface for store/cache o…...

编程日记 2025/5/16 2:18:02

AI大模型开发原理篇-1：语言模型雏形之N-Gram模型

N-Gram模型概念 N-Gram模型是一种基于统计的语言模型，用于预测文本中某个词语的出现概率。它通过分析一个词语序列中前面N-1个词的出现频率来预测下一个词的出现。具体来说，N-Gram模型通过将文本切分为长度为N的词序列来进行建模。注意：这…...

编程日记 2025/5/14 21:07:07

Haproxy入门学习二

一、Haproxy的算法 1.haproxy通过固定参数balance指明对后端服务器的调度算法，其中balance参数可以配置在listen或backend选项中 2.haproxy的调度算法分为静态和动态调度算法，其中有些算法可以根据参数在静态和动态算法中相互转换 3.静态算法&#xff1a…...

编程日记 2025/5/11 9:55:07

【C++题解】1014. 编程求1+1/2+1/3+...+1/n

问题：1014. 编程求11/21/3…1/n 类型：简单循环题目描述： 编程求 11/21/3⋯1/n 。输入： 输入一行，只有一个整数 n(1≤n≤200) 。输出： 输出只有一行（这意味着末尾有一个回车符号&#x…...

编程日记 2025/5/14 8:19:20

Java基础知识-第14章-Java注解

1、注解(Annotation)概述从JDK5.0开始，Java增加了对元数据(MetaData) 的支持，也就是Annotation(注解)Annotation其实就是代码里的特殊标记，这些标记可以在编译，类加载，运行时被读取，并执行相应的处理。通…...

编程日记 2025/5/16 14:06:50

python算法和数据结构刷题[1]：数组、矩阵、字符串

一画图二伪代码三写代码 LeetCode必刷100题：一份来自面试官的算法地图（题解持续更新中）-CSDN博客算法通关手册（LeetCode） | 算法通关手册（LeetCode） (itcharge.cn) 面试经典 150 题 - 学习计…...

编程日记 2025/5/16 14:09:42

【javaweb项目idea版】蛋糕商城（可复用成其他商城项目）

该项目虽然是蛋糕商城项目，但是可以复用成其他商城项目或者购物车项目想要源码的uu可点赞后私聊技术栈主要为：javawebservletmvcc3p0idea运行功能模块主要分为用户模块和后台管理员模块具有商城购物的完整功能基础模块登录注册个人信息编辑…...

编程日记 2025/5/16 10:50:03

人格分裂(交互问答)-小白想懂Elasticsearch

通过交互式追问了解一个中间件 ? 啥是Elasticsearch ! 分布式搜索和分析引擎 ? 为啥是分布式搜索，单体难道用不了吗 ? 实际上是说这个东西可以分布式部署 ! 单机可用但扩展性差，分布式通过分片、副本和负载均衡实现海量数据存储与高并发处理 ? 提…...

编程日记 2025/5/14 10:57:06

独立开发者日刊 | Deepseek 统一多模态 AI Janus 开源 |语音秒变文章 | 免费 AI 视频答案引擎

独立开发者产品日刊，每日汇集 ProductHunt 热榜产品介绍，⚡️ 1句Slogan榨干产品灵魂，⚡️ 3秒 get 全球独立开发者的爆款灵感。关注小前，每日捕获全球产品灵感。 Jotform for Canva 标语：为 Canva 创建强大表单类别&a…...

编程日记 2025/5/16 8:04:42

1999-2020年全国各地区-财政状况分析-一般预算收入-各项税收-个人所得税

1999-2020年全国各地区-财政状况分析-一般预算收入-各项税收-个人所得税https://download.csdn.net/download/2401_84585615/89575946 https://download.csdn.net/download/2401_84585615/89575946 一般预算收入是指各级政府按照预算法规定，将预计取得的各项收入纳…...

编程日记 2025/5/11 0:39:24

基础项目实战——3D赛车（c++）

目录前言一、渲染引擎二、关闭事件三、梯形绘制四、轨道绘制五、边缘绘制六、草坪绘制七、前后移动八、左右移动九、曲线轨道十、课山坡轨道十一、循环轨道十二、背景展示十三、引入速度十四、物品绘制十五、课数字路障十六、分数展示十七、重新生成十八、…...

编程日记 2025/5/12 23:08:13

AboutDialog组件的功能和用法

文章目录 1 概念介绍2 使用方法3 示例代码我们在上一章回中介绍了AlertDialog Widget相关的内容,本章回中将介绍AboutDialog Widget.闲话休提，让我们一起Talk Flutter吧。 1 概念介绍我们在这里说的AboutDialog是一种弹出式窗口，和上一章回中介绍的Al…...

编程日记 2025/5/16 5:10:26

hdfs之读写流程

写入流程： 客户端Client想将文件a.txt上传至hdfs，首先向Namenode发送请求进行权限校验，Namenode通过后会计算出来三个节点，并将这三个节点告知客户端，客户端将输入进行切割成块，一个一个的块进行传输&…...

编程日记 2025/5/16 13:46:34

链表的介绍

目录引言优缺点与链表相似的数据结构注意事项单向链表的实现基础实现创建类创建成员变量创建特殊方法增加数据push_back方法insert方法删除数据del_back方法del_index方法 clear方法查询数据at方法与重载的中括号运算符toArray方法indexOf方法修改数据获取链表大小测试方法…...

编程日记 2025/5/15 22:47:19

背着开发板回家过年~

大家好，我是bug菌~ 小明，过年了， 别再死磕什么STM32底层驱动、linux平台总线驱动框架、嵌入式实时操作系统源码这些了。你背着电脑和开发板回家，压根没一点实际用处。发小们潇洒地出入各种娱乐场所，唱着歌&#xff0…...

编程日记 2025/5/16 13:27:18

Kafka 日志存储 — 磁盘存储

Kafka 依赖与磁盘来存储和缓存消息，采用文件追加的方式来写入消息。顺序写盘的速度快于随机写内存。 1 磁盘存储除顺序写入外，Kafka中大量使用了页缓存、零拷贝等技术来进一步提升吞吐性能。 1.1 页缓存页缓存是操作系统实现的一种磁盘缓存&#x…...

编程日记 2025/5/13 21:20:36

【机器学习】自定义数据集使用tensorflow框架实现逻辑回归并保存模型，然后保存模型后再加载模型进行预测

一、使用tensorflow框架实现逻辑回归 1. 数据部分： 首先自定义了一个简单的数据集，特征 X 是 100 个随机样本，每个样本一个特征，目标值 y 基于线性关系并添加了噪声。tensorflow框架不需要numpy 数组转换为相应的张量&#xff0…...

编程日记 2025/5/16 8:50:25

RK3568中使用QT opencv（显示基础图像）

文章目录一、查看对应的开发环境是否有opencv的库二、QT使用opencv 一、查看对应的开发环境是否有opencv的库在开发板中的/usr/lib目录下查看是否有opencv的库： 这里使用的是正点原子的ubuntu虚拟机，在他的虚拟机里面已经安装好了opencv的库。二、…...

编程日记 2025/5/13 11:08:10

Brave132 编译指南 Windows 篇：获取源码（六）

1. 引言在 Brave 浏览器 132 版本的编译过程中，获取源代码是至关重要的第一步。源代码包含了 Brave 浏览器的所有核心功能、特性和组件的实现细节，是深入理解、定制和优化 Brave 的基础。通过获取和管理源代码，开发者能够深入探索 Brave 的…...

编程日记 2025/5/15 17:50:30

解决 pip install 出现 error: subprocess-exited-with-error 错误的方法

解决 pip install 出现 error: subprocess-exited-with-error 错误的方法_pip安装报错 subprocess-CSDN博客文章浏览阅读10w次，点赞62次，收藏86次。通过上述步骤，我们成功解决了 pip install 时出现的 error: subprocess-exited-with-error 错…...

编程日记 2025/5/8 4:31:38

网络安全攻防实战：从基础防护到高级对抗

📝个人主页🌹：一ge科研小菜鸡-CSDN博客 🌹🌹期待您的关注 🌹🌹 引言在信息化时代，网络安全已经成为企业、政府和个人必须重视的问题。从数据泄露到勒索软件攻击，每一次…...

编程日记 2025/5/15 11:46:23

DeepSeek大模型技术解析：从架构到应用的全面探索

一、引言在人工智能领域，大模型的发展日新月异，其中DeepSeek大模型凭借其卓越的性能和广泛的应用场景，迅速成为业界的焦点。本文旨在深入剖析DeepSeek大模型的技术细节，从架构到应用进行全面探索，以期为读者提供一个…...

编程日记 2025/5/15 18:56:43

Deepseek的api调用报错乱码问题

最近的deepseek也是很火，但是在调用api的过程中也会出现一些大大小小的问题，所以这里也给出一种问题和他的解决方案，报错的类型如下图所示 API Streaming Failed Command failed with exit code 1: powershell (Get-CimInstance -ClassName W…...

编程日记 2025/5/16 14:02:05

.NET Core 中依赖注入的使用

ASP.NET Core中服务注入的地方在ASP.NET Core项目中一般不需要自己创建ServiceCollection、IServiceProvider。在Program.cs的builder.Build()之前向builder.Services中注入。在Controller中可以通过构造方法注入服务。低使用频率的服务把Action用到的服务通过Action的参…...

编程日记 2025/5/12 9:31:19

Mysql Resultset 解析记录

Mysql Resultset 解析记录结果集消息头字段定义结果数据完整spicy文件结果集消息头消息头由消息体长度消息序列号消息体组成；消息头长度为3字节，消息序列号长度为1字节。结果集的消息头消息体内容为结果集的列数。结果集消息头的spicy1格式如下&a…...

编程日记 2025/5/16 5:12:07

ThinkPhp伪静态设置后，访问静态资源也提示找不到Controller

ThinkPhp没有配置伪静态时，除了默认的IndexController能访问，其他路由Controller都访问不到，提示404错误。配置了伪静态后就解决了这个问题。但是当我的ThinkPhp后台项目中有静态资源放在public目录（或子目录）中需要…...

编程日记 2025/5/13 1:31:42

【回溯+剪枝】找出所有子集的异或总和再求和全排列Ⅱ

文章目录 1863. 找出所有子集的异或总和再求和解题思路：子集问题解法（回溯剪枝）47. 全排列 II解题思路：排序回溯剪枝 1863. 找出所有子集的异或总和再求和 1863. 找出所有子集的异或总和再求和一个数组的异或总和定义为…...

编程日记 2025/5/16 14:23:00

单细胞-第五节多样本数据分析,打分R包AUCell

文件在单细胞\5_GC_py\1_single_cell\3.AUCell.Rmd 1.基因 rm(list = ls()) load("g.Rdata")2.AUCell https://www.ncbi.nlm.nih.gov/pmc/articles/PMC9897923 IF: NA NA NA用这个文章里的方法，将单细胞亚群的marker基因与ros相关基因取交集，用作AUCell的基因集…...

编程日记 2025/5/16 13:39:48

锁升级过程与优化操作

前文我们学习了CAS自旋锁知道CAS对应的就是一条指令操作，属于一种轻量级锁，那么有轻必有重，从无锁到轻量级锁到重量级锁是一个升级过程，此文我们对锁升级的过程以及一些优化锁的操作一探究竟。 1. 锁升级从前文《程序员不可能不…...

编程日记 2025/5/13 2:33:19

android主题设置为..DarkActionBar.Bridge时自定义DatePicker选中日期颜色

安卓自定义DatePicker选中日期颜色背景：解决方案：方案一：方案二：实践效果： 背景： 最近在尝试用原生安卓实现仿element-ui表单校验功能，其中的的选择日期涉及到安卓DatePicker组件的使用&#…...

编程日记 2025/5/16 9:37:02

Kafka常见问题之 `javax.management.InstanceAlreadyExistsException`

文章目录 Kafka常见问题之 javax.management.InstanceAlreadyExistsException1. 概述2. 常见原因3. 具体异常示例4. 解决方案4.1 确保单一 Kafka Producer 实例4.2 配置 Kafka Broker 和 Producer 使用唯一的 JMX 名称（对于Producer重点检查 client.id）4…...

编程日记 2025/5/14 21:11:36

数据分析系列--③RapidMiner算子说明及数据预处理

一、算子说明 1.新建过程 2.算子状态灯状态灯说明: (1)状态指示灯： 红色:指示灯说明有参数未被设置或输入端口未被连接等问题; 黄色:指示灯说明还未执行算子，不管配置是否基本齐全; 绿色:指示灯说明一切正常，已成功执行算子。 (2)三角…...

编程日记 2025/5/14 3:30:20

Gradle配置指南：深入解析settings.gradle.kts（Kotlin DSL版）

文章目录 Gradle配置指南：深入解析settings.gradle.kts（Kotlin DSL版）settings.gradle.kts 基础配置选项单项目配置多项目配置高级配置选项插件管理（Plugin Management）基础配置模板案例：Android项目标准配…...

编程日记 2025/5/11 2:00:23

专为课堂打造：宏碁推出三款全新耐用型 Chromebook

IT之家 1 月 25 日消息，宏碁（Acer）昨日（1 月 24 日）发布公告，针对教育市场，推出 Chromebook Spin 512 (R857T)、Chromebook Spin 511 (R757T) 和 Chromebook 511 (C737) 三款产品，兼…...

编程日记 2025/5/9 7:46:21

电商系统-用户认证（三）基于公钥解析JWT令牌

一、基于私钥生成jwt令牌步骤： 导入认证服务将shangcheng_user_auth工程导入到项目中去，如下图启动eureka，再启动认证服务 3） 认证服务中创建测试类 public class CreateJwtTest { /**** 创建令牌测试*/Testpublic voi…...

编程日记 2025/5/16 1:15:50

验证回文串

hello 大家好！今天开写一个新章节，每一天一道算法题。让我们一起来学习算法思维吧！ function isPalindrome(s) {// 第一步：将字符串中的所有大写字符转换为小写字符s s.toLowerCase();// 第二步：使用正则表达式移除所…...

编程日记 2025/5/12 13:28:39

Java定时任务实现方案(四)——Spring Task

Spring Task 这篇笔记，我们要来介绍实现Java定时任务的第四个方案，使用Spring Task，以及该方案的优点和缺点。 Spring Task是Spring框架提供的一个轻量级任务调度框架，用于简化任务调度的开放，通过注解或XML配置的…...

编程日记 2025/5/14 18:54:28

Python 数据分析 - Matplotlib 绘图

Python 数据分析 - Matplotlib 绘图简介绘图折线图单线多线子图散点图直方图条形图纵置横置多条饼图简介 Matplotlib 是 Python 提供的一个绘图库，通过该库我们可以很容易的绘制出折线图、直方图、散点图、饼图等丰富的统计图，安装使用 pip install…...

编程日记 2025/5/16 14:11:12

深入探讨数据库索引类型：B-tree、Hash、GIN与GiST的对比与应用

title: 深入探讨数据库索引类型：B-tree、Hash、GIN与GiST的对比与应用 date: 2025/1/26 updated: 2025/1/26 author: cmdragon excerpt: 在现代数据库管理系统中，索引技术是提高查询性能的重要手段。当数据量不断增长时，如何快速、有效地访问这些数据成为了数据库设计的核…...

编程日记 2025/5/14 4:35:17

【Redis】hash 类型的介绍和常用命令

1. 介绍 Redis 中存储的 key-value 本身就是哈希表的结构，存储的 value 也可以是一个哈希表的结构这里每一个 key 对应的一个哈希类型用 field-value 来表示 2. 常用命令命令介绍时间复杂度 hset key field value 用于设置哈希表 key 中字段 field 的值为…...

编程日记 2025/5/14 21:23:58