Finished static map builder. It is faster than the current map updates, but still somewhat slow. Ideally we can get gmapping to update faster by tweaking parameters, but for now this should help things
Merge branch 'alec'