void xCNAV2PNBgpsNavMsg::firstTest(void)
{
// Set time to Day 153, 2011 (6/2/2011) at noon
CivilTime g( 2011, 6, 2, 12, 14, 44.0, TimeSystem::GPS );
CommonTime TransmitTime = g.convertToCommonTime();
SatID satSys(1, SatID::systemGPS);
ObsID obsID( ObsID::otNavMsg, ObsID::cbL2, ObsID::tcC2LM );
// Test Data copied from RINEX file for PRN3, week 1638, day 153 2011
// Subframe 2 Data
unsigned long TOWWeek = 1638;
int n_TOWWeek = 13;
int s_TOWWeek = 1;
unsigned long ITOW = 53;
int n_ITOW = 8;
int s_ITOW = 1;
unsigned long Top = 378000;
int n_Top = 11;
int s_Top = 300;
unsigned long L1CHealth = 0;
int n_L1CHealth = 1;
int s_L1CHealth = 1;
long URAoe = -16;
int n_URAoe = 5;
int s_URAoe = 1;
unsigned long Toe = 388800;
int n_Toe = 11;
int s_Toe = 300;
double Ahalf = 5.15365527534E+03;
int n_Ahalf = 32;
int s_Ahalf = -19;
double deltaA = Ahalf*Ahalf - A_REF_GPS;
int n_deltaA = 26;
int s_deltaA = -9;
double Adot = 0;
int n_Adot = 25;
int s_Adot = -21;
double dn = 5.39093883996E-09;
int n_dn = 17;
int s_dn = -44;
double dndot = 0;
int n_dndot = 23;
int s_dndot = -57;
double M0 = 1.05539162795E+00;
int n_M0 = 33;
int s_M0 = -32;
double ecc = 1.42575260252E-02;
int n_ecc = 33;
int s_ecc = -34;
double w = 1.09154604931E+00;
int n_w = 33;
int s_w = -32;
double OMEGA0 = -2.16947563164E+00;
int n_OMEGA0 = 33;
int s_OMEGA0 = -32;
double i0 = 9.28692497530E-01;
int n_i0 = 33;
int s_i0 = -32;
double OMEGAdot = -8.56285667735E-09;
int n_OMEGAdot = 24;
int s_OMEGAdot = -43;
double deltaOMEGAdot = OMEGAdot - OMEGADOT_REF_GPS;
int n_deltaOMEGAdot = 17;
int s_deltaOMEGAdot = -44;
double idot = 5.52880172536E-10;
int n_idot = 15;
int s_idot = -44;
double Cis = 5.02914190292E-08;
int n_Cis = 16;
int s_Cis = -30;
double Cic = -2.30967998505E-07;
int n_Cic = 16;
int s_Cic = -30;
double Crs = 1.87812500000E+01;
int n_Crs = 24;
int s_Crs = -8;
double Crc = 2.03562500000E+02;
int n_Crc = 24;
int s_Crc = -8;
double Cus = 8.35768878460E-06;
int n_Cus = 21;
int s_Cus = -30;
double Cuc = 9.57399606705E-07;
int n_Cuc = 21;
int s_Cuc = -30;
long URAoc = 15;
int n_URAoc = 5;
int s_URAoc = 1;
unsigned long URAoc1 = 1;
int n_URAoc1 = 3;
int s_URAoc1 = 1;
unsigned long URAoc2 = 2;
int n_URAoc2 = 3;
int s_URAoc2 = 1;
double af0 = 7.23189674318E-04;
int n_af0 = 26;
int s_af0 = -35;
double af1 = 5.11590769747E-12;
int n_af1 = 20;
int s_af1 = -48;
double af2 = 0.0;
int n_af2 = 10;
int s_af2 = -60;
double Tgd = -4.65661287308E-09;
int n_Tgd = 13;
int s_Tgd = -35;
double ISCL1cp = 1E-8;
int n_ISCL1cp = 13;
int s_ISCL1cp = -35;
double ISCL1cd = -1E-8;
int n_ISCL1cd = 13;
int s_ISCL1cd = -35;
unsigned long sflag = 0;
int n_sflag = 1;
int s_sflag = 1;
unsigned long reservedBits = 0;
int n_reservedBits = 10;
int s_reservedBits = 1;
unsigned long CRC = 0;
int n_CRC = 24;
int s_CRC = 1;
ofstream outf("Logs/CNAV2PNB_Output", ios::out);
// First Test Case. Create PNB object in which to store subframe 2 data
// for the CNAV2 nav message.
PackedNavBits pnb;
/* Pack Subframe 2 data */
pnb.setSatID(satSys);
pnb.setObsID(obsID);
pnb.setTime(TransmitTime);
pnb.addUnsignedLong(TOWWeek, n_TOWWeek, s_TOWWeek);
pnb.addUnsignedLong(ITOW, n_ITOW, s_ITOW);
pnb.addUnsignedLong(Top, n_Top, s_Top);
pnb.addUnsignedLong(L1CHealth, n_L1CHealth, s_L1CHealth);
pnb.addLong(URAoe, n_URAoe, s_URAoe);
pnb.addUnsignedLong(Toe, n_Toe, s_Toe);
pnb.addSignedDouble(deltaA, n_deltaA, s_deltaA);
pnb.addSignedDouble(Adot, n_Adot, s_Adot);
pnb.addDoubleSemiCircles(dn, n_dn, s_dn);
pnb.addDoubleSemiCircles(dndot, n_dndot, s_dndot);
pnb.addDoubleSemiCircles(M0, n_M0, s_M0);
pnb.addUnsignedDouble(ecc, n_ecc, s_ecc);
pnb.addDoubleSemiCircles(w, n_w, s_w);
pnb.addDoubleSemiCircles(OMEGA0, n_OMEGA0, s_OMEGA0);
pnb.addDoubleSemiCircles(i0, n_i0, s_i0);
pnb.addDoubleSemiCircles(deltaOMEGAdot, n_deltaOMEGAdot, s_deltaOMEGAdot);
pnb.addDoubleSemiCircles(idot, n_idot, s_idot);
pnb.addSignedDouble(Cis, n_Cis, s_Cis);
pnb.addSignedDouble(Cic, n_Cic, s_Cic);
pnb.addSignedDouble(Crs, n_Crs, s_Crs);
pnb.addSignedDouble(Crc, n_Crc, s_Crc);
pnb.addSignedDouble(Cus, n_Cus, s_Cus);
pnb.addSignedDouble(Cuc, n_Cuc, s_Cuc);
pnb.addLong(URAoc, n_URAoc, s_URAoc);
pnb.addUnsignedLong(URAoc1, n_URAoc1, s_URAoc1);
pnb.addUnsignedLong(URAoc2, n_URAoc2, s_URAoc2);
pnb.addSignedDouble(af0, n_af0, s_af0);
pnb.addSignedDouble(af1, n_af1, s_af1);
pnb.addSignedDouble(af2, n_af2, s_af2);
pnb.addSignedDouble(Tgd, n_Tgd, s_Tgd);
pnb.addSignedDouble(ISCL1cp, n_ISCL1cp, s_ISCL1cp);
pnb.addSignedDouble(ISCL1cd, n_ISCL1cd, s_ISCL1cd);
pnb.addUnsignedLong(sflag, n_sflag, s_sflag);
pnb.addUnsignedLong(reservedBits, n_reservedBits, s_reservedBits);
pnb.addUnsignedLong(CRC, n_CRC, s_CRC);
outf << endl;
outf << "Time of Transmission: " << pnb.getTransmitTime() << endl;
outf << "Time of Transmission pnb: " << GPSWeekSecond(pnb.getTransmitTime()).printf("%F, %g") << endl;
// Resize the vector holding the packed nav message data
pnb.trimsize();
outf << "PNB Object Dump:" << endl;
outf << pnb << endl;
// Second test case. Create a CEC object with the packed data above, available from RINEX file.
outf << endl << "Test Case 2: Creating CEC object with data from RINEX file." << endl;
outf << "Time = " << g << endl;
CommonTime dt = TransmitTime;
short PRNIDArg = 3;
int TOI = 50; // 9 bit word from subframe 1
CNAV2EphClk cec;
cec.loadData( obsID, PRNIDArg, TOI, pnb);
Xvt xvt = cec.svXvt( dt );
double ClkCorr = cec.svClockBias( dt );
double ClkDrift = cec.svClockDrift( dt );
outf << "Position cec: " << xvt.x<< endl;
outf << "Velocity cec: " << xvt.v << endl;
outf.setf(ios::scientific, ios::floatfield);
outf.precision(11);
outf << "RelCorr cec: " << cec.svRelativity(dt) << endl;
outf << "Clock Bias cec: " << ClkCorr << endl;
outf << "Clock Drift cec: " << ClkDrift << endl;
outf << "Time of Prediction cec:" << GPSWeekSecond(cec.getTimeOfPrediction()).printf("%F, %g") << endl;
outf << endl << "CEC Object Dump:" << endl;
outf << cec << endl;
CPPUNIT_ASSERT(fileEqualTest((char*)"Logs/CNAV2PNB_Truth",(char*)"Logs/CNAV2PNB_Output"));
}
// These tests are NOT real data, but are designed to test
// edge cases and limits.
unsigned PackedNavBits_T ::
abstractTest()
{
// Test Unsigned Integers
TUDEF("PackedNavBits", "addUnsigned");
unsigned long u_i1 = 32767;
int u_n1 = 16;
int u_s1 = 1;
unsigned long u_i2 = 1;
int u_n2 = 8;
int u_s2 = 1;
unsigned long u_i3 = 255;
int u_n3 = 8;
int u_s3 = 1;
unsigned long u_i4 = 604500;
int u_n4 = 11;
int u_s4 = 300;
// Pack the data
PackedNavBits pnb;
pnb.addUnsignedLong(u_i1, u_n1, u_s1);
pnb.addUnsignedLong(u_i2, u_n2, u_s2);
pnb.addUnsignedLong(u_i3, u_n3, u_s3);
pnb.addUnsignedLong(u_i4, u_n4, u_s4);
// Unpack the data and see that the round-trip worked.
int startbit = 0;
unsigned long ultest = pnb.asUnsignedLong(startbit, u_n1, u_s1);
TUASSERTE(unsigned long, ultest, u_i1);
startbit += u_n1;
ultest = pnb.asUnsignedLong(startbit, u_n2, u_s2);
TUASSERTE(unsigned long, ultest, u_i2);
startbit += u_n2;
ultest = pnb.asUnsignedLong(startbit, u_n3, u_s3);
TUASSERTE(unsigned long, ultest, u_i3);
startbit += u_n3;
ultest = pnb.asUnsignedLong(startbit, u_n4, u_s4);
TUASSERTE(unsigned long, ultest, u_i4);
startbit += u_n4;
// Test Signed Integers
TUCSM("addSigned");
long s_i1 = 15;
int s_n1 = 5;
int s_s1 = 1;
long s_i2 = -16;
int s_n2 = 5;
int s_s2 = 1;
long s_i3 = -1;
int s_n3 = 5;
int s_s3 = 1;
long s_i4 = 0;
int s_n4 = 6;
int s_s4 = 1;
long s_i5 = 4194304;
int s_n5 = 24;
int s_s5 = 1;
pnb.addLong(s_i1, s_n1, s_s1);
pnb.addLong(s_i2, s_n2, s_s2);
pnb.addLong(s_i3, s_n3, s_s3);
pnb.addLong(s_i4, s_n4, s_s4);
pnb.addLong(s_i5, s_n5, s_s5);
long ltest;
ltest = pnb.asLong(startbit, s_n1, s_s1);
TUASSERTE(long, ltest, s_i1);
startbit += s_n1;
ltest = pnb.asLong(startbit, s_n2, s_s2);
TUASSERTE(long, ltest, s_i2);
startbit += s_n2;
ltest = pnb.asLong(startbit, s_n3, s_s3);
TUASSERTE(long, ltest, s_i3);
startbit += s_n3;
ltest = pnb.asLong(startbit, s_n4, s_s4);
TUASSERTE(long, ltest, s_i4);
startbit += s_n4;
ltest = pnb.asLong(startbit, s_n5, s_s5);
TUASSERTE(long, ltest, s_i5);
startbit += s_n5;
// Test Signed Doubles
TUCSM("addDouble");
double d_i1 = 0.490005493;
int d_n1 = 16;
int d_s1 = -16;
double d_e1 = pow(2.0,d_s1); // value of lsb
double d_i2 = -0.5;
int d_n2 = 16;
int d_s2 = -16;
double d_e2 = pow(2.0,d_s2); // value of lsb
double d_i3 = 0;
int d_n3 = 16;
int d_s3 = -16;
double d_e3 = pow(2.0,d_s3); // value of lsb
// Test Unsigned Doubles
double d_i4 = 32000.0;
int d_n4 = 16;
int d_s4 = 0;
double d_e4 = pow(2.0,d_s4); // value of lsb
pnb.addSignedDouble(d_i1, d_n1, d_s1);
pnb.addSignedDouble(d_i2, d_n2, d_s2);
pnb.addSignedDouble(d_i3, d_n3, d_s3);
pnb.addUnsignedDouble(d_i4, d_n4, d_s4);
double dtest;
dtest = pnb.asSignedDouble(startbit, d_n1, d_s1);
TUASSERTFEPS(dtest, d_i1, d_e1);
startbit += d_n1;
dtest = pnb.asSignedDouble(startbit, d_n2, d_s2);
TUASSERTFEPS(dtest, d_i2, d_e2);
startbit += d_n2;
dtest = pnb.asSignedDouble(startbit, d_n3, d_s3);
TUASSERTFEPS(dtest, d_i3, d_e3);
startbit += d_n3;
dtest = pnb.asUnsignedDouble(startbit, d_n4, d_s4);
TUASSERTFEPS(dtest, d_i4, d_e4);
startbit += d_n4;
// Test Semi-Circles
TUCSM("addSemiCircles");
double sd_i1 = PI-2*pow(2.0,-31);
int sd_n1 = 32;
int sd_s1 = -31;
double sd_e1 = pow(2.0,sd_s1) * 3.0; // value of lsb in semi-circles
double sd_i2 = -PI;
int sd_n2 = 32;
int sd_s2 = -31;
double sd_e2 = pow(2.0,sd_s1) * 3.0; // value of lsb
pnb.addDoubleSemiCircles(sd_i1, sd_n1, sd_s1);
pnb.addDoubleSemiCircles(sd_i2, sd_n2, sd_s2);
dtest = pnb.asDoubleSemiCircles(startbit, sd_n1, sd_s1);
TUASSERTFEPS(dtest, sd_i1, sd_e1);
startbit += sd_n1;
dtest = pnb.asDoubleSemiCircles(startbit, sd_n2, sd_s2);
TUASSERTFEPS(dtest, sd_i2, sd_e2);
return testFramework.countFails();
}