2D to 3D Line Registration via MILP for Unknown Associations

Resolve Bottlenecks,
Find Innovative Solutions
Generate Solutions

Solution Overview

Problem

Existing methods for determining rigid-body transformations between 2D image data and 3D point cloud data often rely on known data associations, which can be problematic when these associations are unknown, and may not effectively handle outliers or provide robust solutions for sensor calibration and localization in dynamic environments.

Innovation Solution

A system and method that formulates the 2D-3D registration problem as a Mixed Integer Linear Program (MILP) to simultaneously solve for the projection transform vector and data association set, allowing for robust alignment of 2D and 3D data even with unknown associations, using a line-preserving projection operation and a nearest neighbor heuristic for data association.

Engineering Contradictions & Design Principles

VSEngineering Contradiction Analysis

1Productivity

If least-squares solvers are used with known data associations, then the registration problem can be solved efficiently, but the method fails when data associations are unknown or unreliable

Engineering Contradiction:
Improveregistration efficiencyVSAvoidrobustness to unknown associations
Core Design Contradiction:
ProductivityVSReliability

Solution Approach 1:

The patent changes the mathematical formulation from non-linear least-squares optimization to a linear system with binary association variables. By parameterizing the association matrix with binary variables and formulating the problem as finding the optimal binary matrix that minimizes the least-squares error, the method can simultaneously determine both the transformation parameters and the data associations, making it robust to unknown or unreliable associations while maintaining computational efficiency.

Inventive Principle:
Principle #35Parameter changes

2Reliability

If RANSAC or SoftPOSIT methods are used to handle unknown associations, then the method can work with unknown data associations, but these methods rely on random sampling or iterative switching which reduces efficiency and reliability

Engineering Contradiction:
Improvehandling unknown associationsVSAvoidregistration efficiency
Core Design Contradiction:
ReliabilityVSProductivity

Solution Approach 1:

The patent replaces the iterative mechanical processes of RANSAC (random sampling and outlier rejection) and SoftPOSIT (iterative switching between association finding and transformation optimization) with a direct linear algebraic solution. By formulating the problem as finding the optimal binary association matrix through linear system solving, the method eliminates the need for random sampling and iterative switching, achieving both robustness to unknown associations and computational efficiency.

Inventive Principle:
Principle #28Mechanics substitution (Replace mechanical system)

3Ease of operation

If heuristic front-ends are used to provide data associations, then the registration can proceed with known associations, but the heuristic approaches may introduce errors when associations are unreliable

Engineering Contradiction:
Improvesimplicity of registration processVSAvoidassociation accuracy
Core Design Contradiction:
Ease of operationVSMeasurement precision

Solution Approach 1:

The patent enables the system to self-determine the data associations directly from the 2D-3D line correspondence data without relying on external heuristic front-ends. By formulating the association determination as an optimization problem with binary variables that can be solved through linear algebra, the system autonomously identifies the correct associations, eliminating the need for potentially error-prone heuristic methods while maintaining operational simplicity.

Inventive Principle:
Principle #25Self-service

Data Source

PatentUS11393127B22D to 3D line-based registration with unknown associations
Publication Date: 2022.07.19 TOYOTA JIDOSHA KK
  • US11393127B2 patent drawing
  • US11393127B2 patent drawing
  • US11393127B2 patent drawing

AI summary

A system for determining the rigid-body transformation between 2D image data and 3D point cloud data includes a first sensor configured to capture image data of an environment, a second sensor configured to capture point cloud data of the environment; and a computing device communicatively coupled to the first sensor and the second sensor. The computing device is configured to receive image data from the first sensor and point cloud data from the second sensor, parameterize one or more 2D lines from image data, parameterize one or more 3D lines from point cloud data, align the one or more 2D lines with the one or more 3D lines by solving a registration problem formulated as a mixed integer linear program to simultaneously solve for a projection transform vector and a data association set, and generate a data mesh comprising the image data aligned with the point cloud data.