Skip to content
GitLab
Find file Normal viewHistoryPermalink
geonetworking_codec.cc 24.8 KB
Newer Older
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 
#include <string>
//#include <typeinfo>

#include "geonetworking_codec.hh"
#include "loggers.hh"

#include "etsi_ts103097_data_codec.hh"

#include "LibItsGeoNetworking_TypesAndValues.hh"

template <typename T_type> class OPTIONAL;
class TTCN_EncDec;

int geonetworking_codec::encode (const LibItsGeoNetworking__TypesAndValues::GeoNetworkingPdu& msg, OCTETSTRING& data)
{
Yann Garcia's avatar
Bug fixed in Ats Security  
Yann Garcia committed
16 
  loggers::get_instance().log_msg(">>> geonetworking_codec::encode (1): ", (const Base_Type&)msg);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
17 18 19 20 21 22 23 24 25 
  
  TTCN_EncDec::clear_error();
  TTCN_Buffer encoding_buffer;

  _ec.reset();
  
  encode_(msg, *msg.get_descriptor(), encoding_buffer);
  data = OCTETSTRING(encoding_buffer.get_len(), encoding_buffer.get_data());
  // Overwrite the payload length
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
26 27 28 
  if (_ec.get_length() != (unsigned int)-1) {
    loggers::get_instance().log("geonetworking_codec::encode: length=%d - plLength_position = %d - plLength = %d", data.lengthof(), _ec.get_length_position(), _ec.get_length());
    unsigned char b[] = { (unsigned char)((_ec.get_length() & 0x0000FF00) >> 8), (unsigned char)_ec.get_length() };
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
29 30 
    OCTETSTRING rpl(sizeof(b), b);
    loggers::get_instance().log_msg("geonetworking_codec::encode: rpl=", rpl);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
31 
    data = replace(data, _ec.get_length_position(), rpl.lengthof(), rpl);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
32 33 
    loggers::get_instance().log_msg("geonetworking_codec::encode: after replace: ", data);
  }
Yann Garcia's avatar
Set GeoNetworking version to 1  
Yann Garcia committed
34 
  loggers::get_instance().log_msg("geonetworking_codec::encode: After encoding: ", data);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
35 36 37 38 39 40 41 

  loggers::get_instance().log("<<< geonetworking_codec::encode");
  return 0;
}

int geonetworking_codec::encode (const LibItsGeoNetworking__TypesAndValues::GnNonSecuredPacket& p_gnNonSecuredPacket, OCTETSTRING& data)
{
Yann Garcia's avatar
Bug fixed in Ats Security  
Yann Garcia committed
42 43 
  loggers::get_instance().log_msg(">>> geonetworking_codec::encode (2): ", (const Base_Type&)p_gnNonSecuredPacket);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
44 45 46 47 48 
  TTCN_EncDec::clear_error();
  TTCN_Buffer encoding_buffer;
  encode_(p_gnNonSecuredPacket, *p_gnNonSecuredPacket.get_descriptor(), encoding_buffer);
  data = OCTETSTRING(encoding_buffer.get_len(), encoding_buffer.get_data());
  // Overwrite the payload length
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
49 50 51 
  if (_ec.get_length() != (unsigned int)-1) {
    loggers::get_instance().log("geonetworking_codec::encode: length=%d - plLength_position = %d - plLength = %d", data.lengthof(), _ec.get_length_position(), _ec.get_length());
    unsigned char b[] = { (unsigned char)((_ec.get_length() & 0x0000FF00) >> 8), (unsigned char)_ec.get_length() };
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
52 53 
    OCTETSTRING rpl(sizeof(b), b);
    loggers::get_instance().log_msg("geonetworking_codec::encode: rpl=", rpl);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
54 
    data = replace(data, _ec.get_length_position(), rpl.lengthof(), rpl);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 
    loggers::get_instance().log_msg("geonetworking_codec::encode: after replace: ", data);
  }
  loggers::get_instance().log_msg("geonetworking_codec::encode: After encoding: ", data);

  loggers::get_instance().log("<<< geonetworking_codec::encode");
  return 0;
}

