Commit Graph

913 Commits

Author SHA1 Message Date
Andrew Tridgell 05194ed8b6 AP_GPS: don't accept infinite accuracies for blending
these result in NaN values for velocities
2020-11-24 12:00:41 +11:00
Andrew Tridgell 83c479bcc2 AP_GPS: prevent UAVCAN GPS from giving infinite accuracy values
this can happen due to the complex encodings of accuracies in UAVCAN
2020-11-24 12:00:41 +11:00
Andrew Tridgell a762926526 AP_GPS: fixed constrained NaN in EKF3 caused by bad GPS blending
if the accuracies reported are very low then we can do a division by
zero and this results in a constraining NaN for GPS vertical velocity
filter in NavEKF3_core::calcGpsGoodToAlign
2020-11-24 12:00:41 +11:00
Peter Barker e257dd9fee AP_GPS: correct logging for GPS blending 2020-11-20 09:45:57 +11:00
Dr.-Ing. Amilcar do Carmo Lucas 58f0c34612 AP_GPS: fix dataflash logging of blended GPS instance 2020-11-20 09:45:57 +11:00
Peter Barker 428c9ef0e1 AP_GPS: correct logging in dual-ublox setups 2020-11-10 17:39:51 +11:00
Andrew Tridgell 6c4e552a0b AP_GPS: removed have_ekf_logging() 2020-11-10 16:15:45 +11:00
Iampete1 60951a7891 AP_GPS: add use primary if 3D fix GPS_AUTO_SWITCH option 2020-11-10 12:01:56 +11:00
Iampete1 347723dbaf AP_GPS: add primary param 2020-11-10 12:01:56 +11:00
Michael du Breuil b30c55b3f3 AP_GPS: Support yaw from moving base station on SBF drivers 2020-11-03 11:12:20 +11:00
Michael du Breuil 4161e2eb28 AP_GPS: Factor out moving base offset helper 2020-11-03 11:12:20 +11:00
Michael du Breuil a61444cec0 AP_GPS: Don't reset the entire buffer when handling RTCM data
This is a micro optimization intended to just make handling GPS
corrections a bit faster.
2020-10-25 14:21:39 +11:00
murata 4c835a0df9 AP_GPS: Move the CRC24 to the AP_Math class 2020-10-21 18:24:07 +11:00
Andrew Tridgell e529d475d4 AP_GPS: use mktime for NMEA and MTK time conversion
this fixes NMEA time handling, which was off by 3 days
2020-10-20 11:21:00 +11:00
Andrew Tridgell e995a198bd AP_GPS: always send GPS2_RAW if 2nd GPS configured
this improves the display on the GCS when the GPS has not yet been
found. This is particularly important after a reboot, as otherwise the
GCS may display stale information from the previous boot
2020-10-06 16:48:19 +11:00
Andrew Tridgell 8e08d93026 AP_GPS: fixed pre-arm check on ublox M9 GPS
this prevents a failure from config of SOL and TMODE messages
2020-10-06 10:22:52 +11:00
Donione ff80be19c1 AP_GPS: fix type and update reserved bytes in ublox PVT 2020-09-28 16:31:14 -07:00
Andrew Tridgell 8c1bc94053 AP_GPS: fixed build warnings for MSP with AP_Periph 2020-09-15 09:40:03 +10:00
Andrew Tridgell 94670879f8 AP_GPS: allow hwdef.dat override of GPS rate 2020-09-09 06:35:50 +10:00
yaapu 85b61d6bf3 AP_GPS: added support for MSP GPS sensors 2020-09-09 06:35:50 +10:00
Andrew Tridgell 5647aadbcf AP_GPS: added API for getting last iTOW 2020-09-09 06:35:50 +10:00
Andrew Tridgell 56b743dfca AP_GPS: build SBF driver with double precision 2020-09-03 09:56:29 +10:00
Michael du Breuil 6a8680d31d AP_GPS: Send RTK baseline data from SBF 2020-09-03 09:56:29 +10:00
Andrew Tridgell 87c7781be2 AP_GPS: show GPS as unhealthy if it is lagged too much
this detects GPS data lag, and if 5 samples in a row are lagged by
more than 50ms beyond the expected lag for the GPS then we declare the
GPS as unhealthy.

