@@ -1249,6 +1249,7 @@ void UM980::unicoreHandler(uint8_t *response, uint16_t length)
12491249 memcpy (&packetBESTNAV->data .latitude , &data[offsetBestnavLat], sizeof (double ));
12501250 memcpy (&packetBESTNAV->data .longitude , &data[offsetBestnavLon], sizeof (double ));
12511251 memcpy (&packetBESTNAV->data .altitude , &data[offsetBestnavHgt], sizeof (double ));
1252+ memcpy (&packetBESTNAV->data .geoidalSeparation , &data[offsetBestnavUndulation], sizeof (float ));
12521253 memcpy (&packetBESTNAV->data .horizontalSpeed , &data[offsetBestnavHorSpd], sizeof (double ));
12531254 memcpy (&packetBESTNAV->data .verticalSpeed , &data[offsetBestnavVertSpd], sizeof (double ));
12541255 memcpy (&packetBESTNAV->data .trackGround , &data[offsetBestnavTrkGnd], sizeof (double ));
@@ -1587,6 +1588,11 @@ double UM980::getAltitude()
15871588 CHECK_POINTER_BOOL (packetBESTNAV, initBestnav); // Check that RAM has been allocated
15881589 return (packetBESTNAV->data .altitude );
15891590}
1591+ double UM980::getGeoidalSeparation ()
1592+ {
1593+ CHECK_POINTER_BOOL (packetBESTNAV, initBestnav); // Check that RAM has been allocated
1594+ return ((double )packetBESTNAV->data .geoidalSeparation );
1595+ }
15901596double UM980::getHorizontalSpeed ()
15911597{
15921598 CHECK_POINTER_BOOL (packetBESTNAV, initBestnav); // Check that RAM has been allocated
0 commit comments