已知法线,两向量夹角和一向量,求另一向量

3 篇文章 1 订阅

/// <summary>
       /// 获取垂直法线的平面的一条线,P2
       /// </summary>
       /// <param name="v0">顶点</param>
       /// <param name="p0">内部第一个点,与顶点连接起来认为是法线</param>
       /// <param name="p1">与Z轴垂直的线</param>
       /// <param name="angle">线间夹角</param>
       /// <returns></returns>
        public double[] GetP3(double[] v0,double[] p0,double[] p1,  double angle)
        {
            //c = a×b = (a.y*b.z-b.y*a.z , b.x*a.z-a.x*b.z , a.x*b.y-b.x*a.y)
            double[] p2 = new double[3];
            double V = Math.Sqrt((v0[0] - p0[0]) * (v0[0] - p0[0]) + (v0[1] - p0[1]) * (v0[1] - p0[1]) + (v0[2] - p0[2]) * (v0[2] - p0[2]));
            double R = Math.Sqrt((p1[0] - p0[0]) * (p1[0] - p0[0]) + (p1[1] - p0[1]) * (p1[1] - p0[1]) + (p1[2] - p0[2]) * (p1[2] - p0[2]) );
            double h = R * R * Math.Sin(angle) / V;
            p2[1] = p0[1] + (p1[1] - p0[1]) * Math.Cos(angle) + Math.Sin(angle) * ((p1[0]-p0[0])*(v0[2]-p0[2])-(p1[2]-p0[2])*(v0[0]-p0[0])) / V;
            p2[0] = p0[0] + ((p1[0] - p0[0])*(p2[1]-p0[1])-R*R*Math.Sin(angle)*(v0[2]-p0[2])/V)/(p1[1]-p0[1]);
            p2[2] = p0[2] + (((R*R*Math.Sin(angle)*(v0[0]-p0[0]))/V)+(p2[1]-p0[1])*(p1[2]-p0[2]))/ (p1[1] - p0[1]);
           
            return p2;
        }

 

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值