Active slam with informative path planning for heterogeneous robot teams