mirror of
https://github.com/ByteWelder/Tactility.git
synced 2026-10-17 10:55:06 +00:00
65 lines
2.3 KiB
C++
65 lines
2.3 KiB
C++
#include "doctest.h"
|
|
|
|
#include <location/gps_provider.h>
|
|
|
|
#include <cmath>
|
|
|
|
namespace {
|
|
|
|
constexpr auto* RMC = "$GPRMC,123519,A,4807.038,N,01131.000,E,022.4,084.4,230394,003.1,W*6A";
|
|
constexpr auto* GGA = "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47";
|
|
|
|
}
|
|
|
|
TEST_CASE("gps_location_from_nmea converts RMC and GGA") {
|
|
minmea_sentence_rmc rmc;
|
|
minmea_sentence_gga gga;
|
|
REQUIRE(minmea_parse_rmc(&rmc, RMC));
|
|
REQUIRE(minmea_parse_gga(&gga, GGA));
|
|
|
|
Location location;
|
|
REQUIRE(gps_location_from_nmea(&rmc, &gga, &location));
|
|
CHECK(location.latitude == doctest::Approx(48.1173));
|
|
CHECK(location.longitude == doctest::Approx(11.516667));
|
|
CHECK(location.speed == doctest::Approx(11.5235).epsilon(0.001));
|
|
CHECK(location.course == doctest::Approx(84.4));
|
|
CHECK(location.horizontal_accuracy == doctest::Approx(4.5));
|
|
CHECK(location.altitude == doctest::Approx(545.4));
|
|
CHECK(location.ellipsoidal_altitude == doctest::Approx(592.3));
|
|
CHECK(std::isnan(location.vertical_accuracy));
|
|
CHECK(location.satellites == 8);
|
|
CHECK(location.time_ms == 764426119000LL);
|
|
}
|
|
|
|
TEST_CASE("gps_location_from_nmea without GGA has no altitude or accuracy") {
|
|
minmea_sentence_rmc rmc;
|
|
REQUIRE(minmea_parse_rmc(&rmc, RMC));
|
|
|
|
Location location;
|
|
REQUIRE(gps_location_from_nmea(&rmc, nullptr, &location));
|
|
CHECK(location.latitude == doctest::Approx(48.1173));
|
|
CHECK(std::isnan(location.altitude));
|
|
CHECK(std::isnan(location.horizontal_accuracy));
|
|
CHECK(location.satellites == 0);
|
|
}
|
|
|
|
TEST_CASE("gps_location_from_nmea handles the southern and western hemispheres") {
|
|
minmea_sentence_rmc rmc;
|
|
REQUIRE(minmea_parse_rmc(&rmc, "$GPRMC,123519,A,3352.128,S,15112.558,W,000.0,,230394,,*00"));
|
|
|
|
Location location;
|
|
REQUIRE(gps_location_from_nmea(&rmc, nullptr, &location));
|
|
CHECK(location.latitude == doctest::Approx(-33.8688));
|
|
CHECK(location.longitude == doctest::Approx(-151.209300));
|
|
CHECK(location.speed == doctest::Approx(0.0));
|
|
CHECK(std::isnan(location.course));
|
|
}
|
|
|
|
TEST_CASE("gps_location_from_nmea rejects a fix that is not valid") {
|
|
minmea_sentence_rmc rmc;
|
|
REQUIRE(minmea_parse_rmc(&rmc, "$GPRMC,123519,V,,,,,,,230394,,*00"));
|
|
|
|
Location location;
|
|
CHECK_FALSE(gps_location_from_nmea(&rmc, nullptr, &location));
|
|
}
|