fix nonparametric heading test issue (in RoME.jl)

[dehann]

See @test_broken here:

• https://github.com/JuliaRobotics/RoME.jl/pull/688/files#diff-78cdcdee99b52d582f0752fa4c207558a25f1c4e52f95f37127e23a1628d7310R51

[dehann]

try to do for v0.35.0, would like to ensure partials working properly for RoME. Small chance this punts to v0.35.1 given other priorities needing v0.35.0.

[dehann]

spike and bump to v0.35.1 if taking too long

[Affie]

Testing: So far approxConvBelief gives the correct answers.

[dehann]

this is new test coverage, and test looks at implicit partial priors and graph is still fully defined. Decision on how to handle these partials either explicit or code improvements with Manifolds.

Way back before Manifolds and StaticArrays this would work because the implicit partial was handled automatically since all compute and variable assignments were done in coordinates and using manifold dims of variables and factors (i.e. xDim and zDim).

[dehann]

requires new design session on partials, which expected to occur in the near future

[dehann]

quick discussion had preference for always having "partial" info available for each factor. I.e. solver can recover necessary partial info for any factor. Preference to avoid having multiple factors for the same measurement type on different graphs. Example PriorPosition2/PriorPose2_XY/PriorPose3_XY.