An Extension of the ICP Algorithm for Modeling Nonrigid Objects with Mobile Robots