diff --git a/test/testPartialPose3.jl b/test/testPartialPose3.jl index 565a1a7f..7c1700a6 100644 --- a/test/testPartialPose3.jl +++ b/test/testPartialPose3.jl @@ -12,6 +12,24 @@ using Rotations ## + +@testset "Test (partial) priors on Pose3" begin +## there was a problem with partials and staticarrays where asigning PriorPoint3 to Pose3 stopped working, here is an explicit test + +fg = initfg() +getSolverParams(fg).graphinit = false + +addVariable!(fg, :x0, Pose3) + +mv3 = MvNormal(SA[0.0; 0.0; 0.0], SMatrix{3,3}(1,0,0,0,1,0,0,0,1.)) +f = addFactor!(fg, [:x0;], PriorPoint3(mv3)) + +approxConvBelief(fg, getLabel(f), :x0) + +## +end + + @testset "Testing basic PriorPose3ZRP" begin ## diff --git a/test/testPose3.jl b/test/testPose3.jl index bc656b8d..161882a6 100644 --- a/test/testPose3.jl +++ b/test/testPose3.jl @@ -21,21 +21,6 @@ C_ = homography_to_coordinates(M, H) ## end -@testset "Test (partial) priors on Pose3" begin -## there was a problem with partials and staticarrays where asigning PriorPoint3 to Pose3 stopped working, here is an explicit test - -fg = initfg() -getSolverParams(fg).graphinit = false - -addVariable!(fg, :x0, Pose3) - -mv3 = MvNormal(SA[0.0; 0.0; 0.0], SMatrix{3,3}(1,0,0,0,1,0,0,0,1.)) -f = addFactor!(fg, [:x0;], PriorPoint3(mv3)) - -approxConvBelief(fg, getLabel(f), :x0) - -## -end ## @testset "Test Basic Pose3 :parametric and :default" begin