3D Mapping of indoor environments with a time of flight camera

In this work we make a 3D representation of an indoor environment surrounding a robot. So we assume an static environment. We used a Swissranger SR4000 camera to get 3D point clouds of the environment, and ROS for implementing the software. With these information and the position of the robot, we are able to construct a 3D map in real time.