This is useful to detect users who have asked for more data from the
GPS then it can send at the baudrate that is being used. The case that
led to this path was a F9 GPS with GPS_RAW_DATA=1 at 115200 baud. In
that case the UART data is quickly lagged by over 1s
2020-08-25 10:22:05 +10:00
Siddharth Purohit 0690b7bd68 AP_GPS: move to using CANManager library 2020-08-19 17:31:09 +10:00
Michael du Breuil 08d4e1c062 AP_GPS: Support configuring the SBF com port 2020-08-13 15:04:38 +10:00
Iampete1 997ffcf30d AP_GPS: NMEA: only decode each measage once 2020-08-09 11:37:16 +10:00
Siddharth Purohit d122f00c14 AP_GPS: redetection not necessary for UAVCAN GPS 2020-07-29 17:32:56 +10:00
Tom Pittenger 8f6e9caf93 AP_GPS: change GPS_AUTO_SWITCH #define list to enum class
enumeration entry had to change to NONE to avoid name conflict with DISABLED
2020-06-25 11:10:31 +10:00
Andrew Tridgell 4aa10a6c30 AP_GPS: added force_disable_yaw() API 2020-06-18 15:01:00 +10:00
Andrew Tridgell 78858bbcdd AP_GPS: switch ublox over to 230400 baud
this ensures we have sufficient bandwidth for raw data
2020-06-01 17:18:17 -07:00
Andrew Tridgell 529bfe8fcd AP_GPS: fixed issue with GPS selection for moving baseline
when you have a moving baseline pair of ublox GPS modules and the
rover GPS does not have full fixed RTK lock on the base GPS then we
should not use it as our primary GPS as it's position and velocity can
be badly affected by the attempts of the GPS to gain a fixed lock.