int geonetworking_codec::encode_ (const Base_Type& type, const TTCN_Typedescriptor_t& field_descriptor, TTCN_Buffer& encoding_buffer)
{
  loggers::get_instance().log(">>> geonetworking_codec::encode_: processing %s/%s", type.get_descriptor()->name, field_descriptor.name);
  loggers::get_instance().log_msg(">>> geonetworking_codec::encode_: ", type);

  if (dynamic_cast<const Record_Type *>(&type) != NULL) {
    const Record_Type& r = (const Record_Type &)type;
    loggers::get_instance().log("geonetworking_codec::encode_: processing Record_Type %s", r.get_descriptor()->name);
    for(int i = 0; i < r.get_count(); i++) {
      loggers::get_instance().log("geonetworking_codec::encode_: processing %s/%s/%s - %d (1 ==> use dynamic_cast<const OPTIONAL<...>) - %d", r.fld_name(i), r.fld_descr(i)->name, r.get_at(i)->get_descriptor()->name, r.get_at(i)->is_optional(), r.get_at(i)->is_present());
      if (r.get_at(i)->is_present()) {
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
74 
        if ((_ec.get_basic_header() == 0x02) && (std::string(r.fld_descr(i)->name).compare("@LibItsGeoNetworking_TypesAndValues.GeoNetworkingPacket.packet") == 0)) { // Encoding secured GeoNetworking packet, unsecured GN message was already encoded using encvalue
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 
          loggers::get_instance().log("geonetworking_codec::encode_: Skip it");
          continue;
        }
        if (encode_(*r.get_at(i), *r.fld_descr(i), encoding_buffer) == -1) {
          loggers::get_instance().warning("geonetworking_codec::encode_: -1 result code returned");
          return -1;
        }
      }
    } // End of 'for' statement
  } else if (std::string(type.get_descriptor()->name).compare("@LibItsGeoNetworking_TypesAndValues.ExtendedHeader") == 0) {
    const OPTIONAL<LibItsGeoNetworking__TypesAndValues::ExtendedHeader> &v = dynamic_cast<const OPTIONAL<LibItsGeoNetworking__TypesAndValues::ExtendedHeader> &>(type);
    loggers::get_instance().log("geonetworking_codec::encode_: ExtendedHeader present: %d", v.is_present());
    if (v.is_present()) {
      if (encode_extendedHeader(static_cast<const LibItsGeoNetworking__TypesAndValues::ExtendedHeader &>(*v.get_opt_value()), encoding_buffer) == -1) {
        return -1;
      }
    }
  } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.GnNonSecuredPacket.payload") == 0) {
    const OPTIONAL<LibItsGeoNetworking__TypesAndValues::GnRawPayload> &v = dynamic_cast<const OPTIONAL<LibItsGeoNetworking__TypesAndValues::GnRawPayload> &>(type);
    loggers::get_instance().log("geonetworking_codec::encode_: GnRawPayload present: %d", v.is_present());
    if (v.is_present()) {
      const LibItsGeoNetworking__TypesAndValues::GnRawPayload& p = static_cast<const LibItsGeoNetworking__TypesAndValues::GnRawPayload &>(*v.get_opt_value());
      if (encode_(p, *p.get_descriptor()/*LibItsGeoNetworking__TypesAndValues::GnRawPayload_descr_*/, encoding_buffer) == -1) {
        loggers::get_instance().warning("geonetworking_codec::encode_: -1 result code returned");
        return -1;
      }
      // Store playload length and continue encoding
garciay's avatar
Bug fixed in GeoNetworking codec  
garciay committed
102 103 
      _ec.set_length(p.lengthof());
      loggers::get_instance().log("geonetworking_codec::encode_: Storing payload length %d for %s", _ec.get_length(), p.get_descriptor()->name);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
104 105 106 
    }
  } else if (std::string(field_descriptor.name).compare("@EtsiTs103097Module.EtsiTs103097Data") == 0) {
    const EtsiTs103097Module::EtsiTs103097Data& ieee_1609dot2_data = static_cast<const EtsiTs103097Module::EtsiTs103097Data&>(type);
Yann Garcia's avatar
Bug fixed in Ats Security  
Yann Garcia committed
107 
    loggers::get_instance().log_msg("geonetworking_codec::encode_: Encode secured message= ", ieee_1609dot2_data);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
108 109 110 111 112 113 114 115 116 117 118 119 120 
    etsi_ts103097_data_codec codec;
    OCTETSTRING os;
    codec.encode(ieee_1609dot2_data, os);
    if (os.lengthof() == 0) {
      loggers::get_instance().warning("geonetworking_codec::encode_: Failed to encode EtsiTs103097Data");
      return -1;
    }
    loggers::get_instance().log_msg("geonetworking_codec::encode_: ", os);
    encoding_buffer.put_string(os);
  } else {
    loggers::get_instance().log("geonetworking_codec::encode_ (else): processing type %s/%s", type.get_descriptor()->name, field_descriptor.name);
    if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.BasicHeader.nextHeader") == 0) {
      // Store NextHeader field value and continue encoding
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
121 122 
      _ec.set_basic_header((unsigned int)dynamic_cast<const Enum_Type &>(type).as_int());
      loggers::get_instance().log("geonetworking_codec::encode_: Storing basic_header %d for %s", _ec.get_next_header(), field_descriptor.name);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
123 124 
    } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.nextHeader") == 0) {
      // Store NextHeader field value and continue encoding
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
125 126 
      _ec.set_next_header((unsigned int)dynamic_cast<const Enum_Type &>(type).as_int());
      loggers::get_instance().log("geonetworking_codec::encode_: Storing next_header %d for %s", _ec.get_next_header(), field_descriptor.name);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
