#include "include.h"
#include "icq_packet.h"


Packet* PackNew() {
        Packet *packet = malloc(sizeof (Packet));
//        packet->data = malloc(0);
        packet->data=NULL;
	packet->size=0;
	packet->offset=0;
        return packet;
}

void PackFree(Packet *packet) {
        mfree (packet->data);
	mfree (packet);
}
extern void _WriteLog(char *buf);

void PackAdd(Packet *packet, char* data, int size) {
	/* Make the space for the new data */
    if (packet->data)
        packet->data = (char*)realloc(packet->data, packet->size + size);
    else
        packet->data = (char*)malloc(size);
	/* Copy the new data in */
        memcpy((char*)(packet->data + packet->size), data, size);
	/* Recalculate the size */
	packet->size += size;
       
}

void PackAdd8(Packet *packet, char data){
    PackAdd(packet,(char*)&data,1);
}

void PackAdd16(Packet *packet, int data) {
    int tmp=htons(data);
    PackAdd(packet,(char*)&tmp,2);
}

void PackAdd16LE(Packet *packet, int data) {
    int tmp=data;
    PackAdd(packet,(char*)&tmp,2);
}

void PackAdd32(Packet *packet, long data) {
    long tmp = htonl(data); 
    PackAdd(packet,(char*)&tmp,4);
}
void PackAdd32LE(Packet *packet, long data) {
    long tmp = data; 
    PackAdd(packet,(char*)&tmp,4);
}

void PackAddStr(Packet *packet, char *str) {
    PackAdd(packet,str,strlen(str));
    //_WriteLog(str);
}

void PackAddPack(Packet *packet,Packet *packet2)
{
  PackAdd(packet,packet2->data,packet2->size);
}


void PackAddTLV(Packet *packet,int type,int size){
    PackAdd16(packet,type);
    PackAdd16(packet,size);
}

void PackAddTLV16(Packet *packet, int type, int data)
{
    PackAddTLV(packet,type,2);
    PackAdd16(packet,data);
}

void PackAddTLV32(Packet *packet, int type, long data)
{
    PackAddTLV(packet,type,4);
    PackAdd32(packet,data);
}


void PackAddTLVStr(Packet *packet, int type, char *str)
{
    PackAddTLV(packet,type,strlen(str));
    PackAddStr(packet,str);
}

void PackAddTLVRAW(Packet *packet, int type, int size, char* data)
{
    PackAddTLV(packet,type,size);
    PackAdd(packet,data,size);
}

///////////////////////////////////
int PackGet(Packet *packet, void* data, int datalen) {
	if (!packet) return 0;
	if (packet->size - packet->offset < datalen) return 0;
        void *pack=packet->data + packet->offset;
	memcpy(data, pack, datalen);
        packet->offset += datalen;
	return datalen;
}

void PackGetType(Packet *packet,void* val, int size)
{
      PackGet(packet,val,size);
}

void PackGet8(Packet *packet, char* num){
    PackGetType(packet,(char*)num,1);
}

void PackGet16(Packet *packet, short int* num){
    short int value=0;
    
    PackGetType(packet,(short int*)num,2);
    
//   char *tmp_msg=new char[64];
//    sprintf(tmp_msg, percent_d, *num);
//    _WriteLog(tmp_msg);
    
    //num = htons(value);
    value = htons(*num);
    *num=value;
    
//    sprintf(tmp_msg, percent_d, *num);
//   _WriteLog(tmp_msg);
//    delete tmp_msg;
}

void PackGet16LE(Packet *packet, short int* num){
    short int value=0;
    PackGetType(packet,(short int*)num,2);
    value = (*num);
    *num=value;
}

void PackGet32(Packet *packet,int* num){
    PackGetType(packet,(int*)num,4);
    int value=htonl(*num);
    *num = value;
}

void PackGet32LE(Packet *packet,int* num){
    PackGetType(packet,(int*)num,4);
    int value=(*num);
    *num = value;
}


void PackGetTLV(Packet *packet,short int* type,short int* size){
    PackGet16(packet,type);
    PackGet16(packet,size);
}


void PackGetStr(Packet *packet, char* str, int len)
{
	char *tmp=(char*)malloc(len + 1); 
	PackGet(packet, (char*)tmp, len); 
	tmp[len] = 0; 
        str=tmp;
}

void PackSkip(Packet *packet, int len)
{
  packet->offset += len;
}

void PackSkipTLVs(Packet *packet, int num)
{
  short int len;
  for (int i=0;i<num;i++)
  {
    PackSkip(packet,2);
    PackGet16(packet,&len);
    PackSkip(packet,len);
  }
}