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/os/Carriers.h>
12#include <yarp/sig/Vector.h>
14
16
17#include <array>
18#include <thread>
19
20#include <catch2/catch_amalgamated.hpp>
21#include <harness.h>
22
23TEST_CASE("pm::sensorMeasurements_to_vectorTest", "[yarp::pm]")
24{
25 YARP_REQUIRE_PLUGIN("sensorMeasurements_to_vector", "portmonitor")
26
28
30
31 REQUIRE(yarp::os::Carriers::getCarrierTemplate("portmonitor") != nullptr);
32
34
35 struct TestCase {
36 std::string carrier;
37 bool use_converter;
38 };
39
40 auto tc = GENERATE(
41 TestCase {"fast_tcp", false},
42 TestCase {"fast_tcp+recv.portmonitor+file.sensorMeasurements_to_vector+type.dll", true}
43 );
44
45 SECTION("Test SensorStreamingData to Vector conversion")
46 {
48 yarp::os::Port receiver;
49
50 sender.open("/send");
51 receiver.open("/recv");
52
53 bool b = yarp::os::Network::connect("/send", "/recv", tc.carrier);
54 REQUIRE(b);
55
56 // Create test sensor data
58
59 // Add position sensor measurement (3 values)
61 pos_meas.measurement.resize(3);
62 pos_meas.measurement[0] = 1.0;
63 pos_meas.measurement[1] = 2.0;
64 pos_meas.measurement[2] = 3.0;
65 ssd.PositionSensors.measurements.resize(1);
66 ssd.PositionSensors.measurements[0] = pos_meas;
67
68 // Add orientation sensor measurement (3 values)
70 ori_meas.measurement.resize(3);
71 ori_meas.measurement[0] = 4.0;
72 ori_meas.measurement[1] = 5.0;
73 ori_meas.measurement[2] = 6.0;
74 ssd.OrientationSensors.measurements.resize(1);
75 ssd.OrientationSensors.measurements[0] = ori_meas;
76
77 sender.write();
78
80
81 if (tc.use_converter) {
82 // Should receive Vector
84 receiver.read(vec);
85
86 REQUIRE(vec.size() == 6);
87 CHECK(vec[0] == 1.0);
88 CHECK(vec[1] == 2.0);
89 CHECK(vec[2] == 3.0);
90 CHECK(vec[3] == 4.0);
91 CHECK(vec[4] == 5.0);
92 CHECK(vec[5] == 6.0);
93 } else {
94 // Should receive SensorStreamingData
96 receiver.read(received_ssd);
97
98 REQUIRE(received_ssd.PositionSensors.measurements.size() == 1);
99 REQUIRE(received_ssd.OrientationSensors.measurements.size() == 1);
100 CHECK(received_ssd.PositionSensors.measurements[0].measurement[0] == 1.0);
101 CHECK(received_ssd.OrientationSensors.measurements[0].measurement[2] == 6.0);
102 }
103
104 receiver.close();
105 sender.close();
106 }
107
109}
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 Carrier * getCarrierTemplate(const std::string &name)
Get template for carrier.
Definition Carriers.cpp:238
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:784
static bool setLocalMode(bool flag)
Chooses whether communication is process-local.
Definition Network.cpp:1137
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
size_t size() const
Returns the number of elements in the vector.
Definition VectorBase.h:167
void resize(size_t size)
Resize the vector.
Definition VectorBase.h:106
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]")