修复两行根数创建卫星轨道

pull/13/head
陈增辉 2025-03-15 17:14:17 +08:00
parent 151d878e61
commit 2c7e64e370
7 changed files with 130 additions and 26 deletions

View File

@ -1,4 +1,5 @@
#include "SPG4Function.h"
#include "SPG4Tool.h"
#include <Tle.h>
#include <SGP4.h>
#include <Observer.h>
@ -12,16 +13,23 @@
#include <fstream>
#include <vector>
#include <cstdlib>
#include <QDate>
#include <QDateTime>
std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end, double inc, bool printfinfoflag)
std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end, double inc, bool printfinfoflag, bool running, bool first_run)
{
std::cout << "RunTle\t" ;
std::cout << "Start time:\t" << start;
std::cout << "End time:\t" << end;
std::cout << "inc time:\t" << inc << std::endl;
std::vector<SatelliteAntPos> resultpos(0);
double current = start;
libsgp4::SGP4 model(tle);
bool running = true;
bool first_run = true;
//bool running = true;
//bool first_run = true;
std::cout << std::setprecision(0) << tle.NoradNumber() << " xx"
<< std::endl;
@ -53,16 +61,17 @@ std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end,
libsgp4::Eci eci = model.FindPosition(tsince);
position = eci.Position();
velocity = eci.Velocity();
}
catch (libsgp4::SatelliteException& e)
{
std::cerr << e.what() << std::endl;
std::cerr << "SatelliteException:\t" << e.what() << std::endl;
error = true;
running = false;
}
catch (libsgp4::DecayedException& e)
{
std::cerr << e.what() << std::endl;
std::cerr <<"DecayedException:\t" << e.what() << std::endl;
position = e.Position();
velocity = e.Velocity();
@ -83,8 +92,8 @@ std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end,
antpos.Px = position.x;
antpos.Py = position.y;
antpos.Pz = position.z;
antpos.Vx = velocity.z;
antpos.Vy = velocity.z;
antpos.Vx = velocity.x;
antpos.Vy = velocity.y;
antpos.Vz = velocity.z;
resultpos.push_back(antpos);
@ -114,7 +123,7 @@ std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end,
{
running = false;
}
else if (current + inc > end)
else if ((current + inc) > end)
{
current = end;
}
@ -130,12 +139,40 @@ std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end,
return resultpos;
}
SPG4TOOL_EXPORT std::vector<SatelliteAntPos> getGPSPoints(std::string line1, std::string line2, double start, double end, double inc, bool printfinfoflag)
std::vector<SatelliteAntPos> getGPSPoints(std::string line1, std::string line2, double start, double end, double inc, bool printfinfoflag, bool running , bool first_run )
{
libsgp4::Tle tle("GF3", line1, line2);
return RunTle( tle, start, end, inc, printfinfoflag);
libsgp4::Tle tle("satellites", line1, line2);
std::cout << "Start time:\t" << start;
std::cout << "End time:\t" << end;
std::cout << "inc time:\t" << inc << std::endl;
std::vector<SatelliteAntPos> result= RunTle(tle, start, end, inc, printfinfoflag);
return result;
}
double parseTLETimeOffset(const std::string& tle) {
// 假设TLE字符串的时间信息在特定位置
// 例如TLE的第19到32个字符表示纪元时间
if (tle.length() < 32) {
return 0.0;
}
std::string epochStr = tle.substr(18, 14);
int year = std::stoi(epochStr.substr(0, 2));
double dayOfYear = std::stod(epochStr.substr(2));
// 将两位数年份转换为四位数年份
if (year < 57) {
year += 2000;
}
else {
year += 1900;
}
// 计算从纪元开始到指定日期的毫秒数
QDate date(year, 1, 1);
QDateTime dateTime(date.addDays(static_cast<int>(dayOfYear) - 1), QTime(0, 0), Qt::UTC);
qint64 millisecondsSinceEpoch = dateTime.toMSecsSinceEpoch() + static_cast<qint64>((dayOfYear - static_cast<int>(dayOfYear)) * 86400000);
return millisecondsSinceEpoch / 1000.0;
}

