Extended MICP for High Precision Robust Depth Data Registration