ibrdtn/ibrdtn/data/SDNV.cpp

Go to the documentation of this file.

/*
*    Copyright 2005-2006 Intel Corporation
*
*    Licensed under the Apache License, Version 2.0 (the "License");
*    you may not use this file except in compliance with the License.
*    You may obtain a copy of the License at
*
*        http://www.apache.org/licenses/LICENSE-2.0
*
*    Unless required by applicable law or agreed to in writing, software
*    distributed under the License is distributed on an "AS IS" BASIS,
*    WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
*    See the License for the specific language governing permissions and
*    limitations under the License.
*
*    THIS FILE BASES ON DTN_2.4.0/SERVLIB/BUNDLING/SDNV.CC
*/

using namespace std;

#include "ibrdtn/data/SDNV.h"
#include "ibrdtn/data/Exceptions.h"
#include <cstdlib>
#include <cstring>

namespace dtn
{
        namespace data
        {

                SDNV::SDNV(const u_int64_t value) : _value(value)
                {}

                SDNV::SDNV() : _value(0)
                {}

                SDNV::~SDNV()
                {}

                size_t SDNV::getLength() const
                {
                        return getLength(_value);
                }

                size_t SDNV::getLength(const u_int64_t &value)
                {
                        return encoding_len(value);
                }

                size_t SDNV::getLength(const unsigned char *data)
                {
                        return len(data);
                }

                u_int64_t SDNV::getValue() const
                {
                        return _value;
                }

                size_t SDNV::decode(const char *data, const size_t len)
                {
                        return decode((unsigned char*)data, len, &_value);
                }

                size_t SDNV::encode(char *data, const size_t len) const
                {
                        return encode(_value, (unsigned char*)data, len);
                }

                size_t SDNV::operator=(const size_t &value)
                {
                        _value = value;
                        return _value;
                }

                bool SDNV::operator==(const SDNV &value) const
                {
                        return (_value == value._value);
                }

                bool SDNV::operator!=(const SDNV &value) const
                {
                        return (_value != value._value);
                }

                SDNV SDNV::operator+(const SDNV &value)
                {
                        return SDNV(value.getValue() + getValue());
                }

                SDNV& SDNV::operator+=(const SDNV &value)
                {
                        _value += value._value;
                        return (*this);
                }

                SDNV SDNV::operator-(const SDNV &value)
                {
                        return SDNV(value.getValue() - getValue());
                }

                SDNV& SDNV::operator-=(const SDNV &value)
                {
                        _value -= value._value;
                        return (*this);
                }

                bool SDNV::operator&(const size_t &value) const
                {
                        return (_value & value);
                }

                bool SDNV::operator<(const SDNV &value) const
                {
                        return _value < value._value;
                }

                bool SDNV::operator<=(const SDNV &value) const
                {
                        return !(value < *this);
                }

                bool SDNV::operator>(const SDNV &value) const
                {
                        return value < *this;
                }

                bool SDNV::operator>=(const SDNV &value) const
                {
                        return !(*this < value);
                }

                std::ostream &operator<<(std::ostream &stream, const dtn::data::SDNV &obj)
                {
                        size_t len = obj.getLength();
                        char* data = (char*)calloc(len, sizeof(char));
                        obj.encode(data, len);
                        stream.write(data, len);
                        free(data);

                        return stream;
                }

                std::istream &operator>>(std::istream &stream, dtn::data::SDNV &obj)
                {
                        char sdnv[dtn::data::SDNV::MAX_LENGTH];
                        char *sdnv_buf = sdnv;
                        size_t sdnv_length = 0;

                        stream.read(sdnv_buf, sizeof(char));
                        sdnv_length++;

                        while ( *sdnv_buf & 0x80)
                        {
                                if (sdnv_length > dtn::data::SDNV::MAX_LENGTH)
                                        throw InvalidDataException("SDNV decode failed!");

                                sdnv_buf++;
                                stream.read(sdnv_buf, sizeof(char));
                                sdnv_length++;
                        }

                        dtn::data::SDNV::decode(sdnv, sdnv_length, &obj._value);

                        return stream;
                }

                int SDNV::encode(float val_f, u_char* bp, size_t len){
                  // Convert the float to an int and call the encoding_len(int) function
                  u_int32_t val_i;
                  memcpy(&val_i, &val_f, sizeof(u_int32_t));

                  return encode((u_int64_t)val_i, bp, len);
                }

