Skip to content

Commit

Permalink
Merge pull request #703 from JuliaRobotics/23Q4/test/fixiff1776
Browse files Browse the repository at this point in the history
test fix for IIF 1776
  • Loading branch information
dehann authored Oct 9, 2023
2 parents 69b6401 + 4645d09 commit ce8b3dc
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 ce8b3dc

Please sign in to comment.