Add GPS mixing to the Z axis to the IntertialNav library

The baro and gps are used symmetrically, each with their own time
constants which can be changed mid-mission.  This allows optimal
mixing based on the sensor characteristics at any given time.

This doesn't attempt to use the GPS to compensate for long-term
baro drift, that's a deeper change to the INAV library.

The specific use case is flying close to chimneys for inspection
purposes.  The heat and turbulence stuffs up the baro readings
while the good quality GPS we have works better.  Conversely,
while lower to the ground, the obstructed sky view means the baro
is much better.  Having the pair of tuning knobs allows us to get
good behaviour at all points of the mission.