|
14 | 14 |
|
15 | 15 | #include "gtest/gtest.h"
|
16 | 16 | #include "service_log_checker.hpp"
|
| 17 | + |
17 | 18 | #include <yaml-cpp/yaml.h>
|
| 19 | + |
18 | 20 | #include <memory>
|
19 | 21 | #include <string>
|
20 | 22 |
|
21 |
| -TEST(service,checker) |
| 23 | +TEST(service, checker) |
22 | 24 | {
|
23 |
| - { |
24 |
| - using ServiceLog = tier4_system_msgs::msg::ServiceLog; |
25 |
| - using DiagnosticArray = diagnostic_msgs::msg::DiagnosticArray; |
26 |
| - |
27 |
| - class PubManager : public rclcpp::Node |
28 |
| - { |
29 |
| - public: |
30 |
| - PubManager() : Node("test_pub_node") |
31 |
| - { |
32 |
| - pub_odom_ = create_publisher<ServiceLog>("service_log", 1); |
33 |
| - sub_odom_ = create_subscription<DiagnosticArray>("/diagnostics", 1, std::bind(&PubManager::on_service_log, this, std::placeholders::_1)); |
34 |
| - } |
35 |
| - rclcpp::Publisher<ServiceLog>::SharedPtr pub_odom_; |
36 |
| - rclcpp::Subscription<DiagnosticArray>::SharedPtr sub_odom_; |
37 |
| - bool flag=false; |
38 |
| - void on_service_log(const DiagnosticArray::ConstSharedPtr msg) |
39 |
| - { |
40 |
| - if(msg->status.size()>0) |
41 |
| - { |
42 |
| - auto diag_array = msg->status[0].message.c_str(); |
43 |
| - EXPECT_EQ(diag_array,"ERROR"); |
44 |
| - flag=true; |
45 |
| - } |
46 |
| - } |
47 |
| - }; |
48 |
| - |
49 |
| - auto checker = std::make_shared<ServiceLogChecker>(); |
50 |
| - |
51 |
| - auto test_log = std::make_shared<PubManager>(); |
52 |
| - ServiceLog log; |
53 |
| - log.type=6; |
54 |
| - log.name="test"; |
55 |
| - log.node="test_node"; |
56 |
| - test_log->pub_odom_->publish(log); |
57 |
| - |
58 |
| - while(!test_log->flag) |
59 |
| - { |
| 25 | + { |
| 26 | + using ServiceLog = tier4_system_msgs::msg::ServiceLog; |
| 27 | + using DiagnosticArray = diagnostic_msgs::msg::DiagnosticArray; |
60 | 28 |
|
| 29 | + class PubManager : public rclcpp::Node |
| 30 | + { |
| 31 | + public: |
| 32 | + PubManager() : Node("test_pub_node") |
| 33 | + { |
| 34 | + pub_odom_ = create_publisher<ServiceLog>("service_log", 1); |
| 35 | + sub_odom_ = create_subscription<DiagnosticArray>( |
| 36 | + "/diagnostics", 1, std::bind(&PubManager::on_service_log, this, std::placeholders::_1)); |
| 37 | + } |
| 38 | + rclcpp::Publisher<ServiceLog>::SharedPtr pub_odom_; |
| 39 | + rclcpp::Subscription<DiagnosticArray>::SharedPtr sub_odom_; |
| 40 | + bool flag = false; |
| 41 | + void on_service_log(const DiagnosticArray::ConstSharedPtr msg) |
| 42 | + { |
| 43 | + if (msg->status.size() > 0) { |
| 44 | + auto diag_array = msg->status[0].message.c_str(); |
| 45 | + EXPECT_EQ(diag_array, "ERROR"); |
| 46 | + flag = true; |
61 | 47 | }
|
| 48 | + } |
| 49 | + }; |
| 50 | + |
| 51 | + auto checker = std::make_shared<ServiceLogChecker>(); |
| 52 | + |
| 53 | + auto test_log = std::make_shared<PubManager>(); |
| 54 | + ServiceLog log; |
| 55 | + log.type = 6; |
| 56 | + log.name = "test"; |
| 57 | + log.node = "test_node"; |
| 58 | + test_log->pub_odom_->publish(log); |
| 59 | + |
| 60 | + while (!test_log->flag) { |
62 | 61 | }
|
| 62 | + } |
63 | 63 | }
|
0 commit comments