ICP bug fix and enhancement. Some videos of ICP are added. A writer for PLY is there. The output can now be read on say MeshLab.