Indoor Robot Localization Map Updates for Dynamic Layout Changes

Resolve Bottlenecks,
Find Innovative Solutions
Generate Solutions

Solution Overview

Problem

Existing semi-autonomous cleaning devices face challenges in precisely localizing in dynamic environments with significant changes, leading to inaccurate pose estimation and potential safety hazards due to their reliance on static environment assumptions, which are not suitable for environments with frequent layout changes.

Innovation Solution

A hybrid mapping and localization system using continuous localization algorithms, incorporating a probabilistic occupancy grid, 2D Laser Scan Matcher, and Particle Filter, which updates the map based on validated localization quality to integrate dynamic changes, ensuring accurate pose estimation and avoiding incorrect object associations.

Engineering Contradictions & Design Principles

VSEngineering Contradiction Analysis

1Reliability

If Adaptive Monte Carlo Localization (AMCL) with particle filter is used for localization, then localization can be performed on a pre-existing static map, but the system fails in dynamic environments where obstacle layouts change significantly

Engineering Contradiction:
Improvelocalization reliabilityVSAvoidadaptability to dynamic environments
Core Design Contradiction:
ReliabilityVSAdaptability or versatility

Solution Approach 1:

The system dynamically adapts the map representation by introducing a dynamic occupancy grid that can update obstacle layouts in real-time. The particle filter is modified to accommodate dynamic changes by allowing particles to associate with updated obstacle configurations rather than assuming a static environment, enabling the localization system to maintain reliability in dynamic settings.

Inventive Principle:
Principle #15Dynamics

Solution Approach 2:

The system changes the parameters of the localization algorithm by modifying the particle filter to work with dynamic occupancy grids. This involves adjusting how particles are propagated and how likelihoods are calculated based on changing obstacle configurations, rather than relying on fixed static map parameters.

Inventive Principle:
Principle #35Parameter changes

2Device complexity

If the environment is assumed to be static for localization purposes, then computational complexity is reduced and localization is simpler, but the system produces incorrect pose estimates when environment changes exceed 30-50%

Engineering Contradiction:
Improvelocalization system complexityVSAvoidpose estimation accuracy
Core Design Contradiction:
Device complexityVSMeasurement precision

Solution Approach 1:

The system segments the occupancy grid into static and dynamic components. The static portion maintains the original map structure for computational efficiency, while the dynamic portion updates obstacle configurations independently. This segmentation allows the system to maintain simplicity while improving pose estimation accuracy in changing environments.

Inventive Principle:
Principle #1Segmentation

3Reliability

If particle filter associates lidar measurements with fixed map obstacles, then localization works in stable environments, but the system cannot handle new obstacles or layout changes leading to wrong pose estimates

Engineering Contradiction:
Improvelocalization consistencyVSAvoidhandling of environmental changes
Core Design Contradiction:
ReliabilityVSAdaptability or versatility

Solution Approach 1:

The system implements feedback mechanisms where the particle filter continuously compares lidar measurements with both static map data and dynamic obstacle updates. When environmental changes are detected, the system feeds back updated obstacle information to the particle filter, allowing it to re-associate measurements with new configurations and maintain reliable localization.

Inventive Principle:
Principle #23Feedback

Data Source

PatentUS20230113331A1Localization framework for dynamic environments for autonomous indoor semi-autonomous devices
Publication Date: 2023.04.13 AVIDBOTS CORP
  • US20230113331A1 patent drawing
  • US20230113331A1 patent drawing
  • US20230113331A1 patent drawing

AI summary

A hybrid mapping and localization system using continuous localization algorithms is disclosed. When a localization quality is sufficiently high, based on a validated points localization monitor metric, then the map updates are allowed to be made on the localization map. This helps localizing in dynamic environments because these environment changes are actually integrated into the underlying map, so that the particle filter does not snap to incorrect object locations.