First commit
Merge https://github.com/DylanWatson/multi-agent-slam