This was observed in a flight with two F9P GPS, where the GPS velocity
data from the rover GPS went way off when it lost full RTK lock. It's
status stayed at 4, so it was selected as the primary GPS
2020-05-27 10:59:46 +10:00
Andrew Tridgell f00392d567 AP_GPS: don't accept a zero GNSS timestamp from UAVCAN GPS
this is needed for a bug in AP_Periph 1.0 which could briefly send a
zero timestamp on first fix marked as a UTC time
2020-04-29 12:20:19 +10:00
Andrew Tridgell 4f591a338f AP_GPS: use GCS_SEND_TEXT() 2020-04-29 07:36:55 +10:00
Andrew Tridgell 6347d0adb0 AP_GPS: leave uart2 config enabled when using uart2 MB setup 2020-04-21 15:30:54 +10:00
Andrew Tridgell f3a5d915f3 AP_GPS: allow for larger average delta on MB rover than normal 2020-04-21 15:30:54 +10:00
Andrew Tridgell 36098c3221 AP_GPS: improved delay health threshold
allow for missing frames without showing unhealthy on GCS
2020-04-21 15:30:54 +10:00
Andrew Tridgell 3397ed766d AP_GPS: enable ublox moving baseline compilation option
disable for HAL_MINIMIZE_FEATURES and if max receivers 1. This fixes
the f103-GPS AP_Periph build
2020-04-21 15:30:54 +10:00
Andrew Tridgell ae2132d861 AP_GPS: added check for Z error in moving baseline ublox
this ensures we don't get bad yaw from having the right distance but
incorrect Z offset for the currently expected roll/pitch
2020-04-21 15:30:54 +10:00
Andrew Tridgell 7027eecd34 AP_GPS: added GPS_DRV_OPTIONS
this allows for configuration of moving baseline with either uart1 or
uart2 for the RTCM data. Using uart2 requires an extra cable between
the two modules, but requires less uart bandwidth which is good when
DMA channels are low. Using uart2 also avoids the rtcmv3 parser, which
saves memory
2020-04-21 15:30:54 +10:00
Andrew Tridgell 9a6de209ab AP_GPS: ensure that PVT and RELPOSNED msgs time align
this ensures we wait until we have a matching PVT and RELPOSNED
message before we report new data. If we stop receiving RELPOSNED
messages then disable yaw support
2020-04-21 15:30:54 +10:00
Andrew Tridgell 3fbeae613b AP_GPS: fixed moving baseline yaw calculation
this reverts #13955 and instead applies the correct fix, which is to
subtract the angle instead of adding.
2020-04-21 15:30:54 +10:00
Andrew Tridgell 077ab22767 AP_GPS: fixed AP_Periph build with gcc 9.x 2020-04-01 17:08:48 +11:00
Andrew Tridgell 4456732911 AP_GPS: fixed rotation of moving baseline GPS
we were off by 180 degrees. Thanks to Jaime for noticing this!
2020-04-01 17:08:19 +11:00
Peter Barker 2b08af69bc AP_GPS: fix dereference-of-nullptr warning from scan-build
This is kind-of a false positive as this in practise could never be
nullptr.
2020-03-31 10:37:16 +11:00
Andrew Tridgell f00314a5d1 AP_GPS: removed dead blending code 2020-03-17 12:13:54 +11:00
Andrew Tridgell 9fa034d1de AP_GPS: fixed antenna offset for blending
we were accessing beyond the end of the antenna_offset array
2020-03-17 12:13:54 +11:00
Randy Mackay a19634b9d2 AP_GPS: reduce POS param range to 5m and add increment 2020-02-01 08:46:03 +09:00
Andrew Tridgell 7efd5248ee AP_GPS: added get_type() API 2020-01-26 09:12:55 +11:00
Andrew Tridgell e59f32074d AP_GPS: fixed yaw error when one GPS has zero position
the M_PI correction was only valid for one zero side. Much simpler to
always calculate difference
2020-01-24 11:46:40 +11:00
Andrew Tridgell cf8becfa71 AP_GPS: make all semaphores recursive
the cost is very similar and this prevents an easy coding error which
can occur on less used code paths
2020-01-19 20:19:30 +11:00
Andrew Tridgell f0d1d3fa90 AP_GPS: added get_semaphore() 2020-01-16 20:36:54 +11:00
Andrew Tridgell db777c56b9 AP_GPS: provide yaw feedback in GPS_RAW_INT and GPS2_RAW
allow GPS to display status of GPS yaw for moving baseline and NMEA
2020-01-07 12:37:35 +11:00
Andrew Tridgell e40c570615 AP_GPS: faster config of moving baseline
thanks to MdB for suggestion
2020-01-07 12:37:35 +11:00
Andrew Tridgell e660532f67 AP_GPS: fixes from PR review 2020-01-07 12:37:35 +11:00
Andrew Tridgell 41289fe945 AP_GPS: adjust lag for MB RTK ublox
rover will lag by about 40ms
2020-01-07 12:37:35 +11:00
Andrew Tridgell b86c43aa66 AP_GPS: prefer RTK MB rover when it has yaw available
this ensures that yaw data is time aligned with position and velocity
data
2020-01-07 12:37:35 +11:00
Andrew Tridgell 261465ef96 AP_GPS: split out update_primary() from update()
this makes the selection of primary GPS a lot clearer, with less
nesting of if statements
2020-01-07 12:37:35 +11:00
Andrew Tridgell 93aaf98672 AP_GPS: added automatic u-blox moving baseline configuration
this uses GPS_TYPE and GPS_TYPE2 to setup two u-blox F9 receivers in a
RTK moving baseline configuration
2020-01-07 12:37:35 +11:00
Andrew Tridgell 71a0f3a1dc AP_GPS: added RTCMv3 parser
will be used for moving baseline support
2020-01-07 12:37:35 +11:00
Andrew Tridgell 6efbc484fd AP_GPS: cope with UAVCAN GPS that don't provide Aux message
thanks to @VadimZ for the suggestion
2019-12-05 15:48:51 -07:00
Michael du Breuil 8ca6535661 AP_GPS: Log SBF commanded disarms 2019-11-20 11:06:16 -07:00
Michael du Breuil f8808022b8 AP_GPS: Check the driver logging health 2019-11-20 11:06:16 -07:00
Andrew Tridgell 379e3d60a1 AP_GPS: fixed sizes of config items 2019-11-16 15:28:52 +11:00
Michael du Breuil 63a6a1084c AP_GPS: UBlox: Fix the assumption that all keys are 1 byte keys 2019-11-16 15:28:52 +11:00
Michael du Breuil 150a4edcf2 AP_GPS: UBlox fix not listing the time mode as a configuration reason 2019-11-16 15:28:52 +11:00
Andrew Tridgell 7bec9d87b4 AP_GPS: fixed TMODE config issue on non-F9 GPS
thanks to Michel Pastor for reporting this
2019-11-16 15:28:52 +11:00
Andrew Tridgell 8aa781206d AP_GPS: fixed signed/unsigned comparisons 2019-11-09 17:11:32 +11:00
Andrew Tridgell b7c9391619 AP_GPS: support Fix2 message for UAVCAN
this allows for RTK fix levels
2019-11-09 17:11:32 +11:00
Andrew Tridgell 632114d687 AP_GPS: support RTCMStream for RTCM injection on UAVCAN 2019-11-09 17:11:32 +11:00
Andrew Tridgell 6c31fb1bb6 AP_GPS: added automatic config of TMODE on F9
the Drotek F9 GPS ships with TMODE enabled, which means we don't get a
3D fix.

