Started on new approach: ICP transformation estimation