convertRectangularShape.h

Go to the documentation of this file.

 
#pragma once
 
#include <etsi_its_vam_ts_coding/vam_ts_RectangularShape.h>
#include <etsi_its_vam_ts_conversion/convertCartesianPosition3d.h>
#include <etsi_its_vam_ts_conversion/convertStandardLength12b.h>
#include <etsi_its_vam_ts_conversion/convertWgs84AngleValue.h>
#ifdef ROS1
#include <etsi_its_vam_ts_msgs/RectangularShape.h>
namespace vam_ts_msgs = etsi_its_vam_ts_msgs;
#else
#include <etsi_its_vam_ts_msgs/msg/rectangular_shape.hpp>
namespace vam_ts_msgs = etsi_its_vam_ts_msgs::msg;
#endif
 
 
namespace etsi_its_vam_ts_conversion {
 
void toRos_RectangularShape(const vam_ts_RectangularShape_t& in, vam_ts_msgs::RectangularShape& out) {
  if (in.centerPoint) {
    toRos_CartesianPosition3d(*in.centerPoint, out.center_point);
    out.center_point_is_present = true;
  }
  toRos_StandardLength12b(in.semiLength, out.semi_length);
  toRos_StandardLength12b(in.semiBreadth, out.semi_breadth);
  if (in.orientation) {
    toRos_Wgs84AngleValue(*in.orientation, out.orientation);
    out.orientation_is_present = true;
  }
  if (in.height) {
    toRos_StandardLength12b(*in.height, out.height);
    out.height_is_present = true;
  }
}
 
void toStruct_RectangularShape(const vam_ts_msgs::RectangularShape& in, vam_ts_RectangularShape_t& out) {
  memset(&out, 0, sizeof(vam_ts_RectangularShape_t));
  if (in.center_point_is_present) {
    out.centerPoint = (vam_ts_CartesianPosition3d_t*) calloc(1, sizeof(vam_ts_CartesianPosition3d_t));
    toStruct_CartesianPosition3d(in.center_point, *out.centerPoint);
  }
  toStruct_StandardLength12b(in.semi_length, out.semiLength);
  toStruct_StandardLength12b(in.semi_breadth, out.semiBreadth);
  if (in.orientation_is_present) {
    out.orientation = (vam_ts_Wgs84AngleValue_t*) calloc(1, sizeof(vam_ts_Wgs84AngleValue_t));
    toStruct_Wgs84AngleValue(in.orientation, *out.orientation);
  }
  if (in.height_is_present) {
    out.height = (vam_ts_StandardLength12b_t*) calloc(1, sizeof(vam_ts_StandardLength12b_t));
    toStruct_StandardLength12b(in.height, *out.height);
  }
}
 
}