/* tle_pos() -----------------------------------------------------------------*/
static void utest2(void)
{
const char *file2="../data/tle/tle_sgp4.txt";
const double ep0[6]={1980,1,1};
tle_t tle={0};
gtime_t epoch;
double min,rs[6];
int i,stat;
epoch=utc2gpst(timeadd(epoch2time(ep0),274.98708465*86400.0));
stat=tle_read(file2,&tle);
assert(stat);
stat=tle_pos(epoch,"TEST_ERR","","",&tle,NULL,rs);
assert(!stat);
for (i=0;i<5;i++) {
min=360.0*i;
stat=tle_pos(timeadd(epoch,min*60.0),"TEST_SAT","","",&tle,NULL,rs);
assert(stat);
fprintf(OUT,"%4.0f: %14.8f %14.8f %14.8f %11.8f %11.8f %11.8f\n",min,
rs[0]/1e3,rs[1]/1e3,rs[2]/1e3,rs[3]/1e3,rs[4]/1e3,rs[5]/1e3);
}
fprintf(OUT,"%s utest2 : OK\n",__FILE__);
}
/* tle_pos() accuracy --------------------------------------------------------*/
static void utest3(void)
{
const char *file1="../data/tle/brdc3050.12*";
const char *file2="../data/tle/TLE_GNSS_20121101.txt";
const char *file3="../data/tle/igs17127.erp";
const double ep[6]={2012,10,31,0,0,0};
nav_t nav={0};
erp_t erp={0};
tle_t tle={0};
gtime_t time;
char sat[32];
double rs1[6],rs2[6],ds[6],dts[2],var;
int i,j,k,stat,svh;
readrnx(file1,0,"",NULL,&nav,NULL);
assert(nav.n>0);
stat=readerp(file3,&erp);
assert(stat);
stat=tle_read(file2,&tle);
assert(stat);
for (i=0;i<MAXSAT;i++) {
satno2id(i+1,sat);
fprintf(OUT,"SAT=%s\n",sat);
for (j=0;j<96;j++) {
time=timeadd(epoch2time(ep),900.0*j);
if (!satpos(time,time,i+1,EPHOPT_BRDC,&nav,rs1,dts,&var,&svh)) continue;
if (satsys(i+1,NULL)==SYS_QZS) svh&=0xFE;
if (svh) continue;
stat=tle_pos(time,sat,"","",&tle,&erp,rs2);
assert(stat);
for (k=0;k<3;k++) ds[k]=rs2[k]-rs1[k];
fprintf(OUT,"%6.0f %11.3f %11.3f %11.3f %11.3f\n",900.0*j,
ds[0]/1e3,ds[1]/1e3,ds[2]/1e3,norm(ds,3)/1e3);
assert(norm(ds,3)/1e3<300.0);
}
fprintf(OUT,"\n");
}
fprintf(OUT,"%s utest3 : OK\n",__FILE__);
}
// update observation data index, azimuth/elevation, satellite list ---------
void __fastcall TPlot::UpdateObs(int nobs)
{
AnsiString s;
prcopt_t opt=prcopt_default;
gtime_t time;
sol_t sol={0};
double pos[3],rr[3],e[3],azel[MAXOBS*2]={0},rs[6],dts[2],var;
int i,j,k,svh,per,per_=-1;
char msg[128],name[16];
trace(3,"UpdateObs\n");
delete [] IndexObs; IndexObs=NULL;
delete [] Az; Az=NULL;
delete [] El; El=NULL;
NObs=0;
if (nobs<=0) return;
IndexObs=new int[nobs+1];
Az=new double[Obs.n];
El=new double[Obs.n];
opt.err[0]=900.0;
ReadWaitStart();
ShowLegend(NULL);
for (i=0;i<Obs.n;i=j) {
time=Obs.data[i].time;
for (j=i;j<Obs.n;j++) {
if (timediff(Obs.data[j].time,time)>TTOL) break;
}
IndexObs[NObs++]=i;
for (k=0;k<j-i;k++) {
azel[k*2]=azel[1+k*2]=0.0;
}
if (RcvPos==0) {
pntpos(Obs.data+i,j-i,&Nav,&opt,&sol,azel,NULL,msg);
matcpy(rr,sol.rr,3,1);
ecef2pos(rr,pos);
}
else {
if (RcvPos==1) { // lat/lon/height
for (k=0;k<3;k++) pos[k]=OOPos[k];
pos2ecef(pos,rr);
}
else { // rinex header position
for (k=0;k<3;k++) rr[k]=Sta.pos[k];
ecef2pos(rr,pos);
}
for (k=0;k<j-i;k++) {
azel[k*2]=azel[1+k*2]=0.0;
if (!satpos(time,time,Obs.data[i+k].sat,EPHOPT_BRDC,&Nav,rs,dts,
&var,&svh)) continue;
if (geodist(rs,rr,e)>0.0) satazel(pos,e,azel+k*2);
}
}
// satellite azel by tle data
for (k=0;k<j-i;k++) {
if (azel[k*2]!=0.0||azel[1+k*2]!=0.0) continue;
satno2id(Obs.data[i+k].sat,name);
if (!tle_pos(time,name,"","",&TLEData,NULL,rs)) continue;
if (geodist(rs,rr,e)>0.0) satazel(pos,e,azel+k*2);
}
for (k=0;k<j-i;k++) {
Az[i+k]=azel[ k*2];
El[i+k]=azel[1+k*2];
if (Az[i+k]<0.0) Az[i+k]+=2.0*PI;
}
per=(i+1)*100/Obs.n;
if (per!=per_) {
ShowMsg(s.sprintf("updating azimuth/elevation... (%d%%)",(per_=per)));
Application->ProcessMessages();
}
}
IndexObs[NObs]=Obs.n;
UpdateSatList();
ReadWaitEnd();
}
// generate visibility data ----------------------------------------------------
void __fastcall TPlot::GenVisData(void)
{
gtime_t time,ts,te;
obsd_t data={{0}};
sta_t sta={0};
double tint,r,pos[3],rr[3],rs[6],e[3],azel[2];
int i,j,nobs=0;
char name[16];
trace(3,"GenVisData\n");
ClearObs();
SimObs=1;
ts=TimeStart;
te=TimeEnd;
tint=TimeInt;
matcpy(pos,OOPos,3,1);
pos2ecef(pos,rr);
ReadWaitStart();
ShowLegend(NULL);
ShowMsg("generating satellite visibility...");
Application->ProcessMessages();
for (time=ts;timediff(time,te)<=0.0;time=timeadd(time,tint)) {
for (i=0;i<MAXSAT;i++) {
satno2id(i+1,name);
if (!tle_pos(time,name,"","",&TLEData,NULL,rs)) continue;
if ((r=geodist(rs,rr,e))<=0.0) continue;
if (satazel(pos,e,azel)<=0.0) continue;
if (Obs.n>=Obs.nmax) {
Obs.nmax=Obs.nmax<=0?4096:Obs.nmax*2;
Obs.data=(obsd_t *)realloc(Obs.data,sizeof(obsd_t)*Obs.nmax);
if (!Obs.data) {
Obs.n=Obs.nmax=0;
break;
}
}
data.time=time;
data.sat=i+1;
for (j=0;j<NFREQ;j++) {
data.P[j]=data.L[j]=0.0;
data.code[j]=CODE_NONE;
}
data.code[0]=CODE_L1C;
Obs.data[Obs.n++]=data;
}
if (++nobs>=MAX_SIMOBS) break;
}
if (Obs.n<=0) {
ReadWaitEnd();
ShowMsg("no satellite visibility");
return;
}
UpdateObs(nobs);
Caption="Satellite Visibility (Predicted)";
BtnSol1->Down=true;
time2gpst(Obs.data[0].time,&Week);
SolIndex[0]=SolIndex[1]=ObsIndex=0;
if (PlotType<PLOT_OBS||PLOT_DOP<PlotType) {
UpdateType(PLOT_OBS);
}
else {
UpdatePlotType();
}
FitTime();
ReadWaitEnd();
UpdateObsType();
UpdateTime();
UpdatePlot();
}
