Added test for isHandlerReady

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

Author: zulfaqar-azmi-t4

planning/route_handler/CMakeLists.txt

@@ -26,7 +26,9 @@ if(BUILD_TESTING)
     route_parser)
 
   target_link_libraries(test_route_handler
-    route_handler)
+    route_handler
+    route_parser
+  )
 
 endif()
 

planning/route_handler/test/test_route_handler.cpp

@@ -14,15 +14,22 @@
 
 #include "test_route_handler.hpp"
 
+#include "route_parser.hpp"
+
 #include <rclcpp/rclcpp.hpp>
 
 #include <gtest/gtest.h>
 
 namespace route_handler::test
 {
-TEST_F(TestRouteHandler, testSomething)
+TEST_F(TestRouteHandler, isRouteHandlerReadyTest)
 {
-  ASSERT_EQ(1, 1);
+  const auto planning_test_utils_dir =
+    ament_index_cpp::get_package_share_directory("route_handler");
+  const auto rh_test_route = planning_test_utils_dir + "/test_route/rh_test.route";
+  ASSERT_FALSE(route_handler_->isHandlerReady());
+  route_handler_->setRoute(parse_route_file(rh_test_route));
+  ASSERT_TRUE(route_handler_->isHandlerReady());
 }
 
 int main(int argc, char * argv[])