View File

@ -8,6 +8,18 @@
//void RunTle(libsgp4::Tle tle, double start, double end, double inc);
SPG4TOOL_EXPORT std::vector<SatelliteAntPos> getGPSPoints(std::string line1, std::string line2, double start, double end, double inc, bool printfinfoflag = false);
SPG4TOOL_EXPORT double parseTLETimeOffset(const std::string& tle);
/// <summary>
/// 根据两行根数生成坐标与速度,请注意返回的单位是 km
/// </summary>
/// <param name="line1"></param>
/// <param name="line2"></param>
/// <param name="start"></param>
/// <param name="end"></param>
/// <param name="inc"></param>
/// <param name="printfinfoflag"></param>
/// <param name="running"></param>
/// <param name="first_run"></param>
/// <returns></returns>
SPG4TOOL_EXPORT std::vector<SatelliteAntPos> getGPSPoints(std::string line1, std::string line2, double start, double end, double inc, bool printfinfoflag = false, bool running = true, bool first_run = true);
#endif

13
SPG4Tool/SPG4Tool.h Normal file
View File

@ -0,0 +1,13 @@
#pragma once
#include <Tle.h>
#include <SGP4.h>
#include <Observer.h>
#include <CoordGeodetic.h>
#include <CoordTopocentric.h>
#include <vector>
#include <list>
#include <string>
#include "BaseConstVariable.h"
std::vector<SatelliteAntPos> RunTle(libsgp4::Tle tle, double start, double end, double inc, bool printfinfoflag, bool running = true, bool first_run = true);

View File

@ -67,6 +67,7 @@
<ItemDefinitionGroup Condition="'$(Configuration)|$(Platform)'=='Release|x64'">
<ClCompile>
<PreprocessorDefinitions>_CRT_SECURE_NO_WARNINGS;SPG4TOOL_LIB;%(PreprocessorDefinitions)</PreprocessorDefinitions>
<WholeProgramOptimization>false</WholeProgramOptimization>
</ClCompile>
</ItemDefinitionGroup>
<ItemDefinitionGroup Condition="'$(Configuration)|$(Platform)' == 'Debug|x64'" Label="Configuration">
@ -92,7 +93,7 @@
</ClCompile>
<Link>
<SubSystem>Console</SubSystem>
<GenerateDebugInformation>false</GenerateDebugInformation>
<GenerateDebugInformation>DebugFull</GenerateDebugInformation>
<EnableCOMDATFolding>true</EnableCOMDATFolding>
<OptimizeReferences>true</OptimizeReferences>
</Link>
@ -135,6 +136,7 @@
<ClInclude Include="libsgp4\Util.h" />
<ClInclude Include="libsgp4\Vector.h" />
<ClInclude Include="SPG4Function.h" />
<ClInclude Include="SPG4Tool.h" />
<ClInclude Include="SPG4Tool_global.h" />
</ItemGroup>
<ItemGroup>

View File

@ -136,5 +136,8 @@
<ClInclude Include="SPG4Tool_global.h">
<Filter>Header Files</Filter>
</ClInclude>
<ClInclude Include="SPG4Tool.h">
<Filter>Header Files</Filter>
</ClInclude>
</ItemGroup>
</Project>

View File

