caiyu/gps-sdr-sim
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Refactor the main loop

Browse Source
This commit is contained in:
Shigeru KANEMOTO 2015-07-01 14:22:25 +09:00
parent 510726ae80
commit f560c966af
1 changed files with 46 additions and 50 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

94
gpssim.c
View File

@ -1138,7 +1138,7 @@ int main(int argc, char *argv[])
int i; int i;
int nsat; int nsat;
channel_t chan[MAX_CHAN]; channel_t chan[MAX_CHAN];
double elvmask = 0.0/R2D; double elvmask = 0.0/R2D;
int isbf,iwrd; int isbf,iwrd;
unsigned long tow; unsigned long tow;
@ -1155,8 +1155,8 @@ int main(int argc, char *argv[])
#endif #endif
void *iq_buff = NULL; void *iq_buff = NULL;
gpstime_t grx0,grx1; gpstime_t grx;
range_t rho0,rho1; range_t rho_backup[MAX_SAT];
double delt; // = 1.0/SAMP_FREQ; double delt; // = 1.0/SAMP_FREQ;
int isamp; int isamp;
@ -1374,7 +1374,7 @@ int main(int argc, char *argv[])
//////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////
// Initial reception time // Initial reception time
grx0 = g0; grx = g0;
for (i=0; i<nsat; i++) for (i=0; i<nsat; i++)
{ {
@ -1442,42 +1442,38 @@ int main(int argc, char *argv[])
printf("Generating baseband signals...\n"); printf("Generating baseband signals...\n");
printf("\rTime = %4.1f", grx0.sec-g0.sec); printf("\rTime = %4.1f", grx.sec-g0.sec);
fflush(stdout); fflush(stdout);
//
// Generate I/Q samples for every user motion data // Generate I/Q samples for every user motion data
for (iumd=0; iumd<(numd-1); iumd++) //
// Initial pseudorange
for (i=0; i<nsat; i++)
{ {
// Refresh code phase and data bit counters sv = chan[i].prn-1;
for (i=0; i<nsat; i++) computeRange(&rho_backup[sv], eph[sv], grx, umd[0]);
{ }
// Current pseudorange
sv = chan[i].prn-1;
xyz[0] = umd[iumd][0];
xyz[1] = umd[iumd][1];
xyz[2] = umd[iumd][2];
computeRange(&rho0, eph[sv], grx0, xyz);
// Pseudorange at next time step
grx1 = grx0;
grx1.sec += 0.1;
xyz[0] = umd[iumd+1][0];
xyz[1] = umd[iumd+1][1];
xyz[2] = umd[iumd+1][2];
computeRange(&rho1, eph[sv], grx1, xyz);
// Update code phase and data bit counters
computeCodePhase(&chan[i], rho0, rho1, 0.1);
}
grx.sec += 0.1;
for (iumd=1; iumd<numd; iumd++)
{
#pragma omp parallel for private(isamp) #pragma omp parallel for private(isamp)
// Properties -> Configuration Properties -> C/C++ -> Language -> Open MP Support -> Yes (/openmp) // Properties -> Configuration Properties -> C/C++ -> Language -> Open MP Support -> Yes (/openmp)
for (i=0; i<nsat; i++) for (i=0; i<nsat; i++)
{ {
// Refresh code phase and data bit counters
int sv = chan[i].prn-1;
range_t rho;
// Current pseudorange
computeRange(&rho, eph[sv], grx, umd[iumd]);
// Update code phase and data bit counters
computeCodePhase(&chan[i], rho_backup[sv], rho, 0.1);
rho_backup[sv] = rho;
for (isamp=0; isamp<iq_buff_size; isamp++) for (isamp=0; isamp<iq_buff_size; isamp++)
{ {
#ifdef _SINE_LUT #ifdef _SINE_LUT
@ -1535,32 +1531,32 @@ int main(int argc, char *argv[])
} }
} // End of omp parallel for } // End of omp parallel for
for (isamp=0; isamp<2*iq_buff_size; isamp++) if (data_format==SC08)
{ {
if (data_format==SC08) for (isamp=0; isamp<2*iq_buff_size; isamp++)
((signed char*)iq_buff)[isamp] = 0;
else
((short*)iq_buff)[isamp] = 0;
for (i=0; i<nsat; i++)
{ {
if (data_format==SC08) char sample = 0;
((signed char*)iq_buff)[isamp] += (signed char)(chan[i].iq_buff[isamp]>>4); // 12-bit bladeRF -> 8-bit HackRF for (i=0; i<nsat; i++)
else sample += (signed char)(chan[i].iq_buff[isamp]>>4); // 12-bit bladeRF -> 8-bit HackRF
((short*)iq_buff)[isamp] += chan[i].iq_buff[isamp]; ((signed char*)iq_buff)[isamp] = sample;
} }
fwrite(iq_buff, 1, 2*iq_buff_size, fp);
} else {
for (isamp=0; isamp<2*iq_buff_size; isamp++)
{
short sample = 0;
for (i=0; i<nsat; i++)
sample += chan[i].iq_buff[isamp];
((short*)iq_buff)[isamp] = sample;
}
fwrite(iq_buff, 2, 2*iq_buff_size, fp);
} }
if (data_format==SC08)
fwrite(iq_buff, 1, 2*iq_buff_size, fp);
else
fwrite(iq_buff, 2, 2*iq_buff_size, fp);
// Next second // Next second
grx0.sec += 0.1; grx.sec += 0.1;
// Update time counter // Update time counter
printf("\rTime = %4.1f", grx0.sec-g0.sec); printf("\rTime = %4.1f", grx.sec-g0.sec);
fflush(stdout); fflush(stdout);
} }