Directory: | ./ |
---|---|
File: | tests/threadsafe_object_test.cpp |
Date: | 2022-06-29 13:58:11 |
Exec | Total | Coverage | |
---|---|---|---|
Lines: | 3 | 12 | 25.0% |
Branches: | 2 | 10 | 20.0% |
Line | Branch | Exec | Source |
---|---|---|---|
1 | |||
2 | #include <gtest/gtest.h> | ||
3 | #include <eigen3/Eigen/Core> | ||
4 | #include <tuple> | ||
5 | |||
6 | #include "real_time_tools/thread.hpp" | ||
7 | #include "real_time_tools/threadsafe/threadsafe_object.hpp" | ||
8 | #include "real_time_tools/timer.hpp" | ||
9 | |||
10 | using namespace real_time_tools; | ||
11 | |||
12 | const int DATA_LENGTH = 10000; | ||
13 | const int OUTPUT_COUNT = 5; | ||
14 | |||
15 | typedef int Type0; | ||
16 | typedef Eigen::Matrix3d Type1; | ||
17 | typedef double Type2; | ||
18 | typedef Eigen::Matrix<double, 20, 20> Type3; | ||
19 | |||
20 | typedef std::tuple<std::array<Type0, DATA_LENGTH>, | ||
21 | std::array<Type1, DATA_LENGTH>, | ||
22 | std::array<Type2, DATA_LENGTH>, | ||
23 | std::array<Type3, DATA_LENGTH> > | ||
24 | DataType; | ||
25 | |||
26 | 14 | DataType input_data; | |
27 | 14 | std::array<DataType, OUTPUT_COUNT> output_data; | |
28 | |||
29 | template <int INDEX, typename ThreadsafeObjectType> | ||
30 | THREAD_FUNCTION_RETURN_TYPE input_function(void* void_ptr) | ||
31 | { | ||
32 | ThreadsafeObjectType* threadsafe_object_ptr = | ||
33 | static_cast<ThreadsafeObjectType*>(void_ptr); | ||
34 | |||
35 | Timer logger; | ||
36 | logger.set_memory_size(100); | ||
37 | logger.set_name("input " + std::to_string(INDEX)); | ||
38 | |||
39 | for (size_t i = 0; i < DATA_LENGTH; i++) | ||
40 | { | ||
41 | threadsafe_object_ptr->template set<INDEX>( | ||
42 | std::get<INDEX>(input_data)[i]); | ||
43 | logger.tac_tic(); | ||
44 | } | ||
45 | |||
46 | logger.print_statistics(); | ||
47 | |||
48 | return THREAD_FUNCTION_RETURN_VALUE; | ||
49 | } | ||
50 | |||
51 | template <int DATA_INDEX, int OUTPUT_INDEX, typename ThreadsafeObjectType> | ||
52 | THREAD_FUNCTION_RETURN_TYPE output_function(void* void_ptr) | ||
53 | { | ||
54 | ThreadsafeObjectType* threadsafe_object_ptr = | ||
55 | static_cast<ThreadsafeObjectType*>(void_ptr); | ||
56 | |||
57 | Timer logger; | ||
58 | logger.set_memory_size(100); | ||
59 | logger.set_name("output " + std::to_string(DATA_INDEX) + ", " + | ||
60 | std::to_string(OUTPUT_INDEX)); | ||
61 | |||
62 | for (size_t i = 0; i < DATA_LENGTH; i++) | ||
63 | { | ||
64 | threadsafe_object_ptr->template wait_for_update<DATA_INDEX>(); | ||
65 | std::get<DATA_INDEX>(output_data[OUTPUT_INDEX])[i] = | ||
66 | threadsafe_object_ptr->template get<DATA_INDEX>(); | ||
67 | logger.tac_tic(); | ||
68 | } | ||
69 | |||
70 | // logger.print_statistics(); | ||
71 | |||
72 | return THREAD_FUNCTION_RETURN_VALUE; | ||
73 | } | ||
74 | |||
75 | template <int OUTPUT_INDEX, typename ThreadsafeObjectType> | ||
76 | THREAD_FUNCTION_RETURN_TYPE complete_output_function(void* void_ptr) | ||
77 | { | ||
78 | ThreadsafeObjectType* threadsafe_object_ptr = | ||
79 | static_cast<ThreadsafeObjectType*>(void_ptr); | ||
80 | |||
81 | Timer logger; | ||
82 | logger.set_memory_size(100); | ||
83 | logger.set_name("complete output " + std::to_string(OUTPUT_INDEX)); | ||
84 | |||
85 | int i_0, i_1, i_2, i_3 = 0; | ||
86 | for (size_t i = 0; i < 4 * DATA_LENGTH; i++) | ||
87 | { | ||
88 | unsigned data_index = threadsafe_object_ptr->wait_for_update(); | ||
89 | switch (data_index) | ||
90 | { | ||
91 | case 0: | ||
92 | std::get<0>(output_data[OUTPUT_INDEX])[i_0++] = | ||
93 | threadsafe_object_ptr->template get<0>(); | ||
94 | break; | ||
95 | case 1: | ||
96 | std::get<1>(output_data[OUTPUT_INDEX])[i_1++] = | ||
97 | threadsafe_object_ptr->template get<1>(); | ||
98 | break; | ||
99 | case 2: | ||
100 | std::get<2>(output_data[OUTPUT_INDEX])[i_2++] = | ||
101 | threadsafe_object_ptr->template get<2>(); | ||
102 | break; | ||
103 | case 3: | ||
104 | std::get<3>(output_data[OUTPUT_INDEX])[i_3++] = | ||
105 | threadsafe_object_ptr->template get<3>(); | ||
106 | break; | ||
107 | } | ||
108 | logger.tac_tic(); | ||
109 | } | ||
110 | |||
111 | logger.print_statistics(); | ||
112 | |||
113 | return THREAD_FUNCTION_RETURN_VALUE; | ||
114 | } | ||
115 | |||
116 | ✗ | void print(double value) | |
117 | { | ||
118 | ✗ | std::cout << value << std::endl; | |
119 | } | ||
120 | |||
121 | ✗ | void initialize_data_randomly() | |
122 | { | ||
123 | // initialize inputs ------------------------------------------------------- | ||
124 | ✗ | srand(0); | |
125 | ✗ | for (size_t i = 0; i < DATA_LENGTH; i++) | |
126 | { | ||
127 | ✗ | std::get<0>(input_data)[i] = rand(); | |
128 | ✗ | std::get<1>(input_data)[i] = Type1::Random(); | |
129 | ✗ | std::get<2>(input_data)[i] = rand() / 1223232.0; | |
130 | ✗ | std::get<3>(input_data)[i] = Type3::Random(); | |
131 | } | ||
132 |
2/4✓ Branch 1 taken 14 times.
✗ Branch 2 not taken.
✓ Branch 3 taken 14 times.
✗ Branch 4 not taken.
|
42 | } |
133 |