Simultaneous localization and mapping in millimeter wave networks with angle measurements