C++ 实现两个向量之间的夹角

        具体原理可以参考另外一篇博客：点击打开链接，实现思想就是，通过计算两个向量的斜率角，然后相减，就得到了夹角，好了，直接上代码！

#include 
#include 
#include 
#include 

using namespace cv;
using namespace std;

// 以pt1为基准
float getAngelOfTwoVector(Point2f &pt1, Point2f &pt2, Point2f &c)
{
	float theta = atan2(pt1.x - c.x, pt1.y - c.y) - atan2(pt2.x - c.x, pt2.y - c.y);
	if (theta > CV_PI)
		theta -= 2 * CV_PI;
	if (theta < -CV_PI)
		theta += 2 * CV_PI;

	theta = theta * 180.0 / CV_PI;
	return theta;
}

void main()
{
	Point2f c(0, 0);
	Point2f pt1(0, -1);
	Point2f pt2(-1, 0);

	float theta = getAngelOfTwoVector(pt1, pt2, c);

	cout << "theta: " << theta << endl;
}

打完收工！