qi-hardware/antorcha
1
0
Fork 0
mirror of git://projects.qi-hardware.com/antorcha.git synced 2024-11-25 19:10:18 +02:00
Code

fw/sample.c: fix logic in handler() and filter incomplete samples

Browse Source 
An incomplete sample would be an X value followed by another X value,
or Y followed by Y. Not entirely sure why this happens in the first
place, but it does happen.
This commit is contained in:
Werner Almesberger 2012-06-21 16:17:47 -03:00
parent 58e0dda95d
commit 8eca4c99c7
1 changed files with 11 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
fw/sample.c
View File

@ -23,33 +23,37 @@
#include "proto.h"
#include "dispatch.h"
#include "io.h"
/* @@@ keep it small for now - we're running out of RAM :-( */
//#define MAX_PACKET 120 /* <- MAX_PSDU -3 (hdr) -2 (CRC) */
#define MAX_PACKET 60 /* <- MAX_PSDU -3 (hdr) -2 (CRC) */
#define MAX_PACKET 50 /* <- MAX_PSDU -3 (hdr) -2 (CRC) */
static uint8_t buf[MAX_PACKET+3] = { SAMPLES, 0, 0 };
static uint16_t *p;
static bool expect_x;
static void handler(bool x, uint16_t v)
{
bool first;
uint32_t t;
first = p == (uint16_t *) (buf+3);
if (first && !x)
if (x != expect_x)
return;
t = uptime();
if (first)
t = 0; //uptime_irq();
if (p == (uint16_t *) (buf+3))
*p++ = t >> 16;
*p++ = t;
*p++ = v;
expect_x = !expect_x;
if (x)
return;
if ((uint8_t *) (p+4) <= buf+MAX_PACKET)
return;
rf_send(buf, (uint8_t *) p-buf);
buf[1]++;
p = (uint16_t *) (buf+3);
}
@ -61,6 +65,7 @@ static bool sample_first(uint8_t limit, const uint8_t *payload)
cli();
sample = handler;
p = (uint16_t *) (buf+3);
expect_x = 1;
sei();
} else {
cli();