#include #include //include #include "GeoNetworkingCodec.hh" #include "loggers.hh" #include "LibItsGeoNetworking_TypesAndValues.hh" template class OPTIONAL; class TTCN_EncDec; int GeoNetworkingCodec::encode (const LibItsGeoNetworking__TypesAndValues::GeoNetworkingPdu& msg, OCTETSTRING& data) { loggers::loggers::log_msg(">>> GeoNetworkingCodec::encode: ", (const Base_Type&)msg); TTCN_EncDec::clear_error(); TTCN_Buffer encoding_buffer; encode_(msg, LibItsGeoNetworking__TypesAndValues::GeoNetworkingPdu_descr_, encoding_buffer); data = OCTETSTRING(encoding_buffer.get_len(), encoding_buffer.get_data()); // Overwrite the payload length if (_ec.plLength_position != (unsigned int)-1) { loggers::loggers::log("GeoNetworkingCodec::encode: length=%d - plLength_position = %d - plLength = %d", data.lengthof(), _ec.plLength_position, _ec.plLength); unsigned char b[] = { (unsigned char)((_ec.plLength & 0x0000FF00) >> 8), (unsigned char)_ec.plLength }; OCTETSTRING rpl(sizeof(b), b); data = replace(data, _ec.plLength_position, rpl.lengthof(), rpl); } return 0; } int GeoNetworkingCodec::encode_ (const Base_Type& type, const TTCN_Typedescriptor_t& field_descriptor, TTCN_Buffer& encoding_buffer) { loggers::loggers::log(">>> GeoNetworkingCodec::encode_: processing %s/%s", type.get_descriptor()->name, field_descriptor.name); loggers::loggers::log_msg(">>> GeoNetworkingCodec::encode_: ", type); if (dynamic_cast(&type) != NULL) { const Record_Type& r = (const Record_Type &)type; loggers::loggers::log("GeoNetworkingCodec::encode_: processing Record_Type %s", r.get_descriptor()->name); for(int i = 0; i < r.get_count(); i++) { loggers::loggers::log("GeoNetworkingCodec::encode_: processing %s/%s/%s - %d (1 ==> use dynamic_cast) - %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()) { if (encode_(*r.get_at(i), *r.fld_descr(i), encoding_buffer) == -1) { return -1; } } } // End of 'for' statement } else if (std::string(type.get_descriptor()->name).compare("@LibItsGeoNetworking_TypesAndValues.ExtendedHeader") == 0) { const OPTIONAL &v = dynamic_cast &>(type); loggers::loggers::log("GeoNetworkingCodec::encode_: ExtendedHeader present: %d", v.is_present()); if (v.is_present()) { if (encode_extendedHeader(static_cast(*v.get_opt_value()), encoding_buffer) == -1) { return -1; } } } else if (std::string(type.get_descriptor()->name).compare("@LibItsGeoNetworking_TypesAndValues.Payload") == 0) { const OPTIONAL &v = dynamic_cast &>(type); loggers::loggers::log("GeoNetworkingCodec::encode_: Payload present: %d", v.is_present()); if (v.is_present()) { if (encode_(static_cast(*v.get_opt_value()), LibItsGeoNetworking__TypesAndValues::Payload_descr_, encoding_buffer) == -1) { return -1; } } } else if (std::string(type.get_descriptor()->name).compare("@LibItsGeoNetworking_TypesAndValues.DecodedPayload") == 0) { const OPTIONAL &v = dynamic_cast &>(type); loggers::loggers::log("GeoNetworkingCodec::encode_: DecodedPayload present: %d", v.is_present()); if (v.is_present()) { if (encode_decodedPayload(static_cast(*v.get_opt_value()), encoding_buffer) == -1) { return -1; } } } else { loggers::loggers::log("GeoNetworkingCodec::encode_ (else): processing type %s/%s", type.get_descriptor()->name, field_descriptor.name); if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.nextHeader") == 0) { // Store NextHeader field value and continue encoding _ec.next_header = (unsigned int)dynamic_cast(type).as_int(); loggers::loggers::log("GeoNetworkingCodec::encode_: Storing next_header %d for %s", _ec.next_header, field_descriptor.name); } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.headerType") == 0) { // Store HeaderType field value and continue encoding _ec.header_type = (unsigned int)dynamic_cast(type).as_int(); loggers::loggers::log("GeoNetworkingCodec::encode_: Storing header_type %d for %s", _ec.header_type, field_descriptor.name); } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.plLength") == 0) { // Store TTCN_Buffer position and continue encoding _ec.plLength_position = encoding_buffer.get_len(); loggers::loggers::log("GeoNetworkingCodec::encode_: Storing position %d for %s", _ec.plLength_position, field_descriptor.name); } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.Payload.rawPayload") == 0) { // Store playload length and continue encoding _ec.plLength = dynamic_cast(type).lengthof(); loggers::loggers::log("GeoNetworkingCodec::encode_: Storing payload length %d for %s", _ec.plLength, field_descriptor.name); } type.encode(field_descriptor, encoding_buffer, TTCN_EncDec::CT_RAW); } loggers::loggers::log_to_hexa("<<>> GeoNetworkingCodec::decode: decoding_buffer=", decoding_buffer); decode_(msg, LibItsGeoNetworking__TypesAndValues::GeoNetworkingPdu_descr_, decoding_buffer); loggers::loggers::log_msg("<<< GeoNetworkingCodec::decode: ", (const Base_Type&)msg); return 0; } int GeoNetworkingCodec::decode_ (Base_Type& type, const TTCN_Typedescriptor_t& field_descriptor, TTCN_Buffer& decoding_buffer) { loggers::loggers::log(">>> GeoNetworkingCodec::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(&type) != NULL) { Record_Type& r = (Record_Type &)type; loggers::loggers::log("GeoNetworkingCodec::decode_: processing Record_Type %s", r.get_descriptor()->name); for(int i = 0; i < r.get_count(); i++) { loggers::loggers::log("GeoNetworkingCodec::decode_: processing %s/%s/%s", r.fld_name(i), r.fld_descr(i)->name, r.get_at(i)->get_descriptor()->name); if (decode_(*((Base_Type *)(r.get_at(i))), *(r.fld_descr(i)), decoding_buffer) == -1) { return -1; } } // End of 'for' statement } else if (std::string(type.get_descriptor()->name).compare("@LibItsSecurity_TypesAndValues.SecuredMessage") == 0) { dynamic_cast &>(type).set_to_omit(); } else { loggers::loggers::log("GeoNetworkingCodec::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 _dc.next_header = (unsigned int)dynamic_cast(type).as_int(); } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.CommonHeader.headerTST") == 0) { decode_headerTST(static_cast(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 &>(type) = OPTIONAL(e); loggers::loggers::log_msg("GeoNetworkingCodec::decode_: Set OPTIONAL to ", type); } else { loggers::loggers::log("GeoNetworkingCodec::decode_: Set OPTIONAL to omit"); dynamic_cast &>(type).set_to_omit(); } } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.GnNonSecuredPacket.payload") == 0) { LibItsGeoNetworking__TypesAndValues::Payload p; decode_(p, LibItsGeoNetworking__TypesAndValues::Payload_descr_, decoding_buffer); loggers::loggers::log_msg("GeoNetworkingCodec::decode_: payload= ", p); if (p.is_bound()) { dynamic_cast &>(type) = OPTIONAL(p); loggers::loggers::log_msg("GeoNetworkingCodec::decode_: Set OPTIONAL to ", type); } else { loggers::loggers::log("GeoNetworkingCodec::decode_: Set OPTIONAL to omit"); dynamic_cast &>(type).set_to_omit(); } } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.Payload.decodedPayload") == 0) { dynamic_cast &>(type).set_to_omit(); } else if (std::string(field_descriptor.name).compare("@LibItsGeoNetworking_TypesAndValues.Payload.rawPayload") == 0) { // Decode RawPayload data structure OCTETSTRING s(decoding_buffer.get_len() - decoding_buffer.get_pos(), decoding_buffer.get_data() + decoding_buffer.get_pos()); loggers::loggers::log_msg("GeoNetworkingCodec::decode_: s=", s); const unsigned char * p = static_cast(s); if ((unsigned char)s.lengthof() <= _dc.plLength) { _dc.payload.assign(p, p + s.lengthof()); } else { _dc.payload.assign(p, p + _dc.plLength); } loggers::loggers::log("GeoNetworkingCodec::decode_: vector length=%d", _dc.payload.size()); dynamic_cast(type) = OCTETSTRING(_dc.payload.size(), static_cast(_dc.payload.data())); } 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 _dc.plLength = (unsigned int)static_cast(dynamic_cast(type)); } else { type.decode(field_descriptor, decoding_buffer, TTCN_EncDec::CT_RAW); } } loggers::loggers::log_msg("<<< GeoNetworkingCodec::decode_: ", type); loggers::loggers::log_to_hexa("<<< GeoNetworkingCodec::decode_: decoding_buffer=", decoding_buffer); return 0; } int GeoNetworkingCodec::encode_extendedHeader(const LibItsGeoNetworking__TypesAndValues::ExtendedHeader& u, TTCN_Buffer& encoding_buffer) { loggers::loggers::log(">>> GeoNetworkingCodec::encode_extendedHeader: processing %s", u.get_descriptor()->name); int result = -1; switch (u.get_selection()) { case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::UNBOUND_VALUE: TTCN_error("GeoNetworkingCodec::encode_extendedHeader: Invalid selection in unbound union"); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoUnicastHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.geoUnicastHeader().get_descriptor()->name); result = encode_(u.geoUnicastHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_geoUnicastHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_tsbHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.tsbHeader().get_descriptor()->name); result = encode_(u.tsbHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_tsbHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_shbHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.shbHeader().get_descriptor()->name); result = encode_(u.shbHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_shbHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoBroadcastHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.geoBroadcastHeader().get_descriptor()->name); result = encode_(u.geoBroadcastHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_geoBroadcastHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoAnycastHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.geoAnycastHeader().get_descriptor()->name); result = encode_(u.geoAnycastHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_geoAnycastHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_beaconHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.beaconHeader().get_descriptor()->name); result = encode_(u.beaconHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_beaconHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_anyHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.anyHeader().get_descriptor()->name); result = encode_(u.anyHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_anyHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsRequestHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.lsRequestHeader().get_descriptor()->name); result = encode_(u.lsRequestHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_lsRequestHeader_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsReplyHeader: loggers::loggers::log("GeoNetworkingCodec::encode_extendedHeader: processing type %s", u.lsReplyHeader().get_descriptor()->name); result = encode_(u.lsReplyHeader(), LibItsGeoNetworking__TypesAndValues::ExtendedHeader_lsReplyHeader_descr_, encoding_buffer); break; default: TTCN_error("GeoNetworkingCodec::encode_extendedHeader: Invalid selection in union is_bound"); } // End of 'switch' statement return result; } int GeoNetworkingCodec::encode_decodedPayload(const LibItsGeoNetworking__TypesAndValues::DecodedPayload& u, TTCN_Buffer& encoding_buffer) { loggers::loggers::log(">>> GeoNetworkingCodec::encode_decodedPayload: processing %s", u.get_descriptor()->name); int result = -1; switch (u.get_selection()) { case LibItsGeoNetworking__TypesAndValues::DecodedPayload::UNBOUND_VALUE: TTCN_error("GeoNetworkingCodec::encode_decodedPayload: Invalid selection in unbound union"); break; case LibItsGeoNetworking__TypesAndValues::DecodedPayload::ALT_ipv6Packet: loggers::loggers::log("GeoNetworkingCodec::encode_decodedPayload: processing type %s", u.ipv6Packet().get_descriptor()->name); //result = encode_(u.geoUnicastHeader(), LibItsGeoNetworking__TypesAndValues::DecodedPayload_ipv6Packet_descr_, encoding_buffer); break; case LibItsGeoNetworking__TypesAndValues::DecodedPayload::ALT_btpPacket: loggers::loggers::log("GeoNetworkingCodec::encode_decodedPayload: processing type %s", u.btpPacket().get_descriptor()->name); //result = encode_(u.geoUnicastHeader(), LibItsGeoNetworking__TypesAndValues::DecodedPayload_btpPacket_descr_, encoding_buffer); break; default: TTCN_error("GeoNetworkingCodec::encode_decodedPayload: Invalid selection in union is_bound"); } // End of 'switch' statement return result; } int GeoNetworkingCodec::decode_headerTST(LibItsGeoNetworking__TypesAndValues::HeaderTST& u, TTCN_Buffer& decoding_buffer) { loggers::loggers::log(">>> GeoNetworkingCodec::decode_headerTST: processing %s", u.get_descriptor()->name); // Decode HeaderTST data structure _dc.header_type = *(decoding_buffer.get_data() + decoding_buffer.get_pos()) >> 4; _dc.header_sub_type = *(decoding_buffer.get_data() + decoding_buffer.get_pos()) & 0x0F; loggers::loggers::log("GeoNetworkingCodec::decode_: headerTST selectors: _dc.header_type = %d - _dc.header_sub_type = %d", _dc.header_type, _dc.header_sub_type); //LibItsGeoNetworking__TypesAndValues::HeaderTST & u = dynamic_cast(u); switch (_dc.header_type) { case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoUnicastHeader: u.geoUnicastHdr().decode(*u.geoUnicastHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_tsbHeader: u.tsbHdr().decode(*u.tsbHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_shbHeader: u.tsbHdr().decode(*u.tsbHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoBroadcastHeader: u.geoBroadcastHdr().decode(*u.geoBroadcastHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoAnycastHeader: u.geoAnycastHdr().decode(*u.geoAnycastHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_beaconHeader: u.beaconHdr().decode(*u.beaconHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsRequestHeader: u.lsHdr().decode(*u.lsHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsReplyHeader: u.lsHdr().decode(*u.lsHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_anyHeader: u.anyHdr().decode(*u.anyHdr().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; default: TTCN_error("GeoNetworkingCodec::decode_: Not processed, _dc.header_type = %d - _dc.header_sub_type = %d", _dc.header_type, _dc.header_sub_type); } // End of 'switch' statement return 0; } int GeoNetworkingCodec::decode_extendedHeader(LibItsGeoNetworking__TypesAndValues::ExtendedHeader& u, TTCN_Buffer& decoding_buffer) { loggers::loggers::log(">>> GeoNetworkingCodec::decode_extendedHeader: processing %s", u.get_descriptor()->name); switch (_dc.header_type) { case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoUnicastHeader: u.geoUnicastHeader().decode(*u.geoUnicastHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_tsbHeader: u.tsbHeader().decode(*u.tsbHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_shbHeader: u.shbHeader().decode(*u.shbHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoBroadcastHeader: u.geoBroadcastHeader().decode(*u.geoBroadcastHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_geoAnycastHeader: u.geoAnycastHeader().decode(*u.geoAnycastHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_beaconHeader: u.beaconHeader().decode(*u.beaconHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsRequestHeader: u.lsRequestHeader().decode(*u.lsRequestHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_lsReplyHeader: u.lsReplyHeader().decode(*u.lsReplyHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; case LibItsGeoNetworking__TypesAndValues::ExtendedHeader::ALT_anyHeader: u.anyHeader().decode(*u.anyHeader().get_descriptor(), decoding_buffer, TTCN_EncDec::CT_RAW); break; default: TTCN_error("GeoNetworkingCodec::decode_headerTST: Not processed, _dc.header_type = %d - _dc.header_sub_type = %d", _dc.header_type, _dc.header_sub_type); } // End of 'switch' statement return 0; }