JuliaRobotics / Caesar.jl

Robust robotic localization and mapping, together with NavAbility(TM). Reach out to info@wherewhen.ai for help.
https://www.wherewhen.ai
MIT License
185 stars 31 forks source link

manual init bypassing freeze-up but initializes variables at origin #371

Open mc2922 opened 5 years ago

mc2922 commented 5 years ago

Re: issue 370 See script: testDynPtExManual

Same fg that freezes, now added manualinit at line 70. Solve completing: image

but variables are initialized at 0: image The sas-factor here is x5-x9

dehann commented 5 years ago

Hi, thanks for posting -- let me have a closer look. My feeling is there is autoinit bug that is at least partially related to this "numerical" error bug. Example is very helpful in finding and fixing, thanks.

dehann commented 5 years ago

HI @mc2922 , is it possible to plot the ground truth values perhaps please?

mc2922 commented 5 years ago

Yup, Line 95 should be plotting ground truth? Let me check it

dehann commented 5 years ago

Update with latest IIF master, looks like it is working perhaps. @mc2922 if you could please confirm these results? I'm having a little trouble with the ground truth still -- anyway here is what I get now:

With treeinit:

:l1 contour plots on the right.

Screenshot from 2019-08-02 02-25-05 Screenshot from 2019-08-02 02-24-58

dehann commented 5 years ago

I think the manual init is still failing, but autoinit is now performing better. Here is manual init result:

Screenshot from 2019-08-02 02-35-36

mc2922 commented 5 years ago

Yes, freeze is resolved, now the tree-init completes with the following result: image

mc2922 commented 5 years ago

Seeing the same issue with manual init, points are at the origin image

dehann commented 5 years ago

probably fixed, but will retest for v0.4.3