127 128 
    } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.headerType") == 0) {
      // Store HeaderType field value and continue encoding
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
129 130 
      _ec.set_header_type((unsigned int)dynamic_cast<const Enum_Type &>(type).as_int());
      loggers::get_instance().log("geonetworking_codec::encode_: Storing header_type %d for %s", _ec.get_header_type(), field_descriptor.name);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
131 132 
    } else  if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.plLength") == 0) {
      // Store TTCN_Buffer position and continue encoding
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
133 134 
      _ec.set_length_position(encoding_buffer.get_len());
      loggers::get_instance().log("geonetworking_codec::encode_: Storing position %d for %s", _ec.get_length_position(), field_descriptor.name);
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 
    }
    type.encode(field_descriptor, encoding_buffer, TTCN_EncDec::CT_RAW);
  }
  
  loggers::get_instance().log_to_hexa("<<< geonetworking_codec::encode_: ", encoding_buffer);
  return 0;
}

int geonetworking_codec::decode (const OCTETSTRING& data, LibItsGeoNetworking__TypesAndValues::GeoNetworkingPdu& msg, params* params)
{
  TTCN_EncDec::clear_error();
  TTCN_Buffer decoding_buffer(data);

  _dc.reset();
  
  _params = params;
  
  loggers::get_instance().log_to_hexa(">>> geonetworking_codec::decode: decoding_buffer=", decoding_buffer);
  decode_(msg, *msg.get_descriptor(), decoding_buffer);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
154 
  loggers::get_instance().log("geonetworking_codec::decode: After decoding, payload: plLength=%d", _dc.get_length());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
155 156 
  // Set layer parameters
  if (_params != NULL) {
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
157 158 159 160 161 
    (*_params)[params::gn_next_header] = std::to_string((unsigned int)_dc.get_next_header());
    (*_params)[params::gn_header_type] = std::to_string((unsigned int)_dc.get_header_type());
    (*_params)[params::gn_header_sub_type] = std::to_string((unsigned int)_dc.get_header_sub_type());
    (*_params)[params::gn_traffic_class] = std::to_string((unsigned int)_dc.get_traffic_class());
    (*_params)[params::gn_lifetime] = std::to_string(_dc.get_lifetime());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 
    params->log();
  }
  
  loggers::get_instance().log_msg("<<< geonetworking_codec::decode: ", (const Base_Type&)msg);
  return 0;
}

