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
声明:本站所有文章,如无特殊说明或标注,均为本站原创发布。任何个人或组织,在未征得本站同意时,禁止复制、盗用、采集、发布本站内容到任何网站、书籍等各类媒体平台。如若本站内容侵犯了原著者的合法权益,可联系我们进行处理。
评论
50