YARP
Yet Another Robot Platform
 
Loading...
Searching...
No Matches
sensorMeasurements_to_vectorTest.cpp
Go to the documentation of this file.
1/*
2 * SPDX-FileCopyrightText: 2026-2026 Istituto Italiano di Tecnologia (IIT)
3 * SPDX-License-Identifier: BSD-3-Clause
4 */
5
7#include <yarp/os/Network.h>
8#include <yarp/os/LogStream.h>
9#include <yarp/os/Time.h>
11#include <yarp/sig/Vector.h>
13
15
16#include <array>
17#include <thread>
18
19#include <catch2/catch_amalgamated.hpp>
20#include <harness.h>
21
22TEST_CASE("pm::sensorMeasurements_to_vectorTest", "[yarp::pm]")
23{
24 YARP_REQUIRE_PLUGIN("sensorMeasurements_to_vector", "portmonitor")
25
27
30
31 struct TestCase {
32 std::string carrier;
33 bool use_converter;
34 };
35
36 auto tc = GENERATE(
37 TestCase {"fast_tcp", false},
38 TestCase {"fast_tcp+recv.portmonitor+file.sensorMeasurements_to_vector+type.dll", true}
39 );
40
41 SECTION("Test SensorStreamingData to Vector conversion")
42 {
44 yarp::os::Port receiver;
45
46 sender.open("/send");
47 receiver.open("/recv");
48
49 bool b = yarp::os::Network::connect("/send", "/recv", tc.carrier);
50 REQUIRE(b);
51
52 // Create test sensor data
54
55 // Add position sensor measurement (3 values)
57 pos_meas.measurement.resize(3);
58 pos_meas.measurement[0] = 1.0;
59 pos_meas.measurement[1] = 2.0;
60 pos_meas.measurement[2] = 3.0;
61 ssd.PositionSensors.measurements.resize(1);
62 ssd.PositionSensors.measurements[0] = pos_meas;
63
64 // Add orientation sensor measurement (3 values)
66 ori_meas.measurement.resize(3);
67 ori_meas.measurement[0] = 4.0;
68 ori_meas.measurement[1] = 5.0;
69 ori_meas.measurement[2] = 6.0;
70 ssd.OrientationSensors.measurements.resize(1);
71 ssd.OrientationSensors.measurements[0] = ori_meas;
72
73 sender.write();
74
76
77 if (tc.use_converter) {
78 // Should receive Vector
80 receiver.read(vec);
81
82 REQUIRE(vec.size() == 6);
83 CHECK(vec[0] == 1.0);
84 CHECK(vec[1] == 2.0);
85 CHECK(vec[2] == 3.0);
86 CHECK(vec[3] == 4.0);
87 CHECK(vec[4] == 5.0);
88 CHECK(vec[5] == 6.0);
89 } else {
90 // Should receive SensorStreamingData
92 receiver.read(received_ssd);
93
94 REQUIRE(received_ssd.PositionSensors.measurements.size() == 1);
95 REQUIRE(received_ssd.OrientationSensors.measurements.size() == 1);
96 CHECK(received_ssd.PositionSensors.measurements[0].measurement[0] == 1.0);
97 CHECK(received_ssd.OrientationSensors.measurements[0].measurement[2] == 6.0);
98 }
99
100 receiver.close();
101 sender.close();
102 }
103
105}
contains the definition of a Vector type
std::vector< SensorMeasurementData > measurements
SensorMeasurementsData OrientationSensors
SensorMeasurementsData PositionSensors
A mini-server for performing network communication in the background.
void close() override
Stop port activity.
bool open(const std::string &name) override
Start port operation, with a specific name, with automatically-chosen network parameters.
void write(bool forceStrict=false)
Write the current object being returned by BufferedPort::prepare.
T & prepare()
Access the object which will be transmitted by the next call to yarp::os::BufferedPort::write.
static bool connect(const std::string &src, const std::string &dest, const std::string &carrier="", bool quiet=true)
Request that an output port connect to an input port.
Definition Network.cpp:751
static bool setLocalMode(bool flag)
Chooses whether communication is process-local.
Definition Network.cpp:1118
Utilities for manipulating the YARP network, including initialization and shutdown.
Definition Network.h:718
A mini-server for network communication.
Definition Port.h:46
bool read(PortReader &reader, bool willReply=false) override
Read an object from the port.
Definition Port.cpp:440
void close() override
Stop port activity.
Definition Port.cpp:330
bool open(const std::string &name) override
Start port operation, with a specific name, with automatically-chosen network parameters.
Definition Port.cpp:79
void resize(size_t size) override
Resize the vector.
Definition Vector.h:231
size_t size() const
Definition Vector.h:351
void delay(double seconds)
Wait for a certain number of seconds.
Definition Time.cpp:111
@ YARP_CLOCK_SYSTEM
Definition Time.h:28
The main, catch-all namespace for YARP.
Definition dirs.h:16
TEST_CASE("pm::sensorMeasurements_to_vectorTest", "[yarp::pm]")