/******************************************************************************* * libretroshare/src/serialiser: rstlvbase.cc * * * * libretroshare: retroshare core library * * * * Copyright 2007-2008 by Robert Fernie, Horatio, Chris Parker * * * * This program is free software: you can redistribute it and/or modify * * it under the terms of the GNU Lesser General Public License as * * published by the Free Software Foundation, either version 3 of the * * License, or (at your option) any later version. * * * * This program is distributed in the hope that it will be useful, * * but WITHOUT ANY WARRANTY; without even the implied warranty of * * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * * GNU Lesser General Public License for more details. * * * * You should have received a copy of the GNU Lesser General Public License * * along with this program. If not, see . * * * *******************************************************************************/ #include #include "serialiser/rstlvbase.h" #include "serialiser/rsbaseserial.h" //********************* // A facility func inline void* right_shift_void_pointer(const void* p, uint32_t len) { return (void*)( (uint8_t*)p + len); } //********************* //#define TLV_BASE_DEBUG 1 /**** Basic TLV Functions ****/ uint32_t GetTlvSize(void *data) { if (!data) return 0; uint32_t len; void * from =right_shift_void_pointer(data, TLV_HEADER_TYPE_SIZE); memcpy((void *)&len, from , TLV_HEADER_LEN_SIZE); len = ntohl(len); return len; } uint16_t GetTlvType(void *data) { if (!data) return 0; uint16_t type; memcpy((void*)&type, data, TLV_HEADER_TYPE_SIZE); type = ntohs(type); return type; } //tested bool SetTlvBase(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint32_t len) { if (!data) return false; if (!offset) return false; if (size < *offset + TLV_HEADER_SIZE) return false; uint16_t type_n = htons(type); //copy type_n to (data+*offset) void* to = right_shift_void_pointer(data, *offset); memcpy(to , (void*)&type_n, TLV_HEADER_TYPE_SIZE); uint32_t len_n =htonl(len); //copy len_n to (data + *offset +2) to = right_shift_void_pointer(to, TLV_HEADER_TYPE_SIZE); memcpy((void *)to, (void*)&len_n, TLV_HEADER_LEN_SIZE); *offset += TLV_HEADER_SIZE; return true; } bool SetTlvType(void *data, uint32_t size, uint16_t type) { if (!data) return false; if(size < TLV_HEADER_SIZE ) return false; uint16_t type_n = htons(type); memcpy(data , (void*)&type_n, TLV_HEADER_TYPE_SIZE); return true; } //tested bool SetTlvSize(void *data, uint32_t size, uint32_t len) { if (!data) return false; if(size < TLV_HEADER_SIZE ) return false; uint32_t len_n = htonl(len); void * to = (void*)((uint8_t *) data + TLV_HEADER_TYPE_SIZE); memcpy(to, (void*) &len_n, TLV_HEADER_LEN_SIZE); return true; } /* Step past unknown TLV TYPE */ bool SkipUnknownTlv(void *data, uint32_t size, uint32_t *offset) { if (!data) return false; if (size < *offset + TLV_HEADER_SIZE) return false; /* extract the type and size */ void *tlvstart = right_shift_void_pointer(data, *offset); //uint16_t tlvtype = GetTlvType(tlvstart); uint32_t tlvsize = GetTlvSize(tlvstart); /* check that there is size */ uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SkipUnknownTlv() FAILED - not enough space." << std::endl; std::cerr << "SkipUnknownTlv() size: " << size << std::endl; std::cerr << "SkipUnknownTlv() tlvsize: " << tlvsize << std::endl; std::cerr << "SkipUnknownTlv() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; /* step past this tlv item */ *offset = tlvend; return ok; } /**** Generic TLV Functions **** * This have the same data (int or string for example), * but they can have different types eg. a string could represent a name or a path, * so we include a type parameter in the arguments */ //tested bool SetTlvUInt32(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint32_t out) { if (!data) return false; uint32_t tlvsize = GetTlvUInt32Size(); /* this will always be 8 bytes */ uint32_t tlvend = *offset + tlvsize; /* where the data will extend to */ if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SetTlvUInt32() FAILED - not enough space. (or earlier)" << std::endl; std::cerr << "SetTlvUInt32() size: " << size << std::endl; std::cerr << "SetTlvUInt32() tlvsize: " << tlvsize << std::endl; std::cerr << "SetTlvUInt32() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; /* Now use the function we got to set the TlvHeader */ /* function shifts offset to the new start for the next data */ ok &= SetTlvBase(data, tlvend, offset, type, tlvsize); #ifdef TLV_BASE_DEBUG if (!ok) { std::cerr << "SetTlvUInt32() SetTlvBase FAILED (or earlier)" << std::endl; } #endif /* now set the UInt32 ( in rsbaseserial.h???) */ ok &= setRawUInt32(data, tlvend, offset, out); #ifdef TLV_BASE_DEBUG if (!ok) { std::cerr << "SetTlvUInt32() setRawUInt32 FAILED (or earlier)" << std::endl; } #endif return ok; } //tested bool GetTlvUInt32(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint32_t *in) { if (!data) return false; if (size < *offset + TLV_HEADER_SIZE) return false; /* extract the type and size */ void *tlvstart = right_shift_void_pointer(data, *offset); uint16_t tlvtype = GetTlvType(tlvstart); uint32_t tlvsize = GetTlvSize(tlvstart); /* check that there is size */ uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvUInt32() FAILED - not enough space." << std::endl; std::cerr << "GetTlvUInt32() size: " << size << std::endl; std::cerr << "GetTlvUInt32() tlvsize: " << tlvsize << std::endl; std::cerr << "GetTlvUInt32() tlvend: " << tlvend << std::endl; #endif return false; } if (type != tlvtype) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvUInt32() FAILED - Type mismatch" << std::endl; std::cerr << "GetTlvUInt32() type: " << type << std::endl; std::cerr << "GetTlvUInt32() tlvtype: " << tlvtype << std::endl; #endif return false; } *offset += TLV_HEADER_SIZE; /* step past header */ bool ok = true; ok &= getRawUInt32(data, tlvend, offset, in); return ok; } // UInt16 bool SetTlvUInt16(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint16_t out) { if (!data) return false; uint32_t tlvsize = GetTlvUInt16Size(); /* this will always be 8 bytes */ uint32_t tlvend = *offset + tlvsize; /* where the data will extend to */ if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SetTlvUInt16() FAILED - not enough space. (or earlier)" << std::endl; std::cerr << "SetTlvUInt16() size: " << size << std::endl; std::cerr << "SetTlvUInt16() tlvsize: " << tlvsize << std::endl; std::cerr << "SetTlvUInt16() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; /* Now use the function we got to set the TlvHeader */ /* function shifts offset to the new start for the next data */ ok &= SetTlvBase(data, tlvend, offset, type, tlvsize); #ifdef TLV_BASE_DEBUG if (!ok) { std::cerr << "SetTlvUInt16() SetTlvBase FAILED (or earlier)" << std::endl; } #endif /* now set the UInt16 ( in rsbaseserial.h???) */ ok &= setRawUInt16(data, tlvend, offset, out); #ifdef TLV_BASE_DEBUG if (!ok) { std::cerr << "SetTlvUInt16() setRawUInt16 FAILED (or earlier)" << std::endl; } #endif return ok; } bool GetTlvUInt16(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint16_t *in) { if (!data) return false; if (size < *offset + TLV_HEADER_SIZE) return false; /* extract the type and size */ void *tlvstart = right_shift_void_pointer(data, *offset); uint16_t tlvtype = GetTlvType(tlvstart); uint32_t tlvsize = GetTlvSize(tlvstart); /* check that there is size */ uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvUInt16() FAILED - not enough space." << std::endl; std::cerr << "GetTlvUInt16() size: " << size << std::endl; std::cerr << "GetTlvUInt16() tlvsize: " << tlvsize << std::endl; std::cerr << "GetTlvUInt16() tlvend: " << tlvend << std::endl; #endif return false; } if (type != tlvtype) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvUInt16() FAILED - Type mismatch" << std::endl; std::cerr << "GetTlvUInt16() type: " << type << std::endl; std::cerr << "GetTlvUInt16() tlvtype: " << tlvtype << std::endl; #endif return false; } *offset += TLV_HEADER_SIZE; /* step past header */ bool ok = true; ok &= getRawUInt16(data, tlvend, offset, in); return ok; } uint32_t GetTlvUInt64Size() { return TLV_HEADER_SIZE + 8; } uint32_t GetTlvUInt32Size() { return TLV_HEADER_SIZE + 4; } uint32_t GetTlvUInt16Size() { return TLV_HEADER_SIZE + sizeof(uint16_t); } uint32_t GetTlvUInt8Size() { return TLV_HEADER_SIZE + sizeof(uint8_t); } bool SetTlvUInt64(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint64_t out) { if (!data) return false; uint32_t tlvsize = GetTlvUInt64Size(); uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SetTlvUInt64() FAILED - not enough space. (or earlier)" << std::endl; std::cerr << "SetTlvUInt64() size: " << size << std::endl; std::cerr << "SetTlvUInt64() tlvsize: " << tlvsize << std::endl; std::cerr << "SetTlvUInt64() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; /* Now use the function we got to set the TlvHeader */ /* function shifts offset to the new start for the next data */ ok &= SetTlvBase(data, tlvend, offset, type, tlvsize); #ifdef TLV_BASE_DEBUG if (!ok) { std::cerr << "SetTlvUInt64() SetTlvBase FAILED (or earlier)" << std::endl; } #endif /* now set the UInt64 ( in rsbaseserial.h???) */ ok &= setRawUInt64(data, tlvend, offset, out); #ifdef TLV_BASE_DEBUG if (!ok) { std::cerr << "SetTlvUInt64() setRawUInt64 FAILED (or earlier)" << std::endl; } #endif return ok; } bool GetTlvUInt64(void *data, uint32_t size, uint32_t *offset, uint16_t type, uint64_t *in) { if (!data) return false; if (size < *offset + TLV_HEADER_SIZE) return false; /* extract the type and size */ void *tlvstart = right_shift_void_pointer(data, *offset); uint16_t tlvtype = GetTlvType(tlvstart); uint32_t tlvsize = GetTlvSize(tlvstart); /* check that there is size */ uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvUInt64() FAILED - not enough space." << std::endl; std::cerr << "GetTlvUInt64() size: " << size << std::endl; std::cerr << "GetTlvUInt64() tlvsize: " << tlvsize << std::endl; std::cerr << "GetTlvUInt64() tlvend: " << tlvend << std::endl; #endif return false; } if (type != tlvtype) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvUInt64() FAILED - Type mismatch" << std::endl; std::cerr << "GetTlvUInt64() type: " << type << std::endl; std::cerr << "GetTlvUInt64() tlvtype: " << tlvtype << std::endl; #endif return false; } *offset += TLV_HEADER_SIZE; /* step past header */ bool ok = true; ok &= getRawUInt64(data, tlvend, offset, in); return ok; } bool SetTlvString(void *data, uint32_t size, uint32_t *offset, uint16_t type, std::string out) { if (!data) return false; uint32_t tlvsize = GetTlvStringSize(out); uint32_t tlvend = *offset + tlvsize; /* where the data will extend to */ if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SetTlvString() FAILED - not enough space" << std::endl; std::cerr << "SetTlvString() size: " << size << std::endl; std::cerr << "SetTlvString() tlvsize: " << tlvsize << std::endl; std::cerr << "SetTlvString() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; ok &= SetTlvBase(data, tlvend, offset, type, tlvsize); void * to = right_shift_void_pointer(data, *offset); uint32_t strlen = tlvsize - TLV_HEADER_SIZE; memcpy(to, out.c_str(), strlen); *offset += strlen; return ok; } static bool readHex(char s1,char s2,uint8_t& v) { v=0 ; if(s1 >= 'a' && s1 <= 'f') v += (s1-'a')+10; else if(s1 >= 'A' && s1 <= 'F') v += (s1-'A')+10; else if(s1 >= '0' && s1 <= '9') v += s1 - '0' ; else return false ; v = v << 4; if(s2 >= 'a' && s2 <= 'f') v += (s2-'a')+10; else if(s2 >= 'A' && s2 <= 'F') v += (s2-'A')+10; else if(s2 >= '0' && s2 <= '9') v += s2 - '0' ; else return false ; return true ; } static bool find_decoded_string(const std::string& in,const std::string& suspicious_string) { uint32_t ss_pointer = 0 ; for(uint32_t i=0;i 0x7f. // We do this for strings that should not contain some // special characters by design. if( type == 0 // this is used for mGroupName and mMsgName || type == TLV_TYPE_STR_PEERID || type == TLV_TYPE_STR_NAME || type == TLV_TYPE_STR_PATH || type == TLV_TYPE_STR_TITLE || type == TLV_TYPE_STR_SUBJECT || type == TLV_TYPE_STR_LOCATION || type == TLV_TYPE_STR_VERSION ) { bool modified = false ; for(uint32_t i=0;i 0) { modified = true ; in[i] = 0x20 ; } if(modified) std::cerr << "(WW) De-serialised string of type " << type << " contains forbidden characters. They have been replaced by spaces. New string: \"" << in << "\"" << std::endl; } *offset += tlvsize; /* step along */ return true; } uint32_t GetTlvStringSize(const std::string &in) { return TLV_HEADER_SIZE + in.size(); } #ifdef REMOVED_CODE /* We must use a consistent wchar size for cross platform ness. * As unix uses 4bytes, and windows 2bytes? we'll go with 4bytes for maximum flexibility */ const uint32_t RS_WCHAR_SIZE = 4; bool SetTlvWideString(void *data, uint32_t size, uint32_t *offset, uint16_t type, std::wstring out) { if (!data) return false; uint32_t tlvsize = GetTlvWideStringSize(out); uint32_t tlvend = *offset + tlvsize; /* where the data will extend to */ if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SetTlvWideString() FAILED - not enough space" << std::endl; std::cerr << "SetTlvWideString() size: " << size << std::endl; std::cerr << "SetTlvWideString() tlvsize: " << tlvsize << std::endl; std::cerr << "SetTlvWideString() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; ok &= SetTlvBase(data, tlvend, offset, type, tlvsize); uint32_t strlen = out.length(); /* Must convert manually to ensure its always the same! */ for(uint32_t i = 0; i < strlen; i++) { uint32_t widechar = out[i]; ok &= setRawUInt32(data, tlvend, offset, widechar); } return ok; } //tested bool GetTlvWideString(void *data, uint32_t size, uint32_t *offset, uint16_t type, std::wstring &in) { if (!data) return false; if (size < *offset + TLV_HEADER_SIZE) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvWideString() FAILED - not enough space" << std::endl; std::cerr << "GetTlvWideString() size: " << size << std::endl; std::cerr << "GetTlvWideString() *offset: " << *offset << std::endl; #endif return false; } /* extract the type and size */ void *tlvstart = right_shift_void_pointer(data, *offset); uint16_t tlvtype = GetTlvType(tlvstart); uint32_t tlvsize = GetTlvSize(tlvstart); /* check that there is size */ uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvWideString() FAILED - not enough space" << std::endl; std::cerr << "GetTlvWideString() size: " << size << std::endl; std::cerr << "GetTlvWideString() tlvsize: " << tlvsize << std::endl; std::cerr << "GetTlvWideString() tlvend: " << tlvend << std::endl; #endif return false; } if (type != tlvtype) { #ifdef TLV_BASE_DEBUG std::cerr << "GetTlvWideString() FAILED - invalid type" << std::endl; std::cerr << "GetTlvWideString() type: " << type << std::endl; std::cerr << "GetTlvWideString() tlvtype: " << tlvtype << std::endl; #endif return false; } bool ok = true; /* remove the header, calc string length */ *offset += TLV_HEADER_SIZE; uint32_t strlen = (tlvsize - TLV_HEADER_SIZE) / RS_WCHAR_SIZE; /* Must convert manually to ensure its always the same! */ for(uint32_t i = 0; i < strlen; i++) { uint32_t widechar; ok &= getRawUInt32(data, tlvend, offset, &widechar); in += widechar; } // Check for message content. We want to avoid possible lol bombs as soon as possible. static const int number_of_suspiscious_strings = 4 ; static const std::wstring err_in = L"**** String removed (SVG bomb?) ****" ; static std::wstring suspiscious_strings[number_of_suspiscious_strings] = { L"sin_family = AF_INET; /* set FAMILY */ in->sin_addr.s_addr = ipaddr; uint16_t port; ok &= getRawUInt16(data, tlvend, offset, &port); in->sin_port = port; return ok; } uint32_t GetTlvIpAddrPortV4Size() { return TLV_HEADER_SIZE + 4 + 2; /* header + 4 (IP) + 2 (Port) */ } bool SetTlvIpAddrPortV6(void *data, uint32_t size, uint32_t *offset, uint16_t type, struct sockaddr_in6 *out) { if (!data) return false; uint32_t tlvsize = GetTlvIpAddrPortV6Size(); uint32_t tlvend = *offset + tlvsize; /* where the data will extend to */ if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "SetTlvIpAddrPortV6() FAILED - not enough space" << std::endl; std::cerr << "SetTlvIpAddrPortV6() size: " << size << std::endl; std::cerr << "SetTlvIpAddrPortV6() tlvsize: " << tlvsize << std::endl; std::cerr << "SetTlvIpAddrPortV6() tlvend: " << tlvend << std::endl; #endif return false; } bool ok = true; ok &= SetTlvBase(data, tlvend, offset, type, tlvsize); /* now add the data (keep in network order) */ uint32_t *ip6addr = (uint32_t *) out->sin6_addr.s6_addr; for(int i = 0; i < 4; i++) { ok &= setRawUInt32(data, tlvend, offset, ip6addr[i]); } ok &= setRawUInt16(data, tlvend, offset, out->sin6_port); return ok; } bool GetTlvIpAddrPortV6(void *data, uint32_t size, uint32_t *offset, uint16_t type, struct sockaddr_in6 *in) { if (!data) return false; if (size < *offset + TLV_HEADER_SIZE) { #ifdef TLV_BASE_DEBUG std::cerr << "GetIpAddrPortV6() FAILED - not enough space" << std::endl; std::cerr << "GetIpAddrPortV6() size: " << size << std::endl; std::cerr << "GetIpAddrPortV6() *offset: " << *offset << std::endl; #endif return false; } /* extract the type and size */ void *tlvstart = right_shift_void_pointer(data, *offset); uint16_t tlvtype = GetTlvType(tlvstart); uint32_t tlvsize = GetTlvSize(tlvstart); /* check that there is size */ uint32_t tlvend = *offset + tlvsize; if (size < tlvend) { #ifdef TLV_BASE_DEBUG std::cerr << "GetIpAddrPortV6() FAILED - not enough space" << std::endl; std::cerr << "GetIpAddrPortV6() size: " << size << std::endl; std::cerr << "GetIpAddrPortV6() tlvsize: " << tlvsize << std::endl; std::cerr << "GetIpAddrPortV6() tlvend: " << tlvend << std::endl; #endif return false; } if (type != tlvtype) { #ifdef TLV_BASE_DEBUG std::cerr << "GetIpAddrPortV6() FAILED - invalid type" << std::endl; std::cerr << "GetIpAddrPortV6() type: " << type << std::endl; std::cerr << "GetIpAddrPortV6() tlvtype: " << tlvtype << std::endl; #endif return false; } *offset += TLV_HEADER_SIZE; /* skip header */ bool ok = true; /* now get the data (keep in network order) */ uint32_t *ip6addr = (uint32_t *) in->sin6_addr.s6_addr; for(int i = 0; i < 4; i++) { ok &= getRawUInt32(data, tlvend, offset, &(ip6addr[i])); } in->sin6_family = AF_INET6; /* set FAMILY */ ok &= getRawUInt16(data, tlvend, offset, &(in->sin6_port)); return ok; } uint32_t GetTlvIpAddrPortV6Size() { return TLV_HEADER_SIZE + 16 + 2; /* header + 16 (IP) + 2 (Port) */ }