已知6点,求两平面夹角

double fcos(double x1,double y1,double z1,double x2,double y2,double z2,double x3,double y3,double z3,
                double x11,double y11,double z11,double x22,double y22,double z22,double x33,double y33,double z33){
       double vect1[3],vect2[3],nomal1[3],nomal2[3];
       vect1[0] = x2 - x1;vect1[1] = y2 - y1;vect1[2] = z2 - z1;
       vect2[0] = x3 - x1;vect2[1] = y3 - y1;vect2[2] = z3 - z1;
       //平面一法线
       nomal1[0] = vect1[1]*vect2[2] - vect1[2]*vect2[1];
       nomal1[1] = vect1[2]*vect2[0] - vect1[0]*vect2[2];
       nomal1[2] = vect1[0]*vect2[1] - vect1[1]*vect2[0];
      
       vect1[0] = x22 - x11;vect1[1] = y22 - y11;vect1[2] = z22 - z11;
       vect2[0] = x33 - x11;vect2[1] = y33 - y11;vect2[2] = z33 - z11;
       //平面二法线
       nomal2[0] = vect1[1]*vect2[2] - vect1[2]*vect2[1];
       nomal2[1] = vect1[2]*vect2[0] - vect1[0]*vect2[2];
       nomal2[2] = vect1[0]*vect2[1] - vect1[1]*vect2[0];
       //返回cos
       return(-1 * fabs(nomal1[0]*nomal2[0]+nomal1[1]*nomal2[1]+nomal1[2]*nomal2[2])
               /(sqrt(SQR(nomal1[0])+SQR(nomal1[1])+SQR(nomal1[2]))*sqrt(SQR(nomal2[0])+SQR(nomal2[1])+SQR(nomal2[2]))));
  • 2
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值