Skip to content

Commit c375e90

Browse files
committed
mv partial pose test to partial pose file
1 parent 20ecf40 commit c375e90

File tree

2 files changed

+18
-15
lines changed

2 files changed

+18
-15
lines changed

test/testPartialPose3.jl

+18
Original file line numberDiff line numberDiff line change
@@ -12,6 +12,24 @@ using Rotations
1212

1313
##
1414

15+
16+
@testset "Test (partial) priors on Pose3" begin
17+
## there was a problem with partials and staticarrays where asigning PriorPoint3 to Pose3 stopped working, here is an explicit test
18+
19+
fg = initfg()
20+
getSolverParams(fg).graphinit = false
21+
22+
addVariable!(fg, :x0, Pose3)
23+
24+
mv3 = MvNormal(SA[0.0; 0.0; 0.0], SMatrix{3,3}(1,0,0,0,1,0,0,0,1.))
25+
f = addFactor!(fg, [:x0;], PriorPoint3(mv3))
26+
27+
approxConvBelief(fg, getLabel(f), :x0)
28+
29+
##
30+
end
31+
32+
1533
@testset "Testing basic PriorPose3ZRP" begin
1634
##
1735

test/testPose3.jl

-15
Original file line numberDiff line numberDiff line change
@@ -21,21 +21,6 @@ C_ = homography_to_coordinates(M, H)
2121
##
2222
end
2323

24-
@testset "Test (partial) priors on Pose3" begin
25-
## there was a problem with partials and staticarrays where asigning PriorPoint3 to Pose3 stopped working, here is an explicit test
26-
27-
fg = initfg()
28-
getSolverParams(fg).graphinit = false
29-
30-
addVariable!(fg, :x0, Pose3)
31-
32-
mv3 = MvNormal(SA[0.0; 0.0; 0.0], SMatrix{3,3}(1,0,0,0,1,0,0,0,1.))
33-
f = addFactor!(fg, [:x0;], PriorPoint3(mv3))
34-
35-
approxConvBelief(fg, getLabel(f), :x0)
36-
37-
##
38-
end
3924

4025
##
4126
@testset "Test Basic Pose3 :parametric and :default" begin

0 commit comments

Comments
 (0)