81 lines
3.3 KiB
C
81 lines
3.3 KiB
C
/**
|
|
* @file test_mmwave_detect.c
|
|
* @brief Host-side unit tests for the LD2410 frame-validation predicate (#1135).
|
|
*
|
|
* Proves the phantom-detection fix: a floating UART can emit the 4-byte head
|
|
* 0xF4F3F2F1, but the predicate rejects it unless a sane length + matching tail
|
|
* 0xF8F7F6F5 are also present. Tests the REAL predicate from mmwave_detect.h
|
|
* (the same code the firmware's probe_at_baud calls).
|
|
*
|
|
* cc -std=c99 -Wall -I../main -o test_mmwave_detect test_mmwave_detect.c && ./test_mmwave_detect
|
|
*
|
|
* Exits 0 on all-pass; prints the failing case otherwise.
|
|
*/
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include "mmwave_detect.h"
|
|
|
|
static int failures = 0;
|
|
#define CHECK(cond, msg) do { \
|
|
if (!(cond)) { printf("FAIL: %s\n", msg); failures++; } \
|
|
else { printf("ok: %s\n", msg); } \
|
|
} while (0)
|
|
|
|
/* Build a valid LD2410 report frame: F4F3F2F1 | len(LE) | data[len] | F8F7F6F5 */
|
|
static int make_frame(uint8_t *out, uint16_t dlen)
|
|
{
|
|
int n = 0;
|
|
out[n++] = 0xF4; out[n++] = 0xF3; out[n++] = 0xF2; out[n++] = 0xF1;
|
|
out[n++] = (uint8_t)(dlen & 0xFF); out[n++] = (uint8_t)(dlen >> 8);
|
|
for (uint16_t k = 0; k < dlen; k++) out[n++] = (uint8_t)(0xAA ^ k);
|
|
out[n++] = 0xF8; out[n++] = 0xF7; out[n++] = 0xF6; out[n++] = 0xF5;
|
|
return n;
|
|
}
|
|
|
|
int main(void)
|
|
{
|
|
uint8_t buf[256];
|
|
|
|
/* 1. A real basic-report frame (data len 13) validates. */
|
|
int n = make_frame(buf, 13);
|
|
CHECK(mmwave_ld2410_valid_at(buf, 0, n), "valid basic frame (len=13) accepted");
|
|
|
|
/* 2. A real engineering-report frame (data len 35) validates. */
|
|
n = make_frame(buf, 35);
|
|
CHECK(mmwave_ld2410_valid_at(buf, 0, n), "valid engineering frame (len=35) accepted");
|
|
|
|
/* 3. Head magic present but NO valid tail — the #1135 phantom case. */
|
|
memset(buf, 0x00, sizeof(buf));
|
|
buf[0]=0xF4; buf[1]=0xF3; buf[2]=0xF2; buf[3]=0xF1; buf[4]=13; buf[5]=0;
|
|
/* data present but tail is zeros, not F8F7F6F5 */
|
|
CHECK(!mmwave_ld2410_valid_at(buf, 0, 64), "head magic without valid tail REJECTED (#1135)");
|
|
|
|
/* 4. Head magic with insane length is rejected. */
|
|
memset(buf, 0xFF, sizeof(buf));
|
|
buf[0]=0xF4; buf[1]=0xF3; buf[2]=0xF2; buf[3]=0xF1; buf[4]=0xFF; buf[5]=0xFF; /* len=65535 */
|
|
CHECK(!mmwave_ld2410_valid_at(buf, 0, 200), "head magic with oversized length REJECTED");
|
|
|
|
/* 5. Pure noise (no head) is rejected. */
|
|
for (int k = 0; k < 64; k++) buf[k] = (uint8_t)(0x5A + k);
|
|
CHECK(!mmwave_ld2410_valid_at(buf, 0, 64), "non-header noise REJECTED");
|
|
|
|
/* 6. Truncated frame (tail would run past the buffer) is rejected. */
|
|
n = make_frame(buf, 13);
|
|
CHECK(!mmwave_ld2410_valid_at(buf, 0, n - 2), "truncated frame (tail past buffer) REJECTED");
|
|
|
|
/* 7. Valid frame at a non-zero offset still validates. */
|
|
memset(buf, 0x00, sizeof(buf));
|
|
n = make_frame(buf + 7, 13);
|
|
CHECK(mmwave_ld2410_valid_at(buf, 7, 7 + n), "valid frame at offset 7 accepted");
|
|
|
|
/* 8. Repeated head bytes without a frame (worst-case noise) rejected. */
|
|
for (int k = 0; k + 3 < 64; k += 4) {
|
|
buf[k]=0xF4; buf[k+1]=0xF3; buf[k+2]=0xF2; buf[k+3]=0xF1;
|
|
}
|
|
CHECK(!mmwave_ld2410_valid_at(buf, 0, 64), "repeated bare head bytes REJECTED");
|
|
|
|
printf("\n%s (%d failures)\n", failures ? "FAILED" : "ALL PASS", failures);
|
|
return failures ? 1 : 0;
|
|
}
|