--- libaitpelco/src/aitpelco.c 2010/01/22 00:57:32 1.1.1.1 +++ libaitpelco/src/aitpelco.c 2010/03/11 13:39:28 1.1.1.1.2.1 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ -* $Id: aitpelco.c,v 1.1.1.1 2010/01/22 00:57:32 misho Exp $ +* $Id: aitpelco.c,v 1.1.1.1.2.1 2010/03/11 13:39:28 misho Exp $ * *************************************************************************/ #include "global.h" @@ -108,6 +108,50 @@ inline void pelcoClose(void * __restrict p) free(p); } +/* + * pelcoLoad() Load packet from input buffer + * @buffer = Pelco packet from input buffer + * return: NULL error, !=NULL ok, allocated memory for packet + */ +inline void *pelcoLoad(u_char *buffer) +{ + pelco_d_t *pd; + pelco_p_t *pp; + void *p = NULL; + + switch (pelco_GetVersion(buffer)) { + case 'd': + if (pelco_GetCamNo(buffer) < FIRST_CAM_D) { + pelcoSetErr(ENOEXEC, "Error:: unsupported camera number %d!\n", + pelco_GetCamNo(buffer)); + return NULL; + } + + pd = malloc(sizeof(pelco_d_t)); + if (!pd) { + SETERR; + return NULL; + } else + memcpy(pd, buffer, sizeof(pelco_d_t)); + + p = pd; + break; + case 'p': + pp = malloc(sizeof(pelco_p_t)); + if (!pp) { + SETERR; + return NULL; + } else + memcpy(pp, buffer, sizeof(pelco_p_t)); + + p = pp; + break; + default: + pelcoSetErr(ENOEXEC, "Error:: unsupported Pelco protocol version!\n"); + } + + return p; +} /* * pelcoAddCmdData() Add commands and datas for already opened packet