|
|
|
@ -37,9 +37,14 @@
@@ -37,9 +37,14 @@
|
|
|
|
|
* Tests for the bson en/decoder |
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
#define __STDC_FORMAT_MACROS |
|
|
|
|
#include <inttypes.h> |
|
|
|
|
|
|
|
|
|
#include <px4_defines.h> |
|
|
|
|
#include <stdio.h> |
|
|
|
|
#include <string.h> |
|
|
|
|
#include <stdlib.h> |
|
|
|
|
#include <limits.h> |
|
|
|
|
#include <math.h> |
|
|
|
|
|
|
|
|
|
#include <systemlib/err.h> |
|
|
|
@ -59,27 +64,33 @@ static int
@@ -59,27 +64,33 @@ static int
|
|
|
|
|
encode(bson_encoder_t encoder) |
|
|
|
|
{ |
|
|
|
|
if (bson_encoder_append_bool(encoder, "bool1", sample_bool) != 0) { |
|
|
|
|
warnx("FAIL: encoder: append bool failed"); |
|
|
|
|
PX4_ERR("FAIL: encoder: append bool failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_encoder_append_int(encoder, "int1", sample_small_int) != 0) { |
|
|
|
|
warnx("FAIL: encoder: append int failed"); |
|
|
|
|
PX4_ERR("FAIL: encoder: append int failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_encoder_append_int(encoder, "int2", sample_big_int) != 0) { |
|
|
|
|
warnx("FAIL: encoder: append int failed"); |
|
|
|
|
PX4_ERR("FAIL: encoder: append int failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_encoder_append_double(encoder, "double1", sample_double) != 0) { |
|
|
|
|
warnx("FAIL: encoder: append double failed"); |
|
|
|
|
PX4_ERR("FAIL: encoder: append double failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_encoder_append_string(encoder, "string1", sample_string) != 0) { |
|
|
|
|
warnx("FAIL: encoder: append string failed"); |
|
|
|
|
PX4_ERR("FAIL: encoder: append string failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_encoder_append_binary(encoder, "data1", BSON_BIN_BINARY, sizeof(sample_data), sample_data) != 0) { |
|
|
|
|
warnx("FAIL: encoder: append data failed"); |
|
|
|
|
PX4_ERR("FAIL: encoder: append data failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bson_encoder_fini(encoder); |
|
|
|
@ -94,29 +105,29 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
@@ -94,29 +105,29 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
|
|
|
|
|
|
|
|
|
|
if (!strcmp(node->name, "bool1")) { |
|
|
|
|
if (node->type != BSON_BOOL) { |
|
|
|
|
warnx("FAIL: decoder: bool1 type %d, expected %d", node->type, BSON_BOOL); |
|
|
|
|
PX4_ERR("FAIL: decoder: bool1 type %d, expected %d", node->type, BSON_BOOL); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (node->b != sample_bool) { |
|
|
|
|
warnx("FAIL: decoder: bool1 value %s, expected %s", |
|
|
|
|
PX4_ERR("FAIL: decoder: bool1 value %s, expected %s", |
|
|
|
|
(node->b ? "true" : "false"), |
|
|
|
|
(sample_bool ? "true" : "false")); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
warnx("PASS: decoder: bool1"); |
|
|
|
|
PX4_INFO("PASS: decoder: bool1"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (!strcmp(node->name, "int1")) { |
|
|
|
|
if (node->type != BSON_INT32) { |
|
|
|
|
warnx("FAIL: decoder: int1 type %d, expected %d", node->type, BSON_INT32); |
|
|
|
|
PX4_ERR("FAIL: decoder: int1 type %d, expected %d", node->type, BSON_INT32); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (node->i != sample_small_int) { |
|
|
|
|
warnx("FAIL: decoder: int1 value %lld, expected %d", node->i, sample_small_int); |
|
|
|
|
PX4_ERR("FAIL: decoder: int1 value %" PRIu64 ", expected %d", node->i, sample_small_int); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -126,12 +137,12 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
@@ -126,12 +137,12 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
|
|
|
|
|
|
|
|
|
|
if (!strcmp(node->name, "int2")) { |
|
|
|
|
if (node->type != BSON_INT64) { |
|
|
|
|
warnx("FAIL: decoder: int2 type %d, expected %d", node->type, BSON_INT64); |
|
|
|
|
PX4_ERR("FAIL: decoder: int2 type %d, expected %d", node->type, BSON_INT64); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (node->i != sample_big_int) { |
|
|
|
|
warnx("FAIL: decoder: int2 value %lld, expected %lld", node->i, sample_big_int); |
|
|
|
|
PX4_ERR("FAIL: decoder: int2 value %" PRIu64 ", expected %" PRIu64, node->i, sample_big_int); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -141,12 +152,12 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
@@ -141,12 +152,12 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
|
|
|
|
|
|
|
|
|
|
if (!strcmp(node->name, "double1")) { |
|
|
|
|
if (node->type != BSON_DOUBLE) { |
|
|
|
|
warnx("FAIL: decoder: double1 type %d, expected %d", node->type, BSON_DOUBLE); |
|
|
|
|
PX4_ERR("FAIL: decoder: double1 type %d, expected %d", node->type, BSON_DOUBLE); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (fabs(node->d - sample_double) > 1e-12) { |
|
|
|
|
warnx("FAIL: decoder: double1 value %f, expected %f", node->d, sample_double); |
|
|
|
|
PX4_ERR("FAIL: decoder: double1 value %f, expected %f", node->d, sample_double); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -156,36 +167,36 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
@@ -156,36 +167,36 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
|
|
|
|
|
|
|
|
|
|
if (!strcmp(node->name, "string1")) { |
|
|
|
|
if (node->type != BSON_STRING) { |
|
|
|
|
warnx("FAIL: decoder: string1 type %d, expected %d", node->type, BSON_STRING); |
|
|
|
|
PX4_ERR("FAIL: decoder: string1 type %d, expected %d", node->type, BSON_STRING); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
len = bson_decoder_data_pending(decoder); |
|
|
|
|
|
|
|
|
|
if (len != strlen(sample_string) + 1) { |
|
|
|
|
warnx("FAIL: decoder: string1 length %d wrong, expected %d", len, strlen(sample_string) + 1); |
|
|
|
|
PX4_ERR("FAIL: decoder: string1 length %d wrong, expected %zd", len, strlen(sample_string) + 1); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
char sbuf[len]; |
|
|
|
|
|
|
|
|
|
if (bson_decoder_copy_data(decoder, sbuf)) { |
|
|
|
|
warnx("FAIL: decoder: string1 copy failed"); |
|
|
|
|
PX4_ERR("FAIL: decoder: string1 copy failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_decoder_data_pending(decoder) != 0) { |
|
|
|
|
warnx("FAIL: decoder: string1 copy did not exhaust all data"); |
|
|
|
|
PX4_ERR("FAIL: decoder: string1 copy did not exhaust all data"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (sbuf[len - 1] != '\0') { |
|
|
|
|
warnx("FAIL: decoder: string1 not 0-terminated"); |
|
|
|
|
PX4_ERR("FAIL: decoder: string1 not 0-terminated"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (strcmp(sbuf, sample_string)) { |
|
|
|
|
warnx("FAIL: decoder: string1 value '%s', expected '%s'", sbuf, sample_string); |
|
|
|
|
PX4_ERR("FAIL: decoder: string1 value '%s', expected '%s'", sbuf, sample_string); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -195,45 +206,45 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
@@ -195,45 +206,45 @@ decode_callback(bson_decoder_t decoder, void *private, bson_node_t node)
|
|
|
|
|
|
|
|
|
|
if (!strcmp(node->name, "data1")) { |
|
|
|
|
if (node->type != BSON_BINDATA) { |
|
|
|
|
warnx("FAIL: decoder: data1 type %d, expected %d", node->type, BSON_BINDATA); |
|
|
|
|
PX4_ERR("FAIL: decoder: data1 type %d, expected %d", node->type, BSON_BINDATA); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
len = bson_decoder_data_pending(decoder); |
|
|
|
|
|
|
|
|
|
if (len != sizeof(sample_data)) { |
|
|
|
|
warnx("FAIL: decoder: data1 length %d, expected %d", len, sizeof(sample_data)); |
|
|
|
|
PX4_ERR("FAIL: decoder: data1 length %d, expected %zu", len, sizeof(sample_data)); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (node->subtype != BSON_BIN_BINARY) { |
|
|
|
|
warnx("FAIL: decoder: data1 subtype %d, expected %d", node->subtype, BSON_BIN_BINARY); |
|
|
|
|
PX4_ERR("FAIL: decoder: data1 subtype %d, expected %d", node->subtype, BSON_BIN_BINARY); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
uint8_t dbuf[len]; |
|
|
|
|
|
|
|
|
|
if (bson_decoder_copy_data(decoder, dbuf)) { |
|
|
|
|
warnx("FAIL: decoder: data1 copy failed"); |
|
|
|
|
PX4_ERR("FAIL: decoder: data1 copy failed"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (bson_decoder_data_pending(decoder) != 0) { |
|
|
|
|
warnx("FAIL: decoder: data1 copy did not exhaust all data"); |
|
|
|
|
PX4_ERR("FAIL: decoder: data1 copy did not exhaust all data"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (memcmp(sample_data, dbuf, len)) { |
|
|
|
|
warnx("FAIL: decoder: data1 compare fail"); |
|
|
|
|
PX4_ERR("FAIL: decoder: data1 compare fail"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
warnx("PASS: decoder: data1"); |
|
|
|
|
PX4_INFO("PASS: decoder: data1"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (node->type != BSON_EOO) { |
|
|
|
|
warnx("FAIL: decoder: unexpected node name '%s'", node->name); |
|
|
|
|
PX4_ERR("FAIL: decoder: unexpected node name '%s'", node->name); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
return 1; |
|
|
|
@ -259,29 +270,33 @@ test_bson(int argc, char *argv[])
@@ -259,29 +270,33 @@ test_bson(int argc, char *argv[])
|
|
|
|
|
|
|
|
|
|
/* encode data to a memory buffer */ |
|
|
|
|
if (bson_encoder_init_buf(&encoder, NULL, 0)) { |
|
|
|
|
errx(1, "FAIL: bson_encoder_init_buf"); |
|
|
|
|
PX4_ERR("FAIL: bson_encoder_init_buf"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
encode(&encoder); |
|
|
|
|
len = bson_encoder_buf_size(&encoder); |
|
|
|
|
|
|
|
|
|
if (len <= 0) { |
|
|
|
|
errx(1, "FAIL: bson_encoder_buf_len"); |
|
|
|
|
PX4_ERR("FAIL: bson_encoder_buf_len"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
buf = bson_encoder_buf_data(&encoder); |
|
|
|
|
|
|
|
|
|
if (buf == NULL) { |
|
|
|
|
errx(1, "FAIL: bson_encoder_buf_data"); |
|
|
|
|
PX4_ERR("FAIL: bson_encoder_buf_data"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* now test-decode it */ |
|
|
|
|
if (bson_decoder_init_buf(&decoder, buf, len, decode_callback, NULL)) { |
|
|
|
|
errx(1, "FAIL: bson_decoder_init_buf"); |
|
|
|
|
PX4_ERR("FAIL: bson_decoder_init_buf"); |
|
|
|
|
return 1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
decode(&decoder); |
|
|
|
|
free(buf); |
|
|
|
|
|
|
|
|
|
return OK; |
|
|
|
|
} |
|
|
|
|
return PX4_OK; |
|
|
|
|
} |
|
|
|
|