diff options
Diffstat (limited to 'Tools/tests-host/sbus2_test.cpp')
-rw-r--r-- | Tools/tests-host/sbus2_test.cpp | 76 |
1 files changed, 0 insertions, 76 deletions
diff --git a/Tools/tests-host/sbus2_test.cpp b/Tools/tests-host/sbus2_test.cpp deleted file mode 100644 index e2c18369c..000000000 --- a/Tools/tests-host/sbus2_test.cpp +++ /dev/null @@ -1,76 +0,0 @@ - -#include <stdio.h> -#include <unistd.h> -#include <string.h> -#include <systemlib/mixer/mixer.h> -#include <systemlib/err.h> -#include <drivers/drv_hrt.h> -#include <px4iofirmware/px4io.h> -#include "../../src/systemcmds/tests/tests.h" - -int main(int argc, char *argv[]) { - warnx("SBUS2 test started"); - - if (argc < 2) - errx(1, "Need a filename for the input file"); - - warnx("loading data from: %s", argv[1]); - - FILE *fp; - - fp = fopen(argv[1],"rt"); - - if (!fp) - errx(1, "failed opening file"); - - float f; - unsigned x; - int ret; - - // Trash the first 20 lines - for (unsigned i = 0; i < 20; i++) { - char buf[200]; - (void)fgets(buf, sizeof(buf), fp); - } - - // Init the parser - uint8_t frame[30]; - unsigned partial_frame_count = 0; - uint16_t rc_values[18]; - uint16_t num_values; - bool sbus_failsafe; - bool sbus_frame_drop; - uint16_t max_channels = sizeof(rc_values) / sizeof(rc_values[0]); - - float last_time = 0; - - while (EOF != (ret = fscanf(fp, "%f,%x,,", &f, &x))) { - if (((f - last_time) * 1000 * 1000) > 3000) { - partial_frame_count = 0; - warnx("FRAME RESET\n\n"); - } - - frame[partial_frame_count] = x; - partial_frame_count++; - - //warnx("%f: 0x%02x, first: 0x%02x, last: 0x%02x, pcount: %u", (double)f, x, frame[0], frame[24], partial_frame_count); - - if (partial_frame_count == sizeof(frame)) - partial_frame_count = 0; - - last_time = f; - - // Pipe the data into the parser - hrt_abstime now = hrt_absolute_time(); - - //if (partial_frame_count % 25 == 0) - //sbus_parse(now, frame, &partial_frame_count, rc_values, &num_values, &sbus_failsafe, &sbus_frame_drop, max_channels); - } - - if (ret == EOF) { - warnx("Test finished, reached end of file"); - } else { - warnx("Test aborted, errno: %d", ret); - } - -} |