121 lines
4.7 KiB
C++
121 lines
4.7 KiB
C++
|
//
|
|||
|
|
// Created by Wakanda_shaw on 2022/5/5.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
#include "main_window.h"
|
|||
|
|
#include "rtklib.h"
|
|||
|
|
#include "iomanip"
|
|||
|
|
#include "fstream"
|
|||
|
|
#include "QDir"
|
|||
|
|
#include <QTextCodec>
|
|||
|
|
#include "UI/ui_main_window.h"
|
|||
|
|
|
|||
|
|
|
|||
|
|
using namespace std;
|
|||
|
|
|
|||
|
|
void main_window::Read_Sat(const QString& Obs_path,const QString& Nav_path, const QString& Sat_path, Ui::main_window *ui, int IONN_MODEL) {
|
|||
|
|
ofstream satpos_file(Sat_path.toStdString());
|
|||
|
|
if(satpos_file){
|
|||
|
|
/* 依此为：PRN<<Epoch<<伪距<<伪距率<<卫星坐标<<卫星速度<<卫星钟差造成的误差<<信噪比 */
|
|||
|
|
satpos_file<<"PRN"<<','<<"Tow"<<","<<"Psr"<<","<<"dual_cor"<<","<<"tgd_cor"<<","<<"d_Psr"<<","<<"ecef_X"<<","<<"ecef_Y"<<","<<"ecef_Z"<<
|
|||
|
|
","<<"ecef_VX"<<","<<"ecef_VY"<<","<<"ecef_VZ"<<","<<"clk_err"<<","<<"L1_SNR"<<","<<"Carrier_phase"<<","<<"Satpos_var"<<","<<"clr_dtift"<<endl;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
gtime_t ts,te,t;
|
|||
|
|
int n;
|
|||
|
|
obs_t obs={0};
|
|||
|
|
nav_t nav={0};
|
|||
|
|
sta_t sta={""};
|
|||
|
|
QTextCodec *code = QTextCodec::codecForName("GB2312");//解决中文路径问题
|
|||
|
|
|
|||
|
|
|
|||
|
|
//路径转换
|
|||
|
|
string obs_path = code->fromUnicode(QDir::toNativeSeparators(Obs_path)).data();
|
|||
|
|
string nav_path = code->fromUnicode(QDir::toNativeSeparators(Nav_path)).data();
|
|||
|
|
const char *Obs = obs_path.c_str();
|
|||
|
|
const char *Nav = nav_path.c_str();
|
|||
|
|
double vmeas,dual_fre=0,tgd=0;
|
|||
|
|
|
|||
|
|
ts.time = 0;
|
|||
|
|
te.time = 0;
|
|||
|
|
n=readrnxt(Obs,1,ts,te,0.0,"-SYS=sys[G,C,E,J]",&obs,&nav,&sta);//读obs
|
|||
|
|
n=readrnxt(Nav,1,ts,te,0.0,"-SYS=sys[G,C,E,J]",&obs,&nav,&sta);//读nav
|
|||
|
|
n=sortobs(&obs);//得到epoch数目
|
|||
|
|
uniqnav(&nav);//unique 1下
|
|||
|
|
/* 设置一下参数 */
|
|||
|
|
prcopt_t prcopt=prcopt_default;
|
|||
|
|
prcopt.ionoopt = IONN_MODEL;
|
|||
|
|
prcopt.tropopt = TROPOPT_SAAS;
|
|||
|
|
prcopt.nf = 3;//(L1+L2+L5)
|
|||
|
|
|
|||
|
|
prcopt.navsys = SYS_CMP|SYS_GPS|SYS_GAL|SYS_QZS;
|
|||
|
|
double P,P5,freq,range_rate,L1_snr,L2_snr, Carrier_phase,Satpos_var, clk_drift;
|
|||
|
|
double epoch_time;
|
|||
|
|
int epoch_length=0;
|
|||
|
|
|
|||
|
|
|
|||
|
|
for(int i=0;i<n;i++){
|
|||
|
|
int progress_value = 70+i/(n/30);
|
|||
|
|
ui->progressBar->setValue(progress_value);
|
|||
|
|
t = timeadd(obs.data[0].time,(double)i);
|
|||
|
|
char str[64];
|
|||
|
|
time2str(t,str,3);
|
|||
|
|
epoch_time=time2gpst(t,NULL);
|
|||
|
|
obs_t epoch_obs={0};
|
|||
|
|
readrnxt(Obs,1,t,t,0.0,"-SYS=sys[G,C,E,J]",&epoch_obs,&nav,&sta);
|
|||
|
|
epoch_length = epoch_obs.n;
|
|||
|
|
|
|||
|
|
/* 计算卫星位置 */
|
|||
|
|
double *rs1,*dts1,*var;
|
|||
|
|
int svh[MAXOBS];
|
|||
|
|
rs1=mat(6,epoch_obs.n); dts1=mat(2,epoch_obs.n);var=mat(1,epoch_obs.n);
|
|||
|
|
satposs(t,epoch_obs.data,epoch_obs.n,&nav,EPHOPT_BRDC,rs1,dts1,var,svh);
|
|||
|
|
|
|||
|
|
/* 当前epoch所观测到的数据进行遍历处理 */
|
|||
|
|
for(int j =0;j<epoch_obs.n;j++){
|
|||
|
|
int sta_error=0; // 用来检测
|
|||
|
|
if(svh[j]<0){
|
|||
|
|
cout<<"svh < 0"<<endl;
|
|||
|
|
continue;
|
|||
|
|
}
|
|||
|
|
for(int k=0;k<6;k++){
|
|||
|
|
if(rs1[k+j*6] == 0){
|
|||
|
|
sta_error=1;
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
if(sta_error==1){
|
|||
|
|
continue;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// P=prange(epoch_obs.data+j,&nav,&prcopt,&vmeas);// 电离层/TGD修正后的伪距
|
|||
|
|
P = epoch_obs.data[j].P[0];
|
|||
|
|
ion_compensation(epoch_obs.data+j,&nav,&prcopt,&vmeas,&dual_fre,&tgd);
|
|||
|
|
freq=sat2freq(epoch_obs.data[j].sat,epoch_obs.data[j].code[0],&nav);// 找到对应频率
|
|||
|
|
range_rate = -epoch_obs.data[j].D[0]*CLIGHT/freq + CLIGHT*dts1[1+j*2];// 观测的伪距率
|
|||
|
|
L1_snr = epoch_obs.data[j].SNR[0]*SNR_UNIT;//信噪比L1
|
|||
|
|
Carrier_phase = epoch_obs.data[j].L[0]*CLIGHT/freq;
|
|||
|
|
Satpos_var = var[j];
|
|||
|
|
clk_drift = dts1[1+j*2]*CLIGHT;
|
|||
|
|
/*
|
|||
|
|
依此为：PRN<<时间Tow<<伪距<<伪距率<<卫星坐标<<卫星速度<<卫星钟差造成的误差<<信噪比
|
|||
|
|
*/
|
|||
|
|
// cout<<uint(epoch_obs.data[j].sat)<<" "<<epoch_time+18<<" "<<fixed<<setprecision(10)<<P<<" "<<dual_fre<<","<<tgd<<","<<range_rate<<" "<<rs1[0+j*6]<<" "<<rs1[1+j*6]<<" "<<rs1[2+j*6]<<" "<<rs1[3+j*6]<<" "<<rs1[4+j*6]<<" "<<rs1[5+j*6]<<" "<<dts1[0+j*2]*CLIGHT<<" "<<L1_snr<<endl;
|
|||
|
|
|
|||
|
|
if(satpos_file){
|
|||
|
|
satpos_file<<int(epoch_obs.data[j].sat)<<","<<epoch_time+18<<","<<fixed<<setprecision(10)<<P<<","<<dual_fre<<","<<tgd<<","<<range_rate<<","<<rs1[0+j*6]<<","<<rs1[1+j*6]<<","<<rs1[2+j*6]<<","<<rs1[3+j*6]<<","<<rs1[4+j*6]<<","<<rs1[5+j*6]<<","<<dts1[0+j*2]*CLIGHT<<","<<L1_snr<<
|
|||
|
|
","<<Carrier_phase<<","<<Satpos_var<<","<<clk_drift<<endl;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
free(rs1);
|
|||
|
|
free(dts1);
|
|||
|
|
free(var);
|
|||
|
|
free(epoch_obs.data);
|
|||
|
|
epoch_obs.data = NULL;
|
|||
|
|
epoch_obs.n=epoch_obs.nmax=0;
|
|||
|
|
}
|
|||
|
|
satpos_file.close();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|