IMU - increase gain on large Course over ground error (#12792)
* IMU - increase gain on large Course over ground error
* Fix Cog calculation in IMU
Old code did align CoG antiparallel to Yaw. Cross product stays the
same, but dot product is inverted.
@iNav - this is probably reason for magic numbers in iNav IMU
rewrite (especially wind compensation)
* Update gtest
Copy of debian/stable libgtest-dev
* Add unittest for IMU CoG
Work in progress
* IMU - convert compass to new alignment calculation
* IMU Unittests
- new wrapped EXPECT_NEAR_DEG / EXPECT_NEAR_RAD
- magnetometer testing
* IMU - CoG evaluation based on thrust vector
---------
Co-authored-by: Petr Ledvina <ledvinap@hp124.ekotip.cz>