Want to visualize what's happening with hybrid SLAM
I wrote a scilab particle plotting library, the script to visualize the hybrid SLAM is on its way =)
Now also logging Box and going to plot them.
Spotted yet another vector3d[3] wrong index in FastSLAM.updateRobotDepth()... How is it possible it was working?!
Other than that, I have a nice visualization of the HybridSLAM, although loading data is slow. Seeing clear evidence that the sampling must be selective.