HAPSRG / GPSUBX_UART_Eigen

Eigen

Dependencies:   Vector3

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

Diff: GPSUBX_UART.cpp

Revision:
15:e77382079cd9
Parent:
14:1ed344c662d2
Child:
16:8181909e88f8
Child:
19:ae1a294cb30b
--- a/GPSUBX_UART.cpp	Fri Nov 12 06:47:48 2021 +0000
+++ b/GPSUBX_UART.cpp	Mon Nov 29 12:32:42 2021 +0000
@@ -200,8 +200,8 @@
     Vector3 _z(0.0f, 0.0f, 1.0f);
     Vector3 _e = _d * _z;
     Vector3 _n = _e * _d;
-    UniversalZeroUnitN = _n;
-    UniversalZeroUnitE = _e;
+    UniversalZeroUnitN = _n / _n.Norm();
+    UniversalZeroUnitE = _e / _e.Norm();
     UniversalZeroUnitD = _d;
     //twelite.printf("%f %f %f \r\n",_n,_e,_d);
 }