計算兩個點之間的夾角

#include <QtCore/QPoint>

#define PI 3.1425926.f

/// 計算平面上兩個點之間的夾角
/// Param cen 中心參考點
/// Param first 第一坐標點
/// Param second 第二坐標點

double calcAngle(QPoint cen, QPoint first, QPoint second)
{
    double pa_x = first.x() - cen.x();
    double pa_y = first.y() - cen.y();
    double pb_x = second.x() - cen.x();
    double pb_y = second.y() - cen.y();
    double v1 = (pa_x * pb_x) + (pa_y * pb_y);
    double pa_val = sqrt(pa_x * pa_x + pa_y * pa_y);
    double pb_val = sqrt(pb_x * pb_x + pb_y * pb_y);
    double cosAgl = v1 / (pa_val * pb_val);
    double angle = acos(cosAgl) * 180 / PI;

    return angle ;
}