int geonetworking_codec::decode_ (Base_Type& type, const TTCN_Typedescriptor_t& field_descriptor, TTCN_Buffer& decoding_buffer)
{
  loggers::get_instance().log(">>> geonetworking_codec::decode_: processing %s/%s (%d,%d,%p)", type.get_descriptor()->name, field_descriptor.name, decoding_buffer.get_len(), decoding_buffer.get_pos(), decoding_buffer.get_read_data());

  if (dynamic_cast<Record_Type *>(&type) != NULL) {
    Record_Type& r = (Record_Type &)type;
    loggers::get_instance().log("geonetworking_codec::decode_: processing Record_Type %s", r.get_descriptor()->name);
    for(int i = 0; i < r.get_count(); i++) {
      loggers::get_instance().log("geonetworking_codec::decode_: processing %s/%s/%s", r.fld_name(i), r.fld_descr(i)->name, r.get_at(i)->get_descriptor()->name);
      if (decode_(*dynamic_cast<Base_Type *>(r.get_at(i)), *(r.fld_descr(i)), decoding_buffer) == -1) {
        return -1;
      }
    } // End of 'for' statement
    // Save data for upper layer
    if (std::string(r.get_descriptor()->name).compare("@LibItsGeoNetworking_TypesAndValues.Lifetime") == 0) {
      LibItsGeoNetworking__TypesAndValues::Lifetime& l = static_cast<LibItsGeoNetworking__TypesAndValues::Lifetime&>(r);
      unsigned int base = 0;
      switch (l.ltBase().as_int()) {
      case LibItsGeoNetworking__TypesAndValues::LtBase::e__50ms:
        base = 50;
        break;
      case LibItsGeoNetworking__TypesAndValues::LtBase::e__1s:
        base = 1000;
        break;
      case LibItsGeoNetworking__TypesAndValues::LtBase::e__10s:
        base = 10000;
        break;
      case LibItsGeoNetworking__TypesAndValues::LtBase::e__100s:
        base = 100000;
        break;
      } // End of 'switch' statement
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
200 201 
      _dc.set_lifetime(base * static_cast<unsigned int>(l.multiplier()));
      //loggers::get_instance().log("geonetworking_codec::decode_: Lifetime calculus: %d - %s", _dc.get_lifetime(), std::to_string(_dc.get_lifetime()).c_str());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
202 203 
    } else if (std::string(type.get_descriptor()->name).compare("@LibItsGeoNetworking_TypesAndValues.TrafficClass") == 0) {
      LibItsGeoNetworking__TypesAndValues::TrafficClass& t = static_cast<LibItsGeoNetworking__TypesAndValues::TrafficClass&>(r);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
204 
      _dc.set_traffic_class((t.scf().as_int() << 7) | (t.channelOffload() << 6) | (t.tcId() & 0x3f)); // ETSI EN 302 636-4-1 chapter 8.7.5
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
205 206 207 208 209 210 211 212 213 
    }
  } else if (std::string(type.get_descriptor()->name).compare("@IEEE1609dot2.Ieee1609Dot2Data") == 0) {
    dynamic_cast<OPTIONAL<IEEE1609dot2::Ieee1609Dot2Data> &>(type).set_to_omit(); // TODO Add security support
  } else {
    loggers::get_instance().log("geonetworking_codec::decode_ (else): processing type %s/%s - optional:%d", type.get_descriptor()->name, field_descriptor.name, type.is_optional());
    if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.nextHeader") == 0) {
      // Decode NextHeader data structure
      type.decode(field_descriptor, decoding_buffer, TTCN_EncDec::CT_RAW);
      // Store NextHeader field value and continue decoding
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
214 
      _dc.set_next_header((unsigned int)dynamic_cast<const Enum_Type &>(type).as_int());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 
    } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.headerTST") == 0) {
      decode_headerTST(static_cast<LibItsGeoNetworking__TypesAndValues::HeaderTST &>(type), decoding_buffer);
    } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.GnNonSecuredPacket.extendedHeader") == 0) {
      // Decode ExtendedHeader data structure
      LibItsGeoNetworking__TypesAndValues::ExtendedHeader e;
      decode_extendedHeader(e, decoding_buffer);
      if (e.is_bound()) {
        dynamic_cast<OPTIONAL<LibItsGeoNetworking__TypesAndValues::ExtendedHeader> &>(type) = OPTIONAL<LibItsGeoNetworking__TypesAndValues::ExtendedHeader>(e);
        loggers::get_instance().log_msg("geonetworking_codec::decode_: Set OPTIONAL to ", type);
      } else {
        loggers::get_instance().log("geonetworking_codec::decode_: Set OPTIONAL to omit");
        dynamic_cast<OPTIONAL<LibItsGeoNetworking__TypesAndValues::ExtendedHeader> &>(type).set_to_omit();
      }
    } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.GnNonSecuredPacket.payload") == 0) {
      // Decode raw payload data structure
      OCTETSTRING s(decoding_buffer.get_len() - decoding_buffer.get_pos(), decoding_buffer.get_data() + decoding_buffer.get_pos());
      loggers::get_instance().log_msg("geonetworking_codec::decode_: s=", s);
      const unsigned char * p = static_cast<const unsigned char *>(s);
      if (p == NULL) {
        loggers::get_instance().warning("geonetworking_codec::encode_: Static cast error");
        return -1;
      }
      // Align the payload length with the specified plLenght value
