henry/EntityLibrary
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

ADD: updated tests

Browse Source
This commit is contained in:
hwinkel
2023-10-29 22:18:43 +01:00
parent 966d2866bb
commit def866a82b
5 changed files with 41 additions and 59 deletions
Download Patch File Download Diff File Expand all files Collapse all files

35
tests/test_MovementClass.cpp
View File

@@ -11,8 +11,39 @@
#include <loguru.hpp>
struct KinVec{
double x,y,z;
}
struct MovementVec{
double dSpd,dClb,dCrs;
}
KinVec Generate_Kin_Vect(MovementVec Mov_Dat, LLA_Rad LLA_rCoord)
{
KinVec Result;
//Transform Mov_Dat to topocentric vector
UVW UVW_Coord;
UVW_Coord.dU = Mov_Dat.dSpd * cos(Mov_Dat.dClb) * sin(Mov_Dat.dCrs);
UVW_Coord.dV = Mov_Dat.dSpd * cos(Mov_Dat.dClb) * cos(Mov_Dat.dCrs);
UVW_Coord.dW = Mov_Dat.dSpd * sin(Mov_Dat.dClb);
//Transform topocentric vector to geocentric vector
Result.x = -UVW_Coord.dU * sin(LLA_rCoord.dLon) -
UVW_Coord.dV * sin(LLA_rCoord.dLat) * cos(LLA_rCoord.dLon) +
UVW_Coord.dW * cos(LLA_rCoord.dLat) * cos(LLA_rCoord.dLon);
Result.y = UVW_Coord.dU * cos(LLA_rCoord.dLon) -
UVW_Coord.dV * sin(LLA_rCoord.dLat) * sin(LLA_rCoord.dLon) +
UVW_Coord.dW * cos(LLA_rCoord.dLat) * sin(LLA_rCoord.dLon);
Result.z = UVW_Coord.dV * cos(LLA_rCoord.dLat) +
UVW_Coord.dW * sin(LLA_rCoord.dLat);
return Result;
};
SCENARIO("Testing the SimCore Sensor")
@@ -61,6 +92,10 @@ SCENARIO("Testing the SimCore Sensor")
i += 0.5;
}
MovementVec movc;
movc.dSpd = 10;
movc.dClb = 0;
movc.dCrs = 0;
// LOG_S(INFO)<< mov.getEulerAngles();
THEN("check if Track attributes are correct")