AI - 碰撞避免算法分析(VO/RVO)

news2024/11/24 5:44:06

VO/RVO

VO和RVO的原理本身理解起来比较简单的,就是根据两个圆形的相对半径,相对速度,相对位置,求出碰撞区域,然后将速度移出碰撞区域。VO是双方都是当作对方速度不变的情况下,各自都将速度完整的移出了会碰撞的速度域,因此会抖动,RVO则是双方都默认对方速度也会移一半,因此自身也只移一半。
VO的原理
RVO的原理与VO类似,VO通过求出一个速度向量u,让物体的速度加上向量u,来移出会碰撞的速度域,RVO只移一半就行,即物体的速度加上向量u/2

数学相关的判断

代码实现主要是解一些数学题

求碰撞速度域

比如,即是求点到一个圆的两个切线。
在这里插入图片描述

//求point 到 以circleCenter为圆心半径radius的圆的切线
pair<Vec2, Vec2> GeometryMath::calculateTangetLines(Vec2 point, Vec2 circleCenter, float radius) {
	//点到圆心的长度,上图红线
	float distSq = circleCenter.getDistanceSq(point);
	//len是点到切点的长度
	float len = sqrt(distSq - radius * radius);
	//上图盖住部分红线的绿线
	Vec2 temp = circleCenter - point;
	temp.normalize();
	temp *= len;
	//左右各旋转夹角,即为切线点
	float cosA = len / sqrt(distSq);
	float sinA = radius / sqrt(distSq);
	//顺时针
	float x1 = temp.x * cosA - temp.y * sinA;
	float y1 = temp.x * sinA + temp.y * cosA;
	//逆时针
	float x2 = temp.x * cosA - temp.y * (-sinA);
	float y2 = temp.x * (-sinA) + temp.y * cosA;
	return make_pair(Vec2(x1, y1), Vec2(x2, y2));
}

判定是否碰撞

判定速度是否在碰撞域内,即判定速度点与在左切线的右边,并且在右切线的左边

// 点 c 在a到b向量的左边, 即∠abc 小于180°
bool GeometryMath::isInLeft(Vec2 a, Vec2 b, Vec2 c) {
	float e = getVectorCross(a, b, c);
	return getVectorCross(a, b, c) < 0;
}
// 点 c 在a到b向量的右边, 即∠abc 大于180°
bool GeometryMath::isInRight(Vec2 a, Vec2 b, Vec2 c) {
	return getVectorCross(a, b, c) > 0;
}
// 点 c 与a到b向量共线, 即∠abc 等于180°
bool GeometryMath::isCollineation(Vec2 a, Vec2 b, Vec2 c) {
	return getVectorCross(a, b, c) < 0.00001;
}
float GeometryMath::getVectorCross(Vec2 a, Vec2 b, Vec2 c) {
	Vec2 vectorBA = a - b;
	Vec2 vectorBC = c - b;
	return vectorBA.cross(vectorBC);
}
bool isCollision;
bool isFirstLeft = GeometryMath::isInLeft(Vec2::ZERO, verts.second, verts.first);
        if (isFirstLeft) {
            isCollision = GeometryMath::isInLeft(Vec2::ZERO, verts.second, relativeVelocity) && GeometryMath::isInRight(Vec2::ZERO, verts.first, relativeVelocity);
        }
        else {
            isCollision = GeometryMath::isInLeft(Vec2::ZERO, verts.first, relativeVelocity) && GeometryMath::isInRight(Vec2::ZERO, verts.second, relativeVelocity);
        }

求速度转移向量u

选择更近的一条切线边,求出速度到切线上的垂直点,作为新的速度,两者相减即为u
向量a与单位向量n的点积,即为a在n方向的投影长度

Vec2 vert = relativeVelocity.getDistance(verts.first) < relativeVelocity.getDistance(verts.second) ? verts.first : verts.second;
//求切线的单位向量
Vec2 v2 = vert.getNormalized();
//速度在切线上的投影长度
float n = relativeVelocity.dot(v2);
Vec2 v = v2 * n;
Vec2 u = v - relativeVelocity;

