Adding rgb cameras, changing some organization, adding some mapping code, etc.