胶囊体边界点的计算及获取

2023-10-13 03:20
文章标签 计算 获取 胶囊 边界点

本文主要是介绍胶囊体边界点的计算及获取,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

(注意 取的是中心点位置来计算边界点,而非投影点位置。可以自行修改为投影点)

 

之前想做一些体积碰撞的效果但是遇到点问题,胶囊边界点检测这个涉及到球体的交点检测以及圆柱的交点检测

觉得可以放上来,相交检测的代码逻辑来源于网络。

 

using System.Collections;
using System.Collections.Generic;
using UnityEngine;public class CapsuleTest : MonoBehaviour
{public enum DirectionEnum { X, Y, Z }public Vector3 center;public float height = 1f;public float radius = 1f;public DirectionEnum direction = DirectionEnum.Y;public Transform testOutsidePoint;Vector3 Test(Vector3 outsidePoint){var localMassPoint = center;var localOutsidePoint = transform.worldToLocalMatrix.MultiplyPoint3x4(outsidePoint);var centerPoint = localMassPoint + center;var up = Vector3.up;var right = Vector3.right;var forward = Vector3.forward;switch (direction){case DirectionEnum.X:up = Vector3.right;right = Vector3.forward;forward = Vector3.up;break;case DirectionEnum.Z:up = Vector3.forward;right = Vector3.up;forward = Vector3.right;break;}var remainHeight = Mathf.Max(height - radius * 2f, 0) + 0.01f;var remainHeightHalf = remainHeight * 0.5f;var pillarOrigin = centerPoint + up * -remainHeightHalf;var pillarEnd = centerPoint + up * remainHeightHalf;var insectPoint = Vector3.zero;var isHitCylinder = CylinderVSline(localOutsidePoint, (centerPoint - localOutsidePoint).normalized, pillarOrigin, pillarEnd, radius, out insectPoint);if (isHitCylinder){return transform.localToWorldMatrix.MultiplyPoint3x4(insectPoint);}else{var spherePoint1 = centerPoint + up * remainHeightHalf;var spherePoint2 = centerPoint + (-up) * remainHeightHalf;var finalSpherePoint = spherePoint1;if (Vector3.Distance(localOutsidePoint, spherePoint2) < Vector3.Distance(localOutsidePoint, spherePoint1)){finalSpherePoint = spherePoint2;}BetweenLineAndSphere(finalSpherePoint, radius, centerPoint, localOutsidePoint, out spherePoint1, out spherePoint2);if (Vector3.Distance(spherePoint1, centerPoint) > Vector3.Distance(spherePoint2, centerPoint))return transform.localToWorldMatrix.MultiplyPoint3x4(spherePoint1);elsereturn transform.localToWorldMatrix.MultiplyPoint3x4(spherePoint2);}}void OnDrawGizmos(){var cacheColor = Gizmos.color;var cacheMatrix = Gizmos.matrix;if (testOutsidePoint != null){var edgePoint = Test(testOutsidePoint.position);Gizmos.DrawWireSphere(edgePoint, 0.2f);}Gizmos.color = Color.Lerp(Color.green, Color.gray, 0.5f);Gizmos.matrix = transform.localToWorldMatrix;var remainHeight = Mathf.Max(height - radius * 2f, 0);var remainHeightHalf = remainHeight * 0.5f;var up = Vector3.up;var right = Vector3.right;var forward = Vector3.forward;switch (direction){case DirectionEnum.X:up = Vector3.right;right = Vector3.forward;forward = Vector3.up;break;case DirectionEnum.Z:up = Vector3.forward;right = Vector3.up;forward = Vector3.right;break;}var lastPoint1 = (Vector3?)null;var lastPoint2 = (Vector3?)null;for (var i = 0f; i <= 180f; i += 9f){var point1 = up * -remainHeightHalf + Quaternion.AngleAxis(i, right) * forward * radius;var point2 = up * -remainHeightHalf + Quaternion.AngleAxis(i, -forward) * right * radius;Gizmos.DrawLine(center + lastPoint1.GetValueOrDefault(point1), center + point1);Gizmos.DrawLine(center + lastPoint2.GetValueOrDefault(point2), center + point2);lastPoint1 = point1;lastPoint2 = point2;}lastPoint1 = (Vector3?)null;for (var i = 0f; i <= 360f; i += 9f){var point1 = up * -remainHeightHalf + Quaternion.AngleAxis(i, up) * forward * radius;Gizmos.DrawLine(center + lastPoint1.GetValueOrDefault(point1), center + point1);lastPoint1 = point1;}Gizmos.DrawLine(center + forward * radius + up * -remainHeightHalf, center + forward * radius + up * remainHeightHalf);Gizmos.DrawLine(center + -forward * radius + up * -remainHeightHalf, center + -forward * radius + up * remainHeightHalf);Gizmos.DrawLine(center + right * radius + up * -remainHeightHalf, center + right * radius + up * remainHeightHalf);Gizmos.DrawLine(center + -right * radius + up * -remainHeightHalf, center + -right * radius + up * remainHeightHalf);lastPoint1 = (Vector3?)null;lastPoint2 = (Vector3?)null;for (var i = 0f; i <= 180f; i += 9f){var point1 = up * remainHeightHalf + Quaternion.AngleAxis(i, -right) * forward * radius;var point2 = up * remainHeightHalf + Quaternion.AngleAxis(i, forward) * right * radius;Gizmos.DrawLine(center + lastPoint1.GetValueOrDefault(point1), center + point1);Gizmos.DrawLine(center + lastPoint2.GetValueOrDefault(point2), center + point2);lastPoint1 = point1;lastPoint2 = point2;}lastPoint1 = (Vector3?)null;for (var i = 0f; i <= 360f; i += 9f){var point1 = up * remainHeightHalf + Quaternion.AngleAxis(i, up) * forward * radius;Gizmos.DrawLine(center + lastPoint1.GetValueOrDefault(point1), center + point1);lastPoint1 = point1;}Gizmos.color = cacheColor;Gizmos.matrix = cacheMatrix;}bool BetweenLineAndSphere(Vector3 circleCenter, float circleRadius,Vector3 point1, Vector3 point2,out Vector3 intersection1, out Vector3 intersection2){float t;var dx = point2.x - point1.x;var dy = point2.y - point1.y;var dz = point2.z - point1.z;var a = dx * dx + dy * dy + dz * dz;var b = 2 * (dx * (point1.x - circleCenter.x) + dy * (point1.y - circleCenter.y) + dz * (point1.z - circleCenter.z));var c = (point1.x - circleCenter.x) * (point1.x - circleCenter.x)+ (point1.y - circleCenter.y) * (point1.y - circleCenter.y)+ (point1.z - circleCenter.z) * (point1.z - circleCenter.z) - circleRadius * circleRadius;var determinate = b * b - 4 * a * c;// Two solutions.t = (float)((-b + Mathf.Sqrt(determinate)) / (2 * a));intersection1 = new Vector3(point1.x + t * dx, point1.y + t * dy, point1.z + t * dz);t = (float)((-b - Mathf.Sqrt(determinate)) / (2 * a));intersection2 = new Vector3(point1.x + t * dx, point1.y + t * dy, point1.z + t * dz);if (intersection1.normalized == Vector3.zero && intersection2.normalized == Vector3.zero)return false;elsereturn true;}bool CylinderVSline(Vector3 start, Vector3 dir, Vector3 aVec, Vector3 bVec, float radius, out Vector3 intersectPoint){intersectPoint = Vector3.zero;// Solution : http://www.gamedev.net/community/forums/topic.asp?topic_id=467789var ab = bVec - aVec;var ao = start - aVec;var aoxAb = Vector3.Cross(ao, ab);var vxAb = Vector3.Cross(dir, ab);var ab2 = Vector3.Dot(ab, ab);var a = Vector3.Dot(vxAb, vxAb);var b = 2 * Vector3.Dot(vxAb, aoxAb);var c = Vector3.Dot(aoxAb, aoxAb) - (radius * radius * ab2);var d = b * b - 4 * a * c;if (d < 0) return false;float time = (-b - Mathf.Sqrt(d)) / (2 * a);if (time < 0) return false;intersectPoint = start + dir * time;var projectionPoint = aVec + Vector3.Project(intersectPoint - aVec, ab.normalized);var distance1 = Mathf.Max(Vector3.Distance(projectionPoint, aVec), Vector3.Distance(projectionPoint, bVec));var distance2 = Vector3.Distance(aVec, bVec);if (distance1 >= distance2)return false;return true;}
}
View Code

 

转载于:https://www.cnblogs.com/hont/p/9470781.html

这篇关于胶囊体边界点的计算及获取的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



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

相关文章

Python获取浏览器Cookies的四种方式小结

《Python获取浏览器Cookies的四种方式小结》在进行Web应用程序测试和开发时,获取浏览器Cookies是一项重要任务,本文我们介绍四种用Python获取浏览器Cookies的方式,具有一定的... 目录什么是 Cookie?1.使用Selenium库获取浏览器Cookies2.使用浏览器开发者工具

Java获取当前时间String类型和Date类型方式

《Java获取当前时间String类型和Date类型方式》:本文主要介绍Java获取当前时间String类型和Date类型方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,... 目录Java获取当前时间String和Date类型String类型和Date类型输出结果总结Java获取

C#监听txt文档获取新数据方式

《C#监听txt文档获取新数据方式》文章介绍通过监听txt文件获取最新数据,并实现开机自启动、禁用窗口关闭按钮、阻止Ctrl+C中断及防止程序退出等功能,代码整合于主函数中,供参考学习... 目录前言一、监听txt文档增加数据二、其他功能1. 设置开机自启动2. 禁止控制台窗口关闭按钮3. 阻止Ctrl +

一文详解如何使用Java获取PDF页面信息

《一文详解如何使用Java获取PDF页面信息》了解PDF页面属性是我们在处理文档、内容提取、打印设置或页面重组等任务时不可或缺的一环,下面我们就来看看如何使用Java语言获取这些信息吧... 目录引言一、安装和引入PDF处理库引入依赖二、获取 PDF 页数三、获取页面尺寸(宽高)四、获取页面旋转角度五、判断

Python使用OpenCV实现获取视频时长的小工具

《Python使用OpenCV实现获取视频时长的小工具》在处理视频数据时,获取视频的时长是一项常见且基础的需求,本文将详细介绍如何使用Python和OpenCV获取视频时长,并对每一行代码进行深入解析... 目录一、代码实现二、代码解析1. 导入 OpenCV 库2. 定义获取视频时长的函数3. 打开视频文

MySQL 获取字符串长度及注意事项

《MySQL获取字符串长度及注意事项》本文通过实例代码给大家介绍MySQL获取字符串长度及注意事项,本文通过实例代码给大家介绍的非常详细,对大家的学习或工作具有一定的参考借鉴价值,需要的朋友参考下吧... 目录mysql 获取字符串长度详解 核心长度函数对比⚠️ 六大关键注意事项1. 字符编码决定字节长度2

python3如何找到字典的下标index、获取list中指定元素的位置索引

《python3如何找到字典的下标index、获取list中指定元素的位置索引》:本文主要介绍python3如何找到字典的下标index、获取list中指定元素的位置索引问题,具有很好的参考价值,... 目录enumerate()找到字典的下标 index获取list中指定元素的位置索引总结enumerat

SpringMVC高效获取JavaBean对象指南

《SpringMVC高效获取JavaBean对象指南》SpringMVC通过数据绑定自动将请求参数映射到JavaBean,支持表单、URL及JSON数据,需用@ModelAttribute、@Requ... 目录Spring MVC 获取 JavaBean 对象指南核心机制:数据绑定实现步骤1. 定义 Ja

C++中RAII资源获取即初始化

《C++中RAII资源获取即初始化》RAII通过构造/析构自动管理资源生命周期,确保安全释放,本文就来介绍一下C++中的RAII技术及其应用,具有一定的参考价值,感兴趣的可以了解一下... 目录一、核心原理与机制二、标准库中的RAII实现三、自定义RAII类设计原则四、常见应用场景1. 内存管理2. 文件操

Python并行处理实战之如何使用ProcessPoolExecutor加速计算

《Python并行处理实战之如何使用ProcessPoolExecutor加速计算》Python提供了多种并行处理的方式,其中concurrent.futures模块的ProcessPoolExecu... 目录简介完整代码示例代码解释1. 导入必要的模块2. 定义处理函数3. 主函数4. 生成数字列表5.