This also adds the VALGET/VALSET msgs we will need for automatic
moving baseline config
2019-11-09 17:11:32 +11:00
Michael du Breuil d623da0de6 AP_GPS: Always send GPS2_RAW after we've seen the second GPS
This significantly improves the GCS's ability to correctly display whats
happening with the second GPS.
2019-11-02 10:35:08 +11:00
Michael du Breuil 5bafd7d72c AP_GPS: Don't defeat the GCS message interval code 2019-10-28 00:26:28 -07:00
Andrew Tridgell 14cdac9202 AP_GPS: fixed GPS to UART mapping
this allows for first GPS as UAVCAN and 2nd as UART. That is not
possible currently unless you waste a uart
2019-10-24 14:37:30 +11:00
Andrew Tridgell 00260db65a AP_GPS: fixed UAVCAN GPS status when disconnected
this fixes the status reported for a UAVCAN GPS when the cable is
unplugged. It should be "NO GPS", but was instead reporting "NO
FIX". The user had no way to distinguish between not finding a CAN GPS
at all and it not getting satellites

thanks to CUAV for reporting
2019-10-14 19:08:37 -06:00
Andrew Tridgell 37fb028532 AP_GPS: improved checking for valid yaw for moving baseline
and fixed check for carrSolnFixed
2019-10-15 11:06:11 +11:00
Michael du Breuil 2587b13ae7 AP_GPS: UBLOX: Parse RELPOSNED messages
This does not yet:
  - validate the receiver configuration
  - manage timing out stale GPS heading info
  - relPosNormalized usage isn't clear, which may defeat the STRICT_LENGTH_CHECK
2019-10-15 11:06:11 +11:00
Andrew Tridgell b5217412f9 AP_GPS: fixed a bug in handling corrupt u-blox packets
when we have corrupt input due to loss of bytes on a UART we can end
up with a u-blox packet with zero payload bytes. When that happens we
need to bypass payload reading as otherwise we will end up keeping
reading bytes until the driver resets at 4 seconds, causing a GPS
outage.

