计算几何 – C++计算两个二维向量的夹角
1 计算两个二维向量的夹角
#include <iostream>
#include <cmath>
struct PoseInfo {
float x;
float y;
};
typedef PoseInfo Point2D;
typedef PoseInfo Vector2D;
float Vector2DAngle(const Vector2D& vec1, const Vector2D& vec2)
{
double PI = 3.141592653;
float t = (vec1.x * vec2.x + vec1.y * vec2.y) / (sqrt(pow(vec1.x, 2) + pow(vec1.y, 2)) * sqrt(pow(vec2.x, 2) + pow(vec2.y, 2)));
float angle = acos(t) * (180 / PI);
return angle;
}
int main()
{
Point2D vecA_start_point;
vecA_start_point.x = 0.0;
vecA_start_point.y = 0.0;
Point2D vecA_end_point;
vecA_end_point.x = 1.0;
vecA_end_point.y = 0.0;
Point2D vecB_end_point;
vecB_end_point.x = 1.0;
vecB_end_point.y = 5.0;
Vector2D vecA;
vecA.x = vecA_end_point.x - vecA_start_point.x;
vecA.y = vecA_end_point.y - vecA_start_point.y;
Vector2D vecB;
vecB.x = vecB_end_point.x - vecA_start_point.x;
vecB.y = vecB_end_point.y - vecA_start_point.y;
float angle = Vector2DAngle(vecA, vecB);
std::cout << "angle = " << angle << std::endl;
getchar();
return 0;
}
计算结果：
angle = 78.6901
欢迎扫码关注我的微信公众号，及时获取文章更新
本文作者：StubbornHuang
版权声明：本文为站长原创文章，如果转载请注明原文链接！
原文标题：计算几何 – C++计算两个二维向量的夹角
原文链接：https://www.stubbornhuang.com/1559/
发布于：2021年08月12日 14:24:45
修改于：2023年06月26日 21:21:41
声明：本站所有文章，如无特殊说明或标注，均为本站原创发布。任何个人或组织，在未征得本站同意时，禁止复制、盗用、采集、发布本站内容到任何网站、书籍等各类媒体平台。如若本站内容侵犯了原著者的合法权益，可联系我们进行处理。
文章末尾
评论
72