registration[points]: Add cloneMatrix function.
registration[points]: Add solution cost function.