经纬度与平面坐标互转，经纬度与空间直角坐标互转（C++代码）

最新推荐文章于 2024-06-29 11:41:21 发布

weixin_30362801

最新推荐文章于 2024-06-29 11:41:21 发布

阅读量5.5k

点赞数 7

文章标签： c/c++

原文链接：http://www.cnblogs.com/xingzhensun/p/11377963.html

版权

本文分享了在三维激光点云处理中经纬度与平面坐标、空间直角坐标互转的C++实现，提供了头文件、源文件及测试代码，方便快速集成到项目中。

摘要由CSDN通过智能技术生成

在三维激光点云处理中，需经常用到经纬度与平面坐标、空间直角坐标互转的功能，有时只是临时写一个测试demo，不想调用gdal，太麻烦，希望有更简单的调用方式。

网上一通搜索，并没有找到很完整的代码，一些代码杂乱无章，正确性还需确认，于是自己动手写了这四个转换函数，在此与大家分享使用：

头文件：

/*******************************************************************
*
*    作者:    Sun Zhenxing
*    创建日期:    20190819
*
*    说明：实现经纬度与平面坐标互转，实现经纬度与空间直角坐标互转
*
******************************************************************/

#ifndef ZTGEOGRAPHYCOORDINATETRANSFORM_H
#define ZTGEOGRAPHYCOORDINATETRANSFORM_H

#include <math.h>

struct EllipsoidParameter
{
    double a, b, f;
    double e2, ep2;

    // 高斯投影参数
    double c;
    double a0, a2, a4, a6;

    EllipsoidParameter()
    {
        // Default: wgs84
        a = 6378137.0;
        e2 = 0.00669437999013;

        b = sqrt(a * a * (1 - e2));
        ep2 = (a * a - b * b) / (b * b);
        f = (a - b) / a;
        double f0 = 1 / 298.257223563;
        double f1 = 1 / f;

        c = a / (1 - f);
        double m0, m2, m4, m6, m8;
        m0 = a * (1 - e2);
        m2 = 1.5 * e2 * m0;
        m4 = 1.25 * e2 * m2;
        m6 = 7 * e2 * m4 / 6;
        m8 = 9 * e2 * m6 / 8;
        a0 = m0 + m2 / 2 + 3 * m4 / 8 + 5 * m6 / 16 + 35 * m8 / 128;
        a2 = m2 / 2 + m4 / 2 + 15 * m6 / 32 + 7 * m8 / 16;
        a4 = m4 / 8 + 3 * m6 / 16 + 7 * m8 / 32;
        a6 = m6 / 32 + m8 / 16;
    }

    EllipsoidParameter(double ia, double ib)
    {
        if (ib > 1000000)    // ib 是短半轴
        {
            a = ia;
            b = ib;

            f = (a - b) / a;
            e2 = (a * a - b * b) / (a * a);
            ep2 = (a * a - b * b) / (b * b);
        }
        else if (ib < 1)    // ib 是椭球第一偏心率的平方
        {
            a = ia;
            e2 = ib;

            b = sqrt(a * a * (1