#include "XDROutPacket.h"

#include <malloc.h>
#include <string.h>

#include <ByteOrder.h>
#include <KernelExport.h>

#include <kernel.h>


extern const uint8 *
XDROutPacketBuffer(struct XDROutPacket *packet)
{
        return packet->fBuffer;
}

extern size_t 
XDROutPacketLength(struct XDROutPacket *packet)
{
        return packet->fLength;
}

extern void 
XDROutPacketInit(struct XDROutPacket *packet)
{
        packet->fBuffer=NULL;
        packet->fSize=packet->fLength=0;
}

extern void 
XDROutPacketDestroy(struct XDROutPacket *packet)
{
        free (packet->fBuffer);
}

extern void 
XDROutPacketGrow(struct XDROutPacket *packet, size_t size)
{
        if (packet->fLength+size>packet->fSize)
        {
                while (packet->fLength+size>packet->fSize)
                        packet->fSize+=XDROUTPACKET_BUFFER_INCREMENT;
                        
                packet->fBuffer=(uint8 *)realloc(packet->fBuffer,packet->fSize);
        }
}

extern void 
XDROutPacketAddInt32(struct XDROutPacket *packet, int32 val)
{
        XDROutPacketGrow (packet,4);
        *(int32 *)(&packet->fBuffer[packet->fLength])=B_HOST_TO_BENDIAN_INT32(val);
        packet->fLength+=4;
}


status_t
XDROutPacketAddDynamic(struct XDROutPacket *packet, const void *data, size_t size)
{
        XDROutPacketAddInt32(packet, size);
        return XDROutPacketAddFixed(packet, data, size);
}


status_t
XDROutPacketAddFixed(struct XDROutPacket *packet, const void *data, size_t size)
{
        size_t roundedSize = (size + 3) & ~3;
        XDROutPacketGrow(packet, roundedSize);
        if (!IS_USER_ADDRESS(data))
                memcpy(&packet->fBuffer[packet->fLength], data, size);
        else if (user_memcpy(&packet->fBuffer[packet->fLength], data, size) != B_OK)
                return B_BAD_ADDRESS;
        memset(&packet->fBuffer[packet->fLength + size], 0, roundedSize - size);
        packet->fLength += roundedSize;
        return B_OK;
}


status_t
XDROutPacketAddString(struct XDROutPacket *packet, const char *string)
{
        return XDROutPacketAddDynamic(packet, string, strlen(string));
}


extern void 
XDROutPacketAppend(struct XDROutPacket *me, const struct XDROutPacket *packet)
{
        XDROutPacketGrow (me,packet->fLength);
        memcpy (&me->fBuffer[me->fLength],packet->fBuffer,packet->fLength);
        me->fLength+=packet->fLength;
}

extern void 
XDROutPacketClear(struct XDROutPacket *packet)
{
        packet->fLength=0;
}