nica/metawatch
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Implement streaming protocol (mw_feed_...)

Browse source
This commit is contained in:
Nils Faerber 2011-08-29 11:37:02 +02:00
parent 2089fbe853
commit 7d8f5f3b72
3 changed files with 44 additions and 5 deletions
Download patch file Download diff file Expand all files Collapse all files

36
metawatch.c
View file

@ -480,7 +480,7 @@ void mw_set_status_change_event_cb(mwdevice_t *mwdevice, void (*mw_status_change
* Protocol handling
* ---------------------------------------------------------------------- */
int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len)
int mw_decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len)
{
unsigned short crc;
unsigned char msglen;
@ -547,6 +547,38 @@ int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len)
}
int mw_feed_msg_buffer(mwdevice_t *mwdevice, unsigned char *buf, int len)
{
char msgbuf[64];
int tlen;
if (len <= 0)
return -1;
memcpy((mwdevice->pbuf+mwdevice->pbuf_len), buf, len);
mwdevice->pbuf_len += len;
while (mwdevice->pbuf_len > 0) {
/* scan for MW_SOF */
while (mwdevice->pbuf[0] != MW_SOF) {
memmove(mwdevice->pbuf, (mwdevice->pbuf+1), --mwdevice->pbuf_len);
}
tlen = mwdevice->pbuf[1];
/* OK, there is an SOF but the message is too short */
if (tlen > mwdevice->pbuf_len) {
/* we have to wait for more data to come in */
break;
}
/* here we have a complete msg */
memcpy(msgbuf, mwdevice->pbuf, tlen);
mw_decode_frame(mwdevice, msgbuf, tlen);
memmove(mwdevice->pbuf, (mwdevice->pbuf+tlen), tlen);
mwdevice->pbuf_len -= tlen;
}
return 0;
}
/* ----------------------------------------------------------------------
* General code usage
* ---------------------------------------------------------------------- */
@ -555,6 +587,8 @@ int mw_init(mwdevice_t *mwdevice, int mw_fd)
{
memset(mwdevice, 0, sizeof(mwdevice_t));
mwdevice->mw_fd = mw_fd;
memset(mwdevice->pbuf, 0, MW_PBUF_LEN);
mwdevice->pbuf_len = 0;
/* figure out which device we run with */
mw_send_frame(mwdevice, MW_GET_DEVICE_TYPE, 0, NULL, 0);