1 files changed, 86 insertions, 0 deletions
diff --git a/PICA_msgproc.c b/PICA_msgproc.c
new file mode 100755
index 0000000..78987c6
--- /dev/null
+++ b/PICA_msgproc.c
@@ -0,0 +1,86 @@
+#include <limits.h>
+#include <string.h>
+#include "PICA_proto.h"
+#include "PICA_msgproc.h"
+
+
+//возвращает размер сообщения либо UINT_MAX,если количество прочитанных байт недостаточно для определения размера
+//либо 0 при ошибочных данных
+unsigned int PICA_msggetsize(unsigned char *buf,unsigned int nb,struct PICA_msginfo *msgs,unsigned int nmsg)
+{
+unsigned int i;
+
+if (nb<2)
+	return UINT_MAX;
+
+if (buf[0]!=buf[1])
+	return 0;
+
+
+for (i=0;i<nmsg;i++)
+	if (buf[0]==(unsigned char)msgs[i].msgid)
+		{
+		if (msgs[i].fixedsz==PICA_MSG_FIXED_SIZE)
+			return msgs[i].sz;
+		else if (msgs[i].fixedsz==PICA_MSG_VAR_SIZE)
+			{
+			if (nb>=(msgs[i].sz+2))
+				{
+				unsigned int tail_len=0;
+				int j;
+#if defined(__BYTE_ORDER__) && __BYTE_ORDER__ == __ORDER_BIG_ENDIAN__
+        for (j=0;j<msgs[i].sz;j++)
+          ((char*)&tail_len)[sizeof(int)-1-j]=buf[2+j];
+#else
+        for (j=0;j<msgs[i].sz;j++)
+          ((char*)&tail_len)[j]=buf[2+j];
+#endif
+				return 2+msgs[i].sz+tail_len;
+				}
+			else
+				return UINT_MAX;
+			}
+		}
+
+return 0;
+}
+
+//Определяет тип сообщения размера size, находящегося в буфере buf, вызывает соответствующий обработчик и передает обработчику аргумент arg. Возвращает значение, которое вернула функция-обработчик сообщения. Если тип сообщения неизвестен, возвращает 0
+unsigned int PICA_processmsg(unsigned char *buf,unsigned int size,void* arg,struct PICA_msginfo *msgs,unsigned int nmsg)
+{
+int i;
+
+if (buf[0]!=buf[1])
+	return 0;
+
+for (i=0;i<nmsg;i++)
+	if (buf[0]==(unsigned char)msgs[i].msgid)
+		return msgs[i].msgprocfn(buf,size,arg);
+
+return 0;
+}
+
+unsigned int PICA_processdatastream(unsigned char *buf,unsigned int *read_pos,void* arg,struct PICA_msginfo *msgs,unsigned int nmsg)
+{
+			while(*read_pos)
+				{
+				unsigned int uret;
+				uret=PICA_msggetsize(buf,*read_pos,msgs,nmsg);
+
+				if (!uret)
+					return 0;
+
+				if (uret > *read_pos)
+					break;
+
+				if (!PICA_processmsg(buf,uret,arg,msgs,nmsg))
+					return 0;
+
+
+				*read_pos-=uret;
+				
+				memmove(buf,buf+uret,*read_pos);//сдвиг содержимого буфера к началу
+				}
+
+return 1;
+}