raw_packer.cpp

/* raw_packer.cpp */

#include "raw_packer.h"

Error RawPacker::encode(const String& fmt, const Array& array, uint8_t *buf, int &len) {
	
	len=0;
	
	Variant::Type type;
	
	int j=0;
	
	for (int i=0;i<fmt.length();i++) {
		
		ERR_FAIL_COND_V(j>=array.size(),ERR_INVALID_DATA);
		
		type = array[j].get_type();
		
		switch (fmt[i]) {
			case 'c':
			case 'b':
			case 'B': {
				
				ERR_FAIL_COND_V(type!=Variant::INT,ERR_INVALID_DATA);
				
				if (buf) {
					*buf=(uint8_t)array[j];
					buf+=1;
				}
				
				len+=1;
				
			} break;
			
			case '?': {
				
				ERR_FAIL_COND_V(type!=Variant::BOOL,ERR_INVALID_DATA);
				
				if (buf) {
					*buf=(uint8_t)array[j];
					buf+=1;
				}
				
				len+=1;
				
			} break;
			
			case 'h':
			case 'H': {
				
				ERR_FAIL_COND_V(type!=Variant::INT,ERR_INVALID_DATA);
				
				if (buf) {
					encode_uint16((uint16_t)array[j],buf);
					buf+=2;
				}
				
				len+=2;
				
			} break;
			
			case 'i':
			case 'I':
			
			//windows doesn't like longs
			/*case 'l': 
			case 'L':*/ {
				
				ERR_FAIL_COND_V(type!=Variant::INT,ERR_INVALID_DATA);
				
				if (buf) {
					encode_uint32((uint32_t)array[j],buf);
					buf+=4;
				}
				
				len+=4;
				
			} break;
			
			
			case 'q':
			case 'Q': {
				
				ERR_FAIL_COND_V(type!=Variant::INT,ERR_INVALID_DATA);
				
				if (buf) {
					encode_uint64((uint64_t)array[j],buf);
					buf+=8;
				}
				
				len+=8;
				
			} break;
			
			case 'f': {
				
				ERR_FAIL_COND_V(type!=Variant::REAL,ERR_INVALID_DATA);
				
				if (buf) {
					encode_float((float)array[j],buf);
					buf+= 4;
				}
				
				len += 4;
				
			} break;
			
			case 'd': {
				
				ERR_FAIL_COND_V(type!=Variant::REAL,ERR_INVALID_DATA);
				
				if (buf) {
					encode_double((double)array[j],buf);
					buf+=8;
				}
				
				len+=8;
				
			} break;
			
			case 's': {
				
				ERR_FAIL_COND_V(type!=Variant::STRING,ERR_INVALID_DATA);
				
				String size_str;
				
				for (int k=i+1;k<fmt.length();k++) {
					if (is_digit(fmt[k])) {
						size_str.push_back(fmt[k]);
					} else {
						break;
					}
				}
				
				size_str.push_back('\0');
								
				i+=size_str.length();
				
				int str_size = size_str.to_int();
				
				if (str_size==0) {
					
					if (buf) {
						*buf='\0';
						buf+=1;
					}
					
					len+=1;
				} else {
					if (buf) {
						
						String str = (String)array[j];
						
						int k=0;
						
						for (;k<str.size()&&k<str_size;k++) {
							*buf=str[k];
							buf+=1;
						}
						
						for (;k<str_size;k++) {
							*buf='\0';
							buf+=1;
						}
					}
					
					len+=str_size;
				}
				
			} break;
			
			default:
				ERR_FAIL_V(ERR_INVALID_PARAMETER);
		}
		
		j++;
	}
	
	return OK;
}

