Adding visual slam package