diff --git a/ros_packages/.gitman.yml b/ros_packages/.gitman.yml index c3127e3..d42d2fc 100644 --- a/ros_packages/.gitman.yml +++ b/ros_packages/.gitman.yml @@ -12,6 +12,18 @@ sources: target: mrs_gazebo_common_resources scripts: - git submodule update --init --recursive + - repo: https://github.com/ctu-mrs/mrs_uav_gazebo_testing.git + name: mrs_uav_gazebo_testing + rev: master + type: git + params: + sparse_paths: + - + links: + - source: '' + target: mrs_uav_gazebo_testing + scripts: + - git submodule update --init --recursive - repo: https://github.com/ctu-mrs/px4_firmware.git name: px4_firmware rev: 1.13.2-dev diff --git a/ros_packages/mrs_uav_gazebo_simulation/CMakeLists.txt b/ros_packages/mrs_uav_gazebo_simulation/CMakeLists.txt index cc18419..53b3631 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/CMakeLists.txt +++ b/ros_packages/mrs_uav_gazebo_simulation/CMakeLists.txt @@ -14,6 +14,7 @@ set(CATKIN_DEPENDENCIES rospy std_msgs mrs_uav_testing + mrs_uav_gazebo_testing ) find_package(catkin REQUIRED COMPONENTS diff --git a/ros_packages/mrs_uav_gazebo_simulation/package.xml b/ros_packages/mrs_uav_gazebo_simulation/package.xml index b7e1615..b11d1c7 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/package.xml +++ b/ros_packages/mrs_uav_gazebo_simulation/package.xml @@ -26,6 +26,7 @@ rospy std_msgs mrs_uav_testing + mrs_uav_gazebo_testing python3-jinja2 diff --git a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/takeoff_gps_baro.test b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/takeoff_gps_baro.test index 536da84..ef69ec6 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/takeoff_gps_baro.test +++ b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/takeoff_gps_baro.test @@ -13,7 +13,7 @@ - + diff --git a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/test.cpp b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/test.cpp index 8f3b4f3..cc5358b 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/test.cpp +++ b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_baro/test.cpp @@ -1,8 +1,8 @@ #include -#include +#include -class Tester : public mrs_uav_testing::TestGeneric { +class Tester : public mrs_uav_gazebo_testing::TestGeneric { public: bool test(); @@ -10,7 +10,7 @@ class Tester : public mrs_uav_testing::TestGeneric { bool Tester::test() { - std::shared_ptr uh; + std::shared_ptr uh; { auto [uhopt, message] = getUAVHandler(_uav_name_); @@ -24,10 +24,15 @@ bool Tester::test() { } { - auto [success, message] = uh->spawnGazeboUAV(_gazebo_spawner_params_); + std::string _gazebo_spawner_params; + + pl_->loadParam("gazebo_spawner_params", _gazebo_spawner_params, std::string()); + ROS_INFO_STREAM("[" << ros::this_node::getName().c_str() << "]: Spawning " << _uav_name_); + + auto [success, message] = uh->spawn(_gazebo_spawner_params); if (!success) { - ROS_ERROR("[%s]: gazebo UAV spawning failed with message: '%s'", ros::this_node::getName().c_str(), message.c_str()); + ROS_ERROR("[%s]: UAV failed to spawn: %s", ros::this_node::getName().c_str(), message.c_str()); return false; } } diff --git a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/takeoff_gps_garmin.test b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/takeoff_gps_garmin.test index ba16e3a..a44c96e 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/takeoff_gps_garmin.test +++ b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/takeoff_gps_garmin.test @@ -13,7 +13,7 @@ - + diff --git a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/test.cpp b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/test.cpp index 8f3b4f3..6cc7aad 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/test.cpp +++ b/ros_packages/mrs_uav_gazebo_simulation/test/takeoff/takeoff_gps_garmin/test.cpp @@ -1,8 +1,8 @@ #include -#include +#include -class Tester : public mrs_uav_testing::TestGeneric { +class Tester : public mrs_uav_gazebo_testing::TestGeneric { public: bool test(); @@ -10,7 +10,7 @@ class Tester : public mrs_uav_testing::TestGeneric { bool Tester::test() { - std::shared_ptr uh; + std::shared_ptr uh; { auto [uhopt, message] = getUAVHandler(_uav_name_); @@ -24,10 +24,15 @@ bool Tester::test() { } { - auto [success, message] = uh->spawnGazeboUAV(_gazebo_spawner_params_); + + std::string _gazebo_spawner_params; + pl_->loadParam("gazebo_spawner_params", _gazebo_spawner_params, std::string()); + ROS_INFO_STREAM("[" << ros::this_node::getName().c_str() << "]: Spawning " << _uav_name_); + + auto [success, message] = uh->spawn(_gazebo_spawner_params); if (!success) { - ROS_ERROR("[%s]: gazebo UAV spawning failed with message: '%s'", ros::this_node::getName().c_str(), message.c_str()); + ROS_ERROR("[%s]: UAV failed to spawn: %s", ros::this_node::getName().c_str(), message.c_str()); return false; } } diff --git a/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/test.cpp b/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/test.cpp index 8f3b4f3..d5b32c7 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/test.cpp +++ b/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/test.cpp @@ -1,8 +1,8 @@ #include -#include +#include -class Tester : public mrs_uav_testing::TestGeneric { +class Tester : public mrs_uav_gazebo_testing::TestGeneric { public: bool test(); @@ -10,7 +10,7 @@ class Tester : public mrs_uav_testing::TestGeneric { bool Tester::test() { - std::shared_ptr uh; + std::shared_ptr uh; { auto [uhopt, message] = getUAVHandler(_uav_name_); @@ -24,14 +24,17 @@ bool Tester::test() { } { - auto [success, message] = uh->spawnGazeboUAV(_gazebo_spawner_params_); - + std::string _gazebo_spawner_params; + pl_->loadParam("gazebo_spawner_params", _gazebo_spawner_params, std::string()); + ROS_INFO_STREAM("[" << ros::this_node::getName().c_str() << "]: Spawning " << _uav_name_); + auto [success, message] = uh->spawn(_gazebo_spawner_params); if (!success) { - ROS_ERROR("[%s]: gazebo UAV spawning failed with message: '%s'", ros::this_node::getName().c_str(), message.c_str()); + ROS_ERROR("[%s]: UAV failed to spawn: %s", ros::this_node::getName().c_str(), message.c_str()); return false; } } + { auto [success, message] = uh->takeoff(); diff --git a/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/uav_models.test b/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/uav_models.test index ba16e3a..a44c96e 100644 --- a/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/uav_models.test +++ b/ros_packages/mrs_uav_gazebo_simulation/test/uav_models/uav_models.test @@ -13,7 +13,7 @@ - +