Skip to content

Commit

Permalink
test fix for IIF 1776
Browse files Browse the repository at this point in the history
  • Loading branch information
dehann committed Oct 5, 2023
1 parent 69b6401 commit 4645d09
Showing 1 changed file with 4 additions and 2 deletions.
6 changes: 4 additions & 2 deletions test/testBearingRange2D.jl
Original file line number Diff line number Diff line change
Expand Up @@ -260,14 +260,16 @@ end
##

# Start with an empty graph
N = 1
# N = 1
fg = initfg()

#add pose with partial constraint
addVariable!(fg, :x0, Pose2)
addFactor!(fg, [:x0], PriorPose2(MvNormal(zeros(3), 0.01*Matrix{Float64}(LinearAlgebra.I, 3,3))), graphinit=false)
# force particular initialization
setVal!(fg, :x0, [getPointIdentity(Pose2)])
u0 = getPointIdentity(Pose2)
arr = push!(Vector{typeof(u0)}(), u0)
setVal!(fg, :x0, arr)

##----------- sanity check that predictbelief plumbing is doing the right thing
_pts = getPoints(propagateBelief(fg, :x0, ls(fg, :x0), N=75)[1])
Expand Down

0 comments on commit 4645d09

Please sign in to comment.