3d - 空间中两个 3D 磁盘之间的碰撞检测
问题描述
我想开发一种算法,用于在 3D 空间中执行两个 3D 磁盘之间的碰撞检测。是否可以建议一种分析方法,以便我可以开发此程序。
谢谢,
解决方案
所以每个圆盘都位于一个无限平面的顶部,每个圆盘都有一个法向量和到原点的距离。在两个平面相交的地方,它们形成一条线。
这条线将中心c 1和c 2投影到线上p 1和p 2上的两个点,它们的垂直距离为 h 1和h 2。投影点之间的距离为l。
如果磁盘接触,公共线将包含接触点。如果它们没有接触,或者它们正在相互穿透,那么这个点p C是同时最靠近两个磁盘中心的线上的点。
要找到从 p 1到p C的距离t 1 ,请使用相似三角形来求解 ( t 1 )/ h 1 = ( l - t 1 )/ h 2
t_1 = h_1*ell/(h_1+h_2)
从距离t 1和公共线方向,计算点p C ,然后如果两个圆盘到它们的中心的距离等于或小于它们的半径,则这两个圆盘相交。
intersect = ( distance(c_1-p_C)<=R_1 ) && ( distance(c_2-p_C)<=R_2 )
有一种特殊情况,即两个圆心都在公共线上,这也是需要考虑的。完整的解决方案C#
是
主要的
static void Main(string[] args)
{
var disk_1 = new Disk(Point.Origin, Vector3.UnitZ, 1);
var disk_2 = new Disk(
Point.Origin + Vector3.UnitY,
Vector3.UnitY,
0.6f);
if (Disk.Intersect(disk_1, disk_2))
{
Debug.WriteLine($"Crash");
}
}
磁盘
using System.Numerics;
public class Disk : Plane
{
public Disk(Point center, Vector3 normal, float radius, float thickness)
: base(center, normal)
{
this.Center=center;
this.Radius=radius;
this.Thickness = thickness;
}
public Point Center { get; }
public float Radius { get; }
public float Thickness { get; }
public bool Containts(Point point)
{
if (DistanceTo(point)<= Thickness/2)
{
var d = (point - Center).Length();
return d<=Radius;
}
return false;
}
public static bool Intersect(Disk disk_1, Disk disk_2)
{
var commonLine = Line.Meet(disk_1, disk_2);
var p_1 = commonLine.Project(disk_1.Center);
var p_2 = commonLine.Project(disk_2.Center);
var ell = p_1.DistanceTo(p_2);
var h_1 = commonLine.DistanceTo(disk_1.Center);
var h_2 = commonLine.DistanceTo(disk_2.Center);
if (Math.Abs(h_1+h_2)>1e-8)
{
var t_1 = h_1*ell/(h_1+h_2);
var contact = p_1 - commonLine.Direction * t_1;
return disk_1.Containts(contact) && disk_2.Containts(contact);
}
else
{
return ell <= disk_1.Radius + disk_2.Radius;
}
}
}
几何学
using System.Numerics;
public class Point
{
public Vector3 Vector { get; }
public float Scalar { get; }
public Point(Vector3 position)
: this(position, 1) { }
public Point(Vector3 vector, float scalar)
{
this.Vector = vector;
this.Scalar=scalar;
}
public Point(Vector4 coordinates)
: this(new Vector3(coordinates.X, coordinates.Y, coordinates.Z), coordinates.W)
{ }
public Point(Plane plane)
: this(-plane.Scalar*plane.Vector, plane.Vector.LengthSquared())
{ }
public Point(Line line)
: this(Vector3.Cross(line.Vector, line.Moment), line.Vector.LengthSquared())
{ }
public static implicit operator Point(Vector3 position)
=> new Point(position, 1);
public static implicit operator Point(Vector4 coordinates)
=> new Point(coordinates);
public static readonly Point Origin = new Point(Vector3.Zero, 1);
public static Point Meet(Plane plane, Line line)
{
return new Point(
Vector3.Cross(line.Moment, plane.Vector)+plane.Scalar*line.Vector,
-Vector3.Dot(plane.Vector, line.Vector));
}
public static Point Meet(Plane plane_1, Plane plane_2, Plane plane_3)
{
return Meet(plane_1, Line.Meet(plane_2, plane_3));
}
public float Magnitude { get => Math.Abs(Scalar); }
public Vector3 Position { get => Vector/Scalar; }
public float DistanceTo(Point point)
=> (Scalar*point.Vector - point.Scalar*Vector).Length()/(Scalar*point.Scalar);
public float DistanceTo(Plane plane)
=> (Vector3.Dot(plane.Vector, Vector) + Scalar*plane.Scalar)/(Scalar*plane.Vector.Length());
public float DistanceTo(Line line)
=> (Vector3.Cross(line.Vector, Vector) + Scalar * line.Moment).Length()/(Scalar*line.Vector.Length());
public static Point operator +(Point point, Vector3 delta)
=> new Point(point.Vector + point.Scalar*delta, point.Scalar);
public static Vector3 operator -(Point point, Point @base)
=> point.Position - @base.Position;
}
public class Plane
{
public Vector3 Vector { get; }
public float Scalar { get; }
public Plane(Vector3 vector, float scalar)
{
this.Vector=vector;
this.Scalar=scalar;
}
public Plane(Vector4 coordinates)
: this(new Vector3(coordinates.X, coordinates.Y, coordinates.Z), coordinates.W)
{ }
public Plane(Point point, Vector3 normal)
: this(normal, -Vector3.Dot(point.Position, normal))
{ }
public Plane(Point point)
: this(-point.Scalar*point.Vector, point.Vector.LengthSquared())
{ }
public Plane(Line line)
: this(Vector3.Cross(line.Moment, line.Vector), line.Moment.LengthSquared())
{ }
public static implicit operator Plane(Vector4 coordinates)
=> new Plane(coordinates);
public static Plane Join(Point point, Line line)
{
return new Plane(
Vector3.Cross(line.Vector, point.Position) + line.Moment,
-Vector3.Dot(point.Position, line.Moment));
}
public static Plane Join(Point point_1, Point point_2, Point point_3)
{
return Join(point_1, Line.Join(point_2, point_3));
}
public float Magnitude { get => Vector.Length(); }
public Vector3 Normal { get => Vector3.Normalize(Vector); }
public float Offset { get => -Scalar/Magnitude; }
public Vector3 Position
{
get => Normal*Offset;
}
public float DistanceTo(Point point)
=> point.DistanceTo(this);
public Point Project(Point point)
{
float t = Vector3.Dot(Normal, point.Position)-Offset;
return point.Position - Normal*t;
}
}
public class Line
{
public Vector3 Vector { get; }
public Vector3 Moment { get; }
public Line(Vector3 vector, Vector3 moment)
{
this.Vector=vector;
this.Moment=moment;
}
public static Line Ray(Point point, Vector3 direction)
{
return new Line(direction,
Vector3.Cross(point.Position, direction));
}
public static Line Join(Point point_1, Point point_2)
{
return new Line(
point_2.Position-point_1.Position,
Vector3.Cross(point_1.Position, point_2.Position));
}
public static Line Meet(Plane plane_1, Plane plane_2)
{
return new Line(
Vector3.Cross(plane_1.Vector, plane_2.Vector),
plane_2.Vector*plane_1.Scalar-plane_1.Vector*plane_2.Scalar);
}
public Point Along(float travel)
=> Position.Position + Direction * travel;
public float Magnitude { get => Vector.Length(); }
public Vector3 Direction { get => Vector3.Normalize(Vector); }
public Point Position
{
get => new Point(this);
}
public float DistanceTo(Point point)
=> point.DistanceTo(this);
public float DistanceTo(Line line)
=> (Vector3.Dot(Vector, line.Moment) + Vector3.Dot(line.Vector, Moment))/Vector3.Cross(Vector, line.Vector).Length();
public Point Project(Point point)
{
return Along(Vector3.Dot(Direction, point.Position-Position.Position));
}
}
以上数学基于Eric Lengyel 的《游戏引擎开发基础》。
更新
推荐阅读
- php - 我想从这个 JSON URL 回显 IMDB ID、标题、质量和嵌入 URL
- c# - 如何在 C# 和 ASP.NET MVC 中从视图访问数据到模型
- python - 当数据框列中的值为 x 时,使用 Jupyter Notebooks 和 Python 计算另一个列值为 y 的次数?
- matlab - 如何在 MATLAB 中从国际标准大气模型绘制多个图形?
- unity3d - 在运行时创建可编写脚本的对象 - 它创建实例但不将它们保存在资产文件夹中?
- python - 使用数组的 Seaborn 小提琴图 - 错误:`x` 和 `y` 变量似乎都不是数字
- ios - 是否可以添加带有多行文本的左栏按钮项
- flutter - Flutter web 执行“热重启”而不是“热重载”。Flutter Web 是否支持“热重载”?
- android - 神经网络 API 与芯片组 NPU api
- java - 这个正弦源代码有什么问题?