vagrant's avatar
Enhance GeoNetworking codec  
vagrant committed
238 
      loggers::get_instance().log("geonetworking_codec::decode_: Payload: Decoded payload length: %d", _dc.get_length());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
239 
      OCTETSTRING os;
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
240 241 
      if (_dc.get_length() != 0) {
        if ((unsigned char)s.lengthof() <= _dc.get_length()) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
242 
          os = OCTETSTRING(s.lengthof(), p);
vagrant's avatar
Enhance GeoNetworking codec  
vagrant committed
243 
          (*_params)[params::gn_payload] = static_cast<const char *>(oct2str(os));
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
244 
        } else {
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
245 
          os = OCTETSTRING(_dc.get_length(), p);
vagrant's avatar
Enhance GeoNetworking codec  
vagrant committed
246 
          (*_params)[params::gn_payload] = static_cast<const char *>(oct2str(os));
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
247 248 
        }
      } else {
garciay's avatar
udp_layer: wring default value, geonetworking_codec: Wrong empty payload value  
garciay committed
249 
        os = OCTETSTRING(0, nullptr);
vagrant's avatar
Enhance GeoNetworking codec  
vagrant committed
250 
        (*_params)[params::gn_payload] = "";
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
251 
      }
garciay's avatar
Rebuild with TCT3  
garciay committed
252 
      loggers::get_instance().log_msg("geonetworking_codec::decode_: Payload: os: ", os);
vagrant's avatar
Enhance GeoNetworking codec  
vagrant committed
253 
      loggers::get_instance().log("geonetworking_codec::decode_: Payload: '%s'", (*_params)[params::gn_payload].c_str());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
254 255 256 257 258 259 260 261 262 263 264 
      if (os.lengthof() != 0) {
        dynamic_cast<OPTIONAL<LibItsGeoNetworking__TypesAndValues::GnRawPayload> &>(type) = OPTIONAL<LibItsGeoNetworking__TypesAndValues::GnRawPayload>(os);
        loggers::get_instance().log_msg("geonetworking_codec::decode_: Set OPTIONAL<GnRawPayload> to ", type);
      } else {
        loggers::get_instance().log("geonetworking_codec::decode_: Set OPTIONAL<GnRawPayload> to omit");
        dynamic_cast<OPTIONAL<LibItsGeoNetworking__TypesAndValues::GnRawPayload> &>(type).set_to_omit();
      }
    } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.plLength") == 0) {
      // Decode plLength data structure
      type.decode(field_descriptor, decoding_buffer, TTCN_EncDec::CT_RAW);
      // Store playload length and continue decoding
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
265 
      _dc.set_length((unsigned int)static_cast<int>(dynamic_cast<const INTEGER &>(type)));
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 
    } else {
      type.decode(field_descriptor, decoding_buffer, TTCN_EncDec::CT_RAW);
    }
  }

  loggers::get_instance().log_msg("<<< geonetworking_codec::decode_: ", type);
  loggers::get_instance().log_to_hexa("<<< geonetworking_codec::decode_: decoding_buffer=", decoding_buffer);

  return 0;
}

