Simultaneous planning, localization, and mapping in a camera sensor network