Fast 3 D Perception for Collision Avoidance and SLAM in Domestic Environments 1 Fast 3 D Perception for Collision Avoidance and SLAM in Domestic Environments