Merge pull request #298 from JuliaRobotics/24Q3/enh/liegauprod2

more Lie Gaussian product tests
JuliaRobotics · Jul 29, 2024 · 9da5292 · 9da5292
2 parents cb26bea + 889bc18
commit 9da5292
Showing 1 changed file with 13 additions and 0 deletions.
diff --git a/test/testLieFundamentals.jl b/test/testLieFundamentals.jl
@@ -314,6 +314,19 @@ p̂ = calcProductGaussians(
   do_transport_correction = true
 )
 
+@test isapprox(
+  [0;0;0.0], 
+  mean(p̂.p);
+  atol=1e-10
+)
+
+@test isapprox(
+  μn,
+  vee(M, ε, log(M, ε, mean(p̂)));
+  atol=1e-1 # NOTE looser bound for even-mean-mean case vs naive-identity-mean case
+)
+
+
 
 ##
 end