luoyikun

导航

统计

unity3d:两条线段相交并求交点坐标

public static float Cross(Vector2 a, Vector2 b)
{
return a.x * b.y - b.x * a.y;
}
public static bool SegmentsInterPoint(Vector2 a, Vector2 b, Vector2 c, Vector2 d, ref Vector2 IntrPos)
{
//v1×v2=x1y2-y1x2
//以线段ab为准,是否c,d在同一侧
Vector2 ab = b - a;
Vector2 ac = c - a;
float abXac = Cross(ab,ac);
Vector2 ad = d - a;
float abXad = Cross(ab, ad);
if (abXac * abXad >= 0)
{
return false;
}
//以线段cd为准,是否ab在同一侧
Vector2 cd = d - c;
Vector2 ca = a - c;
Vector2 cb = b - c;
float cdXca = Cross(cd, ca);
float cdXcb = Cross(cd, cb);
if (cdXca * cdXcb >= 0)
{
return false;
}
//计算交点坐标
float t = Cross(a -c, d -c) / Cross (d-c,b-a);
float dx = t * (b.x - a.x);
float dy = t * (b.y - a.y);
IntrPos = new Vector2() { x = a.x + dx, y = a.y + dy };
return true;
}

外积,又称叉积,是向量代数(解析几何)中的一个概念。两个向量v1(x1, y1)和v2(x2, y2)的外积v1×v2=x1y2-y1x2。如果由v1到v2是顺时针转动,外积为负,反之为正,为0表示二者方向相同(平行)。
在这里插入图片描述
abxac * abxad >= 0 说明以ab线段为准,c,d两点都在同一侧,说明两个线段不会相交
cdxca * cdxcb >=0 说明以cd线段为准,a,b两点都在同一侧,说明两个线段不会相交
交点为o
在这里插入图片描述
然后根据线段定义
在这里插入图片描述
以a为起点,b-a为u, t为 ao/ab, 求出o点坐标
在这里插入图片描述

posted on   luoyikun  阅读(405)  评论(0编辑  收藏  举报  

相关博文:
阅读排行:
· 被坑几百块钱后,我竟然真的恢复了删除的微信聊天记录!
· 没有Manus邀请码?试试免邀请码的MGX或者开源的OpenManus吧
· 【自荐】一款简洁、开源的在线白板工具 Drawnix
· 园子的第一款AI主题卫衣上架——"HELLO! HOW CAN I ASSIST YOU TODAY
· Docker 太简单,K8s 太复杂?w7panel 让容器管理更轻松!
点击右上角即可分享
微信分享提示