【光能蜗牛的图形学之旅】求3维度空间异面直线的垂足点

微信图片_20180521170640.png
微信图片_20180521170547.png

求异面直线一般有定义法和向量法
通常来说,定义法的解法只适用于解题,而实际使用中,为了减少条件判断,通常使用向量法的方式

开始:

题设:假设有两条直线 L1,L2 ,以及两条直线的方向向量V1,V2,求其最短距离连线的连接点。

首先,最短距离很好求,也即是两异面直线公垂线的长度,选择L1上任意一点P1连接L2上任意一点P2,则线段P1P2在L1,L2的公垂线上的投影即是长度,这个太简单,而且百度搜索一搜一大堆,不解释

而异面直线的垂足点,则不是那么好求,我找了好一阵网上的代码,坑得要死,无奈只能自己写,

基本思路如下,
因为直线的定义可以由如下式子给出
L(t) = P + t*V

则在L1和L2上分别选择任意的p1,p2,以及对应的t1,t2,得到的L1(t1),L2(t2)。
写作如下等式
L1(t1) = P1 + t1V1--------------------------(1)
L2(t2) = P2 + t2
V2--------------------------(2)

如果L1(t1),L2(t2)刚好是各自直线的垂足点,
那么可以得出此时| L2(t2)-L1(t1) | 的模长为最小值
且构成的 L2(t2)-L1(t1) 向量刚好就是公垂线
因为v1,和 v2都和公垂线垂直,所以,v1和v2各自和公垂线的点乘都为0

于是我们可以写出如下等式
( L2(t2)-L1(t1) ) . V1 = 0 //.表示点乘
( L2(t2)-L1(t1) ) . V2 = 0


(t2V2-t1V1 + P2 - P1 ).V1 = 0
(t2V2-t1V1 + P2 - P1 ).V2 = 0

整理

t2V2.V1 - t1V1.V1 + (P2 - P1).V1 = 0
t2V2.V2 - t1V1.V2 + (P2 - P1).V2 = 0


a = V1 .V2 = V2.V1
b = V1.V1
c = V2.V2
d = (P2 - P1) .V1
e = (P2 - P1).V2

则上式可化简为

at2 - bt1 + d = 0
ct2 - at1 + e = 0

以下分三种情形讨论

当a = 0 ,即 V1 .V2 = V2.V1 = 0时,表明原始两条直线互相垂直

t1 = d / b;
t2 = -e / c;

当a != 0时候
解上述方程
t1 = (ae -cd)/(aa-bc)
t2 = b/a * t1 - d/a

这里发现当(a * a - b * c) = 0时,即(V2.V1) * (V2.V1) = (V1.V1) * (V2.V2) = 0时,也就是两条直线平行或共线,此时无意义,所以只要排除即可

综上所述
a = 0 时

t1 = d / b;
t2 = -e / c;

(a * a - b * c) ! = 0 时

t1 = (ae -cd)/(aa-bc)
t2 = b/a * t1 - d/a

   class TLine{
        Vector3 source; //射线起点
        Vector3 vDirection;//射线方向
     }
    void MethodByLightSnail(TLine line1,TLine line2,Color color) {

        float a = Vector3.Dot(line1.vDirection,line2.vDirection);
        float b = Vector3.Dot(line1.vDirection,line1.vDirection);
        float c = Vector3.Dot(line2.vDirection,line2.vDirection);

        float d = Vector3.Dot((line2.source - line1.source),line1.vDirection);
        float e = Vector3.Dot((line2.source - line1.source),line2.vDirection);

        float t1 = 0;
        float t2 = 0;
        if (a == 0)
        {
            t1 = d / b;
            t2 = -e / c;
        }
        else if   (Mathf.Abs(a * a - b * c) < 0.0001f)//表明共线或平行,注意理想情况下应该是a * a - b * c == 0,才认为共线或平行,但在计算机世界里,有精度这个东西存在,所以我们近视的认为数值小于某一个值则认为等于0
        {//说明共线或平行

        }
        else {

            t1 = (a * e - c * d) / (a * a - b * c);
            t2 = b / a * t1 - d / a;
        }
 
    }


最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 203,547评论 6 477
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 85,399评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 150,428评论 0 337
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,599评论 1 274
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,612评论 5 365
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,577评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,941评论 3 395
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,603评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,852评论 1 297
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,605评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,693评论 1 329
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,375评论 4 318
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,955评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,936评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,172评论 1 259
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 43,970评论 2 349
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,414评论 2 342

推荐阅读更多精彩内容

  • 基于学生学习共同体培育语文生态课堂文化的研究 近年来,随着现代教育理念的不断深入与...
    火车头123阅读 1,974评论 0 8
  • 第一章数和数的运算 一概念 (一)整数 1整数的意义 自然数和0都是整数。 2自然数 我们在数物体的时候,用来表示...
    meychang阅读 2,584评论 0 5
  • 几分钟后,来到了“点点唱吧”门口,二人下了车来到二楼,203门口。 两人推门而进,只见肖鹏坐在沙发上,一个漂亮的女...
    伫立雨中阅读 228评论 0 0