KJ135
/
RasterProcessTool
mirror of http://172.16.0.12:5000/LAMPSARToolSoftware/RasterProcessTool.git
4
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
RasterProcessTool/Toolbox/SimulationSARTool/SimulationSAR/SatelliteOribtModel.cpp

601 lines
21 KiB
C++
Raw Normal View History

合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
#include "stdafx.h"
#include "SatelliteOribtModel.h"
#include "GeoOperator.h"
#include <boost/math/tools/polynomial.hpp> // <20><><EFBFBD><EFBFBD>ʽ
#include "BaseTool.h"
#include <QDebug>
同步轨道模型的修改
2025-02-14 02:18:48 +00:00
#include <QFile>
#include <QXmlStreamWriter>
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
PolyfitSatelliteOribtModel::PolyfitSatelliteOribtModel()
{
this->oribtStartTime = 0;
this->beamAngle = 0;
this->RightLook = true;
this->cycletime = 0;
this->minAzAngle = 0;
this->maxAzAngle = 0;
this->referenceAzAngle = 0;
this->referenceTimeFromStartTime = 0;
this->AntnnaAxisX = Point3{ 1,0,0 };
this->AntnnaAxisY = Point3{ 0,1,0 };
this->AntnnaAxisZ = Point3{ 0,0,1 };
this->Pxchisq = 0;
this->Pychisq = 0;
this->Pzchisq = 0;
this->Vxchisq = 0;
this->Vychisq = 0;
this->Vzchisq = 0;
this->Pt = 1;
this->Gri = 1;
}
PolyfitSatelliteOribtModel::~PolyfitSatelliteOribtModel()
{
//TODO: <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
}
补充了完整的流程
2024-11-25 06:26:46 +00:00
QString PolyfitSatelliteOribtModel::getSatelliteOribtModelParamsString()
{
QString result = "";
result += this->polyfitPx.size()-1 + "\n";
result += "----------- poly Position X -------------------------\n";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
result += QString::number(this->polyfitPx[i], 'e', 6) + "\n";
}
result += "----------- poly Position Y -------------------------\n";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
result += QString::number(this->polyfitPy[i], 'e', 6) + "\n";
}
result += "----------- poly Position Z -------------------------\n";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
result += QString::number(this->polyfitPz[i], 'e', 6) + "\n";
}
result += "----------- poly Position Vector X ------------------\n";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
result += QString::number(this->polyfitVx[i], 'e', 6) + "\n";
}
result += "----------- poly Position Vector Y ------------------\n";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
result += QString::number(this->polyfitVy[i], 'e', 6) + "\n";
}
result += "----------- poly Position Vector Z ------------------\n";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
result += QString::number(this->polyfitVz[i], 'e', 6) + "\n";
}
result+= "------------------------------------------------------\n";
return result;
}
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
SatelliteOribtNode PolyfitSatelliteOribtModel::getSatelliteOribtNode(double& timeFromStartTime, bool& antAzAngleFlag)
{
// λ<>á<EFBFBD><C3A1>ٶ<EFBFBD>
SatelliteOribtNode node;
ErrorCode state = getSatelliteOribtNode(timeFromStartTime, node, antAzAngleFlag);
return node;
}
ErrorCode PolyfitSatelliteOribtModel::getSatelliteOribtNode(double& timeFromStartTime, SatelliteOribtNode& node, bool& antAzAngleFlag)
{
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>꣬<EFBFBD>ٶȷ<D9B6><C8B7><EFBFBD>
node.time = timeFromStartTime;
node.Px=0;
node.Py=0;
node.Pz=0;
node.Vx=0;
node.Vy=0;
node.Vz=0;
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
node.Px += this->polyfitPx[i] * pow(timeFromStartTime, i);
node.Py += this->polyfitPy[i] * pow(timeFromStartTime, i);
node.Pz += this->polyfitPz[i] * pow(timeFromStartTime, i);
node.Vx += this->polyfitVx[i] * pow(timeFromStartTime, i);
node.Vy += this->polyfitVy[i] * pow(timeFromStartTime, i);
node.Vz += this->polyfitVz[i] * pow(timeFromStartTime, i);
}
node.beamAngle = this->beamAngle; // <20><>λ<EFBFBD><CEBB>
ErrorCode Azstatecode=this->getAzAngleInCurrentTimeFromStartTime(timeFromStartTime, node.AzAngle); // <20>ڶ<EFBFBD><DAB6><EFBFBD>
if (Azstatecode != ErrorCode::SUCCESS) {
return Azstatecode;
} else {}
if (!antAzAngleFlag) {
return ErrorCode::SUCCESS;
} else {
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8>
ErrorCode state = getAntnnaDirection(node);
if (state != ErrorCode::SUCCESS) {
return state;
} else {}
为工具增加界面
2024-11-25 17:51:20 +00:00
state = getZeroDopplerAntDirect(node);
if (state != ErrorCode::SUCCESS) {
return state;
}
else {}
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
return ErrorCode::SUCCESS;
}
ErrorCode PolyfitSatelliteOribtModel::getSatelliteAntDirectNormal(SatelliteOribtNode& Rs, Vector3D& Rt, SatelliteAntDirect& antNode)
{
//Vector3D Rts = Vector3D{Rt.x-Rs.Px,Rt.y- Rs.Py,Rt.z-Rs.Pz}; // Rts t-->s
antNode.Xst = (Rt.x - Rs.Px); // <20><><EFBFBD><EFBFBD> --> <20><><EFBFBD><EFBFBD>
antNode.Yst = (Rt.y - Rs.Py);
antNode.Zst = (Rt.z - Rs.Pz);
antNode.Vxs = Rs.Vx; // <20><><EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD>
antNode.Vys = Rs.Vy;
antNode.Vzs = Rs.Vz;
// <20><><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵ<EFBFBD>µ<EFBFBD>ֵ
antNode.Xant = (antNode.Xst * (Rs.AntYaxisY * Rs.AntZaxisZ - Rs.AntYaxisZ * Rs.AntZaxisY) + antNode.Xst * (Rs.AntXaxisZ * Rs.AntZaxisY - Rs.AntXaxisY * Rs.AntZaxisZ) + antNode.Xst * (Rs.AntXaxisY * Rs.AntYaxisZ - Rs.AntXaxisZ * Rs.AntYaxisY)) / (Rs.AntXaxisX * (Rs.AntYaxisY * Rs.AntZaxisZ - Rs.AntZaxisY * Rs.AntYaxisZ) - Rs.AntYaxisX * (Rs.AntXaxisY * Rs.AntZaxisZ - Rs.AntXaxisZ * Rs.AntZaxisY) + Rs.AntZaxisX * (Rs.AntXaxisY * Rs.AntYaxisZ - Rs.AntXaxisZ * Rs.AntYaxisY));
antNode.Yant = (antNode.Yst * (Rs.AntYaxisZ * Rs.AntZaxisX - Rs.AntYaxisX * Rs.AntZaxisZ) + antNode.Yst * (Rs.AntXaxisX * Rs.AntZaxisZ - Rs.AntXaxisZ * Rs.AntZaxisX) + antNode.Yst * (Rs.AntYaxisX * Rs.AntXaxisZ - Rs.AntXaxisX * Rs.AntYaxisZ)) / (Rs.AntXaxisX * (Rs.AntYaxisY * Rs.AntZaxisZ - Rs.AntZaxisY * Rs.AntYaxisZ) - Rs.AntYaxisX * (Rs.AntXaxisY * Rs.AntZaxisZ - Rs.AntXaxisZ * Rs.AntZaxisY) + Rs.AntZaxisX * (Rs.AntXaxisY * Rs.AntYaxisZ - Rs.AntXaxisZ * Rs.AntYaxisY));
antNode.Zant = (antNode.Zst * (Rs.AntYaxisX * Rs.AntZaxisY - Rs.AntYaxisY * Rs.AntZaxisX) + antNode.Zst * (Rs.AntXaxisY * Rs.AntZaxisX - Rs.AntXaxisX * Rs.AntZaxisY) + antNode.Zst * (Rs.AntXaxisX * Rs.AntYaxisY - Rs.AntYaxisX * Rs.AntXaxisY)) / (Rs.AntXaxisX * (Rs.AntYaxisY * Rs.AntZaxisZ - Rs.AntZaxisY * Rs.AntYaxisZ) - Rs.AntYaxisX * (Rs.AntXaxisY * Rs.AntZaxisZ - Rs.AntXaxisZ * Rs.AntZaxisY) + Rs.AntZaxisX * (Rs.AntXaxisY * Rs.AntYaxisZ - Rs.AntXaxisZ * Rs.AntYaxisY));
// <20><><EFBFBD><EFBFBD>theta <20><> phi
antNode.Norm = std::sqrt(antNode.Xant*antNode.Xant+antNode.Yant*antNode.Yant+antNode.Zant*antNode.Zant); // <20><><EFBFBD><EFBFBD> pho
antNode.ThetaAnt = std::acos(antNode.Zant / antNode.Norm); // theta <20><> Z<><5A><EFBFBD>ļн<C4BC>
antNode.PhiAnt = (antNode.Yant*std::sin(antNode.ThetaAnt)/std::abs(antNode.Yant*std::sin(antNode.ThetaAnt))) * std::acos(antNode.Xant/(antNode.Norm*std::sin(antNode.ThetaAnt)));
return ErrorCode::SUCCESS;
}
void PolyfitSatelliteOribtModel::setSatelliteOribtStartTime(long double oribtStartTime)
{
this->oribtStartTime = oribtStartTime;
}
long double PolyfitSatelliteOribtModel::getSatelliteOribtStartTime()
{
return this->oribtStartTime;
}
void PolyfitSatelliteOribtModel::setbeamAngle(double beamAngle, bool RightLook)
{
this->beamAngle = beamAngle;
this->RightLook = RightLook;
}
void PolyfitSatelliteOribtModel::setAzAngleRange(double cycletime, double minAzAngle, double maxAzAngle, double referenceAzAngle, double referenceTimeFromStartTime)
{
this->cycletime = cycletime;
this->minAzAngle = minAzAngle;
this->maxAzAngle = maxAzAngle;
this->referenceAzAngle = referenceAzAngle;
this->referenceTimeFromStartTime = referenceTimeFromStartTime;
}
double PolyfitSatelliteOribtModel::getAzAngleInCurrentTimeFromStartTime(double& currentTime)
{
// <20><><EFBFBD><EFBFBD><EFBFBD>Ƕ<EFBFBD>
double Azangle = 0;
ErrorCode state = getAzAngleInCurrentTimeFromStartTime(currentTime, Azangle);
return Azangle;
}
///
/// X=Y x Z <20>ڶ<EFBFBD><DAB6><EFBFBD>(-<2D><> <20>ڶ<EFBFBD><DAB6>ǣ<EFBFBD>+<2B><>
/// Z Z Z
/// ^ \ /
/// | \ /
/// y<--X--- y<--X--- y<--X---
/// | |\ /|
/// | \ /
///
ErrorCode PolyfitSatelliteOribtModel::getAzAngleInCurrentTimeFromStartTime(double& currentTime, double& AzAngle)
{
if (std::abs(this->maxAzAngle - this->minAzAngle) < 1e-7||std::abs(this->cycletime)<1e-7) {
AzAngle=this->referenceAzAngle;
return ErrorCode::SUCCESS;
}
else {
AzAngle = this->referenceAzAngle + (currentTime - this->referenceTimeFromStartTime) / this->cycletime * (this->maxAzAngle - this->minAzAngle);
return ErrorCode::SUCCESS;
}
}
void PolyfitSatelliteOribtModel::setAntnnaAxisX(double X, double Y, double Z)
{
this->AntnnaAxisX = Point3{ X, Y, Z };
}
void PolyfitSatelliteOribtModel::setAntnnaAxisY(double X, double Y, double Z)
{
this->AntnnaAxisY = Point3{ X, Y, Z };
}
void PolyfitSatelliteOribtModel::setAntnnaAxisZ(double X, double Y, double Z)
{
this->AntnnaAxisZ = Point3{ X, Y, Z };
}
/// <20><><EFBFBD><EFBFBD>(+<2B><> <20><><EFBFBD>ӣ<EFBFBD>-<2D><>
/// Z Z Z
/// ^ \ /
/// | \ /
/// x<--O--- x<--O--- x<--O---
/// | |\ /|
/// \ /
///
ErrorCode PolyfitSatelliteOribtModel::getAntnnaDirection(SatelliteOribtNode& node)
{
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
bool flag = false;
double nexttime = node.time + 1e-6;
SatelliteOribtNode node1 = this->getSatelliteOribtNode(nexttime, flag);
修改了 时域插值BP算法
2025-02-25 05:18:19 +00:00
//qDebug() << "getAntnnaDirection corrdination " << std::endl;
更新仿真代码文件 1. 修复天线坐标问题 2. 修复天线方向图 插值问题 ps: 下个版本调试整体的能量计算问题
2024-12-20 15:38:34 +00:00
double Vx = (node1.Px - node.Px);
double Vy = (node1.Py - node.Py);
double Vz = (node1.Pz - node.Pz);
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Բ<EFBFBD><D4B2><EFBFBD>
//node.Px = 0;
//node.Py = 0;
//node.Pz = 1;
//Vx = 1, Vy = 0, Vz = 0;
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
// 1. <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8>
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
Eigen::Vector3d axisZ0 = { -1 * node.Px ,-1 * node.Py,-1 * node.Pz }; // z <20><> --<2D><>λ<EFBFBD><CEBB>Ϊ0ʱ<30><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8><EFBFBD>ķ<EFBFBD><C4B7><EFBFBD><EFBFBD><EFBFBD>
更新仿真代码文件 1. 修复天线坐标问题 2. 修复天线方向图 插值问题 ps: 下个版本调试整体的能量计算问题
2024-12-20 15:38:34 +00:00
Eigen::Vector3d axisX0 = { Vx,Vy,Vz }; // x <20><> --<2D><><EFBFBD>з<EFBFBD><D0B7><EFBFBD>
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
Eigen::Vector3d axisY0 = axisZ0.cross(axisX0); // y <20><> --<2D><><EFBFBD>ֶ<EFBFBD><D6B6><EFBFBD> -- <20><>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD>ϵ
修改了 时域插值BP算法
2025-02-25 05:18:19 +00:00
//qDebug() << "axis_X0=[ " << axisX0.x() << "," << axisX0.y() << "," << axisX0.z() << "]" << std::endl;
//qDebug() << "axis_Y0=[ " << axisY0.x() << "," << axisY0.y() << "," << axisY0.z() << "]" << std::endl;
//qDebug() << "axis_Z0=[ " << axisZ0.x() << "," << axisZ0.y() << "," << axisZ0.z() << "]" << std::endl;
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
double rotateAngle = this->RightLook ? -this->beamAngle : this->beamAngle; // <20><>ת<EFBFBD>Ƕ<EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>룩<EFBFBD><EBA3A9>theta , <20>ң<EFBFBD>˳ʱ<CBB3>룩<EFBFBD><EBA3A9> -theta
修改了 时域插值BP算法
2025-02-25 05:18:19 +00:00
//qDebug() << "rotateAngle=" << rotateAngle << std::endl;
//qDebug() << "Look side:\t" << (this->RightLook ? "right" : "left") << std::endl;
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
// 1.2. <20><><EFBFBD>ݲ<EFBFBD>λ<EFBFBD>ǣ<EFBFBD>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>X<EFBFBD><58>-<2D><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
Eigen::Matrix3d rotateMatrixBeam = rotationMatrix(axisX0, rotateAngle*d2r); // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
axisZ0=rotateMatrixBeam*axisZ0; // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
axisY0=rotateMatrixBeam*axisY0;
axisX0=rotateMatrixBeam*axisX0;
// 1.3. <20><><EFBFBD>ݷ<EFBFBD>λ<EFBFBD>ǣ<EFBFBD>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Y<EFBFBD><59><EFBFBD><EFBFBD>ת
double azangle = node.AzAngle;
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
Eigen::Matrix3d rotateMatrixAzAngle = rotationMatrix(axisY0, azangle * d2r); // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
axisZ0 = rotateMatrixAzAngle * axisZ0; // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
axisY0 = rotateMatrixAzAngle * axisY0;
axisX0 = rotateMatrixAzAngle * axisX0;
// 1.4. <20><><EFBFBD><EFBFBD>ʵ<EFBFBD><CAB5>ָ<EFBFBD><D6B8>
node.AntDirecX = axisZ0[0];
node.AntDirecY = axisZ0[1];
node.AntDirecZ = axisZ0[2];
// 2. <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵ,<2C><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>߷<EFBFBD><DFB7><EFBFBD>ͼ
node.AntXaxisX =axisX0[0]; // ʵ<><CAB5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵ <20><> WGS84 <20><><EFBFBD><EFBFBD>ϵ
node.AntXaxisY =axisX0[1];
node.AntXaxisZ =axisX0[2];
node.AntYaxisX =axisY0[0];
node.AntYaxisY =axisY0[1];
node.AntYaxisZ =axisY0[2];
node.AntZaxisX =axisZ0[0];
node.AntZaxisY =axisZ0[1];
node.AntZaxisZ =axisZ0[2];
修改了 时域插值BP算法
2025-02-25 05:18:19 +00:00
//qDebug() << "axis_X=[" << axisX0.x() << "," << axisX0.y() << "," << axisX0.z() << "]" << std::endl;
//qDebug() << "axis_Y=[" << axisY0.x() << "," << axisY0.y() << "," << axisY0.z() << "]" << std::endl;
//qDebug() << "axis_Z=[" << axisZ0.x() << "," << axisZ0.y() << "," << axisZ0.z() << "]" << std::endl;
//qDebug() << "------------------------------------" << std::endl;
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
return ErrorCode::SUCCESS;
}
为工具增加界面
2024-11-25 17:51:20 +00:00
ErrorCode PolyfitSatelliteOribtModel::getZeroDopplerAntDirect(SatelliteOribtNode& node)
{
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
bool flag = false;
double nexttime = node.time + 1e-6;
SatelliteOribtNode node1 = this->getSatelliteOribtNode(nexttime, flag);
为工具增加界面
2024-11-25 17:51:20 +00:00
// 1. <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8>
Eigen::Vector3d axisZ0 = { -1 * node.Px ,-1 * node.Py,-1 * node.Pz }; // z <20><> --<2D><>λ<EFBFBD><CEBB>Ϊ0ʱ<30><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8><EFBFBD>ķ<EFBFBD><C4B7><EFBFBD><EFBFBD><EFBFBD>
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
Eigen::Vector3d axisX0 = { (node1.Px-node.Px) , (node1.Py - node.Py) , (node1.Pz - node.Pz) }; // x <20><> --<2D><><EFBFBD>з<EFBFBD><D0B7><EFBFBD>
为工具增加界面
2024-11-25 17:51:20 +00:00
Eigen::Vector3d axisY0 = axisZ0.cross(axisX0); // y <20><> --<2D><><EFBFBD>ֶ<EFBFBD><D6B6><EFBFBD> -- <20><>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD>ϵ
double rotateAngle = this->RightLook ? -this->beamAngle : this->beamAngle; // <20><>ת<EFBFBD>Ƕ<EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>룩<EFBFBD><EBA3A9>theta , <20>ң<EFBFBD>˳ʱ<CBB3>룩<EFBFBD><EBA3A9> -theta
// 1.2. <20><><EFBFBD>ݲ<EFBFBD>λ<EFBFBD>ǣ<EFBFBD>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>X<EFBFBD><58>-<2D><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
Eigen::Matrix3d rotateMatrixBeam = rotationMatrix(axisX0, rotateAngle * d2r); // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
axisZ0 = rotateMatrixBeam * axisZ0; // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
axisY0 = rotateMatrixBeam * axisY0;
axisX0 = rotateMatrixBeam * axisX0;
// 1.3. <20><><EFBFBD>ݷ<EFBFBD>λ<EFBFBD>ǣ<EFBFBD>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Y<EFBFBD><59><EFBFBD><EFBFBD>ת
double azangle = 0;
代码更新： 1. 仿真部分代码修改为GPU 2. 删除了原CPU的仿真代码 3. GPU代码部分，由 SimulationSAR 文件，移动到 BaseLibraryCPP 文件中 4. 补充了成像平面的 matlab 代码
2024-11-29 15:32:50 +00:00
Eigen::Matrix3d rotateMatrixAzAngle = rotationMatrix(axisY0, azangle * d2r); // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
为工具增加界面
2024-11-25 17:51:20 +00:00
axisZ0 = rotateMatrixAzAngle * axisZ0; // <20><>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
axisY0 = rotateMatrixAzAngle * axisY0;
axisX0 = rotateMatrixAzAngle * axisX0;
// 1.4. <20><><EFBFBD><EFBFBD>ʵ<EFBFBD><CAB5>ָ<EFBFBD><D6B8>
node.zeroDopplerDirectX = axisZ0[0];
node.zeroDopplerDirectY = axisZ0[1];
node.zeroDopplerDirectZ = axisZ0[2];
return ErrorCode::SUCCESS;
}
合并仿真、成像、影像合并的代码
2024-11-25 01:30:14 +00:00
void PolyfitSatelliteOribtModel::addOribtNode(SatelliteOribtNode node)
{
this->oribtNodes.push_back(node);
}
ErrorCode PolyfitSatelliteOribtModel::polyFit(int polynum/*=3*/, bool input_timeFromReferenceTime)
{
if (polynum > this->oribtNodes.size() - 1) {
return ErrorCode::OrbitNodeNotEnough;
}
else {}
this->polyfitPx=std::vector<double>(polynum+1,0);
this->polyfitPy=std::vector<double>(polynum+1,0);
this->polyfitPz=std::vector<double>(polynum+1,0);
this->polyfitVx=std::vector<double>(polynum+1,0);
this->polyfitVy=std::vector<double>(polynum+1,0);
this->polyfitVz=std::vector<double>(polynum+1,0);
std::vector<double> timeArr = std::vector<double>(this->oribtNodes.size(), 0);
std::vector<double> PxArr = std::vector<double>(this->oribtNodes.size(), 0);
std::vector<double> PyArr = std::vector<double>(this->oribtNodes.size(), 0);
std::vector<double> PzArr = std::vector<double>(this->oribtNodes.size(), 0);
std::vector<double> VxArr = std::vector<double>(this->oribtNodes.size(), 0);
std::vector<double> VyArr = std::vector<double>(this->oribtNodes.size(), 0);
std::vector<double> VzArr = std::vector<double>(this->oribtNodes.size(), 0);
// <20><><EFBFBD><EFBFBD>׼<EFBFBD><D7BC>
for (long i = 0; i < this->oribtNodes.size(); i++) {
if (input_timeFromReferenceTime) {
timeArr[i] = this->oribtNodes[i].time;
}
else {
timeArr[i] = this->oribtNodes[i].time - this->oribtStartTime; // <20>Բο<D4B2>ʱ<EFBFBD><CAB1>Ϊ<EFBFBD><CEAA>׼
qDebug() << this->oribtNodes[i].time << "\t--->\t"<< timeArr[i];
}
PxArr[i] = this->oribtNodes[i].Px;
PyArr[i] = this->oribtNodes[i].Py;
PzArr[i] = this->oribtNodes[i].Pz;
VxArr[i] = this->oribtNodes[i].Vx;
VyArr[i] = this->oribtNodes[i].Vy;
VzArr[i] = this->oribtNodes[i].Vz;
}
// <20><><EFBFBD><EFBFBD>Px Py Pz Vx Vy Vz
ErrorCode codePx = polynomial_fit(timeArr, PxArr, polynum, this->polyfitPx, this->Pxchisq);
ErrorCode codePy = polynomial_fit(timeArr, PyArr, polynum, this->polyfitPy, this->Pychisq);
ErrorCode codePz = polynomial_fit(timeArr, PzArr, polynum, this->polyfitPz, this->Pzchisq);
ErrorCode codeVx = polynomial_fit(timeArr, VxArr, polynum, this->polyfitVx, this->Vxchisq);
ErrorCode codeVy = polynomial_fit(timeArr, VyArr, polynum, this->polyfitVy, this->Vychisq);
ErrorCode codeVz = polynomial_fit(timeArr, VzArr, polynum, this->polyfitVz, this->Vzchisq);
// <20><>ӡ this->polyfitPx
qDebug() << "polyfit value:";
qDebug() << "Px" << "\t" << "Py" << "\t" << "Pz" << "\t" << "Vx" << "\t" << "Vy" << "\t" << "Vz";
for (long i = 0; i < this->polyfitPx.size(); i++) { // <20><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>
qDebug() << this->polyfitPx[i] << "\t" << this->polyfitPy[i] << "\t" << this->polyfitPz[i] << "\t" << this->polyfitVx[i] << "\t" << this->polyfitVy[i] << "\t" << this->polyfitVz[i];
}
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
double starttime = this->oribtStartTime;
qDebug() << "oribt refrence time: " << starttime;
qDebug() << "time" << "\t" << "dPx" << "\t" << "dPy" << "\t" << "dPz" << "\t" << "dVx" << "\t" << "dVy" << "\t" << "dVz";
for (long i = 0; i < timeArr.size(); i++) {
double time_temp = timeArr[i];
bool flag = false;
SatelliteOribtNode tempnode;
this->getSatelliteOribtNode(time_temp, tempnode, flag);
qDebug() << timeArr[i] << "\t" << PxArr[i] - tempnode.Px << "\t" << PyArr[i] - tempnode.Py << "\t" << PzArr[i] - tempnode.Pz << "\t" << VxArr[i] - tempnode.Vx << "\t" << VyArr[i] - tempnode.Vy << "\t" << VzArr[i] - tempnode.Vz;
}
return ErrorCode::SUCCESS;
}
double PolyfitSatelliteOribtModel::getPt()
{
return this->Pt;
}
double PolyfitSatelliteOribtModel::getGri()
{
return this->Gri;
}
void PolyfitSatelliteOribtModel::setPt(double pt)
{
this->Pt = pt;
}
void PolyfitSatelliteOribtModel::setGri(double gri)
{
this->Gri = gri;
}
std::shared_ptr<AbstractSatelliteOribtModel> CreataPolyfitSatelliteOribtModel(std::vector<SatelliteOribtNode>& nodes, long double startTime, int polynum)
{
qDebug() << "CreataPolyfitSatelliteOribtModel \t" << (double)startTime<<"\t" << polynum;
std::shared_ptr<PolyfitSatelliteOribtModel> ployfitOribtModel= std::make_shared< PolyfitSatelliteOribtModel>();
for (long i = 0; i < nodes.size(); i++) {
ployfitOribtModel->addOribtNode(nodes[i]);
}
ployfitOribtModel->setSatelliteOribtStartTime(startTime);
ErrorCode stateCode = ployfitOribtModel->polyFit(polynum,false);
if (stateCode != ErrorCode::SUCCESS) {
qDebug() <<QString::fromStdString( errorCode2errInfo(stateCode));
return nullptr;
}
else {
return ployfitOribtModel;
}
return ployfitOribtModel;
}
同步轨道模型的修改
2025-02-14 02:18:48 +00:00
void PolyfitSatelliteOribtModel::saveToXml(const QString& filePath) {
QFile file(filePath);
if (!file.open(QIODevice::WriteOnly | QIODevice::Text)) {
// Handle error
return;
}
QXmlStreamWriter xmlWriter(&file);
xmlWriter.setAutoFormatting(true);
xmlWriter.writeStartDocument();
xmlWriter.writeStartElement("PolyfitSatelliteOribtModel");
// Write basic properties
xmlWriter.writeTextElement("oribtStartTime", QString::number(oribtStartTime, 'e', 35)); // <20><>ѧ<EFBFBD><D1A7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>35λ<35><CEBB>Ч<EFBFBD><D0A7><EFBFBD><EFBFBD>
// Write polyfit parameters
xmlWriter.writeStartElement("PolyfitParameters");
输出轨道多项式模型的精度为 36 个有效数字（并不意味实际精度能到36个有效数字）
2025-04-07 02:36:51 +00:00
xmlWriter.writeAttribute("Pxchisq", QString::number(Pxchisq,'e',35));
xmlWriter.writeAttribute("Pychisq", QString::number(Pychisq,'e',35));
xmlWriter.writeAttribute("Pzchisq", QString::number(Pzchisq,'e',35));
xmlWriter.writeAttribute("Vxchisq", QString::number(Vxchisq,'e',35));
xmlWriter.writeAttribute("Vychisq", QString::number(Vychisq,'e',35));
xmlWriter.writeAttribute("Vzchisq", QString::number(Vzchisq,'e',35));
同步轨道模型的修改
2025-02-14 02:18:48 +00:00
writeVector(xmlWriter, "polyfitPx", polyfitPx);
writeVector(xmlWriter, "polyfitPy", polyfitPy);
writeVector(xmlWriter, "polyfitPz", polyfitPz);
writeVector(xmlWriter, "polyfitVx", polyfitVx);
writeVector(xmlWriter, "polyfitVy", polyfitVy);
writeVector(xmlWriter, "polyfitVz", polyfitVz);
xmlWriter.writeEndElement();
xmlWriter.writeEndElement(); // End of PolyfitSatelliteOribtModel
xmlWriter.writeEndDocument();
file.close();
}
void PolyfitSatelliteOribtModel::writeVector(QXmlStreamWriter& xmlWriter, const QString& name, const std::vector<double>& vec) {
xmlWriter.writeStartElement(name);
for (double val : vec) {
输出轨道多项式模型的精度为 36 个有效数字（并不意味实际精度能到36个有效数字）
2025-04-07 02:36:51 +00:00
xmlWriter.writeTextElement("Value", QString::number(val,'e',35));
同步轨道模型的修改
2025-02-14 02:18:48 +00:00
}
xmlWriter.writeEndElement();
}
bool PolyfitSatelliteOribtModel::loadFromXml(const QString& filePath) {
QFile file(filePath);
if (!file.open(QIODevice::ReadOnly | QIODevice::Text)) {
// Handle error
return false;
}
QXmlStreamReader xmlReader(&file);
while (!xmlReader.atEnd() && !xmlReader.hasError()) {
QXmlStreamReader::TokenType token = xmlReader.readNext();
if (token == QXmlStreamReader::StartElement) {
if (xmlReader.name() == "oribtStartTime") {
oribtStartTime = xmlReader.readElementText().toDouble();
}
else if (xmlReader.name() == "PolyfitParameters") {
Pxchisq = xmlReader.attributes().value("Pxchisq").toDouble();
Pychisq = xmlReader.attributes().value("Pychisq").toDouble();
Pzchisq = xmlReader.attributes().value("Pzchisq").toDouble();
Vxchisq = xmlReader.attributes().value("Vxchisq").toDouble();
Vychisq = xmlReader.attributes().value("Vychisq").toDouble();
Vzchisq = xmlReader.attributes().value("Vzchisq").toDouble();
修复查找表生成工具bug
2025-02-19 14:49:46 +00:00
}
else if (xmlReader.name() == "polyfitPx") {
this->readVector(xmlReader, QString("polyfitPx"), polyfitPx);
}
else if (xmlReader.name() == "polyfitPy") {
this->readVector(xmlReader, QString("polyfitPy"), polyfitPy);
}
else if (xmlReader.name() == "polyfitPz") {
this->readVector(xmlReader, QString("polyfitPz"), polyfitPz);
}
else if (xmlReader.name() == "polyfitVx") {
this->readVector(xmlReader, QString("polyfitVx"), polyfitVx);
}
else if (xmlReader.name() == "polyfitVy") {
this->readVector(xmlReader, QString("polyfitVy"), polyfitVy);
}
else if (xmlReader.name() == "polyfitVz") {
this->readVector(xmlReader, QString("polyfitVz"), polyfitVz);
同步轨道模型的修改
2025-02-14 02:18:48 +00:00
}
}
}
if (xmlReader.hasError()) {
// Handle error
return false;
}
file.close();
return true;
}
增加了DEM重采样工具
2025-02-17 09:13:18 +00:00
修复查找表生成工具bug
2025-02-19 14:49:46 +00:00
void PolyfitSatelliteOribtModel::readVector(QXmlStreamReader& xmlReader, const QString& name, std::vector<double>& vec) {
if (xmlReader.name() == name) {
qDebug() << "read orbit model ,key " << name;
while (xmlReader.readNextStartElement()) {
if (xmlReader.name() == "Value") {
vec.push_back(xmlReader.readElementText().toDouble());
}
}
}
}
增加了DEM重采样工具
2025-02-17 09:13:18 +00:00
long double PolyfitSatelliteOribtModel::getOribtStartTime()
{
return oribtStartTime;
}
std::vector<double> PolyfitSatelliteOribtModel::getPolyfitPx()
{
return polyfitPx;
}
std::vector<double> PolyfitSatelliteOribtModel::getPolyfitPy()
{
return polyfitPy;
}
std::vector<double> PolyfitSatelliteOribtModel::getPolyfitPz()
{
return polyfitPz;
}
std::vector<double> PolyfitSatelliteOribtModel::getPolyfitVx()
{
return polyfitVx;
}
std::vector<double> PolyfitSatelliteOribtModel::getPolyfitVy()
{
return polyfitVy;
}
std::vector<double> PolyfitSatelliteOribtModel::getPolyfitVz()
{
return polyfitVz;
}