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

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

相关文章

Vue3组件中getCurrentInstance()获取App实例,但是返回null的解决方案

《Vue3组件中getCurrentInstance()获取App实例,但是返回null的解决方案》:本文主要介绍Vue3组件中getCurrentInstance()获取App实例,但是返回nu... 目录vue3组件中getCurrentInstajavascriptnce()获取App实例,但是返回n

SpringMVC获取请求参数的方法

《SpringMVC获取请求参数的方法》:本文主要介绍SpringMVC获取请求参数的方法,本文通过实例代码给大家介绍的非常详细,对大家的学习或工作具有一定的参考借鉴价值,需要的朋友可以参考下... 目录1、通过ServletAPI获取2、通过控制器方法的形参获取请求参数3、@RequestParam4、@

Python获取C++中返回的char*字段的两种思路

《Python获取C++中返回的char*字段的两种思路》有时候需要获取C++函数中返回来的不定长的char*字符串,本文小编为大家找到了两种解决问题的思路,感兴趣的小伙伴可以跟随小编一起学习一下... 有时候需要获取C++函数中返回来的不定长的char*字符串,目前我找到两种解决问题的思路,具体实现如下:

golang获取当前时间、时间戳和时间字符串及它们之间的相互转换方法

《golang获取当前时间、时间戳和时间字符串及它们之间的相互转换方法》:本文主要介绍golang获取当前时间、时间戳和时间字符串及它们之间的相互转换,本文通过实例代码给大家介绍的非常详细,感兴趣... 目录1、获取当前时间2、获取当前时间戳3、获取当前时间的字符串格式4、它们之间的相互转化上篇文章给大家介

Python获取中国节假日数据记录入JSON文件

《Python获取中国节假日数据记录入JSON文件》项目系统内置的日历应用为了提升用户体验,特别设置了在调休日期显示“休”的UI图标功能,那么问题是这些调休数据从哪里来呢?我尝试一种更为智能的方法:P... 目录节假日数据获取存入jsON文件节假日数据读取封装完整代码项目系统内置的日历应用为了提升用户体验,

微信公众号脚本-获取热搜自动新建草稿并发布文章

《微信公众号脚本-获取热搜自动新建草稿并发布文章》本来想写一个自动化发布微信公众号的小绿书的脚本,但是微信公众号官网没有小绿书的接口,那就写一个获取热搜微信普通文章的脚本吧,:本文主要介绍微信公众... 目录介绍思路前期准备环境要求获取接口token获取热搜获取热搜数据下载热搜图片给图片加上标题文字上传图片

使用Python实现获取网页指定内容

《使用Python实现获取网页指定内容》在当今互联网时代,网页数据抓取是一项非常重要的技能,本文将带你从零开始学习如何使用Python获取网页中的指定内容,希望对大家有所帮助... 目录引言1. 网页抓取的基本概念2. python中的网页抓取库3. 安装必要的库4. 发送HTTP请求并获取网页内容5. 解

C++常见容器获取头元素的方法大全

《C++常见容器获取头元素的方法大全》在C++编程中,容器是存储和管理数据集合的重要工具,不同的容器提供了不同的接口来访问和操作其中的元素,获取容器的头元素(即第一个元素)是常见的操作之一,本文将详细... 目录一、std::vector二、std::list三、std::deque四、std::forwa

使用Python高效获取网络数据的操作指南

《使用Python高效获取网络数据的操作指南》网络爬虫是一种自动化程序,用于访问和提取网站上的数据,Python是进行网络爬虫开发的理想语言,拥有丰富的库和工具,使得编写和维护爬虫变得简单高效,本文将... 目录网络爬虫的基本概念常用库介绍安装库Requests和BeautifulSoup爬虫开发发送请求解

Android App安装列表获取方法(实践方案)

《AndroidApp安装列表获取方法(实践方案)》文章介绍了Android11及以上版本获取应用列表的方案调整,包括权限配置、白名单配置和action配置三种方式,并提供了相应的Java和Kotl... 目录前言实现方案         方案概述一、 androidManifest 三种配置方式