Template tracking and mapping between depth and color