diff --git a/source/Navigation/libraries/trajectory_control/TrajectoryFollowingController.cpp b/source/Navigation/libraries/trajectory_control/TrajectoryFollowingController.cpp index eda53b12037a83f4440bb80219d7016e05795ecc..caab69bd730d33da2716ad48361868149f8548c0 100644 --- a/source/Navigation/libraries/trajectory_control/TrajectoryFollowingController.cpp +++ b/source/Navigation/libraries/trajectory_control/TrajectoryFollowingController.cpp @@ -14,6 +14,9 @@ #include "Navigation/libraries/core/types.h" #include "Navigation/libraries/trajectory_control/TrajectoryController.h" #include "Navigation/libraries/trajectory_control/core.h" +#include "Navigation/libraries/trajectory_control/aron_conversions.h" + +#include "Navigation/libraries/trajectory_control/aron/TrajectoryFollowingControllerParams.aron.generated.h" namespace armarx::nav::traj_ctrl { @@ -26,13 +29,24 @@ namespace armarx::nav::traj_ctrl aron::datanavigator::DictNavigatorPtr TrajectoryFollowingControllerParams::toAron() const { - return nullptr; // TODO implement + arondto::TrajectoryFollowingControllerParams dto; + + TrajectoryFollowingControllerParams bo; + aron_conv::toAron(dto, bo); + + return dto.toAron(); } TrajectoryFollowingControllerParams TrajectoryFollowingControllerParams::FromAron(const aron::datanavigator::DictNavigatorPtr& dict) { - return TrajectoryFollowingControllerParams(); // TODO implement + arondto::TrajectoryFollowingControllerParams dto; + dto.fromAron(dict); + + TrajectoryFollowingControllerParams bo; + aron_conv::fromAron(dto, bo); + + return bo; } TrajectoryFollowingController::TrajectoryFollowingController(const Params& params, diff --git a/source/Navigation/libraries/trajectory_control/WaypointController.cpp b/source/Navigation/libraries/trajectory_control/WaypointController.cpp index 2e3282800a87b763386832b06c9e85c72588ef61..10eea28757ef247c179d4cbcf9ea29c2aca9cc20 100644 --- a/source/Navigation/libraries/trajectory_control/WaypointController.cpp +++ b/source/Navigation/libraries/trajectory_control/WaypointController.cpp @@ -1,7 +1,9 @@ #include "WaypointController.h" #include "Navigation/libraries/trajectory_control/TrajectoryController.h" +#include "Navigation/libraries/trajectory_control/aron_conversions.h" #include "Navigation/libraries/trajectory_control/core.h" +#include "Navigation/libraries/trajectory_control/aron/WaypointControllerParams.aron.generated.h" namespace armarx::nav::traj_ctrl { @@ -14,13 +16,24 @@ namespace armarx::nav::traj_ctrl aron::datanavigator::DictNavigatorPtr WaypointControllerParams::toAron() const { - return nullptr; // TODO implement + arondto::WaypointControllerParams dto; + + WaypointControllerParams bo; + aron_conv::toAron(dto, bo); + + return dto.toAron(); } WaypointControllerParams WaypointControllerParams::FromAron(const aron::datanavigator::DictNavigatorPtr& dict) { - return WaypointControllerParams(); // TODO implement + arondto::WaypointControllerParams dto; + dto.fromAron(dict); + + WaypointControllerParams bo; + aron_conv::fromAron(dto, bo); + + return bo; } // WaypointController diff --git a/source/Navigation/libraries/trajectory_control/aron_conversions.cpp b/source/Navigation/libraries/trajectory_control/aron_conversions.cpp index 94884c330dc90d10af6157c2dfcae31b0d21d3f2..604fcf9422a1d8af30533da4327d6f241ec4ee03 100644 --- a/source/Navigation/libraries/trajectory_control/aron_conversions.cpp +++ b/source/Navigation/libraries/trajectory_control/aron_conversions.cpp @@ -5,6 +5,9 @@ #include "Navigation/libraries/trajectory_control/TrajectoryController.h" #include "Navigation/libraries/trajectory_control/TrajectoryFollowingController.h" #include "Navigation/libraries/trajectory_control/WaypointController.h" +#include "Navigation/libraries/trajectory_control/aron/TrajectoryControllerParams.aron.generated.h" +#include "Navigation/libraries/trajectory_control/aron/TrajectoryFollowingControllerParams.aron.generated.h" +#include "Navigation/libraries/trajectory_control/aron/WaypointControllerParams.aron.generated.h" namespace armarx::nav::traj_ctrl::aron_conv {