Positioning method of AMCL algorithm based on Gaussian model and storage medium

A technology of Gaussian model and positioning method, which is applied in the re-radiation of electromagnetic waves, special data processing applications, and the use of re-radiation, etc. It can solve problems such as continuous positioning and easy failure of robot positioning initialization

Pending Publication Date: 2021-06-18
长沙金维信息技术有限公司
View PDF0 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0004] In view of the above-mentioned technical problems, the main purpose of the present invention is to provide a positioning method based on the AMCL algorithm of the Gaussian model, to solve t

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Positioning method of AMCL algorithm based on Gaussian model and storage medium
  • Positioning method of AMCL algorithm based on Gaussian model and storage medium
  • Positioning method of AMCL algorithm based on Gaussian model and storage medium

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0031] The following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are some of the embodiments of the present invention, but not all of them. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without creative efforts fall within the protection scope of the present invention.

[0032] refer to figure 1 , the present invention provides a kind of positioning method based on the AMCL algorithm of Gaussian model, comprises steps:

[0033] S1, in response to the received laser data, convert the laser data from the laser coordinate system data to the map coordinate system data according to the set conversion parameters. In the positioning of the robot, the laser sensor emits a laser beam in a fixed direction. The emitted laser lig...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention provides a positioning method of an AMCL algorithm based on a Gaussian model and a storage medium. The method comprises the steps of receiving laser data, and converting the laser data into map coordinate system data according to a set conversion parameter; filtering data exceeding a map range and a sensor range; judging whether a recently occupied grid of a measurement point in the map coordinate system data is less than a threshold value or not, and if so, marking the measurement point as a laser matching point; normalizing the actual distance between the laser matching point and the occupied grid through a Gaussian model, dividing the normalized data into three groups, and respectively calculating the accumulated normalized distance; carrying out weighted average on the three groups of normalized distances, and calculating a laser matching score of single-frame laser data; and determining the positioning accuracy of the laser data according to the laser matching score. According to the method, the problems of easy failure of robot positioning initialization and continuous positioning under the condition of large environment change, such as the condition that a sensor is shielded by a dynamic obstacle, are solved.

Description

technical field [0001] The invention relates to the field of robot positioning, in particular to a Gaussian model-based AMCL algorithm positioning method and a storage medium. Background technique [0002] The AMCL (Adaptive Monte Carlo Algorithm) algorithm is a common algorithm for positioning a robot with prior map information using sensors such as lidar to perceive the surrounding environment of the robot. A known map tracks the pose of the robot. Compared with the ordinary Monte Carlo algorithm, the adaptive Monte Carlo algorithm is embodied in: to solve the robot kidnapping problem, it will find that the average score of the particles suddenly decreases, which means that the correct particles are abandoned in a certain iteration At this time, re-sprinkle some particles in the whole world; solve the problem of fixed number of particles, because sometimes when the robot is positioned successfully, the particles are all concentrated in one piece, and it is not necessary t...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
IPC IPC(8): G01S17/93G01S17/42G06F16/29
CPCG01S17/42G01S17/93G06F16/29
Inventor 于泠汰王锦山冼志怀杨建强王宇雨方锐涌
Owner 长沙金维信息技术有限公司
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products