243 lines
9.0 KiB
C++
243 lines
9.0 KiB
C++
#pragma once
|
|
///
|
|
/// 仿真成像算法
|
|
///
|
|
//#define EIGEN_USE_MKL_ALL
|
|
//#define EIGEN_VECTORIZE_SSE4_2
|
|
//#include <mkl.h>
|
|
// 本地方法
|
|
#include "baseTool.h"
|
|
#include <iostream>
|
|
#include <Eigen/Core>
|
|
#include <Eigen/Dense>
|
|
#include <time.h>
|
|
//#include <mkl.h>
|
|
#include <omp.h>
|
|
#include "SateOrbit.h"
|
|
#include "ImageMatch.h"
|
|
using namespace std;
|
|
using namespace Eigen;
|
|
|
|
////////////// 常用函数 ////////////////////////
|
|
|
|
double getRangeColumn(long double R, long double NearRange, long double Fs, long double lamda);
|
|
Eigen::MatrixXd getRangeColumn(Eigen::MatrixXd R, long double NearRange, long double Fs, long double lamda);
|
|
|
|
double getRangebyColumn(double j, long double NearRange, long double Fs, long double lamda);
|
|
Eigen::MatrixXd getRangebyColumn(Eigen::MatrixXd j, long double NearRange, long double Fs, long double lamda);
|
|
///////////// ptsn 算法 /////////////////////
|
|
|
|
class PSTNAlgorithm {
|
|
public:
|
|
// 初始化与析构函数
|
|
PSTNAlgorithm();
|
|
PSTNAlgorithm(string parameterPath);
|
|
~PSTNAlgorithm();
|
|
|
|
int dem2lat_lon(std::string dem_path, std::string lon_path, std::string lat_path);
|
|
int dem2SAR_RC(std::string dem_path, std::string sim_rc_path);
|
|
|
|
// 模拟算法函数
|
|
Eigen::MatrixX<double> calNumericalDopplerValue(Eigen::MatrixX<double> R);// 数值模拟法计算多普勒频移值
|
|
double calNumericalDopplerValue(double R);// 数值模拟法计算多普勒频移值
|
|
Eigen::MatrixX<double> calTheoryDopplerValue(Eigen::MatrixX<double> R, Eigen::MatrixX<double> R_s1, Eigen::MatrixX<double> V_s1);//根据理论模型计算多普勒频移值
|
|
double calTheoryDopplerValue(double R, Eigen::MatrixX<double> R_s1, Eigen::MatrixX<double> V_s1);
|
|
Eigen::MatrixX<double> PSTN(Eigen::MatrixX<double> TargetPostion, double ave_dem, double dt, bool isCol ); // 输入DEM
|
|
//Eigen::MatrixXd WGS842J2000(Eigen::MatrixXd blh);
|
|
//Landpoint WGS842J2000(Landpoint p);
|
|
public: // WGS84 到 J2000 之间的变换参数
|
|
Eigen::MatrixXd UTC;
|
|
double Xp = 0.204071;
|
|
double Yp = 0.318663;
|
|
double Dut1 = 0.0366742;
|
|
double Dat = 37;
|
|
public:
|
|
int height; // 影像的高
|
|
int width;
|
|
|
|
// 入射角
|
|
double near_in_angle;// 近入射角
|
|
double far_in_angle;// 远入射角
|
|
|
|
// SAR的成像参数
|
|
double fs;// 距离向采样率
|
|
double R0;//近斜距
|
|
double LightSpeed; // 光速
|
|
double lamda;// 波长
|
|
double refrange;// 参考斜距
|
|
double doppler_reference_time; //多普勒参考时间
|
|
|
|
double imgStartTime;// 成像起始时间
|
|
double PRF;// 脉冲重复率
|
|
|
|
int doppler_paramenter_number;//多普勒系数个数
|
|
MatrixX<double> doppler_paras;// 多普勒系数
|
|
|
|
OrbitPoly orbit; // 轨道模型
|
|
|
|
};
|
|
|
|
|
|
/// <summary>
|
|
/// 获取局地入射角，角度值
|
|
/// </summary>
|
|
/// <param name="satepoint"></param>
|
|
/// <param name="landpoint"></param>
|
|
/// <param name="slopeVector"></param>
|
|
/// <returns></returns>
|
|
double getlocalIncAngle(Landpoint& satepoint, Landpoint& landpoint, Landpoint& slopeVector);
|
|
|
|
|
|
/// <summary>
|
|
/// 侧视入射角,角度值
|
|
/// </summary>
|
|
/// <param name="satepoint"></param>
|
|
/// <param name="landpoint"></param>
|
|
/// <returns></returns>
|
|
double getIncAngle(Landpoint& satepoint, Landpoint& landpoint);
|
|
|
|
|
|
/// <summary>
|
|
/// ASF计算方法
|
|
/// </summary>
|
|
class ASFOrthClass {
|
|
|
|
public:
|
|
Eigen::MatrixXd Satellite2ECR(Eigen::Vector3d Rsc, Eigen::Vector3d Vsc); // 根据卫星坐标计算变换矩阵 M
|
|
Eigen::Vector3d UnitVectorOfSatelliteAndTarget(double alpha, double beta, Eigen::MatrixXd M);
|
|
double GetLookFromRangeYaw(double R, double alpha, double beta, Eigen::Vector3d SatellitePosition, Eigen::Vector3d SatelliteVelocity, double R_threshold, double H = 0);
|
|
|
|
Eigen::Vector3d GetXYZByBetaAlpha(double alpha,double beta, Eigen::Vector3d SatellitePosition,double R, Eigen::MatrixXd M);
|
|
|
|
double FD(double alpha, double beta, Eigen::Vector3d SatelliteVelocity, Eigen::Vector3d TargetVelocity,double R,double lamda, Eigen::MatrixXd M);
|
|
double FR(double alpha, double beta, Eigen::Vector3d SatellitePosition, Eigen::MatrixXd M, double R_threshold, double H = 0);
|
|
|
|
Eigen::Vector3d ASF(double R, Eigen::Vector3d SatellitePosition, Eigen::Vector3d SatelliteVelocity, Eigen::Vector3d TargetPosition, PSTNAlgorithm PSTN, double R_threshold, double H = 0, double alpha0 = 0, double beta0 = 0);
|
|
|
|
};
|
|
|
|
/// <summary>
|
|
/// 仿真处理流程
|
|
/// </summary>
|
|
class simProcess {
|
|
public:
|
|
simProcess();
|
|
~simProcess();
|
|
|
|
int parameters(int argc, char* argv[]);
|
|
|
|
int InitSimulationSAR(std::string paras_path,std::string workspace_path,std::string out_dir_path,std::string in_dem_path,std::string in_sar_path); // 间接定位法
|
|
|
|
int CreateSARDEM();
|
|
int dem2SAR(); // 切换行号
|
|
int SARIncidentAngle();
|
|
int SARSimulationWGS();
|
|
int SARSimulation();
|
|
int in_sar_power();
|
|
int ReflectTable_WGS2Range();
|
|
|
|
int InitRPCIncAngle(std::string paras_path, std::string workspace_path, std::string out_dir_path, std::string in_dem_path,std::string in_rpc_lon_lat_path,std::string out_inc_angle_path, std::string out_local_inc_angle_path, std::string out_inc_angle_geo_path, std::string out_local_inc_angle_geo_path);
|
|
int dem2SAR_row(); // 切换行号
|
|
int SARIncidentAngle_RPC();
|
|
int createRPCDEM();
|
|
|
|
// 格网离散插值
|
|
int Scatter2Grid(std::string lon_lat_path, std::string data_tiff, std::string grid_path, double space);
|
|
|
|
// ASF 模块计算
|
|
int InitASFSAR(std::string paras_path, std::string workspace_path, std::string out_dir_path, std::string in_dem_path);
|
|
|
|
int ASF(std::string in_dem_path, std::string out_latlon_path, ASFOrthClass asfclass, PSTNAlgorithm PSTN);
|
|
|
|
//int dem2simSAR(std::string dem_path, std::string out_sim_path, PSTNAlgorithm PSTN); // 根据DEM生成输出仿真图像
|
|
int sim_SAR(std::string dem_path, std::string sim_rc_path, std::string sim_sar_path, PSTNAlgorithm PSTN);
|
|
int dem2aspect_slope(std::string dem_path, std::string aspect_path, std::string slope_path);
|
|
int sim_sum_SAR(std::string sim_dem_path,std::string sim_rc_path, std::string sim_orth_path, std::string sim_sum_path,PSTNAlgorithm pstn);
|
|
void interpolation_GTC_sar_sigma(std::string in_rc_wgs84_path, std::string in_ori_sar_path, std::string out_orth_sar_path, PSTNAlgorithm pstn);
|
|
|
|
//双线性插值
|
|
void interpolation_bil(std::string in_rc_wgs84_path, std::string in_ori_sar_path, std::string out_orth_sar_path, PSTNAlgorithm pstn);
|
|
//lee滤波
|
|
void lee_process(std::string in_ori_sar_path, std::string out_orth_sar_path, int w_size, double noise_var);
|
|
// 原始影像强度图
|
|
int ori_sar_power(std::string ori_sar_path, std::string out_sar_power_path);
|
|
|
|
// 匹配偏移模型构建
|
|
int createImageMatchModel(std::string ori_sar_rsc_path, std::string ori_sar_rsc_jpg_path, std::string sim_sar_path, std::string sim_sar_jpg_path, std::string matchmodel_path);
|
|
|
|
// 纠正影像
|
|
int correctOrth_rc(std::string sim_rc_path,ImageMatch matchmodel);
|
|
|
|
int correct_ati(std::string orth_rc_path, std::string dem_path, std::string out_inclocal_path, std::string out_dem_path, std::string out_count_path, PSTNAlgorithm PSTN);
|
|
|
|
void calcalIncident_localIncident_angle(std::string in_dem_path, std::string in_rc_wgs84_path, std::string out_incident_angle_path, std::string out_local_incident_angle_path, PSTNAlgorithm PSTN);
|
|
|
|
void calGEC_Incident_localIncident_angle(std::string in_dem_path, std::string in_gec_lon_lat_path,std::string out_incident_angle_path, std::string out_local_incident_angle_path,PSTNAlgorithm PSTN);
|
|
|
|
void interpolation_GTC_sar(std::string in_rc_wgs84_path, std::string in_ori_sar_path, std::string out_orth_sar_path, PSTNAlgorithm pstn);
|
|
// RPC
|
|
void CreateRPC_DEM(std::string in_rpc_rc_path, std::string in_dem_path, std::string out_rpc_dem_path);
|
|
|
|
void CreateRPC_refrenceTable(string in_rpc_tiff_path, string in_merge_dem, string out_rpc_lon_lat_tiff_path);
|
|
|
|
void CorrectionFromSLC2Geo(string in_lon_lat_path, string in_radar_path, string out_radar_path, int in_band_ids);
|
|
|
|
//TODO:计算方位角
|
|
double getAzimuth();
|
|
|
|
// 内部参数
|
|
public:
|
|
ImageMatch matchmodel;
|
|
bool isMatchModel;
|
|
|
|
std::string workSpace_path;// 工作空间路径
|
|
std::string outSpace_path;// 输出工作空间路径
|
|
PSTNAlgorithm pstn; // 参数组件
|
|
///// RPC 局地入射角 ///////////////////////////////////
|
|
std::string in_rpc_lon_lat_path;
|
|
std::string out_dir_path;
|
|
std::string workspace_path;
|
|
// 临时文件
|
|
std::string rpc_wgs_path;
|
|
std::string ori_sim_count_tiff;// 映射角文件
|
|
// 输出文件
|
|
std::string out_inc_angle_rpc_path;
|
|
std::string out_local_inc_angle_rpc_path;
|
|
|
|
// 输出文件
|
|
std::string out_inc_angle_geo_path;
|
|
std::string out_local_inc_angle_geo_path;
|
|
|
|
///// 正向仿真方法 /////////
|
|
|
|
|
|
|
|
// 临时产品文件
|
|
std::string in_dem_path; // 输入DEM
|
|
std::string dem_path; // 重采样之后DEM
|
|
std::string dem_r_path;// 行号影像
|
|
std::string dem_rc_path; // 行列号
|
|
std::string sar_sim_wgs_path;
|
|
std::string sar_sim_path;
|
|
std::string in_sar_path;
|
|
std::string sar_jpg_path;
|
|
std::string sar_power_path;
|
|
// 最终产品
|
|
std::string out_dem_rc_path; // 经纬度与行列号变换文件
|
|
|
|
std::string out_dem_slantRange_path; // 斜距文件
|
|
std::string out_plant_slantRange_path;// 平面斜距文件
|
|
|
|
//// ASF 方法 /////////////
|
|
std::string out_lon_path;// 经度
|
|
std::string out_lat_path;// 纬度
|
|
std::string out_slantRange_path;// 斜距文件
|
|
|
|
/// 共同文件 ///
|
|
std::string out_localIncidenct_path;// 计算局地入射角
|
|
std::string out_incidence_path; // 入射角文件
|
|
std::string out_ori_sim_tiff;// 映射角文件'
|
|
std::string out_sim_ori_tiff;
|
|
};
|
|
|
|
bool PtInRect(Point_3d pCur, Point_3d pLeftTop, Point_3d pRightTop, Point_3d pRightBelow, Point_3d pLeftBelow); |