Hao Men, Biruk A. Gebre, Kishore Pochiraju: Color point cloud registration with 4D ICP algorithm. ICRA 2011: 1511-1516