VO的效果:
请添加图片描述
RVO的效果:
请添加图片描述
实际写代码中VO其实还有个问题,就是在当前帧求出了新的速度的话,如果在这一帧立刻更新位置的话,在非常近的情况下。是极有可能产生碰撞的。
因为VO抖动的问题就是,在第一帧,双方可能碰撞于是计算了新的速度相互错开(此时的新速度在下一帧计算VO是不会碰撞的)如果当前帧根据新速度更新位置不会产生碰撞。而到了第二帧,双方根据此时的速度计算不会碰撞,于是新速度调整回了最佳速度(调整回的新速度在下一帧计算VO是会产生碰撞的,所以之后会产生抖动),而此时如果根据当前帧调整的最佳速度立刻更新位置,在非常近的情况下,是会直接产生碰撞的

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/1445655.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

Stream流学习笔记

Stream流 创建流中间操作1、filter2、map3、distinct4、sorted5、limit6、skip7、flatMap 终结操作1、forEach2、count3、max&min4、collect5、查找与匹配 创建流 单例集合&#xff1a;集合对象.stream() List<Integer> list new ArrayList<>(); Stream<…

Centos7安装nginx yum报错

Centos7安装nginx yum报错&#xff0c;yum源报错解决办法&#xff1a; 1、更新epel源后&#xff0c;出现yum报错 [roothacker117 ~]# yum install epel-release&#xff08;安装成功&#xff09; [roothacker117 ~]# yum install nginx&#xff08;安装失败&#xff0c;提示如…

极市平台 | 卡车货车、野外火灾、抽烟识别等开源数据集资源汇总

本文来源公众号“极市平台”&#xff0c;仅用于学术分享&#xff0c;侵权删&#xff0c;干货满满。 原文链接&#xff1a;卡车货车、野外火灾、抽烟识别等开源数据集资源汇总 最近正好在做这方面的项目。本文收集了一些卡车货车、抽烟和野外火灾等开源数据集资源&#xff0c;…

springboot182基于springboot的网上服装商城

简介 【毕设源码推荐 javaweb 项目】基于springbootvue 的 适用于计算机类毕业设计&#xff0c;课程设计参考与学习用途。仅供学习参考&#xff0c; 不得用于商业或者非法用途&#xff0c;否则&#xff0c;一切后果请用户自负。 看运行截图看 第五章 第四章 获取资料方式 **项…

Stable Diffusion 模型下载:majicMIX sombre 麦橘唯美

本文收录于《AI绘画从入门到精通》专栏,专栏总目录:点这里。 文章目录 模型介绍生成案例案例一案例二案例三案例四案例五案例六案例七案例八案例九案例十

C++进阶(十五)C++的类型转换

&#x1f4d8;北尘_&#xff1a;个人主页 &#x1f30e;个人专栏:《Linux操作系统》《经典算法试题 》《C》 《数据结构与算法》 ☀️走在路上&#xff0c;不忘来时的初心 文章目录 一、C语言中的类型转换二、为什么C需要四种类型转换三、C强制类型转换1、static_cast2、reint…

Python 中的互斥锁:保护共享资源的利器

Python 作为一门流行的编程语言&#xff0c;广泛应用于各种领域&#xff0c;特别是在多线程编程中。多线程编程可以让程序同时执行多个任务&#xff0c;但也会引发一些问题&#xff0c;比如多个线程同时访问共享资源可能导致数据错误或不一致。为了解决这个问题&#xff0c;Pyt…

《CSS 简易速速上手小册》第10章:未来的 CSS(2024 最新版)

文章目录 10.1 CSS 的新特性和趋势10.1.1 基础知识10.1.2 重点案例&#xff1a;使用 CSS Grid 创建响应式图库10.1.3 拓展案例 1&#xff1a;利用 CSS 变量实现主题切换10.1.4 拓展案例 2&#xff1a;使用 lab() 颜色和 layer 规则优化样式 10.2 CSS Houdini&#xff1a;魔法般…

OpenMVG(EXIF、畸变、仿射特征、特征匹配)

本人之前也研究过OpenMVS但是对于OpenMVG只是原理层次的了解&#xff0c;因此乘着过年期间对这个库进行详细的学习。 目录 1 OpenMVG编译与简单测试 1.1 sfm_data.json获取 1.2 计算特征 2 OpenMVG整个流程的运行测试 3 OpenMVG实战 3.1 SVG绘制 3.2 解析图片的EXIF信息…