int geonetworking_codec::encode_extendedHeader(const LibItsGeoNetworking__TypesAndValues::ExtendedHeader& u, TTCN_Buffer& encoding_buffer) {
  loggers::get_instance().log(">>> geonetworking_codec::encode_extendedHeader: processing %s", u.get_descriptor()->name);

  int result = -1;
  switch (u.get_selection()) {
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::UNBOUND_VALUE:
    TTCN_error("geonetworking_codec::encode_extendedHeader: Invalid selection in unbound union");
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoUnicastHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.geoUnicastHeader().get_descriptor()->name);
    result = encode_(u.geoUnicastHeader(), *u.geoUnicastHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_tsbHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.tsbHeader().get_descriptor()->name);
    result = encode_(u.tsbHeader(), *u.tsbHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_shbHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.shbHeader().get_descriptor()->name);
    result = encode_(u.shbHeader(), *u.shbHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoBroadcastHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.geoBroadcastHeader().get_descriptor()->name);
    result = encode_(u.geoBroadcastHeader(), *u.geoBroadcastHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoAnycastHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.geoAnycastHeader().get_descriptor()->name);
    result = encode_(u.geoAnycastHeader(), *u.geoAnycastHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_beaconHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.beaconHeader().get_descriptor()->name);
    result = encode_(u.beaconHeader(), *u.beaconHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_anyHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.anyHeader().get_descriptor()->name);
    result = encode_(u.anyHeader(), *u.anyHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsRequestHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.lsRequestHeader().get_descriptor()->name);
    result = encode_(u.lsRequestHeader(), *u.lsRequestHeader().get_descriptor(), encoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsReplyHeader:
    loggers::get_instance().log("geonetworking_codec::encode_extendedHeader: processing type %s", u.lsReplyHeader().get_descriptor()->name);
    result = encode_(u.lsReplyHeader(), *u.lsReplyHeader().get_descriptor(), encoding_buffer);
    break;
  default: TTCN_error("geonetworking_codec::encode_extendedHeader: Invalid selection in union is_bound");
  } // End of 'switch' statement

  return result;
}