                int SDNV::encode(u_int64_t val, u_char* bp, size_t len){
                  u_char* start = bp;

                  //Figure out how many bytes we need for the encoding.
                  size_t val_len = 0;
                  u_int64_t tmp = val;

                  do {
                        tmp = tmp >> 7;
                        val_len++;
                  } while (tmp != 0);

                  if (!(val_len > 0)) throw InvalidDataException("ERROR(SDNV): !(val_len > 0)");
                  if (!(val_len <= MAX_LENGTH)) throw InvalidDataException("ERROR(SDNV): !(val_len <= MAX_LENGTH)");
                  // Make sure we have enough buffer space.
                  if (len < val_len) {
                        return -1;
                  }

                  // Now advance bp to the last byte and fill it in backwards with the value bytes.
                  bp += val_len;
                  u_char high_bit = 0; // for the last octet
                  do {
                        --bp;
                        *bp = (u_char)(high_bit | (val & 0x7f));
                        high_bit = (1 << 7); // for all but the last octet
                        val = val >> 7;
                  } while (val != 0);

                  if (!(bp == start)) throw InvalidDataException("ERROR(SDNV): !(bp == start)");

                  return val_len;
                }


                size_t SDNV::encoding_len(u_int64_t val){
                  u_char buf[16];
                  int ret = encode(val, buf, sizeof(buf));
                  if (!(ret != -1 && ret != 0)) throw InvalidDataException("ERROR(SDNV): !(ret != -1 && ret != 0)");
                  return ret;
                }

                size_t SDNV::encoding_len(float val_f){
                  // Convert the float to an int and call the encoding_len(int) function
                  u_int32_t val_i;
                  memcpy(&val_i, &val_f, sizeof(u_int32_t));

                  return encoding_len(val_i);
                }

                int SDNV::decode(const u_char* bp, size_t len, u_int64_t* val){
                  const u_char* start = bp;

                  if (!val) {
                        throw InvalidDataException();
                  }

                  // Zero out the existing value, then shift in the bytes of the
                  // encoding one by one until we hit a byte that has a zero high-order bit.
                  size_t val_len = 0;
                  *val = 0;
                  do {
                        if (len == 0)
                          return -1; // buffer too short

                        *val = (*val << 7) | (*bp & 0x7f);
                        ++val_len;

                        if ((*bp & (1 << 7)) == 0)
                          break; // all done;

                        ++bp;
                        --len;
                  } while (1);


                  // Since the spec allows for infinite length values but this
                  // implementation only handles up to 64 bits, check for overflow.
                  // Note that the only supportable 10 byte SDNV must store exactly
                  // one bit in the first byte of the encoding (i.e. the 64'th bit
                  // of the original value).
                  // This is OK because a spec update says that behavior
                  // is undefined for values > 64 bits.
                  if ((val_len > MAX_LENGTH) || ((val_len == MAX_LENGTH) && (*start != 0x81))){
                        throw InvalidDataException("ERROR(SDNV): overflow value in sdnv");
                  }

                  return val_len;
                }

                int SDNV::decode(const u_char* bp, size_t len, u_int32_t* val){
                  u_int64_t lval;
                  int ret = decode(bp, len, &lval);

                  if (lval > 0xffffffffLL) {
                        throw InvalidDataException();
                  }

                  *val = (u_int32_t)lval;

                  return ret;
                }

                int SDNV::decode(const u_char* bp, size_t len, u_int16_t* val){
                  u_int64_t lval;
                  int ret = decode(bp, len, &lval);

                  if (lval > 0xffffffffLL) {
                        throw InvalidDataException();
                  }

                  *val = (u_int16_t)lval;

                  return ret;
                }

                int SDNV::decode(const u_char* bp, size_t len, float* val){
                  u_int64_t lval;
                  int ret = decode(bp, len, &lval);

                  if (lval > 0xffffffffLL) {
                        throw InvalidDataException();
                  }

                  float fval;
                  u_int32_t ival = (u_int32_t)lval;
                  memcpy(&fval, &ival, sizeof(u_int32_t));

                  *val = fval;

                  return ret;
                }

                size_t SDNV::len(const u_char* bp){
                  size_t val_len = 1;

                  for ( ; *bp++ & 0x80; ++val_len )
                        ;
                  return val_len;
                }
        }
}