/*

	oscpack -- Open Sound Control packet manipulation library

	http://www.audiomulch.com/~rossb/oscpack

	Copyright (c) 2004-2005 Ross Bencina <rossb@audiomulch.com>

	Permission is hereby granted, free of charge, to any person obtaining

	a copy of this software and associated documentation files

	(the "Software"), to deal in the Software without restriction,

	including without limitation the rights to use, copy, modify, merge,

	publish, distribute, sublicense, and/or sell copies of the Software,

	and to permit persons to whom the Software is furnished to do so,

	subject to the following conditions:

	The above copyright notice and this permission notice shall be

	included in all copies or substantial portions of the Software.

	Any person wishing to distribute modifications to the Software is

	requested to send the modifications to the original developer so that

	they can be incorporated into the canonical version.

	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,

	EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF

	MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.

	IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR

	ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF

	CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION

	WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.

*/

#include "OscReceivedElements.h"

#include <cassert>

#include "OscHostEndianness.h"

namespace osc{

// return the first 4 byte boundary after the end of a str4

// be careful about calling this version if you don't know whether

// the string is terminated correctly.

static inline const char* FindStr4End( const char *p )

{

	if( p[0] == '\0' )    // special case for SuperCollider integer address pattern

		return p + 4;

    p += 3;

    while( *p )

        p += 4;

    return p + 1;

}

// return the first 4 byte boundary after the end of a str4

// returns 0 if p == end or if the string is unterminated

static inline const char* FindStr4End( const char *p, const char *end )

{

    if( p >= end )

        return 0;

	if( p[0] == '\0' )    // special case for SuperCollider integer address pattern

		return p + 4;

    p += 3;

    end -= 1;

    while( p < end && *p )

        p += 4;

    if( *p )

        return 0;

    else

        return p + 1;

}

static inline unsigned long RoundUp4( unsigned long x )

{

    unsigned long remainder = x & 0x3UL;

    if( remainder )

        return x + (4 - remainder);

    else

        return x;

}

static inline int32 ToInt32( const char *p )

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        osc::int32 i;

        char c[4];

    } u;

    u.c[0] = p[3];

    u.c[1] = p[2];

    u.c[2] = p[1];

    u.c[3] = p[0];

    return u.i;

#else

	return *(int32*)p;

#endif

}

static inline uint32 ToUInt32( const char *p )

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        osc::uint32 i;

        char c[4];

    } u;

    u.c[0] = p[3];

    u.c[1] = p[2];

    u.c[2] = p[1];

    u.c[3] = p[0];

    return u.i;

#else

	return *(uint32*)p;

#endif

}

int64 ToInt64( const char *p )

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        osc::int64 i;

        char c[8];

    } u;

    u.c[0] = p[7];

    u.c[1] = p[6];

    u.c[2] = p[5];

    u.c[3] = p[4];

    u.c[4] = p[3];

    u.c[5] = p[2];

    u.c[6] = p[1];

    u.c[7] = p[0];

    return u.i;

#else

	return *(int64*)p;

#endif

}

uint64 ToUInt64( const char *p )

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        osc::uint64 i;

        char c[8];

    } u;

    u.c[0] = p[7];

    u.c[1] = p[6];

    u.c[2] = p[5];

    u.c[3] = p[4];

    u.c[4] = p[3];

    u.c[5] = p[2];

    u.c[6] = p[1];

    u.c[7] = p[0];

    return u.i;

#else

	return *(uint64*)p;

#endif

}

//------------------------------------------------------------------------------

bool ReceivedPacket::IsBundle() const

{

    return (Size() > 0 && Contents()[0] == '#');

}

//------------------------------------------------------------------------------

bool ReceivedBundleElement::IsBundle() const

{

    return (Size() > 0 && Contents()[0] == '#');

}

int32 ReceivedBundleElement::Size() const

{

    return ToUInt32( size_ );

}

//------------------------------------------------------------------------------

