Switch back to Release optimizations
Add routine to get current world pose
Quiet slam graph optimizer