@ -57,7 +57,7 @@ void QtCreateGPSPointsDialog::onoutGPSxmlSelectBtnClicked()
// 如果用户选择了文件
if (!fileName.isEmpty()) {
this->ui->outGPSxmlSelectBtn->setText(fileName);
this->ui->lineEditoutGPSxml->setText(fileName);
}
else {
QMessageBox::information(this, tr(u8"没有选择文件"), tr(u8"没有选择任何文件。"));
@ -67,7 +67,7 @@ void QtCreateGPSPointsDialog::onoutGPSxmlSelectBtnClicked()
void QtCreateGPSPointsDialog::onaccepted()
{
QString inLTEPath = this->ui->lineEditLTE->text();
QString outGPSxmlPath = this->ui->outGPSxmlSelectBtn->text();
QString outGPSxmlPath = this->ui->lineEditoutGPSxml->text();
double start = this->ui->StartimedateTimeEdit->dateTime().toTime_t();
double end = this->ui->EndimedateTimeEdit->dateTime().toTime_t();
@ -100,9 +100,20 @@ void QtCreateGPSPointsDialog::onaccepted()
}
ifs.close();
std::vector<SatelliteAntPos> gpspoints = getGPSPoints(tle1, tle2, start, end, gpsoint, true);
// 根据两行根数计算时间偏移情况
// 这里假设tle1和tle2包含时间信息并且可以解析为时间偏移量
double tle1TimeOffset = parseTLETimeOffset(tle1);
//double tle2TimeOffset = parseTLETimeOffset(tle2);
start = start- tle1TimeOffset;
end = end- tle1TimeOffset;
double inc = (end - start) / (gpsoint-1);
std::vector<SatelliteAntPos> gpspoints = getGPSPoints(tle1, tle2, start, end, inc, true,true,false);
qDebug() << "create gpspoints size:" << gpspoints.size();
// 计算GPS点
std::ofstream ofs(outGPSxmlPath.toLocal8Bit().constData());
if (!ofs.is_open()) {
@ -111,19 +122,19 @@ void QtCreateGPSPointsDialog::onaccepted()
}
ofs << "<root>\n<GPS>\n";
for (const auto& point : gpspoints) {
for (const auto& point : gpspoints) { // 缩放单位
ofs << "<GPSParam>\n";
ofs << "<TimeStamp>" << QDateTime::fromTime_t(point.time).toString("yyyy-MM-dd HH:mm:ss.zzz").toStdString() << "</TimeStamp>\n";
ofs << "<xPosition>" << point.Px << "</xPosition>\n";
ofs << "<yPosition>" << point.Py << "</yPosition>\n";
ofs << "<zPosition>" << point.Pz << "</zPosition>\n";
ofs << "<xVelocity>" << point.Vx << "</xVelocity>\n";
ofs << "<yVelocity>" << point.Vy << "</yVelocity>\n";
ofs << "<zVelocity>" << point.Vz << "</zVelocity>\n";
ofs << "<TimeStamp>" << QDateTime::fromTime_t(point.time+ tle1TimeOffset).toString("yyyy-MM-dd HH:mm:ss.zzz").toStdString() << "</TimeStamp>\n";
ofs << "<xPosition>" << point.Px*1000.0 << "</xPosition>\n";
ofs << "<yPosition>" << point.Py*1000.0 << "</yPosition>\n";
ofs << "<zPosition>" << point.Pz*1000.0 << "</zPosition>\n";
ofs << "<xVelocity>" << point.Vx*1000.0 << "</xVelocity>\n";
ofs << "<yVelocity>" << point.Vy*1000.0 << "</yVelocity>\n";
ofs << "<zVelocity>" << point.Vz*1000.0 << "</zVelocity>\n";
ofs << "</GPSParam>\n";
}
ofs << "</GPS>\n</root>\n";
ofs.flush();
ofs.close();
QMessageBox::warning(this, tr(u8"提示"), tr(u8"completed!!"));
@ -134,3 +145,6 @@ void QtCreateGPSPointsDialog::onrejected()
{
this->close();
}

View File

@ -71,6 +71,16 @@
<height>30</height>
</size>
</property>
<property name="dateTime">
<datetime>
<hour>19</hour>
<minute>56</minute>
<second>21</second>
<year>2025</year>
<month>3</month>
<day>14</day>
</datetime>
</property>
<property name="displayFormat">
<string>yyyy/M/d H:mm:ss.zzz</string>
</property>
@ -84,6 +94,16 @@
<height>30</height>
</size>
</property>
<property name="dateTime">
<datetime>
<hour>19</hour>
<minute>55</minute>
<second>11</second>
<year>2025</year>
<month>3</month>
<day>14</day>
</datetime>
</property>
<property name="currentSection">
<enum>QDateTimeEdit::YearSection</enum>
</property>
@ -129,6 +149,9 @@
<property name="maximum">
<number>1000</number>
</property>
<property name="value">
<number>71</number>
</property>
</widget>
</item>
</layout>