如何使用Boost C++获取linestring的旋转角度或朝向

开发者阿泽

2026-10-1

Boost.Geometry Linestring朝向计算与正北判断方案

实现原理

两点构成的linestring的朝向可通过首尾点的坐标差值计算向量与正北方向的夹角得到，常规地理坐标系中默认y轴正方向为正北，方位角取值范围为0~360度，正北对应0度/360度。

代码实现

步骤1：定义方位角计算函数

#include <boost/geometry.hpp>
#include <cmath>
#include <stdexcept>

// 你提前定义的linestring类型
typedef boost::geometry::model::linestring<point_type> linestring_type;

// 计算线段方位角，返回值为从正北顺时针旋转的角度，范围0~360度
double calculate_line_bearing(const linestring_type& line) {
    // 入参校验：linestring至少需要两个点
    if (line.size() < 2) {
        throw std::invalid_argument("linestring must have at least 2 points");
    }
    const auto& start_p = line.front();
    const auto& end_p = line.back();

    double dx = boost::geometry::get<0>(end_p) - boost::geometry::get<0>(start_p);
    double dy = boost::geometry::get<1>(end_p) - boost::geometry::get<1>(start_p);

    // 排除首尾点重合的异常情况
    const double eps = 1e-8;
    if (fabs(dx) < eps && fabs(dy) < eps) {
        throw std::runtime_error("start point and end point are coincident");
    }

    // 弧度转角度，调整为正北为0的顺时针方位角
    double rad = atan2(dx, dy);
    double bearing = rad * 180.0 / M_PI;
    if (bearing < 0) {
        bearing += 360.0;
    }
    return bearing;
}

步骤2：正北判断逻辑

考虑浮点数精度误差，通过容差阈值判断是否朝向正北：

bool is_facing_north(const linestring_type& line, double tolerance = 0.5) {
    double bearing = calculate_line_bearing(line);
    // 容差范围可根据业务精度需求调整，默认允许0.5度的误差
    return bearing < tolerance || bearing > 360 - tolerance;
}