我是靠谱客的博主 潇洒台灯,最近开发中收集的这篇文章主要介绍三维向量求夹角(0-360),觉得挺不错的,现在分享给大家,希望可以做个参考。

概述

规定Z轴的正方向是(0,0,1)

 

从a->b做法向量;

a和b的法向量与Z轴正向的积,积大于0,同向,夹角为正;

                                                     积小于0,反向,夹角为负,这里要求0-360,所以夹角为2*pi-theta;

double  Cross( Eigen::Vector3d a, Eigen::Vector3d b){
    
   
    double theta = atan2(a.cross(b).norm(), a.transpose() * b);
    //规定正方向(0,0,1)
    Eigen::Vector3d direction(0,0,1);
    double z = a.cross(b).transpose() * direction;
    return z >= 0 ? theta : 2*PI- theta;
    
}

 

 

 

 

 

 

 

最后

以上就是潇洒台灯为你收集整理的三维向量求夹角(0-360)的全部内容,希望文章能够帮你解决三维向量求夹角(0-360)所遇到的程序开发问题。

如果觉得靠谱客网站的内容还不错,欢迎将靠谱客网站推荐给程序员好友。

本图文内容来源于网友提供,作为学习参考使用,或来自网络收集整理,版权属于原作者所有。
点赞(62)

评论列表共有 0 条评论

立即
投稿
返回
顶部