27th International Symposium on Automation and Robotics in Construction (ISARC 2010) Figure 3: Belt selected using intensity image Figure 4: Point cloud in camera coordinate system The normal e of the plane fitting the set of points is obtained by the following equation: u S T e arg e min e u d where d is the distance from the origin to the place, which is assumed to be 0.