diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-05-19 21:07:19 +0200 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-05-19 21:07:19 +0200 |
commit | f0630547aa6d391fbb056e450d2344bd888721e2 (patch) | |
tree | 15356bf627b5e869ad0dd37fb63bacf3870170c6 /src/drivers/gps/mtk.cpp | |
parent | ce62f073796f5956b32eaa8eb8d4a371821077de (diff) | |
download | px4-firmware-f0630547aa6d391fbb056e450d2344bd888721e2.tar.gz px4-firmware-f0630547aa6d391fbb056e450d2344bd888721e2.tar.bz2 px4-firmware-f0630547aa6d391fbb056e450d2344bd888721e2.zip |
MTK: Bail out correctly
Diffstat (limited to 'src/drivers/gps/mtk.cpp')
-rw-r--r-- | src/drivers/gps/mtk.cpp | 6 |
1 files changed, 6 insertions, 0 deletions
diff --git a/src/drivers/gps/mtk.cpp b/src/drivers/gps/mtk.cpp index 60a98134d..680f00d97 100644 --- a/src/drivers/gps/mtk.cpp +++ b/src/drivers/gps/mtk.cpp @@ -249,6 +249,12 @@ MTK::handle_message(gps_mtk_packet_t &packet) warnx("mtk: unknown revision"); _gps_position->lat = 0; _gps_position->lon = 0; + + // Indicate this data is not usable and bail out + _gps_position->eph_m = 1000.0f; + _gps_position->epv_m = 1000.0f; + _gps_position->fix_type = 0; + return; } _gps_position->alt = (int32_t)(packet.msl_altitude * 10); // from cm to mm |