GT-ICP: a General Temporal ICP algorithm for simultaneous frame-to-frame registration and motion compensation