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