#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <assert.h>
#include "aitpelco.h"


int main()
{
	pelco_d_t *dpkt;
	pelco_p_t *ppkt;
	u_char ver, cam;
	u_char cmd[2], data[2];
       	u_char pd[7] = { 0xFF, 0x01, 0x00, 0x04, 0x3F, 0x00, 0x44 };
	u_char pp[8] = { 0xA0, 0x00, 0x00, 0x04, 0x20, 0x00, 0xAF, 0x2b };

	dpkt = pelcoOpen('d', 1);
	assert(dpkt);
	ppkt = pelcoOpen('p', 7);
	assert(ppkt);

	cmd[0] = 0;
	cmd[1] = 2;
	data[0] = 0x10;
	data[1] = 0;
	pelco_SetCamCmdData('d', 1, cmd, data, (u_char*) dpkt);
	pelcoAddCmdData(ppkt, cmd, data);

	ver = pelco_GetCamCmdData(pd, &cam, cmd, data);
	if (!ver)
		printf("error:: #%d - %s\n", pelco_GetErrno(), pelco_GetError());
	printf("D ver=%c cam=%x, cmd1=%x cmd2=%x data1=%x data2=%x\n", 
			ver, cam, cmd[0], cmd[1], data[0], data[1]);
	ver = pelco_GetCamCmdData((void*) pp, &cam, cmd, data);
	if (!ver)
		printf("error:: #%d - %s\n", pelco_GetErrno(), pelco_GetError());
	printf("P ver=%c cam=%x, cmd1=%x cmd2=%x data1=%x data2=%x\n", 
			ver, cam, cmd[0], cmd[1], data[0], data[1]);

	ver = pelco_GetCamCmdData((void*) dpkt, &cam, cmd, data);
	if (!ver)
		printf("error:: #%d - %s\n", pelco_GetErrno(), pelco_GetError());
	printf("2.) D ver=%c cam=%x, cmd1=%x cmd2=%x data1=%x data2=%x\n", 
			ver, cam, cmd[0], cmd[1], data[0], data[1]);
	ver = pelco_GetCamCmdData((void*) ppkt, &cam, cmd, data);
	if (!ver)
		printf("error:: #%d - %s\n", pelco_GetErrno(), pelco_GetError());
	printf("2.) P ver=%c cam=%x, cmd1=%x cmd2=%x data1=%x data2=%x\n", 
			ver, cam, cmd[0], cmd[1], data[0], data[1]);

	pelcoClose(dpkt);
	pelcoClose(ppkt);
	return 0;
}