CN109444847A - The noise filtering method of robotic laser radar avoidance - Google Patents

The noise filtering method of robotic laser radar avoidance Download PDF

Info

Publication number
CN109444847A
CN109444847A CN201811294180.3A CN201811294180A CN109444847A CN 109444847 A CN109444847 A CN 109444847A CN 201811294180 A CN201811294180 A CN 201811294180A CN 109444847 A CN109444847 A CN 109444847A
Authority
CN
China
Prior art keywords
distance
laser radar
outlier
distance threshold
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201811294180.3A
Other languages
Chinese (zh)
Inventor
肖湘江
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Individual
Original Assignee
Individual
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Individual filed Critical Individual
Priority to CN201811294180.3A priority Critical patent/CN109444847A/en
Publication of CN109444847A publication Critical patent/CN109444847A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Electromagnetism (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

The present invention provides a kind of noise filtering method of robotic laser radar avoidance.Specifically comprise the following steps: set distance threshold value;Read all scanning elements of laser radar and its distance apart from robot;Successively take continuous three points as sample since certain point of all scanning elements, mutual distance determines outlier two-by-two according to three points in the sample;If there is outlier, the distance between the outlier and another two lines are calculated, and be compared with distance threshold described in step 1;If more than the distance threshold, then it is assumed that the point is noise, and the distance between the noise and robot are set as zero or infinitely great;If being less than the distance threshold, do not deal with;If this sub-sampling is not dealt with without outlier, continue next sampling;Until all scanning elements are at least completed once to compare and return to initial point.The noise filtering method accuracy provided by the invention is high, real-time is good, is conducive to promote artificial intelligence commercialization.

Description

The noise filtering method of robotic laser radar avoidance
Technical field
Relate to that the present invention relates to laser radar technique fields, and in particular to a kind of noise filtering of robotic laser radar avoidance Method.
Background technique
The existing cost laser radar applied to robot will appear the noise of bounce, institute when scanning context It states noise and will lead to robot and be mistakenly considered to have at the noise barrier to be evaded, track route is caused to deviate even shadow Ring the normal walking for arriving robot.No matter filtering algorithm in the prior art in real-time or correctness is neither able to satisfy machine The requirement of people's avoidance.Cause are as follows: one, these filtering algorithms need to carry out certain sampling, and the barrier that robot obstacle-avoiding requires Information must be real-time, and the lag of obstacle information will lead to avoidance and go wrong.For example, for example laser radar sees obstacle Object is disembarked the artificial 1m of device, and filtering the spent time is 0.5s, and robot is practical after 0.5s only has 0.5m from barrier, but filtering Before moment is 0.5s, it is believed that obstacle distance 1m, there are time delays and space error.Two, existing filtering algorithm is not examined Consider the relevant information of barrier feature, and accidentally filters out the point of bounce.For example be strictly to there is an object to beat before robot, So robot will be considered that the barrier is not present after existing filtering algorithm filters out, and bump against so as to cause with barrier.
Summary of the invention
It is an object of the invention to overcome the problems, such as that existing filtering technique present on correctness and real-time, provides one kind The noise filtering method for the robotic laser radar avoidance that accuracy is high, real-time is good.
A kind of noise filtering method of robotic laser radar avoidance, specifically comprises the following steps:
Step S1, set distance threshold value;
Step S2, all scanning elements of laser radar and its distance apart from robot are read;
Step S3, continuous three points are successively taken as sample, according to the sample since certain point of all scanning elements Mutual distance determines that whether there is or not outliers to three points two-by-two in this;If there is outlier, S4 is entered step;If without peeling off Point, then this sub-sampling is not dealt with, and continues next sampling;
Step S4, calculate the distance between the outlier and another two lines, and with distance threshold described in step S1 It is compared;If more than the distance threshold, then it is assumed that the point is noise, and the distance between the noise and robot are set as Zero or infinitely great;If being less than the distance threshold, do not deal with;
Step S5, circulation step S3 to step S4 is until all scanning elements are at least completed once to compare and return to initially Point.
In a kind of preferred embodiment of the noise filtering method of robotic laser radar avoidance provided by the invention, step Distance threshold described in S1 is (2~5) * sin (laser radar angular resolution) rice.
In a kind of preferred embodiment of the noise filtering method of robotic laser radar avoidance provided by the invention, step The step of outlier is determined in S3 specifically:
S31: it calculates and appoints the distance between two o'clock in sample;
S32: the distance between two o'clock is compared with distance threshold described in step S1;If more than the distance threshold, then Think that the two o'clock is apart from each other, otherwise at a distance of relatively close;The outlier is the point all apart from each other from another 2 points.
Compared to the prior art, the noise filtering method principle letter of the robotic laser radar avoidance provided by the invention Single, practical good wave filtering effect, has the advantages that
One, filtering accuracy is high.This method it is initiative propose to be a little (2 with the distance between reference point threshold value wait filter out ~5) * sin (laser radar angular resolution) m, it is ensured that the barrier of physical presence is not filtered out accidentally, because of any practical barrier Hinder object, when closer apart from robot, the point measured by Airborne Lidar is unlikely to be single point, because without being filtered out.
Two, the real-time filtered.This method avoids the data sampling of multiframe and complicated signature analysis, high efficiency single frames Data processing ensure that the real-time of filtering, while it is abnormal to solve the problems, such as that obstacle information delays caused avoidance.
Three, the method can reduce the cost of laser radar in practical volume production applied to robot.Most low cost Laser radar all has that noise, this method are mainly used in cost laser radar, solves on hardware from software view The problem of, so that the laser radar of low side is reached high-precision laser radar filter effect, reduces cost of the robot on device, have Conducive to robot volume production and popularization and use, while a kind of soft or hard combination is provided to reduce the production cost of laser radar producer Feasible scheme.
Detailed description of the invention
To describe the technical solutions in the embodiments of the present invention more clearly, used in being described below to embodiment Attached drawing is briefly described, it should be apparent that, drawings in the following description are only some embodiments of the invention, for ability For the those of ordinary skill of domain, without creative efforts, it can also be obtained according to these attached drawings other attached Figure, in which:
Fig. 1 is the noise filtering method workflow schematic diagram of robotic laser radar avoidance provided by the invention;
Fig. 2 is the noise filtering method operation principle schematic diagram of robotic laser radar avoidance provided by the invention;
Fig. 3 is the judgment method example of outlier;
Fig. 4 is the filtering effect of one specific embodiment of noise filtering method of robotic laser radar avoidance provided by the invention Fruit figure;
Fig. 5 is the noise filtering method Correctness Analysis figure of robotic laser radar avoidance provided by the invention.
Specific embodiment
Following will be combined with the drawings in the embodiments of the present invention, and technical solution in the embodiment of the present invention carries out clear, complete Site preparation description, it is clear that the described embodiments are merely a part of the embodiments of the present invention, instead of all the embodiments.
Referring to Fig. 1, being the noise filtering method workflow signal of robotic laser radar avoidance provided by the invention Figure.The noise filtering method specifically comprises the following steps:
Step S1, set distance threshold value;It sets in the present embodiment a little described apart from threshold between reference point wait filter out Value is (2-5) * sin (laser radar angular resolution) m.Here, 2-5 is distance 2-5m in the real world, laser radar Angular resolution is obtained from the essential information of laser radar device.This distance threshold is that many experiments test institute is passed through by my company ?.If distance threshold setting is excessive, not can be filtered from the closer noise of barrier, that is, the limitation filtered out is excessively loose;And If setting is too small, barrier also will be filtered accidentally, that is, the limitation filtered out is excessively tight, and being within close proximity between two points may also can It is filtered out.And threshold value is arranged in (2~5) * sin (laser angle resolution ratio) m, robot obstacle-avoiding demand can be met, at this point, if Laser radar angular resolution is 0.5 degree, and distance threshold is 0.017m~0.043m, i.e., can be filtered when barrier is narrower than 1.7cm It removes.
Step S2, all scanning elements of laser radar and its distance apart from robot are read.
Step S3, this is sampled.According to the data characteristic of laser radar device, since certain point of all scanning elements according to Secondary three points for taking angle adjacent are as sample.
According to three points in the sample, mutual distance determines that whether there is or not outliers two-by-two;If there is outlier, enter Step S4;If this sub-sampling is not dealt with without outlier, continue next sampling.
The step of determining outlier specifically:
S31: it calculates and appoints the distance between two o'clock in sample.In the higher situation of laser radar resolution ratio, between two o'clock Distance be about the respective distance away from robot of the two o'clock difference.
S32: the distance between two o'clock is compared with distance threshold described in step S1;If more than the distance threshold, then Think that the two o'clock is apart from each other, otherwise at a distance of relatively close;The outlier is the point all apart from each other from another 2 points.
Step S4, calculate the distance between the outlier and another two lines, and with distance threshold described in step S1 It is compared;If more than the distance threshold, then it is assumed that the point is noise, and the distance between the noise and robot are set as Zero or infinitely great;If being less than the distance threshold, do not deal with;
Step S5, circulation step S3 to step S4 is until all scanning elements are at least completed once to compare and return to initially Point.
The principle of the noise filtering method of robotic laser radar avoidance provided by the invention is very simple, for a word just It is outlier to be filtered, i.e., away from data point filtering out apart from biggish a single point.Point in circle as shown in Figure 2 is to filter The point removed, the point in rectangle is the point for not needing to filter out, because the point in circle meets two following conditions: nearby only one Point and apart from multiple point groups farther out, and farther out closer discrimination standard be distance threshold.Therefore, as shown in figure 3, point A is to G point group Distance be more than distance threshold, then point A be outlier, filtered out;E, the distance of f point to G point group is less than distance threshold, recognizes For in a point group, without filtering out.
Preferably, the number of the also settable outlier for needing to filter out of the present invention, to filter out k point, then by this k point It regards a point as to filter, filtering algorithm is outlier function.But it learns by multiple practical experience in different resolution Laser radar in the case of, sampled point is three, when filtering out a little as one, lasts minimum, filters out accurately, filter effect such as Fig. 4 Shown, Fig. 4 right half part is before filtering out, and left-half is after filtering out, it is seen that the noise in filter field has been filtered out.
For laser radar avoidance, algorithm it is simple and last be less avoidance real-time guarantee.Pass through outlier Function determines that needs filter out a little the position of i.e. noise, then will need to filter out corresponding laser radar data-a little apart from machine The distance of people is set as zero or infinitely great achievees the effect that filtering.Outlier function distribution of obstacles is divided into before in after Three parts compare preceding middle and back and other two-part distances respectively, if the distance between other two parts are relatively close but our department It is point apart from each other with other two parts, indicate that our department is divided into the outlier that needs filter out.According to laser radar data in angle Continuous characteristic, is not in two laser radar datas in an angle, and the turning point cloud of this method and classics is analyzed again to be filtered out Method compare more simple and efficient, time complexity be O (n).
Real time analysis: being divided into the scan period of a laser radar between this method lag longest, if laser radar Frequency is 10HZ, then space lag up to 0.1s, because this algorithm can be located at once after receiving laser radar data Reason does not need to carry out multiple repairing weld to determine outlier, to meet robot obstacle-avoiding requirement of real-time.
Correctness Analysis: it is a single point that this algorithm, which filters out, through testing, the lesser barrier of diameter at a distance when, laser The scanning element of the acquisition of radar may only one, but on hand when inherently more than two points, therefore will not be filtered out, so Correctness meets avoidance requirement, because avoidance only needs to hide barrier nearby, the barrier over 5-6m is with nearby Avoidance and onrelevant.As shown in fig. 5, it is assumed that rectangular is laser radar, circle is barrier, and small circle is the obstacle scanned Object information point.Visual impediments are closer apart from robot, and bigger by the angle of laser radar scanned, the scanning element of acquisition is got over More, the barrier of farthest can be filtered out if only one information point, but remain to be identified on hand, be kept away to will not influence Barrier.
The implementation method of classical laser radar filtering algorithm be laser radar data is converted to after a cloud carry out again from Group's processing, the noise filtering method principle of the robotic laser radar avoidance provided by the invention is simple, practical filter effect It is good, it has the advantages that
One, filtering accuracy is high.This method it is initiative propose to be a little 2- with the distance between reference point threshold value wait filter out 5*sin (laser radar angular resolution) m, it is ensured that the barrier of physical presence is not filtered out accidentally.
Two, the real-time filtered.This method avoids the data sampling of multiframe and complicated signature analysis, high efficiency single frames Data processing ensure that the real-time of filtering, and it is abnormal equally to solve the problems, such as that obstacle information delays caused avoidance.
Three, the cost of laser radar in practical volume production is reduced applied to robot.Most cost laser radar All there are problems that noise, this method are mainly used in cost laser radar, solve the problems, such as on hardware from software view, make The laser radar of low side reaches high-precision laser radar filter effect, reduces cost of the robot on device, is conducive to machine People's volume production and popularization and use, while a kind of feasibility side of soft or hard combination is provided to reduce the production cost of laser radar producer Case.
The above description is only an embodiment of the present invention, is not intended to limit the scope of the invention, all to utilize this hair Equivalent structure or equivalent flow shift made by bright description is applied directly or indirectly in other relevant technology necks Domain similarly includes within scope of patent protection of the invention.

Claims (3)

1. a kind of noise filtering method of robotic laser radar avoidance, it is characterised in that: specifically comprise the following steps:
Step S1, set distance threshold value;
Step S2, all scanning elements of laser radar and its distance apart from robot are read;
Step S3, continuous three points are successively taken as sample, according in the sample since certain point of all scanning elements Mutual distance determines that whether there is or not outliers to three points two-by-two;If there is outlier, S4 is entered step;If without outlier, This sub-sampling is not dealt with, and continues next sampling;
Step S4, the distance between the outlier and another two lines are calculated, and is carried out with distance threshold described in step S1 Compare;If more than the distance threshold, then it is assumed that the point be noise, by the distance between the noise and robot be set as zero or It is infinitely great;If being less than the distance threshold, do not deal with;
Step S5, circulation step S3 to step S4 is until all scanning elements are at least completed once to compare and return to initial point.
2. the noise filtering method of robotic laser radar avoidance according to claim 1, it is characterised in that: step S1 institute Stating distance threshold is (2~5) * sin (laser radar angular resolution) rice.
3. the noise filtering method of robotic laser radar avoidance according to claim 2, it is characterised in that: in step S3 The step of determining outlier specifically:
S31: it calculates and appoints the distance between two o'clock in sample;
S32: the distance between two o'clock is compared with distance threshold described in step S1;If more than the distance threshold, then it is assumed that The two o'clock is apart from each other, otherwise at a distance of relatively close;The outlier is the point all apart from each other from another 2 points.
CN201811294180.3A 2018-11-01 2018-11-01 The noise filtering method of robotic laser radar avoidance Pending CN109444847A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811294180.3A CN109444847A (en) 2018-11-01 2018-11-01 The noise filtering method of robotic laser radar avoidance

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811294180.3A CN109444847A (en) 2018-11-01 2018-11-01 The noise filtering method of robotic laser radar avoidance

Publications (1)

Publication Number Publication Date
CN109444847A true CN109444847A (en) 2019-03-08

Family

ID=65549851

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811294180.3A Pending CN109444847A (en) 2018-11-01 2018-11-01 The noise filtering method of robotic laser radar avoidance

Country Status (1)

Country Link
CN (1) CN109444847A (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110927742A (en) * 2019-11-19 2020-03-27 杭州飞步科技有限公司 Obstacle tracking method, device, equipment and storage medium
CN111258320A (en) * 2020-02-14 2020-06-09 广东博智林机器人有限公司 Robot obstacle avoidance method and device, robot and readable storage medium
CN111722201A (en) * 2020-06-23 2020-09-29 常州市贝叶斯智能科技有限公司 Data denoising method for indoor robot laser radar
CN112353322A (en) * 2020-10-30 2021-02-12 珠海市一微半导体有限公司 Laser head-based sunlight noise filtering method, chip and robot
CN112513679A (en) * 2020-04-15 2021-03-16 华为技术有限公司 Target identification method and device
WO2021102963A1 (en) * 2019-11-29 2021-06-03 深圳市大疆创新科技有限公司 Noise point filtering method, device, and laser radar
CN112912756A (en) * 2019-09-17 2021-06-04 深圳市大疆创新科技有限公司 Point cloud noise filtering method, distance measuring device, system, storage medium and mobile platform
CN113640771A (en) * 2021-08-19 2021-11-12 深圳市中联讯科技有限公司 Noise filtering method and terminal
CN113640771B (en) * 2021-08-19 2024-05-28 深圳市中联讯科技有限公司 Noise filtering method and terminal

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103824270A (en) * 2013-09-25 2014-05-28 浙江树人大学 Rapid disperse three-dimensional point cloud filtering method
CN105547166A (en) * 2015-12-17 2016-05-04 华中科技大学 2D laser scanning based rapid detection method for heading window of heading machine
CN108107444A (en) * 2017-12-28 2018-06-01 国网黑龙江省电力有限公司检修公司 Substation's method for recognizing impurities based on laser data
CN108549084A (en) * 2018-01-30 2018-09-18 西安交通大学 A kind of target detection based on sparse two-dimensional laser radar and Attitude estimation method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103824270A (en) * 2013-09-25 2014-05-28 浙江树人大学 Rapid disperse three-dimensional point cloud filtering method
CN105547166A (en) * 2015-12-17 2016-05-04 华中科技大学 2D laser scanning based rapid detection method for heading window of heading machine
CN108107444A (en) * 2017-12-28 2018-06-01 国网黑龙江省电力有限公司检修公司 Substation's method for recognizing impurities based on laser data
CN108549084A (en) * 2018-01-30 2018-09-18 西安交通大学 A kind of target detection based on sparse two-dimensional laser radar and Attitude estimation method

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
李幸刚等: "一种基于邻域扩展聚类的去噪算法", 《系统仿真学报》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112912756A (en) * 2019-09-17 2021-06-04 深圳市大疆创新科技有限公司 Point cloud noise filtering method, distance measuring device, system, storage medium and mobile platform
CN110927742A (en) * 2019-11-19 2020-03-27 杭州飞步科技有限公司 Obstacle tracking method, device, equipment and storage medium
WO2021102963A1 (en) * 2019-11-29 2021-06-03 深圳市大疆创新科技有限公司 Noise point filtering method, device, and laser radar
CN113196092A (en) * 2019-11-29 2021-07-30 深圳市大疆创新科技有限公司 Noise filtering method and device and laser radar
CN111258320A (en) * 2020-02-14 2020-06-09 广东博智林机器人有限公司 Robot obstacle avoidance method and device, robot and readable storage medium
CN112513679A (en) * 2020-04-15 2021-03-16 华为技术有限公司 Target identification method and device
CN112513679B (en) * 2020-04-15 2021-12-03 华为技术有限公司 Target identification method and device
CN111722201A (en) * 2020-06-23 2020-09-29 常州市贝叶斯智能科技有限公司 Data denoising method for indoor robot laser radar
CN112353322A (en) * 2020-10-30 2021-02-12 珠海市一微半导体有限公司 Laser head-based sunlight noise filtering method, chip and robot
CN112353322B (en) * 2020-10-30 2022-03-04 珠海一微半导体股份有限公司 Laser head-based sunlight noise filtering method, chip and robot
CN113640771A (en) * 2021-08-19 2021-11-12 深圳市中联讯科技有限公司 Noise filtering method and terminal
CN113640771B (en) * 2021-08-19 2024-05-28 深圳市中联讯科技有限公司 Noise filtering method and terminal

Similar Documents

Publication Publication Date Title
CN109444847A (en) The noise filtering method of robotic laser radar avoidance
Hui et al. Vision-based autonomous navigation approach for unmanned aerial vehicle transmission-line inspection
CN104268883B (en) A kind of time-frequency spectral curve extracting method based on edge detection
Wang et al. A study on long-close distance coordination control strategy for litchi picking
CN103533303A (en) Real-time tracking system and method of moving target
CN113341396B (en) Robot and charging pile identification method and device thereof
CN106872967A (en) A kind of moving target detecting system and method based on bistatic radar
CN110263733A (en) Image processing method, nomination appraisal procedure and relevant apparatus
CN110147837B (en) Method, system and equipment for detecting dense target in any direction based on feature focusing
CN106324563A (en) Multipoint passive detection all-phase signal sorting and arrival time difference measurement system
CN108763158A (en) Frequency difference combined calculation method and system when a kind of
CN103733225A (en) Characteristic point coordination system, characteristic point coordination method, and recording medium
CN109829909A (en) A kind of object detection method, device and storage medium
CN115690545A (en) Training target tracking model and target tracking method and device
CN101539999B (en) Method and device for recognizing plane geometrical shapes
CN112418089A (en) Gesture recognition method and device and terminal
Yu et al. Separated calibration of a camera and a laser rangefinder for robotic heterogeneous sensors
Stefanut et al. Nearby platform: Algorithm for automated asteroids detection in astronomical images
CN104217200A (en) Automatic fingerprint identifying method and system for criminal investigation
CN108734098A (en) Human body image recognition methods and device
Cervigon et al. Granger causality and jensen–shannon divergence to determine dominant atrial area in atrial fibrillation
CN104331680B (en) Flowing water lamp-based beacon system for rapidly identifying
Lima et al. Cooperative-phd tracking based on distributed sensors for naval surveillance area
CN114330418A (en) Electroencephalogram and eye movement fusion method, medium and equipment for AR target recognition
Parvizi et al. The EB factory project. II. Validation with the Kepler field in preparation for K2 and TESS

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20190308

WD01 Invention patent application deemed withdrawn after publication