convertTrajectoryPointContainer.h

Go to the documentation of this file.

 
#pragma once
 
#include <stdexcept>
 
#include <etsi_its_mcm_uulm_coding/asn_SEQUENCE_OF.h>
#include <etsi_its_mcm_uulm_coding/mcm_uulm_TrajectoryPointContainer.h>
#include <etsi_its_mcm_uulm_coding/mcm_uulm_TrajectoryPoint.h>
#include <etsi_its_mcm_uulm_conversion/convertTrajectoryPoint.h>
#ifdef ROS1
#include <etsi_its_mcm_uulm_msgs/TrajectoryPoint.h>
#include <etsi_its_mcm_uulm_msgs/TrajectoryPointContainer.h>
namespace mcm_uulm_msgs = etsi_its_mcm_uulm_msgs;
#else
#include <etsi_its_mcm_uulm_msgs/msg/trajectory_point.hpp>
#include <etsi_its_mcm_uulm_msgs/msg/trajectory_point_container.hpp>
namespace mcm_uulm_msgs = etsi_its_mcm_uulm_msgs::msg;
#endif
 
 
namespace etsi_its_mcm_uulm_conversion {
 
void toRos_TrajectoryPointContainer(const mcm_uulm_TrajectoryPointContainer_t& in, mcm_uulm_msgs::TrajectoryPointContainer& out) {
  for (int i = 0; i < in.list.count; ++i) {
    mcm_uulm_msgs::TrajectoryPoint el;
    toRos_TrajectoryPoint(*(in.list.array[i]), el);
    out.array.push_back(el);
  }
}
 
void toStruct_TrajectoryPointContainer(const mcm_uulm_msgs::TrajectoryPointContainer& in, mcm_uulm_TrajectoryPointContainer_t& out) {
  memset(&out, 0, sizeof(mcm_uulm_TrajectoryPointContainer_t));
  for (int i = 0; i < in.array.size(); ++i) {
    mcm_uulm_TrajectoryPoint_t* el = (mcm_uulm_TrajectoryPoint_t*) calloc(1, sizeof(mcm_uulm_TrajectoryPoint_t));
    toStruct_TrajectoryPoint(in.array[i], *el);
    if (asn_sequence_add(&out, el)) throw std::invalid_argument("Failed to add to A_SEQUENCE_OF");
  }
}
 
}