//
// Created by Wakanda_shaw on 2022/5/5.
//

#include "main_window.h"
#include  "rtklib.h"
#include   "iomanip"
#include "fstream"
using namespace std;

void main_window::Read_Sat(QString Obs_path, QString Nav_path, QString Sat_path, 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"<<","<<"clk_drift"<<endl;
    }
    gtime_t ts,te,t;
    int n;
    obs_t obs={0};
    nav_t nav={0};
    sta_t sta={""};

    string obs_path = Obs_path.toStdString();
    string nav_path = Nav_path.toStdString();
    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++){

        t = timeadd(obs.data[0].time,(double)i);
        t.sec=0;
        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,n);
        satposs(t,epoch_obs.data,epoch_obs.n,&nav,EPHOPT_BRDC,rs1,dts1,var,svh);

        cout<<epoch_time+18<<endl;

        /* 当前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;

//            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;
            }
        }
        delete [] rs1;
        delete [] dts1;
        delete [] var;
    }
    satpos_file.close();
}