acos 等出现结果:-1.#IND00,实操解决。求取两个向量夹角时所遇到的问题

当出现如题的结果时,主要是因为越界导致的。

首先,C++中acos的取值范围是[0,M_PI],也就对应cos的[-1,1]。因此,当acos(alpha)中的alpha不在[-1,1]中时,运行结果就会是:-1.#IND00。

这里是在求取向量夹角时所遇到的问题。公式如下所示:

|a|=√[x1^2+y1^2]
|b|=√[x2^2+y2^2]
a*b=(x1,y1)(x2,y2)=x1x2+y1y2
cos=a*b/[|a|*|b|]
=(x1x2+y1y2)/[√[x1^2+y1^2]*√[x2^2+y2^2]]

出现越界情况也只能是cos约等于+1或-1时。因此这里添加了一个if判断,如下,最终解决问题。

			float seata = acos(fz / fm);
			if (isnan(seata))//acos取值范围[-1,1],若超出范围则越界,输出-1.#IND00
			{
				seata = acos(fm / fz);
			}

 

你可能感兴趣的:(pcl)