bool ReceivedMessageArgument::AsBool() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == TRUE_TYPE_TAG )

		return true;

	else if( *typeTag_ == FALSE_TYPE_TAG )

		return false;

	else

		throw WrongArgumentTypeException();

}

bool ReceivedMessageArgument::AsBoolUnchecked() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == TRUE_TYPE_TAG )

		return true;

    else

	    return false;

}

int32 ReceivedMessageArgument::AsInt32() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == INT32_TYPE_TAG )

		return AsInt32Unchecked();

	else

		throw WrongArgumentTypeException();

}

int32 ReceivedMessageArgument::AsInt32Unchecked() const

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        osc::int32 i;

        char c[4];

    } u;

    u.c[0] = argument_[3];

    u.c[1] = argument_[2];

    u.c[2] = argument_[1];

    u.c[3] = argument_[0];

    return u.i;

#else

	return *(int32*)argument_;

#endif

}

float ReceivedMessageArgument::AsFloat() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == FLOAT_TYPE_TAG )

		return AsFloatUnchecked();

	else

		throw WrongArgumentTypeException();

}

float ReceivedMessageArgument::AsFloatUnchecked() const

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        float f;

        char c[4];

    } u;

    u.c[0] = argument_[3];

    u.c[1] = argument_[2];

    u.c[2] = argument_[1];

    u.c[3] = argument_[0];

    return u.f;

#else

	return *(float*)argument_;

#endif

}

char ReceivedMessageArgument::AsChar() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == CHAR_TYPE_TAG )

		return AsCharUnchecked();

	else

		throw WrongArgumentTypeException();

}

char ReceivedMessageArgument::AsCharUnchecked() const

{

    return (char)ToInt32( argument_ );

}

uint32 ReceivedMessageArgument::AsRgbaColor() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == RGBA_COLOR_TYPE_TAG )

		return AsRgbaColorUnchecked();

	else

		throw WrongArgumentTypeException();

}

uint32 ReceivedMessageArgument::AsRgbaColorUnchecked() const

{

	return ToUInt32( argument_ );

}

uint32 ReceivedMessageArgument::AsMidiMessage() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == MIDI_MESSAGE_TYPE_TAG )

		return AsMidiMessageUnchecked();

	else

		throw WrongArgumentTypeException();

}

uint32 ReceivedMessageArgument::AsMidiMessageUnchecked() const

{

	return ToUInt32( argument_ );

}

int64 ReceivedMessageArgument::AsInt64() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == INT64_TYPE_TAG )

		return AsInt64Unchecked();

	else

		throw WrongArgumentTypeException();

}

int64 ReceivedMessageArgument::AsInt64Unchecked() const

{

    return ToInt64( argument_ );

}

uint64 ReceivedMessageArgument::AsTimeTag() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == TIME_TAG_TYPE_TAG )

		return AsTimeTagUnchecked();

	else

		throw WrongArgumentTypeException();

}

uint64 ReceivedMessageArgument::AsTimeTagUnchecked() const

{

    return ToUInt64( argument_ );

}

double ReceivedMessageArgument::AsDouble() const

{

    if( !typeTag_ )

        throw MissingArgumentException();

	else if( *typeTag_ == DOUBLE_TYPE_TAG )

		return AsDoubleUnchecked();

	else

		throw WrongArgumentTypeException();

}

double ReceivedMessageArgument::AsDoubleUnchecked() const

{

#ifdef OSC_HOST_LITTLE_ENDIAN

    union{

        double d;

        char c[8];

    } u;

    u.c[0] = argument_[7];

    u.c[1] = argument_[6];

    u.c[2] = argument_[5];

    u.c[3] = argument_[4];

    u.c[4] = argument_[3];

    u.c[5] = argument_[2];

    u.c[6] = argument_[1];

    u.c[7] = argument_[0];

    return u.d;

#else

	return *(double*)argument_;

#endif