191 lines
6.0 KiB
C++
191 lines
6.0 KiB
C++
/** @todo check if gps structure is not modified with multiple decodes */
|
|
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
|
|
#include <gtest/gtest.h>
|
|
|
|
#include <di/drv/hl854x.h>
|
|
extern "C" {
|
|
#include "drv/hl854x/gps_pvt.c"
|
|
static struct di_drv_hl854x_ctx ctx;
|
|
}
|
|
|
|
TEST(time, init) {
|
|
di_time_init();
|
|
}
|
|
|
|
/**
|
|
* - Translates latitude N 051 35'07.80" -> 051.5855
|
|
* - Translates longitude E 005 11'42.40 -> 005.1951
|
|
* - Translates latitude S 023 01'20.90" -> -23.022461
|
|
* - Translates longitude W 043 10'58.90 -> -43.183024
|
|
*/
|
|
TEST(drv_hl854x_gps_pvt, extract_coord) {
|
|
const char *coord1 = "N 051 35'07.80\"";
|
|
const char *coord2 = "E 005 11'42.40";
|
|
const char *coord3 = "S 023 01'20.90\"";
|
|
const char *coord4 = "W 043 10'58.90";
|
|
const char *coord1_corrupt = "Q 043 10'58.90";
|
|
const char *coord2_corrupt = "W_043 10'58.90";
|
|
const char *coord3_corrupt = "W 043-10'58.90";
|
|
const char *coord4_corrupt = "W 043 10=58.90";
|
|
const char *coord5_corrupt = "W 043 10'58-90";
|
|
const char *coord6_tooshort = "W 043 10'58.0";
|
|
|
|
EXPECT_NEAR((double)51.5855, di_drv_hl854x_gps_pvt_extract_coord(coord1), 0.0001);
|
|
EXPECT_NEAR((double)5.1951, di_drv_hl854x_gps_pvt_extract_coord(coord2), 0.0001);
|
|
|
|
EXPECT_NEAR((double)-23.022461, di_drv_hl854x_gps_pvt_extract_coord(coord3), 0.0001);
|
|
EXPECT_NEAR((double)-43.183024, di_drv_hl854x_gps_pvt_extract_coord(coord4), 0.0001);
|
|
|
|
EXPECT_DOUBLE_EQ(0.0, di_drv_hl854x_gps_pvt_extract_coord(coord1_corrupt));
|
|
EXPECT_DOUBLE_EQ(0.0, di_drv_hl854x_gps_pvt_extract_coord(coord2_corrupt));
|
|
EXPECT_DOUBLE_EQ(0.0, di_drv_hl854x_gps_pvt_extract_coord(coord3_corrupt));
|
|
EXPECT_DOUBLE_EQ(0.0, di_drv_hl854x_gps_pvt_extract_coord(coord4_corrupt));
|
|
EXPECT_DOUBLE_EQ(0.0, di_drv_hl854x_gps_pvt_extract_coord(coord5_corrupt));
|
|
EXPECT_DOUBLE_EQ(0.0, di_drv_hl854x_gps_pvt_extract_coord(coord6_tooshort));
|
|
}
|
|
|
|
TEST(drv_hl854x_gps_pvt, hdr_id_0_time) {
|
|
const char *time1 = "01:02:03";
|
|
const char *time2 = "23:59:59";
|
|
const char *time_to_small = "23:59:";
|
|
const char *time_inval = "01:02 03";
|
|
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_time(&ctx, time1);
|
|
EXPECT_EQ(ctx.gps.time.tm_hour, 1);
|
|
EXPECT_EQ(ctx.gps.time.tm_min, 2);
|
|
EXPECT_EQ(ctx.gps.time.tm_sec, 3);
|
|
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_time(&ctx, time2);
|
|
EXPECT_EQ(ctx.gps.time.tm_hour, 23);
|
|
EXPECT_EQ(ctx.gps.time.tm_min, 59);
|
|
EXPECT_EQ(ctx.gps.time.tm_sec, 59);
|
|
|
|
memset(&ctx.gps.time, 0, sizeof(ctx.gps.time));
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_time(&ctx, time_to_small);
|
|
EXPECT_EQ(ctx.gps.time.tm_hour, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_min, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_sec, 0);
|
|
|
|
memset(&ctx.gps.time, 0, sizeof(ctx.gps.time));
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_time(&ctx, time_inval);
|
|
EXPECT_EQ(ctx.gps.time.tm_hour, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_min, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_sec, 0);
|
|
}
|
|
|
|
TEST(drv_hl854x_gps_pvt, hdr_id_0_date) {
|
|
const char *date1 = "01/01/1970";
|
|
const char *date_to_short = "01/01/19";
|
|
const char *date_inval = "01-01-19";
|
|
|
|
memset(&ctx.gps.time, 0, sizeof(ctx.gps.time));
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_date(&ctx, date1);
|
|
EXPECT_EQ(ctx.gps.time.tm_year, 1970);
|
|
EXPECT_EQ(ctx.gps.time.tm_mon, 1);
|
|
EXPECT_EQ(ctx.gps.time.tm_mday, 1);
|
|
|
|
memset(&ctx.gps.time, 0, sizeof(ctx.gps.time));
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_date(&ctx, date_to_short);
|
|
EXPECT_EQ(ctx.gps.time.tm_year, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_mon, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_mday, 0);
|
|
|
|
memset(&ctx.gps.time, 0, sizeof(ctx.gps.time));
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_date(&ctx, date_inval);
|
|
EXPECT_EQ(ctx.gps.time.tm_year, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_mon, 0);
|
|
EXPECT_EQ(ctx.gps.time.tm_mday, 0);
|
|
}
|
|
|
|
TEST(drv_hl854x_gps_pvt, fix_state) {
|
|
struct {
|
|
const char *str;
|
|
enum di_rpc_sensor_data_gps_fix_state s;
|
|
} t[] = {
|
|
{ "", DI_RPC_GPS_FIX_STATE_UNKNOWN },
|
|
{ "3A FIX", DI_RPC_GPS_FIX_STATE_UNKNOWN },
|
|
{ "NO FIX", DI_RPC_GPS_FIX_STATE_NO_FIX },
|
|
{ "ES FIX", DI_RPC_GPS_FIX_STATE_ES_FIX },
|
|
{ "2D FIX", DI_RPC_GPS_FIX_STATE_2D_FIX },
|
|
{ "3D FIX", DI_RPC_GPS_FIX_STATE_3D_FIX }
|
|
};
|
|
|
|
for (unsigned int i = 0; i < sizeof(t)/sizeof(t[0]); i++) {
|
|
di_drv_hl854x_gps_pvt_hdr_id_0_gps_fix_state(&ctx, t[i].str);
|
|
EXPECT_EQ(ctx.gps.data.fix_state, t[i].s);
|
|
}
|
|
}
|
|
|
|
TEST(drv_hl854x_gps_pvt, cb_hdr_id_0) {
|
|
char pvt_frame_id_0[] = "0,06:59:28,15/09/2015,3D FIX,N 051 35'07.80\",E 005 11'42.40,+0012m";
|
|
char pvt_frame_id_0_no_fix[] = "0,06:59:28,15/09/2015,NO FIX,N 051 35'07.80\",E 005 11'42.40,+0012m";
|
|
|
|
di_drv_hl854x_init(&ctx);
|
|
|
|
/* 3D fix */
|
|
ctx.me.match.str = pvt_frame_id_0;
|
|
|
|
di_drv_hl854x_cb_gps_pvt(&ctx.me);
|
|
|
|
EXPECT_EQ(ctx.gps.time.tm_hour, 6U);
|
|
EXPECT_EQ(ctx.gps.time.tm_min, 59U);
|
|
EXPECT_EQ(ctx.gps.time.tm_sec, 28U);
|
|
|
|
EXPECT_EQ(ctx.gps.time.tm_mday, 15U);
|
|
EXPECT_EQ(ctx.gps.time.tm_mon, 9U);
|
|
EXPECT_EQ(ctx.gps.time.tm_year, 2015U);
|
|
|
|
EXPECT_NEAR((double)51.5855, ctx.gps.data.latitude, 0.0001);
|
|
EXPECT_NEAR((double)5.1951, ctx.gps.data.longitude, 0.0001);
|
|
|
|
EXPECT_EQ(ctx.gps.data.fix_state, DI_RPC_GPS_FIX_STATE_3D_FIX);
|
|
|
|
/* No fix */
|
|
ctx.me.match.str = pvt_frame_id_0_no_fix;
|
|
|
|
di_drv_hl854x_cb_gps_pvt(&ctx.me);
|
|
|
|
EXPECT_EQ(ctx.gps.time.tm_hour, 6U);
|
|
EXPECT_EQ(ctx.gps.time.tm_min, 59U);
|
|
EXPECT_EQ(ctx.gps.time.tm_sec, 28U);
|
|
|
|
EXPECT_EQ(ctx.gps.time.tm_mday, 15U);
|
|
EXPECT_EQ(ctx.gps.time.tm_mon, 9U);
|
|
EXPECT_EQ(ctx.gps.time.tm_year, 2015U);
|
|
|
|
/* Old coordinates are kept */
|
|
EXPECT_NEAR((double)51.5855, ctx.gps.data.latitude, 0.0001);
|
|
EXPECT_NEAR((double)5.1951, ctx.gps.data.longitude, 0.0001);
|
|
|
|
EXPECT_EQ(ctx.gps.data.fix_state, DI_RPC_GPS_FIX_STATE_NO_FIX);
|
|
}
|
|
|
|
TEST(drv_hl854x_gps_pvt, cb_hdr_id_1) {
|
|
char pvt_frame_id_1[] = "1,087.5deg,021m/s";
|
|
|
|
di_drv_hl854x_init(&ctx);
|
|
|
|
ctx.me.cfg.private_data = &ctx;
|
|
ctx.me.match.str = pvt_frame_id_1;
|
|
|
|
/* pvt frame id 1 is not used */
|
|
di_drv_hl854x_cb_gps_pvt(&ctx.me);
|
|
}
|
|
|
|
TEST(drv_hl854x_gps_pvt, cb_hdr_id_2) {
|
|
char pvt_frame_id_2[] = "2,08SV,1.0HDOP,29,18.2";
|
|
|
|
di_drv_hl854x_init(&ctx);
|
|
|
|
ctx.me.cfg.private_data = &ctx;
|
|
ctx.me.match.str = pvt_frame_id_2;
|
|
|
|
di_drv_hl854x_cb_gps_pvt(&ctx.me);
|
|
|
|
EXPECT_EQ(ctx.gps.data.siv, 8);
|
|
EXPECT_STREQ(ctx.gps.data.hdop, "1.0");
|
|
}
|