convertRadialShape.h

Go to the documentation of this file.

 
#pragma once
 
#include <etsi_its_vam_ts_coding/vam_ts_RadialShape.h>
#include <etsi_its_vam_ts_conversion/convertCartesianAngleValue.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/RadialShape.h>
namespace vam_ts_msgs = etsi_its_vam_ts_msgs;
#else
#include <etsi_its_vam_ts_msgs/msg/radial_shape.hpp>
namespace vam_ts_msgs = etsi_its_vam_ts_msgs::msg;
#endif
 
 
namespace etsi_its_vam_ts_conversion {
 
void toRos_RadialShape(const vam_ts_RadialShape_t& in, vam_ts_msgs::RadialShape& out) {
  if (in.shapeReferencePoint) {
    toRos_CartesianPosition3d(*in.shapeReferencePoint, out.shape_reference_point);
    out.shape_reference_point_is_present = true;
  }
  toRos_StandardLength12b(in.range, out.range);
  toRos_Wgs84AngleValue(in.stationaryHorizontalOpeningAngleStart, out.stationary_horizontal_opening_angle_start);
  toRos_Wgs84AngleValue(in.stationaryHorizontalOpeningAngleEnd, out.stationary_horizontal_opening_angle_end);
  if (in.verticalOpeningAngleStart) {
    toRos_CartesianAngleValue(*in.verticalOpeningAngleStart, out.vertical_opening_angle_start);
    out.vertical_opening_angle_start_is_present = true;
  }
  if (in.verticalOpeningAngleEnd) {
    toRos_CartesianAngleValue(*in.verticalOpeningAngleEnd, out.vertical_opening_angle_end);
    out.vertical_opening_angle_end_is_present = true;
  }
}
 
void toStruct_RadialShape(const vam_ts_msgs::RadialShape& in, vam_ts_RadialShape_t& out) {
  memset(&out, 0, sizeof(vam_ts_RadialShape_t));
  if (in.shape_reference_point_is_present) {
    out.shapeReferencePoint = (vam_ts_CartesianPosition3d_t*) calloc(1, sizeof(vam_ts_CartesianPosition3d_t));
    toStruct_CartesianPosition3d(in.shape_reference_point, *out.shapeReferencePoint);
  }
  toStruct_StandardLength12b(in.range, out.range);
  toStruct_Wgs84AngleValue(in.stationary_horizontal_opening_angle_start, out.stationaryHorizontalOpeningAngleStart);
  toStruct_Wgs84AngleValue(in.stationary_horizontal_opening_angle_end, out.stationaryHorizontalOpeningAngleEnd);
  if (in.vertical_opening_angle_start_is_present) {
    out.verticalOpeningAngleStart = (vam_ts_CartesianAngleValue_t*) calloc(1, sizeof(vam_ts_CartesianAngleValue_t));
    toStruct_CartesianAngleValue(in.vertical_opening_angle_start, *out.verticalOpeningAngleStart);
  }
  if (in.vertical_opening_angle_end_is_present) {
    out.verticalOpeningAngleEnd = (vam_ts_CartesianAngleValue_t*) calloc(1, sizeof(vam_ts_CartesianAngleValue_t));
    toStruct_CartesianAngleValue(in.vertical_opening_angle_end, *out.verticalOpeningAngleEnd);
  }
}
 
}