slam

Developed slam and tested in drones/handpack/backpack/wheel robots