| 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 |