fixbug and documented icp.h