GetSpawnablesServiceHandler.cpp 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354
  1. /*
  2. * Copyright (c) Contributors to the Open 3D Engine Project.
  3. * For complete copyright and license terms please see the LICENSE at the root of this distribution.
  4. *
  5. * SPDX-License-Identifier: Apache-2.0 OR MIT
  6. *
  7. */
  8. #include "GetSpawnablesServiceHandler.h"
  9. #include <SimulationInterfaces/SimulationEntityManagerRequestBus.h>
  10. namespace ROS2SimulationInterfaces
  11. {
  12. AZStd::unordered_set<AZ::u8> GetSpawnablesServiceHandler::GetProvidedFeatures()
  13. {
  14. return AZStd::unordered_set<AZ::u8>{ SimulationFeatures::SPAWNABLES };
  15. }
  16. AZStd::optional<GetSpawnablesServiceHandler::Response> GetSpawnablesServiceHandler::HandleServiceRequest(
  17. const std::shared_ptr<rmw_request_id_t> header, const Request& request)
  18. {
  19. AZ::Outcome<SimulationInterfaces::SpawnableList, SimulationInterfaces::FailedResult> outcome;
  20. SimulationInterfaces::SimulationEntityManagerRequestBus::BroadcastResult(
  21. outcome, &SimulationInterfaces::SimulationEntityManagerRequests::GetSpawnables);
  22. Response response;
  23. response.result.result = simulation_interfaces::msg::Result::RESULT_OK;
  24. if (!outcome.IsSuccess())
  25. {
  26. const auto& failedResult = outcome.GetError();
  27. response.result.result = aznumeric_cast<uint8_t>(failedResult.error_code);
  28. response.result.error_message = failedResult.error_string.c_str();
  29. return response;
  30. }
  31. const auto& spawnableList = outcome.GetValue();
  32. std::vector<simulation_interfaces::msg::Spawnable> simSpawnables;
  33. AZStd::transform(
  34. spawnableList.begin(),
  35. spawnableList.end(),
  36. AZStd::back_inserter(simSpawnables),
  37. [](const SimulationInterfaces::Spawnable& spawnable)
  38. {
  39. simulation_interfaces::msg::Spawnable simSpawnable;
  40. simSpawnable.uri = spawnable.m_uri.c_str();
  41. simSpawnable.description = spawnable.m_description.c_str();
  42. return simSpawnable;
  43. });
  44. response.result.result = simulation_interfaces::msg::Result::RESULT_OK;
  45. response.spawnables = simSpawnables;
  46. return response;
  47. }
  48. } // namespace ROS2SimulationInterfaces