Linux:信号的保存

文章目录 信号相关概念信号递达信号未决信号阻塞内核中的示意图 信号集的操作函数 前面对于信号的产生中对操作系统有了一个基础的认知&#xff0c;对于一个真正的操作系统来说&#xff0c;进程是由操作系统进行调度的&#xff0c;那操作系统本身也是代码&#xff0c;是由谁进行…

一键打造属于自己漏扫系统

0x01 工具介绍 本系统是对Web中间件和Web框架进行自动化渗透的一个系统,根据扫描选项去自动化收集资产,然后进行POC扫描,POC扫描时会根据指纹选择POC插件去扫描,POC插件扫描用异步方式扫描.前端采用vue技术,后端采用python fastapi。 0x02 安装与使用 1、Docker部署环境 编译…

Java String源码剖析+面试题整理

由于字符串操作是计算机程序中最常见的操作之一&#xff0c;在面试中也是经常出现。本文从基本用法出发逐步深入剖析String的结构和性质&#xff0c;并结合面试题来帮助理解。 String基本用法 在Java中String的创建可以直接像基本类型一样定义&#xff0c;也可以new一个 Str…

骑砍MOD天芒传奇-天芒使用方法

骑砍1战团mod天芒传奇-使用红色天芒碎片开P51战斗机_单机游戏热门视频 (bilibili.com)https://www.bilibili.com/video/BV1nm41197iA/ 一.黄色天芒碎片 天芒盒子 野外战斗H键-召唤徐天地 二.绿色天芒碎片 天芒盒子 野外战斗H键-站在巨人肩膀上战斗 三.蓝色天芒碎片 天芒盒…

华为问界M9:全方位自动驾驶技术解决方案

华为问界M9的自动驾驶技术采用了多种方法来提高驾驶的便利性和安全性。以下是一些关键技术&#xff1a; 智能感知系统&#xff1a;问界M9配备了先进的传感器&#xff0c;包括高清摄像头、毫米波雷达、超声波雷达等&#xff0c;这些传感器可以实时监测车辆周围的环境&#xff0…

车载电子电器架构 —— 电子电气系统功能开发

车载电子电器架构 —— 电子电气系统功能开发 我是穿拖鞋的汉子,魔都中坚持长期主义的汽车电子工程师。 老规矩,分享一段喜欢的文字,避免自己成为高知识低文化的工程师: 本就是小人物,输了就是输了,不要在意别人怎么看自己。江湖一碗茶,喝完再挣扎,出门靠自己,四海皆…

几个好用的 iphone 手机模板贴图样机

整理了几个好用的 iphone 手机模板贴图&#xff0c;分享一下。 关注订阅号「设计师工作日常」&#xff0c;发送关键词 iphone mockup ,获取下载链接。 [1] 原文阅读 我是 Just&#xff0c;这里是「设计师工作日常」&#xff0c;求点赞求关注&#xff01;

huggingface学习|用dreambooth和lora对stable diffusion模型进行微调

目录 用dreambooth对stable-diffusion-v1-5模型进行微调&#xff08;一&#xff09;模型下载和环境配置&#xff08;二&#xff09;数据集准备&#xff08;三&#xff09;模型微调&#xff08;四&#xff09;运行微调后的模型 用lora对stable-diffusion-v1-5模型进行微调&#…

windows 下安装gin

go install 执行命令&#xff0c;执行不了的参考一下 https://blog.csdn.net/weixin_42592326/article/details/135946806 Golang 中没法下载第三方包解决办法-CSDN博客 go install github.com/gin-gonic/ginlatest 还是安装不了的话&#xff0c;用手机开热点&#xff0c;电…

在程序中使用日志功能

在应用中&#xff0c;需要记录程序运行过程中的一些关键信息以及异常输出等。这些信息用来排查程序故障或者其他用途。 日志模块可以自己实现或者是借用第三方库&#xff0c;之前写过一个类似的使用Qt的打印重定向将打印输出到文件&#xff1a;Qt将打印信息输出到文件_qt log输…

PyCharm2023.3.2配置conda环境

重点在于Path to conda这一步&#xff0c;需要找到conda.bat这个文件&#xff0c;PyCharm才能识别出现有的conda环境。