Debian Codegraph @

libs/hwdrivers/src/CVelodyneScanner_unittest.cpp

raw
1 /* +------------------------------------------------------------------------+
2 | Mobile Robot Programming Toolkit (MRPT) |
3 | https://www.mrpt.org/ |
4 | |
5 | Copyright (c) 2005-2026, Individual contributors, see AUTHORS file |
6 | See: https://www.mrpt.org/Authors - All rights reserved. |
7 | Released under BSD License. See: https://www.mrpt.org/License |
8 +------------------------------------------------------------------------+ */
9
10 #include <gtest/gtest.h>
11 #include <mrpt/hwdrivers/CVelodyneScanner.h>
12 #include <mrpt/system/filesystem.h>
13 #include <test_mrpt_common.h>
14
15 using namespace mrpt;
16 using namespace mrpt::hwdrivers;
17 using namespace std;
18
19 #include <mrpt/config.h>
20 #if MRPT_HAS_LIBPCAP && MRPT_HAS_TINYXML2
21
22 TEST(CVelodyneScanner, sample_vlp16_dataset)
23 {
24 const string fil = UNITTEST_BASEDIR() + string("/tests/sample_velodyne_vlp16_gps.pcap");
25
26 if (!mrpt::system::fileExists(fil))
27 {
28 std::cerr << "WARNING: Skipping test due to missing file: " << fil << "\n";
29 return;
30 }
31
32 CVelodyneScanner velodyne;
33
34 velodyne.setModelName(mrpt::hwdrivers::CVelodyneScanner::VLP16);
35 velodyne.setPCAPInputFile(fil);
36 velodyne.setPCAPInputFileReadOnce(true);
37 velodyne.enableVerbose(false);
38 velodyne.setPCAPVerbosity(false);
39
40 velodyne.initialize();
41
42 size_t nScans = 0, nGPS = 0;
43 bool rx_ok = true;
44 for (size_t i = 0; i < 1000 && rx_ok; i++)
45 {
46 mrpt::obs::CObservationVelodyneScan::Ptr scan;
47 mrpt::obs::CObservationGPS::Ptr gps;
48 rx_ok = velodyne.getNextObservation(scan, gps);
49 if (scan)
50 {
51 nScans++;
52 scan->generatePointCloud();
53 }
54 if (gps) nGPS++;
55 };
56 EXPECT_EQ(nScans, 4U);
57 EXPECT_GT(nGPS, 0U);
58 }
59
60 TEST(CVelodyneScanner, sample_hdl32_dataset)
61 {
62 const string fil = UNITTEST_BASEDIR() + string("/tests/sample_velodyne_hdl32.pcap");
63
64 if (!mrpt::system::fileExists(fil))
65 {
66 std::cerr << "WARNING: Skipping test due to missing file: " << fil << "\n";
67 return;
68 }
69
70 CVelodyneScanner velodyne;
71
72 velodyne.setModelName(mrpt::hwdrivers::CVelodyneScanner::HDL32);
73 velodyne.setPCAPInputFile(fil);
74 velodyne.setPCAPInputFileReadOnce(true);
75 velodyne.enableVerbose(false);
76 velodyne.setPCAPVerbosity(false);
77
78 velodyne.initialize();
79
80 size_t nScans = 0;
81 // size_t nGPS=0;
82 bool rx_ok = true;
83 for (size_t i = 0; i < 1000 && rx_ok; i++)
84 {
85 mrpt::obs::CObservationVelodyneScan::Ptr scan;
86 mrpt::obs::CObservationGPS::Ptr gps;
87 rx_ok = velodyne.getNextObservation(scan, gps);
88 if (scan) nScans++;
89 // if (gps) nGPS++;
90 };
91 EXPECT_EQ(nScans, 3U);
92 }
93
94 #endif // MRPT_HAS_LIBPCAP