#include "mq_cmd.h"

#define MQ_CMD_MSG_SIZE 8192
//last string element should be string ;]
mq_cmd* mq_cmd_create(int id, char *cmd, size_t cmd_sz, char *param, size_t param_sz)
{
	mq_cmd *ret = NULL;

	if (cmd == NULL)
	{
		PERM();
		return NULL;
	}
	if (param == NULL)
	{
		PERM();
		return NULL;
	}

	ret = malloc(sizeof(mq_cmd));
	if (ret == NULL)
	{
		ENL();
		return NULL;
	}

	ret->id = id;
	ret->sz = MQ_CMD_MSG_SIZE;
	ret->buf = malloc(ret->sz);
	if (!ret->buf)
	{
		ENL();
		free(ret);
		return NULL;
	}
	//if not null string that everything will blow up pal
	//cmd[cmd_sz-1]     = 0x0;
	//param[param_sz-1] = 0x0; 
	snprintf(ret->buf,ret->sz-1,":%d:%s: %s", id, cmd, param);

	return ret;
}

mq_cmd* mq_cmd_creates(char *str, size_t sz)
{
	mq_cmd *ret = NULL;

	//just naive belive everything is fine in string
	ret = malloc(sizeof(mq_cmd));
	ret->buf = malloc(sz);
	if (ret->buf == NULL)
	{
		PERM();
		return NULL;
	}
	ret->sz = sz;
	memcpy(ret->buf,str,sz);
	ret->id = -1;

	return ret;
}

int mq_cmd_id(mq_cmd *cmd, int *id)
{
	int i,j,strt,sz;
	int ret=-1;
	int id_parse;
	char buf[16]; //fix this
	/*:[ID]:*/

	if (cmd == NULL)
	{
		PERM();
		return -1;
	}
	if (id == NULL)
	{
		PERM();
		return -1;
	}

	i = 0;
	while ((cmd->buf[i] != 0) && (i<cmd->sz))
	{	
		if (cmd->buf[i] == ':')
		{
			i++;
			strt = i;
			sz = 0;
			while ((cmd->buf[i] != ':')&&
				(cmd->buf[i] != '\0')&&
				(i<cmd->sz))
			{
				sz++;
				i++;
			}
			for (j=0;j<(strt+sz)||j<15;j++)
			{
				buf[j] = cmd->buf[strt+j];
			}
			buf[j] = 0x0;
			id_parse = atoi(buf);
			*id = id_parse;
			return 0;
		}	
		i++;
	}
	return -1;
}

//buf contains pointer to cmd
//sz contains size of buf
//%s formatting should work badly, writting to buf modifies cmd
//be carefull
char* mq_cmd_cmd(mq_cmd *cmd, char **buf, size_t *sz)
{
	size_t sz_parse;
	int i,j,strt,cnt,l_c;
	char *p;

	if (cmd == NULL)
	{
		PERM();
		return NULL;
	}
	if (buf == NULL)
	{
		PERM();
		return NULL;
	}
	if (sz == NULL)
	{
		PERM();
		return NULL;
	}

	p = cmd->buf;

	i = 0;
	l_c = 0;
	while ((cmd->buf[i] != 0)&&(i<cmd->sz))
	{
		if (cmd->buf[i] == ':')
		{
			l_c += 1;
			if (l_c == 2)
			{
				i++;
				break;
				
			}
		}
		i++;
	}
	strt = i;
	cnt = 0;
	while ((cmd->buf[i] != 0)&&(i<cmd->sz))
	{

		if (cmd->buf[i] == ':')
			break;
		cnt++;
		i++;
	}
	*buf = cmd->buf+strt;
	*sz = cnt;

	return 0;
}

int mq_cmd_param(mq_cmd *cmd, char **param, size_t *sz)
{
	size_t sz_parse;
	int i,j,strt,cnt,l_c;
	char *p;

	p = cmd->buf;

	i = 0;
	l_c = 0;
	while ((cmd->buf[i] != 0)&&(i<cmd->sz))
	{
		if (cmd->buf[i] == ':')
		{
			l_c += 1;
			if (l_c == 3)
			{
				i++;
				break;
			}
		}
		i++;
	}
	
	while ((cmd->buf[i] != 0)&&(i<cmd->sz))
	{
		if (cmd->buf[i] != ' ') break;
		i++;
	}
	strt = i;
	*param = cmd->buf+strt;
	*sz = cmd->sz - strt+1;

	return 0;
}

size_t mq_cmd_size(mq_cmd *cmd)
{
	if (cmd == NULL)
	{
		PERM();
		return -1;
	}
	return cmd->sz;
}

char *mq_cmd_buf(mq_cmd *cmd)
{
	if (cmd == NULL)
	{
		PERM();
		return NULL;
	}

	return cmd->buf;
}

void mq_cmd_free(mq_cmd *mq)
{
	if (mq != NULL)
	{
		free(mq->buf);
		mq->buf = NULL;
		free(mq);
	}
	
}