int geonetworking_codec::decode_headerTST(LibItsGeoNetworking__TypesAndValues::HeaderTST& u, TTCN_Buffer& decoding_buffer) {
  loggers::get_instance().log(">>> geonetworking_codec::decode_headerTST: processing %s", u.get_descriptor()->name);

  // Decode HeaderTST data structure
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
331 332 333 
  _dc.set_header_type(*(decoding_buffer.get_data() + decoding_buffer.get_pos()) >> 4);
  _dc.set_header_sub_type(*(decoding_buffer.get_data() + decoding_buffer.get_pos()) & 0x0F);
  loggers::get_instance().log("geonetworking_codec::decode_: headerTST selectors: _dc.header_type = %d - _dc.header_sub_type = %d", _dc.get_header_type(), _dc.get_header_sub_type());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
334 
  //LibItsGeoNetworking__TypesAndValues::HeaderTST & u = dynamic_cast<LibItsGeoNetworking__TypesAndValues::HeaderTST &>(u);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
335 
  switch (_dc.get_header_type()) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__geoUnicast:
    decode_(u.geoUnicastHdr(), *u.geoUnicastHdr().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__topologicallyScopedBroadcast:
    decode_(u.tsbHdr(), *u.tsbHdr().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__geoBroadcast:
    decode_(u.geoBroadcastHdr(), *u.geoBroadcastHdr().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__geoAnycast:
    decode_(u.geoAnycastHdr(), *u.geoAnycastHdr().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__beacon:
    decode_(u.beaconHdr(), *u.beaconHdr().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__locationService:
    decode_(u.lsHdr(), *u.lsHdr().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__any:
    decode_(u.anyHdr(), *u.anyHdr().get_descriptor(), decoding_buffer);
    break;
  default:
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
358 
    TTCN_error("geonetworking_codec::decode_: Not processed, _dc.header_type = %d - _dc.header_sub_type = %d", _dc.get_header_type(), _dc.get_header_sub_type());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
359 360 361 362 363 364 365 366 
  } // End of 'switch' statement

  return 0;
}

int geonetworking_codec::decode_extendedHeader(LibItsGeoNetworking__TypesAndValues::ExtendedHeader& u, TTCN_Buffer& decoding_buffer) {
  loggers::get_instance().log(">>> geonetworking_codec::decode_extendedHeader: processing %s", u.get_descriptor()->name);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
367 
  switch (_dc.get_header_type()) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
368 369 370 371 
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__geoUnicast:
    decode_(u.geoUnicastHeader(), *u.geoUnicastHeader().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__topologicallyScopedBroadcast:
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
372 
    if (_dc.get_header_sub_type() == LibItsGeoNetworking__TypesAndValues::HeaderSubTypeTSB::e__multiHop) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
373 
      decode_(u.tsbHeader(), *u.tsbHeader().get_descriptor(), decoding_buffer);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
374 
    } else if (_dc.get_header_sub_type() == LibItsGeoNetworking__TypesAndValues::HeaderSubTypeTSB::e__singleHop) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
375 376 
      decode_(u.shbHeader(), *u.shbHeader().get_descriptor(), decoding_buffer);
    } else {
YannGarcia's avatar
Enhance AtsRSUsSimulator  
YannGarcia committed
377 
      TTCN_error("geonetworking_codec::decode_headerTST: TSB subtype not processed, See ETSI EN 302 636-4-1 Clause 9.7.4 Encoding of the HT and HST fields");
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
378 379 380 381 382 383 384 385 386 387 388 389 
    }
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__geoBroadcast:
    decode_(u.geoBroadcastHeader(), *u.geoBroadcastHeader().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__geoAnycast:
    decode_(u.geoAnycastHeader(), *u.geoAnycastHeader().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__beacon:
    decode_(u.beaconHeader(), *u.beaconHeader().get_descriptor(), decoding_buffer);
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__locationService:
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
390 
    if (_dc.get_header_sub_type() == LibItsGeoNetworking__TypesAndValues::HeaderSubTypeLs::e__lsRequest) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
391 
      decode_(u.lsRequestHeader(), *u.lsRequestHeader().get_descriptor(), decoding_buffer);
garciay's avatar
Bug fixed in certificate generation test suite  
garciay committed
392 
    } else if (_dc.get_header_sub_type() == LibItsGeoNetworking__TypesAndValues::HeaderSubTypeLs::e__lsReply) {
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
393 394 
      decode_(u.lsReplyHeader(), *u.lsReplyHeader().get_descriptor(), decoding_buffer);
    } else {
YannGarcia's avatar
Enhance AtsRSUsSimulator  
YannGarcia committed
395 
      TTCN_error("geonetworking_codec::decode_headerTST: Location service subtype not processed, See ETSI EN 302 636-4-1 Clause 9.7.4 Encoding of the HT and HST fields");
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
396 397 398 399 400 401 
    }
    break;
  case LibItsGeoNetworking__TypesAndValues::HeaderType::e__any:
    decode_(u.anyHeader(), *u.anyHeader().get_descriptor(), decoding_buffer);
    break;
  default:
YannGarcia's avatar
Enhance AtsRSUsSimulator  
YannGarcia committed
402 
    TTCN_error("geonetworking_codec::decode_headerTST: Not processed, _dc.header_type = %d - _dc.header_sub_type = %d, See ETSI EN 302 636-4-1 Clause 9.7.4 Encoding of the HT and HST fields", _dc.get_header_type(), _dc.get_header_sub_type());
filatov's avatar
fix eol-styles, executable permissions, etc  
filatov committed
403 404 405 406 
  } // End of 'switch' statement

  return 0;
}