Robot Pose Confidence Evaluation Using Lidar Map Matching

Resolve Bottlenecks,
Find Innovative Solutions
Generate Solutions

Solution Overview

Problem

Conventional methods for determining a robot's pose lack accuracy, leading to inefficient and imprecise relocation, especially in humanoid robots, due to insufficient assessment of the determined pose.

Innovation Solution

A method involving laser scanning to determine laser points in a map coordinate system, calculating matching scores, and using confidence levels to adjust and optimize the robot's pose for higher accuracy, utilizing algorithms like Gauss-Newton iterative matching to refine the pose determination.

Engineering Contradictions & Design Principles

VSEngineering Contradiction Analysis

1Measurement precision

If conventional methods are used to determine robot pose, then the process is simple, but the accuracy of pose determination is low

Engineering Contradiction:
Improvepose determination accuracyVSAvoidmethod complexity
Core Design Contradiction:
Measurement precisionVSDevice complexity

Solution Approach 1:

The patent implements a feedback mechanism by calculating a confidence level for the determined pose and using this feedback to iteratively optimize the pose. The confidence level serves as a quality metric that guides further refinement, allowing the system to assess and improve its own measurements until a satisfactory accuracy threshold is achieved.

Inventive Principle:
Principle #23Feedback

Solution Approach 2:

The patent performs preliminary actions by first obtaining an initial pose determination through conventional methods, then using this preliminary result as a basis for subsequent optimization. The initial pose serves as a starting point that is refined through iterative confidence-based adjustments, combining simplicity with eventual precision.

Inventive Principle:
Principle #10Preliminary action

2Manufacturing precision

If conventional pose determination methods are used, then the implementation is fast, but the relocation precision is insufficient

Engineering Contradiction:
Improverelocation precisionVSAvoidtime for pose determination
Core Design Contradiction:
Manufacturing precisionVSLoss of time

Solution Approach 1:

The patent performs a preliminary pose determination using fast conventional methods, then uses this preliminary result as a basis for subsequent optimization. This allows the system to quickly obtain an initial estimate and then refine it only if necessary, minimizing time loss while improving precision.

Inventive Principle:
Principle #10Preliminary action

Solution Approach 2:

The patent applies partial optimization by performing confidence-based pose refinement only when the initial pose determination does not meet the required confidence threshold. This selective approach avoids unnecessary computational overhead while ensuring sufficient relocation precision when needed.

Inventive Principle:
Principle #16Partial or excessive action

3Reliability

If no confidence assessment is performed, then the method is simple, but the pose determination reliability is low

Engineering Contradiction:
Improvepose determination reliabilityVSAvoidassessment mechanism complexity
Core Design Contradiction:
ReliabilityVSDevice complexity

Solution Approach 1:

The patent introduces a confidence level assessment that provides feedback on the reliability of the determined pose. This confidence metric enables the system to evaluate its own measurements and determine whether further optimization is necessary, thereby improving reliability through self-assessment.

Inventive Principle:
Principle #23Feedback

Solution Approach 2:

The system performs self-assessment by calculating its own confidence level for the determined pose without requiring external validation. This self-service mechanism allows the robot to autonomously evaluate the quality of its pose determination and initiate refinement when needed, enhancing reliability independently.

Inventive Principle:
Principle #25Self-service

Applied Scientific Principles

This section explains which scientific principles are used to turn an abstract innovation direction into a practical engineering solution.

Function Achieved in This Case

Enhances the accuracy and efficiency of robot pose determination by adjusting and optimizing the pose based on confidence levels, ensuring precise relocation.

Implementation Method 1

determine first positions of laser points corresponding to a lidar in a map coordinate system according to a first pose when the lidar performs laser scanning

Methodology Applied
Scientific EffectLIDAR: LIDAR

Data Source

PatentUS12589495B2Method for determining pose of robot, robot and computer-readable storage medium
Publication Date: 2026.03.31 UBTECH ROBOTICS CORP LTD
  • US12589495B2 patent drawing
  • US12589495B2 patent drawing
  • US12589495B2 patent drawing

AI summary

A method for determining a pose of a robot having a lidar including: obtaining a first pose of the robot in a map coordinate system; determining first positions of laser points corresponding to the lidar in the map coordinate system according to the first pose when the lidar performs laser scanning; determining matching scores between the first positions and grids where the first positions are located according to the first positions and mean values of the grids where the first positions are located, wherein the grids are grids in a probability map corresponding to the map coordinate system; determining a first confidence level for the first pose based on the matching scores; and determining a target pose according to the first confidence level.