150 lines
5.0 KiB
C
150 lines
5.0 KiB
C
|
#pragma once
|
|||
|
|
|
|||
|
|
|
|||
|
|
#ifndef _GEOOPERATOR_H
|
|||
|
|
#define _GEOOPERATOR_H
|
|||
|
|
|
|||
|
|
#include "BaseConstVariable.h"
|
|||
|
|
#include <Eigen/Core>
|
|||
|
|
#include <Eigen/Dense>
|
|||
|
|
#include <stdio.h>
|
|||
|
|
#include <stdlib.h>
|
|||
|
|
#include <memory.h>
|
|||
|
|
#include <string.h>
|
|||
|
|
#include <iostream>
|
|||
|
|
|
|||
|
|
|
|||
|
|
/// <summary>
|
|||
|
|
/// 将经纬度转换为地固参心坐标系
|
|||
|
|
/// </summary>
|
|||
|
|
/// <param name="XYZP">经纬度点--degree</param>
|
|||
|
|
/// <returns>投影坐标系点</returns>
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI LLA2XYZ(const Landpoint& LLA);
|
|||
|
|
void BASECONSTVARIABLEAPI LLA2XYZ(const Landpoint& LLA,Point3& XYZ);
|
|||
|
|
Eigen::MatrixXd BASECONSTVARIABLEAPI LLA2XYZ(Eigen::MatrixXd landpoint);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getPixelSpacingInDegree(double pixelSpacingInMeter);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getPixelSpacingInMeter(double pixelSpacingInDegree);
|
|||
|
|
/// <summary>
|
|||
|
|
/// 将地固参心坐标系转换为经纬度
|
|||
|
|
/// </summary>
|
|||
|
|
/// <param name="XYZ">固参心坐标系</param>
|
|||
|
|
/// <returns>经纬度--degree</returns>
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI XYZ2LLA(const Landpoint& XYZ);
|
|||
|
|
|
|||
|
|
void BASECONSTVARIABLEAPI XYZ2BLH_FixedHeight(double x, double y, double z, double ati, Landpoint& point);
|
|||
|
|
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI operator +(const Landpoint& p1, const Landpoint& p2);
|
|||
|
|
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI operator -(const Landpoint& p1, const Landpoint& p2);
|
|||
|
|
|
|||
|
|
bool BASECONSTVARIABLEAPI operator ==(const Landpoint& p1, const Landpoint& p2);
|
|||
|
|
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI operator *(const Landpoint& p, double scale);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getAngle(const Landpoint& a, const Landpoint& b);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI dot(const Landpoint& p1, const Landpoint& p2);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getlength(const Landpoint& p1);
|
|||
|
|
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI crossProduct(const Landpoint& a, const Landpoint& b);
|
|||
|
|
|
|||
|
|
|
|||
|
|
Landpoint BASECONSTVARIABLEAPI getSlopeVector(const Landpoint& p0, const Landpoint& p1, const Landpoint& p2, const Landpoint& p3, const Landpoint& p4, bool inLBH=true);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getlocalIncAngle(Landpoint& satepoint, Landpoint& landpoint, Landpoint& slopeVector);
|
|||
|
|
|
|||
|
|
float BASECONSTVARIABLEAPI cross2d(Point3 a, Point3 b);
|
|||
|
|
|
|||
|
|
Point3 BASECONSTVARIABLEAPI operator -(Point3 a, Point3 b);
|
|||
|
|
|
|||
|
|
Point3 BASECONSTVARIABLEAPI operator +(Point3 a, Point3 b);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI operator /(Point3 a, Point3 b);
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
// 矢量计算
|
|||
|
|
struct Vector3D {
|
|||
|
|
double x, y, z;
|
|||
|
|
};
|
|||
|
|
|
|||
|
|
// 计算两点之间的距离
|
|||
|
|
double BASECONSTVARIABLEAPI distance(const Vector3D& p1, const Vector3D& p2);
|
|||
|
|
// 计算点到直线的最短距离
|
|||
|
|
double BASECONSTVARIABLEAPI pointToLineDistance(const Vector3D& point, const Vector3D& linePoint, const Vector3D& lineDirection);
|
|||
|
|
|
|||
|
|
Vector3D BASECONSTVARIABLEAPI operator +(const Vector3D& p1, const Vector3D& p2);
|
|||
|
|
|
|||
|
|
Vector3D BASECONSTVARIABLEAPI operator -(const Vector3D& p1, const Vector3D& p2);
|
|||
|
|
|
|||
|
|
bool BASECONSTVARIABLEAPI operator ==(const Vector3D& p1, const Vector3D& p2);
|
|||
|
|
|
|||
|
|
Vector3D BASECONSTVARIABLEAPI operator *(const Vector3D& p, double scale);
|
|||
|
|
|
|||
|
|
Vector3D BASECONSTVARIABLEAPI operator *(double scale,const Vector3D& p );
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getAngle(const Vector3D& a, const Vector3D& b);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getCosAngle(const Vector3D& a, const Vector3D& b);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI dot(const Vector3D& p1, const Vector3D& p2);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getlength(const Vector3D& p1);
|
|||
|
|
|
|||
|
|
Vector3D BASECONSTVARIABLEAPI crossProduct(const Vector3D& a, const Vector3D& b);
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
/// <summary>
|
|||
|
|
/// n1
|
|||
|
|
/// n4 n0 n2
|
|||
|
|
/// n3
|
|||
|
|
/// </summary>
|
|||
|
|
/// <param name="n0"></param>
|
|||
|
|
/// <param name="n1"></param>
|
|||
|
|
/// <param name="n2"></param>
|
|||
|
|
/// <param name="n3"></param>
|
|||
|
|
/// <param name="n4"></param>
|
|||
|
|
/// <returns></returns>
|
|||
|
|
Vector3D BASECONSTVARIABLEAPI getSlopeVector(const Vector3D& n0, const Vector3D& n1, const Vector3D& n2, const Vector3D& n3, const Vector3D& n4);
|
|||
|
|
|
|||
|
|
|
|||
|
|
struct CartesianCoordinates {
|
|||
|
|
double x, y, z;
|
|||
|
|
};
|
|||
|
|
|
|||
|
|
struct SphericalCoordinates {
|
|||
|
|
double r, theta, phi;
|
|||
|
|
};
|
|||
|
|
|
|||
|
|
SphericalCoordinates BASECONSTVARIABLEAPI cartesianToSpherical(const CartesianCoordinates& cartesian);
|
|||
|
|
|
|||
|
|
CartesianCoordinates BASECONSTVARIABLEAPI sphericalToCartesian(const SphericalCoordinates& spherical);
|
|||
|
|
|
|||
|
|
double BASECONSTVARIABLEAPI getlocalIncAngle(Vector3D& satepoint, Vector3D& landpoint, Vector3D& slopeVector);
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
/**
|
|||
|
|
* @brief 将平面坐标分辨率（米）转换为经纬度分辨率（度）
|
|||
|
|
* @param sourceEPSG 平面坐标系 EPSG 码（如 UTM Zone 50N 对应 32650）
|
|||
|
|
* @param resolutionMeters 输入分辨率（单位：米）
|
|||
|
|
* @param refLon 参考点经度（十进制度，用于计算局部转换系数）
|
|||
|
|
* @param refLat 参考点纬度（十进制度，用于计算局部转换系数）
|
|||
|
|
* @param[out] degreePerPixelX 经度方向分辨率（度/像素）
|
|||
|
|
* @param[out] degreePerPixelY 纬度方向分辨率（度/像素）
|
|||
|
|
* @return 是否转换成功
|
|||
|
|
*/
|
|||
|
|
bool BASECONSTVARIABLEAPI ConvertResolutionToDegrees(
|
|||
|
|
int sourceEPSG,
|
|||
|
|
double resolutionMeters,
|
|||
|
|
double refLon,
|
|||
|
|
double refLat,
|
|||
|
|
double& degreePerPixelX,
|
|||
|
|
double& degreePerPixelY
|
|||
|
|
);
|
|||
|
|
|
|||
|
|
#endif
|