This was causing GPS outages every few hours in copters running 3.6.7,
and was also reproduced in SITL using SIM_GPS_BYTELOSS.
2019-09-30 15:20:30 -06:00
Andrew Tridgell 9eb6c1be64 AP_GPS: use jitter correction on GPS_INPUT data
this allows for more accurate timing when using GPS_INPUT for indoor
positioning systems
2019-09-17 09:17:04 +10:00
Michael du Breuil f857eb4640 AP_GPS: Take responsibility for logging the GPS if the EKF wants logging 2019-09-10 09:09:17 +10:00
Michael du Breuil ca0dad9a7f AP_GPS: Directly include needed headers 2019-08-28 13:13:03 +10:00
Andrew Tridgell 291d72601b AP_GPS: enabled reduced size for AP_Periph support 2019-08-27 10:29:56 +10:00
Peter Barker 8c21a279ea AP_GPS: examples: var_info is now in GCS_MAVLINK_Parameters 2019-08-14 18:25:43 +10:00
Andrew Tridgell 8d7262994b AP_GPS: support yaw in GPS_INPUT mavlink GPS
useful for Vicon setups
2019-08-12 10:25:40 +10:00
murata e4455491aa AP_GPS: Use common hexadecimal character to number conversion method 2019-08-06 10:14:12 +10:00
Peter Barker 46ad04aab7 AP_GPS: correct format string warnings in SBF driver 2019-08-05 11:20:35 +10:00
Andrew Tridgell be9c98db12 AP_GPS: ensure we have full timestamp before setting RTC clock
thanks to Martin Sollie for this bug report
2019-07-31 20:13:55 +10:00
Michael du Breuil d33006a2e7 AP_GPS: Refactor first_unconfigured_gps to return bool 2019-07-30 10:12:43 +10:00
Randy Mackay 64637dba8f AP_GPS: resolve gcs::send_text compiler warning 2019-07-30 09:02:39 +09:00
Peter Barker 678c11f048 AP_GPS: supply format string to send_text 2019-07-26 10:54:41 +10:00
Pierre Kancir 13ac187fd8 AP_GPS: pass mavlink_message_t by const reference 2019-07-16 20:51:42 +10:00
Grant Morphett 64ed76326b AP_GPS: Adding support for the NMEA GPHDT sentence
The NMEA GPHDT sentence can be used to determine the vehicles bearing
instead of a compass even when the vehicle is stationary.  This type
of GPS is normally very expensive and does the bearing using some sort
of phase ambituity algorithm.
2019-07-13 11:05:57 +10:00
Andrew Tridgell 5bfb6ced84 AP_GPS: fixed u-blox F9 auto configuration 2019-07-05 13:31:40 +10:00
Michael du Breuil eed710db5f AP_GPS: Fix a lot of unneded example includes 2019-06-18 10:02:05 +10:00
Peter Barker 73c81519da AP_GPS: fix missing-declaration warning in example 2019-06-04 10:25:15 +10:00
Michael Oborne 6031f5b6a9 AP_GPS_UBLOX: add support for TIMEGPS message. used to get gps week 2019-05-29 09:48:17 +10:00
Andrew Tridgell 9f5a598697 AP_GPS: removed unusued AP_Common/Semaphore.h 2019-05-15 15:33:48 +10:00
Michael du Breuil 7871040bb6 AP_GPS: Pass an in range value for the param initilizer 2019-05-13 15:46:38 +10:00
Pierre Kancir deb6aafcbe AP_GPS: fix GPS_AUTO_test 2019-05-01 14:17:34 -07:00
Michael du Breuil e6d97f63a5 AP_GPS: Remove unneeded wrappers 2019-04-26 08:07:19 +10:00