Error RawPacker::decode(const String& fmt, Array& array, const uint8_t *buf, int size) {
	
	int len=0;
	
	for (int i=0;i<fmt.length();i++) {
		
		switch (fmt[i]) {
			case 'c':
			case 'b': {
			
				ERR_FAIL_COND_V(size<len+1,ERR_INVALID_DATA);
			
				array.push_back(Variant((char)*buf));
				buf+=1;
				len+=1;
			} break;
				
			case 'B': {
			
				ERR_FAIL_COND_V(size<len+1,ERR_INVALID_DATA);
			
				array.push_back(Variant((unsigned char)*buf));
				buf+=1;
				len+=1;
			} break;
				
			case '?': {

				ERR_FAIL_COND_V(size<len+1,ERR_INVALID_DATA);
				
				array.push_back(Variant((bool)*buf));
				buf+=1;
				len+=1;
			} break;
			
			case 'h': {
			
				ERR_FAIL_COND_V(size<len+2,ERR_INVALID_DATA);
			
				array.push_back(Variant((short)decode_uint16(buf)));
				buf+=2;
				len+=2;
			} break;
			
			case 'H': {
				
				ERR_FAIL_COND_V(size<len+2,ERR_INVALID_DATA);
			
				array.push_back(Variant((unsigned short)decode_uint16(buf)));
				buf+=2;
				len+=2;
			} break;
			
			case 'i': {
			
				ERR_FAIL_COND_V(size<len+4,ERR_INVALID_DATA);
			
				array.push_back(Variant((int)decode_uint32(buf)));
				buf+=4;
				len+=4;
			} break;
			
			case 'I': {
				
				ERR_FAIL_COND_V(size<len+4,ERR_INVALID_DATA);
				
				array.push_back(Variant((unsigned int)decode_uint32(buf)));
				buf+=4;
				len+=4;
			} break;
			
			//windows doesn't like longs
			/*case 'l': {
				
				ERR_FAIL_COND_V(size<len+4,ERR_INVALID_DATA);
				
				array.push_back(Variant((long)decode_uint32(buf)));
				buf+=4;
				len+=4;
			} break;
			
			case 'L': {
			
				ERR_FAIL_COND_V(size<len+4,ERR_INVALID_DATA);
			
				array.push_back(Variant((unsigned long)decode_uint32(buf)));
				buf+=4;
				len+=4;
			} break;*/
			
			case 'q': {
				
				ERR_FAIL_COND_V(size<len+8,ERR_INVALID_DATA);
				
				array.push_back(Variant((int64_t)decode_uint64(buf)));
				buf+=8;
				len+=8;
			} break;
			
			case 'Q': {
			
				ERR_FAIL_COND_V(size<len+8,ERR_INVALID_DATA);
			
				array.push_back(Variant((uint64_t)decode_uint64(buf)));
				buf+=8;
				len+=8;
			} break;
			
			case 'f': {
			
				ERR_FAIL_COND_V(size<len+4,ERR_INVALID_DATA);
			
				array.push_back(Variant((float)decode_float(buf)));
				buf+=4;
				len+=4;
			} break;
			
			case 'd': {
				
				ERR_FAIL_COND_V(size<len+8,ERR_INVALID_DATA);
			
				array.push_back(Variant((double)decode_double(buf)));
				buf+=8;
				len+=8;
			} break;
			
			case 's': {
			
				String size_str;
				
				for (int k=i+1;k<fmt.length();k++) {
					if (is_digit(fmt[k])) {
						size_str.push_back(fmt[k]);
					} else {
						break;
					}
				}
				
				size_str.push_back('\0');
				
				i+=size_str.length();
				
				int str_size=size_str.to_int();
				
				String str;
				
				if (str_size==0) {
					
					ERR_FAIL_COND_V(size<len+1,ERR_INVALID_DATA)	
					
					str.push_back('\0');
					buf+=1;
					len+=1;
				} else {
					
					ERR_FAIL_COND_V(size<len+str_size,ERR_INVALID_DATA)
					
					int k=0;
					
					while (*buf!='\0'&&k<str_size-1) {
						str.push_back((char)*buf);
						buf+=1;
						k+=1;
					}
					
					str.push_back('\0');
					buf+=(str_size-k);
					len+=str_size;
				}
			
				array.push_back(str);
			} break;
			
			default:
				ERR_FAIL_V(ERR_INVALID_PARAMETER);
		}
	}
	
	
	
	return OK;
}

bool RawPacker::is_digit(char c) {
	return (c == '0' || c == '1' || 
		c == '2' || c == '3' || 
		c == '4' || c == '5' || 
		c == '6' || c == '7' || 
		c == '8' || c == '9');
}

ByteArray RawPacker::pack(const String& fmt, const Array& array) {
	
	int len;
	Error err = encode(fmt,array,NULL,len);
	
	if (err!=OK)
		return ByteArray();
	
	ByteArray res;
	res.resize(len);
	
	ByteArray::Write w = res.write();
	encode(fmt, array, w.ptr(), len);
	
	return res;
}

Array RawPacker::unpack(const String& fmt, const ByteArray& array) {
	
	Array res;
	
	ByteArray::Read r = array.read();
	
	Error err = decode(fmt,res,r.ptr(),array.size());
	
	if (err!=OK)
		return Array();
	
	return res;
}

void RawPacker::_bind_methods() {

    ObjectTypeDB::bind_method("pack",&RawPacker::pack);
    ObjectTypeDB::bind_method("unpack",&RawPacker::unpack);
}

RawPacker::RawPacker() {

}