WO2021114080A1 - Laser radar ranging method and apparatus, and computer device and storage medium - Google Patents

Laser radar ranging method and apparatus, and computer device and storage medium Download PDF

Info

Publication number
WO2021114080A1
WO2021114080A1 PCT/CN2019/124280 CN2019124280W WO2021114080A1 WO 2021114080 A1 WO2021114080 A1 WO 2021114080A1 CN 2019124280 W CN2019124280 W CN 2019124280W WO 2021114080 A1 WO2021114080 A1 WO 2021114080A1
Authority
WO
WIPO (PCT)
Prior art keywords
pixel
crosstalk
pixels
echo image
edge
Prior art date
Application number
PCT/CN2019/124280
Other languages
French (fr)
Chinese (zh)
Inventor
何一雄
Original Assignee
深圳市速腾聚创科技有限公司
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 深圳市速腾聚创科技有限公司 filed Critical 深圳市速腾聚创科技有限公司
Priority to PCT/CN2019/124280 priority Critical patent/WO2021114080A1/en
Priority to CN201980050264.9A priority patent/CN112639516B/en
Publication of WO2021114080A1 publication Critical patent/WO2021114080A1/en

Links

Images

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
    • G01S7/483Details of pulse systems
    • G01S7/486Receivers
    • G01S7/487Extracting wanted echo signals, e.g. pulse detection
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/10Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation

Abstract

A laser radar ranging method, comprising: obtaining an echo image received by a laser radar (302); determining whether the echo image has a crosstalk pixel or not (304); if the echo image has a crosstalk pixel, correcting the crosstalk pixel to obtain a corrected echo image (306); and calculating according to the corrected echo image to obtain object pose information (308).

Description

激光雷达测距方法、装置、计算机设备和存储介质Lidar ranging method, device, computer equipment and storage medium 技术领域Technical field
本申请涉及一种激光雷达测距方法、装置、计算机设备和存储介质。This application relates to a laser radar ranging method, device, computer equipment and storage medium.
背景技术Background technique
激光雷达能够提供实时并且精确的三维场景信息,具有对环境感知的先天优势,测距范围大精度高,被广泛应用于安防监测、测绘勘探、交通管理、自动驾驶等领域。激光雷达通过向待测物体发射探测信号,接收待测物体反射的回波信号,进而根据回波信号与探测信号之间的相位差来计算待测物体的距离。Lidar can provide real-time and accurate three-dimensional scene information, has the inherent advantages of environmental perception, large ranging range and high accuracy, and is widely used in security monitoring, surveying and mapping exploration, traffic management, autonomous driving and other fields. The lidar transmits a detection signal to the object to be measured, receives the echo signal reflected by the object to be measured, and then calculates the distance of the object to be measured based on the phase difference between the echo signal and the detection signal.
Flash激光雷达属于全固态扫描的激光雷达,没有运动部件,系统的稳定性和可靠性好。其接收端采用像素阵列接收物体反射的回波信号,像素阵列根据回波信号以及探测信号来计算待测物体的距离。随着探测距离的增加,接收端的单个像素会接收到不同物体反射的回波信号,会造成像素间串扰问题,进而影响激光雷达的测距准确性。Flash lidar is an all-solid-state scanning lidar. There are no moving parts, and the system has good stability and reliability. The receiving end adopts a pixel array to receive the echo signal reflected by the object, and the pixel array calculates the distance of the object to be measured according to the echo signal and the detection signal. As the detection distance increases, a single pixel on the receiving end will receive echo signals reflected by different objects, which will cause crosstalk between pixels, which will affect the accuracy of lidar ranging.
发明内容Summary of the invention
根据本申请公开的各种实施例,提供一种能够提高待测物体的测距准确性的激光雷达测距方法、装置、计算机设备和存储介质。According to various embodiments disclosed in the present application, a lidar ranging method, device, computer device, and storage medium that can improve the ranging accuracy of an object to be measured are provided.
一种激光雷达测距方法包括:A lidar ranging method includes:
获取激光雷达接收的回波图像;Obtain the echo image received by the lidar;
判断所述回波图像是否存在串扰像素点;Judging whether there are crosstalk pixels in the echo image;
当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及When there are crosstalk pixels in the echo image, correct the crosstalk pixels to obtain a corrected echo image; and
根据所述校正后的回波图像计算得到物体位姿信息。The posture information of the object is calculated according to the corrected echo image.
一种激光雷达测距装置包括:A laser radar ranging device includes:
获取模块,用于获取激光雷达接收的回波图像;The acquisition module is used to acquire the echo image received by the lidar;
判断模块,用于判断所述回波图像是否存在串扰像素点;A judging module for judging whether there are crosstalk pixels in the echo image;
校正模块,用于当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及The correction module is used to correct the crosstalk pixels when the echo image has crosstalk pixels to obtain a corrected echo image; and
计算模块,用于根据所述校正后的回波图像计算得到物体位姿信息。The calculation module is used to calculate the posture information of the object according to the corrected echo image.
一种计算机设备,包括存储器和一个或多个处理器,所述存储器中储存有计算机可读指令,所述计算机可读指令被所述处理器执行时,使得所述一个或多个处理器执行以下步骤:A computer device, including a memory and one or more processors, the memory stores computer readable instructions, and when the computer readable instructions are executed by the processor, the one or more processors execute The following steps:
获取激光雷达接收的回波图像;Obtain the echo image received by the lidar;
判断所述回波图像是否存在串扰像素点;Judging whether there are crosstalk pixels in the echo image;
当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及When there are crosstalk pixels in the echo image, correct the crosstalk pixels to obtain a corrected echo image; and
根据所述校正后的回波图像计算得到物体位姿信息。The posture information of the object is calculated according to the corrected echo image.
一个或多个存储有计算机可读指令的非易失性计算机可读存储介质,计算机可读指令被一个或多个处理器执行时,使得一个或多个处理器执行以下步骤:One or more non-volatile computer-readable storage media storing computer-readable instructions. When the computer-readable instructions are executed by one or more processors, the one or more processors perform the following steps:
获取激光雷达接收的回波图像;Obtain the echo image received by the lidar;
判断所述回波图像是否存在串扰像素点;Judging whether there are crosstalk pixels in the echo image;
当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及When there are crosstalk pixels in the echo image, correct the crosstalk pixels to obtain a corrected echo image; and
根据所述校正后的回波图像计算得到物体位姿信息。The posture information of the object is calculated according to the corrected echo image.
本申请的一个或多个实施例的细节在下面的附图和描述中提出。本申请的其它特征和优点将从说明书、附图以及权利要求书变得明显。The details of one or more embodiments of the present application are set forth in the following drawings and description. Other features and advantages of this application will become apparent from the description, drawings and claims.
附图说明Description of the drawings
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。In order to more clearly describe the technical solutions in the embodiments of the present application, the following will briefly introduce the drawings needed in the embodiments. Obviously, the drawings in the following description are only some embodiments of the present application. A person of ordinary skill in the art can obtain other drawings based on these drawings without creative work.
图1为根据一个或多个实施例中激光雷达测距方法的应用环境图。Fig. 1 is an application environment diagram of a lidar ranging method according to one or more embodiments.
图2为根据一个或多个实施例中像素间串扰现象的示意图。FIG. 2 is a schematic diagram of the crosstalk phenomenon between pixels according to one or more embodiments.
图3为根据一个或多个实施例中激光雷达测距方法的流程示意图。Fig. 3 is a schematic flowchart of a lidar ranging method according to one or more embodiments.
图4为根据一个或多个实施例中判断回波图像是否存在串扰像素点步骤的流程示意图。Fig. 4 is a schematic flow chart of the step of judging whether there are crosstalk pixels in an echo image according to one or more embodiments.
图5为根据一个或多个实施例中获取深度图像的第一边缘像素点步骤的流程示意图。FIG. 5 is a schematic flow chart of the step of acquiring the first edge pixel point of the depth image according to one or more embodiments.
图6为根据一个或多个实施例中判断第一边缘像素点是否满足预设串扰条件步骤的流程示意图。FIG. 6 is a schematic flowchart of the step of judging whether the first edge pixel meets the preset crosstalk condition according to one or more embodiments.
图7为根据一个或多个实施例中第一边缘像素点及其所有相邻像素点构成的3×3像素阵列的深度图像的框图。Fig. 7 is a block diagram of a depth image of a 3×3 pixel array formed by a first edge pixel point and all adjacent pixels in one or more embodiments.
图8为另一个实施例中第一边缘像素点及其所有相邻像素点构成的3×3像素阵列的深度图像的框图。FIG. 8 is a block diagram of a depth image of a 3×3 pixel array formed by a first edge pixel point and all adjacent pixels in another embodiment.
图9为另一个实施例中判断回波图像是否存在串扰像素点步骤的流程示意图。FIG. 9 is a schematic flowchart of the step of judging whether there are crosstalk pixels in the echo image in another embodiment.
图10为根据一个或多个实施例中激光雷达发射的探测信号的示意图。Fig. 10 is a schematic diagram of a detection signal emitted by a lidar according to one or more embodiments.
图11为根据一个或多个实施例中激光雷达在多调制频率切换下的工作原理示意图。Fig. 11 is a schematic diagram of the working principle of lidar under multi-modulation frequency switching according to one or more embodiments.
图12为根据一个或多个实施例中对串扰像素点分割后为多个子像素点后得到的校正后的回波图像的框图。Fig. 12 is a block diagram of a corrected echo image obtained after dividing a crosstalk pixel into a plurality of sub-pixels according to one or more embodiments.
图13为另一个实施例中对串扰像素点分割后为多个子像素点后得到的校正后的回波图像的框图。FIG. 13 is a block diagram of a corrected echo image obtained by dividing the crosstalk pixel points into multiple sub-pixel points in another embodiment.
图14为根据一个或多个实施例中按照探测准确率要求由高到低将回波图像进行划分,得到划分后的图像区域的示意图。FIG. 14 is a schematic diagram of dividing the echo image from high to low according to the detection accuracy requirement according to one or more embodiments to obtain the divided image area.
图15为根据一个或多个实施例中激光雷达测距装置的框图。Fig. 15 is a block diagram of a laser radar ranging device according to one or more embodiments.
图16为根据一个或多个实施例中计算机设备的框图。Figure 16 is a block diagram of a computer device according to one or more embodiments.
具体实施方式Detailed ways
为了使本申请的技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。In order to make the technical solutions and advantages of the present application clearer, the following further describes the present application in detail with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application, and are not used to limit the present application.
本申请提供的激光雷达测距方法可以应用于如图1所示的应用环境中。激光雷达102向待测物体发射探测信号,通过接收端的像素阵列接收待测物体反射的回波信号。激光雷达102对回波信号进行处理后,得到回波图像。激光雷达102将回波图像发送至计算机设备104。计算机设备104判断回波图像是否存在串扰像素点。当回波图像存在串扰像素点时,计算机设备104校正串扰像素点,得到校正后的回波图像。计算机设备104根据校正后的回波图像计算得到物体位姿信息。The lidar ranging method provided in this application can be applied to the application environment as shown in FIG. 1. The lidar 102 transmits a detection signal to the object to be measured, and receives the echo signal reflected by the object to be measured through the pixel array at the receiving end. After the lidar 102 processes the echo signal, an echo image is obtained. The lidar 102 sends the echo image to the computer device 104. The computer device 104 determines whether there are crosstalk pixels in the echo image. When there are crosstalk pixels in the echo image, the computer device 104 corrects the crosstalk pixels to obtain a corrected echo image. The computer device 104 calculates the posture information of the object according to the corrected echo image.
对于flash激光雷达,其角分辨率取决于接收镜头的视场角和接收端的像素阵列的像素点个数。示例性的,flash激光雷达的接收镜头的视场角为60°×45°,像素阵列的像素点个数为320×240,计算可得水平方向和竖直方向的角分辨率均为0.1875°。据此可以估算单个像素点在距离R处对应的视场为正方形,其面积S为:For flash lidar, its angular resolution depends on the field of view of the receiving lens and the number of pixels in the pixel array at the receiving end. Exemplarily, the field of view of the receiving lens of the flash lidar is 60°×45°, the number of pixels in the pixel array is 320×240, and the angular resolution in the horizontal and vertical directions is both 0.1875°. . Based on this, it can be estimated that the field of view corresponding to a single pixel at the distance R is square, and its area S is:
S=4R 2tan 2(0.1875°/2)          (1) S=4R 2 tan 2 (0.1875°/2) (1)
如R 1=10m,则S 1=10.71cm 2;若R 2=50m,则S 2=267.75cm 2。由此可以看出,flash激光雷达的单个像素点对应的视场面积S随着距离R增加而增大。因此,在较远距离处的物体,单 个像素点对应的视场面积较大,单个像素点对应的视场有较大概率落在两个距离不同物体的边缘处。如图2所示,图中像素点2会接收到两个物体(如图中物体A和物体B)反射的回波信号,这样的现象被称为“像素间串扰”,像素点2即为串扰像素点。此时若按照之前计算距离的方法计算串扰像素点的测距值,测距值Rx是关于物体A和物体B实际距离的函数,即Rx=f(R A,R B),将得到错误的计算结果。这会导致flash激光雷达探测后得到的深度图像在两个(或多个)物体的边界出现一串距离错误的像素点,反应在激光雷达点云中,会在物体的边界出现彗星状点云拖尾现象。 If R 1 =10m, then S 1 =10.71cm 2 ; if R 2 =50m, then S 2 =267.75cm 2 . It can be seen that the field of view area S corresponding to a single pixel of the flash lidar increases as the distance R increases. Therefore, for objects at a longer distance, a single pixel corresponds to a larger field of view area, and the field of view corresponding to a single pixel has a greater probability of falling on the edge of two objects at different distances. As shown in Figure 2, pixel point 2 in the figure will receive the echo signals reflected by two objects (object A and object B in the figure). This phenomenon is called "inter-pixel crosstalk", and pixel point 2 is Crosstalk pixels. At this time, if you calculate the distance value of the crosstalk pixel according to the previous method of calculating the distance, the distance value Rx is a function of the actual distance between object A and object B, that is, Rx = f(R A , R B ), you will get an error Calculation results. This will cause the depth image obtained after flash lidar detection to show a series of pixels with the wrong distance on the boundary of two (or more) objects. This is reflected in the lidar point cloud, and a comet-like point cloud will appear on the boundary of the object. Smearing phenomenon.
像素间串扰影响flash激光雷达对物体边界测距的准确性,增加了深度图像的误点率,破坏点云质量,很大程度限制了flash激光雷达在自动驾驶、物体识别、环境建模等领域的应用。本申请提供的激光雷达测距方法用于解决上述像素间串扰问题。Inter-pixel crosstalk affects the accuracy of flash lidar for distance measurement of object boundaries, increases the error rate of depth images, destroys the quality of point clouds, and greatly limits the use of flash lidar in areas such as automatic driving, object recognition, and environmental modeling. application. The lidar ranging method provided in this application is used to solve the above-mentioned inter-pixel crosstalk problem.
需要说明的是,深度相机也存在上述像素间串扰的问题。本申请提供的测距方法也能够用于解决深度相机的像素间串扰问题。It should be noted that the depth camera also has the above-mentioned inter-pixel crosstalk problem. The distance measurement method provided in this application can also be used to solve the problem of crosstalk between pixels of a depth camera.
在其中一个实施例中,如图3所示,提供了一种激光雷达测距方法,以该方法应用于图1中的计算机设备为例进行说明,包括以下步骤:In one of the embodiments, as shown in FIG. 3, a lidar ranging method is provided. Taking the method applied to the computer device in FIG. 1 as an example for description, the method includes the following steps:
步骤302,获取激光雷达接收的回波图像。Step 302: Obtain the echo image received by the lidar.
激光雷达可以是flash激光雷达,激光雷达发射端的发射阵列发射探测信号照亮视场,探测信号被视场内物体反射后返回回波信号,接收端的像素阵列接收回波信号,激光雷达处理回波信号得到回波图像,将回波图像发送至计算机设备。激光雷达的接收端中每个像素点对应一个角度范围的视场,视场中同一个物体反射的回波信号可以被对应的多个像素点接收。回波图像可以是激光雷达在探测过程中获取的整个视场的带有灰度信息和空间信息的图像,包括灰度图像和深度图像。The lidar can be a flash lidar. The transmitting array at the transmitting end of the lidar emits a detection signal to illuminate the field of view. The detection signal is reflected by objects in the field of view and then returns to the echo signal. The pixel array at the receiving end receives the echo signal, and the lidar processes the echo. The signal gets an echo image, and the echo image is sent to the computer device. Each pixel in the receiving end of the lidar corresponds to a field of view of an angular range, and the echo signal reflected by the same object in the field of view can be received by multiple corresponding pixels. The echo image can be an image with grayscale information and spatial information of the entire field of view acquired by the lidar in the detection process, including grayscale images and depth images.
步骤304,判断回波图像是否存在串扰像素点。Step 304: Determine whether there are crosstalk pixels in the echo image.
判断是否存在串扰像素点的方法有多种。There are many ways to determine whether there is a crosstalk pixel.
其中可选的一种为,获取深度图像的第一边缘像素点。判断第一边缘像素点是否满足预设串扰条件。若满足预设串扰条件,确定第一边缘像素点为串扰像素点。The optional one is to obtain the first edge pixel of the depth image. Determine whether the first edge pixel meets the preset crosstalk condition. If the preset crosstalk condition is met, the first edge pixel is determined to be the crosstalk pixel.
其中可选的一种为,激光雷达的工作频率不同。比较不同工作频率下所有像素点的测距值。若不同,确定测距值不同的像素点为串扰像素点。One of the options is that the operating frequency of the lidar is different. Compare the ranging values of all pixels under different operating frequencies. If they are different, the pixels with different distance measurement values are determined to be crosstalk pixels.
对判断串扰像素点的方式不作限制,计算机设备可以单独采用一种判断串扰像素点的方式,也可以同时采用多种判断串扰像素点的方式。There is no restriction on the way of judging crosstalk pixels. The computer equipment can use one way of judging crosstalk pixels alone, or it can use multiple ways of judging crosstalk pixels at the same time.
步骤306,校正串扰像素点,得到校正后的回波图像。Step 306: Correct the crosstalk pixel points to obtain a corrected echo image.
若步骤304判断为有串扰像素点,则该串扰像素点接收的回波信号包括至少两个物体反射的回波信号。根据该串扰像素点接收到的回波信号解算得到的测距值,是错误的,无法真实反映探测到的物体的距离信息。因此,需要对判断为有串扰问题的像素串扰点进行校正,避免得到错误的探测信息。If it is determined in step 304 that there is a crosstalk pixel, the echo signal received by the crosstalk pixel includes echo signals reflected by at least two objects. The distance measurement value calculated according to the echo signal received by the crosstalk pixel is wrong and cannot truly reflect the distance information of the detected object. Therefore, it is necessary to correct the pixel crosstalk points that are judged to have crosstalk problems to avoid obtaining false detection information.
校正串扰像素点的方法有多种。其中可选的一种为,删除串扰像素点的信息。其中可选的一种为,将与像素串扰点相邻的备用像素点的信息,复制入像素串扰点。其中可选的一种为,将像素串扰点分割为多个子像素点,将子像素点相邻的像素点的信息复制入该子像素点。There are many ways to correct crosstalk pixels. One option is to delete crosstalk pixel information. One option is to copy the information of the spare pixel points adjacent to the pixel crosstalk point into the pixel crosstalk point. An optional one is to divide the pixel crosstalk point into a plurality of sub-pixel points, and copy the information of the pixels adjacent to the sub-pixel points into the sub-pixel points.
校正串扰像素点后得到校正后的回波图像,提高了回波图像的准确性。After correcting the crosstalk pixels, a corrected echo image is obtained, which improves the accuracy of the echo image.
步骤308,根据校正后的回波图像计算得到物体位姿信息。Step 308: Calculate the posture information of the object according to the corrected echo image.
校正后的回波图像,修正或者部分修正了串扰像素点的错误信息,提高了回波图像的准确性。以准确性高的回波图像为计算数据源,计算后得到的物体位姿信息也更准确。The corrected echo image has corrected or partially corrected the error information of the crosstalk pixels, which improves the accuracy of the echo image. Taking the highly accurate echo image as the calculation data source, the posture information of the object obtained after the calculation is also more accurate.
计算得到物体位姿信息的方法有多种。其中可选的一种为,连续波式非相干探测,探测信号被载波调制后出射,通过解算回波信号和探测信号之间的相位差,得到距离信息。其中可选的一种为,脉冲式非相干探测。ITOF型为脉冲积分测距,周期性地连续发射宽脉宽的探测信号,在不同积分时间窗内采集回波信号,通过比例关系求得飞行时间从而解算得到距离信息。DTOF型,周期性地连续发射窄脉宽、大峰值功率的探测信号,检测回波信号得到飞行时间,从而解算得到距离信息。其中可选的一种为,相干探测,回波信号和本机的参考信号在满足波前匹配的条件下,在接收端拍频或相干叠加并由接收端接收,根据接收到的相干信号解算得到距离信息。There are many ways to calculate the pose information of an object. One of the options is continuous-wave incoherent detection, where the detection signal is modulated by the carrier wave and then emitted, and the distance information is obtained by calculating the phase difference between the echo signal and the detection signal. One of the options is pulsed incoherent detection. The ITOF type is pulse integration ranging, which periodically continuously emits wide pulse width detection signals, collects echo signals in different integration time windows, and calculates the flight time through proportional relations to obtain distance information. DTOF type, periodically and continuously transmit a narrow pulse width, high peak power detection signal, detect the echo signal to get the flight time, and then calculate the distance information. The optional one is coherent detection. The echo signal and the local reference signal are beaten or coherently superimposed at the receiving end and received by the receiving end under the condition of wavefront matching. According to the received coherent signal, the Calculate the distance information.
步骤310,保持回波图像不变。Step 310: Keep the echo image unchanged.
若步骤304判断为无串扰像素点,则接收端的像素点接收到的回波信号均为准确的,不需要进一步校正。If it is determined in step 304 that there is no crosstalk pixel, the echo signals received by the pixel at the receiving end are all accurate, and no further correction is required.
步骤312,根据回波图像计算得到物体位姿信息。Step 312: Calculate the pose information of the object according to the echo image.
通过准确的回波信号,计算后得到的物体位姿信息。具体的计算物体位姿信息的方法,可参照步骤308。Through accurate echo signal, the posture information of the object obtained after calculation. For a specific method of calculating the pose information of an object, refer to step 308.
在本实施例中,计算机设备获取激光雷达接收的回波图像,接着判断回波图像是否存在串扰像素点,判断并识别像素点中存在像素间串扰的串扰像素点,串扰像素点接收到不同物体反射的回波信号,串扰像素点接收到的回波信号无法准确对应被测物体的距离信息,对激光雷达的测距准确性有较大影响。下一步,回波图像中存在串扰像素点时,校正串扰像素点,根据判断结果对像素串扰点进行校正,修正或者部分修正了串扰像素点的错误信息,有效减少像素串扰对回波图像准确性的影响,得到准确的回波图像。最后,根据校正后的回波图像 计算得到物体位姿信息,由于回波图像中不存在串扰像素点,用于计算的回波图像中的信息均为准确的,通过解算获得的物体位姿信息的准确性得到提高,提高了激光雷达探测的准确性和可靠性。In this embodiment, the computer device obtains the echo image received by the lidar, and then determines whether there are crosstalk pixels in the echo image, determines and recognizes the crosstalk pixels that have inter-pixel crosstalk among the pixels, and the crosstalk pixels receive different objects The reflected echo signal and the echo signal received by the crosstalk pixel point cannot accurately correspond to the distance information of the measured object, which has a greater impact on the accuracy of the lidar range. Next, when there are crosstalk pixels in the echo image, correct the crosstalk pixels, correct the pixel crosstalk points according to the judgment result, correct or partially correct the error information of the crosstalk pixels, and effectively reduce the effect of pixel crosstalk on the accuracy of the echo image The effect of this is to get an accurate echo image. Finally, the object pose information is calculated according to the corrected echo image. Since there are no crosstalk pixels in the echo image, the information in the echo image used for calculation is accurate. The object pose obtained by the calculation The accuracy of information has been improved, and the accuracy and reliability of lidar detection has been improved.
判断回波图像是否存在串扰像素点的方法有两种。There are two methods for judging whether there are crosstalk pixels in the echo image.
其中一种为,在其中一个实施例中,回波图像包括深度图像,如图4所示,步骤304:判断回波图像是否存在串扰像素点的步骤具体包括:One of them is that, in one of the embodiments, the echo image includes a depth image, as shown in FIG. 4, step 304: the step of determining whether there are crosstalk pixels in the echo image specifically includes:
步骤402,获取深度图像的第一边缘像素点。Step 402: Obtain the first edge pixel of the depth image.
获取深度图像的边缘像素点的方法有多种。其中可选的一种为,利用灰度图像提取物体的边缘特征,获取物体的第二边缘像素点。再根据灰度图像和深度图像的对应关系,将灰度图像的第二边缘像素点映射到深度图像中,深度图像中对应的像素点即为第一边缘像素点。其中可选的一种为,直接对深度图像采用边缘检测算子,得到深度图像的第一边缘像素点。深度图像不受发射端的探测信号的照射方向及待测物体的表面反射特性的影响,而且不存在阴影,能够更准确地表达物体的三维信息。对边缘像素点的检测也更准确,像素串扰往往发生在交错的不同距离的至少两个物体的边缘处,获取的第一边缘像素点中检测到像素串扰的概率高,并且直接从深度图像中获取第一边缘像素点,直接简单,减少运算难度,提高运算速度。There are many ways to obtain the edge pixels of the depth image. The optional one is to extract the edge feature of the object by using the gray image to obtain the second edge pixel of the object. Then, according to the corresponding relationship between the gray image and the depth image, the second edge pixel of the gray image is mapped to the depth image, and the corresponding pixel in the depth image is the first edge pixel. The optional one is to directly use an edge detection operator on the depth image to obtain the first edge pixel of the depth image. The depth image is not affected by the illumination direction of the detection signal at the transmitter and the surface reflection characteristics of the object to be measured, and there is no shadow, which can more accurately express the three-dimensional information of the object. The detection of edge pixels is also more accurate. Pixel crosstalk often occurs at the edges of at least two objects at different distances that are staggered. The probability of detecting pixel crosstalk in the first edge pixel points obtained is high, and it is directly from the depth image. Obtaining the first edge pixel points is straightforward and simple, reducing the difficulty of calculation and improving the speed of calculation.
回波图像中包括正常接收回波信号的像素点和发生串扰的像素点,由于像素串扰往往发生在多个物体的边缘,因此对边缘像素点进行判断,能够简化处理步骤,减少运算量,提高运算速度。The echo image includes pixels that normally receive echo signals and pixels that have crosstalk. Because pixel crosstalk often occurs on the edges of multiple objects, judging edge pixels can simplify processing steps, reduce the amount of calculation, and improve calculating speed.
步骤404,判断第一边缘像素点是否满足预设串扰条件。Step 404: Determine whether the first edge pixel meets a preset crosstalk condition.
根据上一步获得的第一边缘像素点进行像素串扰的判断。因为深度图像中的第一边缘像素点不全都有像素串扰的问题,第一边缘像素点仅探测到一个物体的边缘时,没有像素串扰问题。如图2所示,像素点1探测到的是物体A的边缘,但该点没有像素串扰。需要逐一对获取到的第一边缘像素点进行判断,以确认是否为像素串扰点。The pixel crosstalk is judged according to the first edge pixel point obtained in the previous step. Because not all the first edge pixels in the depth image have the problem of pixel crosstalk, when the first edge pixel only detects the edge of an object, there is no pixel crosstalk problem. As shown in Figure 2, pixel point 1 detects the edge of object A, but there is no pixel crosstalk at this point. The first edge pixel points obtained need to be judged one by one to confirm whether they are pixel crosstalk points.
具体的,判断第一边缘像素点是否满足预设串扰条件的步骤中还包括:获取第一边缘像素点的边缘测距值和梯度方向;获取第一边缘像素点与梯度方向相同一侧的所有周围像素点的第一平均测距值;获取第一边缘像素点与梯度方向的相反一侧的所有周围像素点的第二平均测距值;当边缘测距值与第一平均测距值的差值的绝对值大于预设距离阈值以及当边缘测距值与第二平均测距值的差值的绝对值大于预设距离阈值时,则第一边缘像素点满足预设串扰条件。Specifically, the step of judging whether the first edge pixel meets the preset crosstalk condition further includes: obtaining the edge ranging value and the gradient direction of the first edge pixel; obtaining all the first edge pixels on the same side as the gradient direction The first average ranging value of surrounding pixels; obtain the second average ranging value of all surrounding pixels on the opposite side of the first edge pixel to the gradient direction; when the edge ranging value is equal to the first average ranging value When the absolute value of the difference is greater than the preset distance threshold, and when the absolute value of the difference between the edge ranging value and the second average ranging value is greater than the preset distance threshold, the first edge pixel meets the preset crosstalk condition.
其中,周围像素点包括与第一边缘像素点相邻的像素点。梯度方向相同一侧的周围像素点的第一测距平均值,与第一边缘像素点的边缘测距值,两者数值相近,说明边缘测距值相较于正确的第一测距平均值没有较大偏差,第一边缘像素点和梯度方向相同一侧的周围像素点探测到的是同一个物体。因此该第一边缘像素点未发生像素串扰,其边缘测距值是正确和可靠的。Wherein, the surrounding pixels include pixels adjacent to the first edge pixel. The first ranging average value of surrounding pixels on the same side of the gradient direction is the edge ranging value of the first edge pixel. The two values are similar, indicating that the edge ranging value is compared to the correct first ranging average There is no large deviation, the first edge pixel and the surrounding pixels on the same side of the gradient direction detect the same object. Therefore, no pixel crosstalk occurs at the first edge pixel point, and its edge ranging value is correct and reliable.
同理,梯度方向相反一侧的周围像素点的第二测距平均值,与第一边缘像素点的边缘测距值,两者数值相近,则第一边缘像素点和梯度方向相反一侧的周围像素点探测到的是同一个物体,第一边缘像素点未发生像素串扰。Similarly, the second ranging average value of surrounding pixels on the opposite side of the gradient direction is equal to the edge ranging value of the first edge pixel. If the two values are similar, then the first edge pixel and the opposite side of the gradient direction The surrounding pixels detect the same object, and no pixel crosstalk occurs at the first edge pixel.
当边缘测距值与第一测距平均值、第二测距平均值均相差较大时,例如大于预设距离阈值,则该第一边缘像素点为串扰像素点。When the edge ranging value is significantly different from the first ranging average value and the second ranging average value, for example, greater than the preset distance threshold, the first edge pixel point is a crosstalk pixel point.
步骤406,当第一边缘像素点满足预设串扰条件时,将第一边缘像素点确定为回波图像的串扰像素点。Step 406: When the first edge pixel meets the preset crosstalk condition, the first edge pixel is determined as the crosstalk pixel of the echo image.
如前述,逐一对获取到的第一边缘像素点进行判断,当第一边缘像素点的边缘测距值与第一测距平均值、第二测距平均值相差较大,大于预设距离阈值时,则第一边缘像素点为串扰像素点。As mentioned above, the first edge pixel points obtained are judged one by one, when the edge distance value of the first edge pixel point is greatly different from the first and second distance average values, which is greater than the preset distance threshold. When, the first edge pixel is a crosstalk pixel.
步骤408,当第一边缘像素点不满足预设串扰条件时,第一边缘像素点不为回波图像的串扰像素点。Step 408: When the first edge pixel does not meet the preset crosstalk condition, the first edge pixel is not a crosstalk pixel of the echo image.
在本实施例中,计算机设备获取深度图像的第一边缘像素点,逐一对第一边缘像素点进行判断是否满足预设串扰条件,若满足预设串扰条件则确认第一边缘像素点为串扰像素点。由于深度图像不受发射端的探测信号的照射方向及待测物体的表面反射特性的影响,而且不存在阴影,能够更准确地表达物体的三维信息;对边缘像素点的检测也更准确,像素串扰往往发生在交错的不同距离的至少两个物体的边缘处,获取的第一边缘像素点中检测到像素串扰的概率高,提高计算机设备处理效率;并且直接从深度图像中获取第一边缘像素点,直接简单,减少运算难度,提高运算速度。In this embodiment, the computer device obtains the first edge pixel of the depth image, and determines whether the first edge pixel meets the preset crosstalk condition one by one. If the preset crosstalk condition is satisfied, the first edge pixel is confirmed to be a crosstalk pixel point. Since the depth image is not affected by the radiation direction of the detection signal at the transmitter and the surface reflection characteristics of the object to be measured, and there is no shadow, it can more accurately express the three-dimensional information of the object; the detection of edge pixels is also more accurate, and pixel crosstalk It often occurs at the edges of at least two objects at different distances that are staggered, and the probability of detecting pixel crosstalk in the acquired first edge pixels is high, which improves the processing efficiency of computer equipment; and directly obtains the first edge pixels from the depth image , Direct and simple, reduce the difficulty of calculation and increase the speed of calculation.
在其中一个实施例中,如图5所示,步骤402:获取深度图像的第一边缘像素点,可以根据灰度图像和深度图像的对应关系获得,先从灰度图像中获取第二边缘像素点,再映射到深度图像中找到对应像素点,该步骤具体包括:In one of the embodiments, as shown in FIG. 5, step 402: Obtain the first edge pixel of the depth image, which can be obtained according to the corresponding relationship between the gray image and the depth image, first obtain the second edge pixel from the gray image Point, and then map to the depth image to find the corresponding pixel point. This step specifically includes:
步骤502,获取灰度图像的第二边缘像素点。Step 502: Obtain second edge pixels of the grayscale image.
计算机设备标识灰度图像中亮度变化明显的像素点,图像属性中的显著变化通常反映了属性的重要事件和变化,这些变化可以包括(a)深度上的不连续、(b)表面方向的不连续、 (c)物质属性的变化以及(d)场景照明的变化。Computer equipment identifies pixels with obvious brightness changes in grayscale images. Significant changes in image attributes usually reflect important events and changes in attributes. These changes can include (a) discontinuities in depth and (b) discontinuities in surface orientation. Continuous, (c) changes in material properties and (d) changes in scene lighting.
边缘检测的算子可以包括Sobel算子、Laplacian算子、Canny算子等。由于深度图像与灰度图像的边缘特征具有一致性,计算机设备可以根据第二边缘像素点在回波图像的深度图像中查找对应像素点,从而将对应像素点作为深度图像的第一边缘像素点。Operators for edge detection can include Sobel operators, Laplacian operators, Canny operators, and so on. Since the edge characteristics of the depth image and the gray image are consistent, the computer device can find the corresponding pixel in the depth image of the echo image according to the second edge pixel, and then use the corresponding pixel as the first edge pixel of the depth image .
示例性地,以采用Sobel算子进行边缘检测来进行说明。Sobel算子包含两组3×3的矩阵T 1和T 2,分别对应灰度图像的横向和纵向。将Sobel算子与灰度图像做平面卷积,以此得出灰度图像中横向和纵向的亮度差分近似值。Sobel算子的两组矩阵为: Illustratively, the Sobel operator is used for edge detection for description. The Sobel operator contains two sets of 3×3 matrices T 1 and T 2 , corresponding to the horizontal and vertical directions of the grayscale image, respectively. The Sobel operator and the gray-scale image are convolved in a plane to obtain the approximate value of the horizontal and vertical brightness difference in the gray-scale image. The two sets of matrices of Sobel operator are:
Figure PCTCN2019124280-appb-000001
Figure PCTCN2019124280-appb-000001
如果以A代表初始灰度图像,G X和G Y分别代表横向和纵向图像的灰度值,G X和G Y的计算公式如下: If A represents the initial gray image, G X and G Y represent the gray values of the horizontal and vertical images, respectively, and the calculation formulas of G X and G Y are as follows:
Figure PCTCN2019124280-appb-000002
Figure PCTCN2019124280-appb-000002
Figure PCTCN2019124280-appb-000003
Figure PCTCN2019124280-appb-000003
灰度图像中单个像素点的梯度幅值的计算公式可以如下所示:The calculation formula for the gradient amplitude of a single pixel in a grayscale image can be as follows:
Figure PCTCN2019124280-appb-000004
Figure PCTCN2019124280-appb-000004
计算机设备将灰度图像中每个像素点的梯度幅值与预设梯度阈值进行比较;当某一个像素点的梯度幅值大于预设梯度阈值时,该像素点即为第二边缘像素点。该第二边缘像素点用P 0(X 0,Y 0)来表示,第二边缘像素点的梯度方向为: The computer device compares the gradient magnitude of each pixel in the grayscale image with a preset gradient threshold; when the gradient magnitude of a certain pixel is greater than the preset gradient threshold, the pixel is the second edge pixel. The second edge pixel is represented by P 0 (X 0 ,Y 0 ), and the gradient direction of the second edge pixel is:
Figure PCTCN2019124280-appb-000005
Figure PCTCN2019124280-appb-000005
灰度图像包括深度信息和表面信息,包含的不连续信息更多,漏检边缘像素点的情况较少。同时,灰度图像进行边缘检测的算子已经过验证,运算结果可靠性好。Gray-scale images include depth information and surface information, and contain more discontinuous information, and there are fewer cases of missing edge pixels. At the same time, the operator for edge detection of grayscale images has been verified, and the calculation results are reliable.
步骤504,在深度图像中查找第二边缘像素点的对应像素点。Step 504: Find a pixel point corresponding to the second edge pixel point in the depth image.
激光雷达探测后得到的回波图像中包含灰度图像和深度图像,因此灰度图像的像素点和深度图像的像素点是有对应关系的。获取灰度图像和深度图像的对应关系的方法可以有多种。The echo image obtained after lidar detection contains grayscale image and depth image, so the pixels of the grayscale image and the pixels of the depth image have a corresponding relationship. There may be multiple methods for obtaining the corresponding relationship between the grayscale image and the depth image.
其中可选的一种为,提取灰度图像和深度图像中物体的特征点,如路沿的直线或转角、路灯灯柱的端点等,将灰度图像和深度图像中对应物体的特征点对齐,得到灰度图像和深度 图像的映射。这种确定对应关系的方法,仅需要匹配特征点即可,运算量小,运算速度高。One option is to extract the feature points of the object in the grayscale image and the depth image, such as the straight line or corner of the roadside, the end point of the lamppost, etc., and align the feature points of the corresponding object in the grayscale image and the depth image , Get the mapping of gray image and depth image. This method of determining the corresponding relationship only needs to match the feature points, and the calculation amount is small, and the calculation speed is high.
其中可选的一种为,提取灰度图像和深度图像中物体的特征,如物体的边框等,将灰度图像和深度图像中对应物体的边框内的所有像素点对齐,得到灰度图像和深度图像的映射。这种确定对应关系的方法,匹配物体边框内的所有像素点,运算准确率高。One option is to extract the features of the object in the gray image and the depth image, such as the border of the object, and align all the pixels in the border of the corresponding object in the gray image and the depth image to obtain the gray image and Depth image mapping. This method of determining the corresponding relationship matches all the pixels in the object frame, and the calculation accuracy is high.
其中可选的一种为,由于灰度图像和深度图像均通过同一个激光雷达获得,因此灰度图像和深度图像的每个像素点均包含时间信息,将时间信息相同的像素点对齐,即可得到灰度图像和深度图像的映射。这种确定对应关系的方法,充分运用激光雷达获得的图像之间的时间对应关系,利用现有数据,简化运算过程,运算准确率高。The optional one is that since both the grayscale image and the depth image are obtained by the same lidar, each pixel of the grayscale image and the depth image contains time information, and the pixels with the same time information are aligned, that is, The mapping of grayscale image and depth image can be obtained. This method of determining the correspondence relationship makes full use of the time correspondence relationship between the images obtained by the lidar, utilizes the existing data, simplifies the calculation process, and has a high calculation accuracy.
根据获取的深度图像和灰度图像的映射,将灰度图像中的第二边缘像素点映射到深度图像中,得到对应像素点。According to the acquired mapping of the depth image and the gray image, the second edge pixel in the gray image is mapped to the depth image to obtain the corresponding pixel.
步骤506,将对应像素点确定为深度图像的第一边缘像素点。Step 506: Determine the corresponding pixel as the first edge pixel of the depth image.
由于灰度图像和深度图像是对同一个视场进行探测得到的,灰度图像和深度图像的内容具有一致性。因此,第二边缘像素点映射得到的对应像素点,可以确定为深度图像的第一边缘像素点。Since the grayscale image and the depth image are detected from the same field of view, the content of the grayscale image and the depth image are consistent. Therefore, the corresponding pixel point obtained by the second edge pixel point mapping can be determined as the first edge pixel point of the depth image.
在本实施例中,计算机设备利用灰度图像提取物体的边缘特征,获取物体的第二边缘像素点,再根据灰度图像和深度图像的对应关系,将灰度图像的第二边缘像素点映射到深度图像中,深度图像中对应的像素点即为第一边缘像素点。由于灰度图像包括深度信息和表面信息,例如图像属性信息、物体深度信息、物体表面信息以及场景照明信息等,包含的不连续信息更全面,能够降低边缘像素点的漏检率。且灰度图像进行边缘检测的算子已经过验证,运算结果可靠性好,提高了边缘像素检测的准确性。In this embodiment, the computer device uses the gray image to extract the edge feature of the object, obtain the second edge pixel of the object, and then map the second edge pixel of the gray image according to the corresponding relationship between the gray image and the depth image In the depth image, the corresponding pixel in the depth image is the first edge pixel. Because grayscale images include depth information and surface information, such as image attribute information, object depth information, object surface information, and scene lighting information, the discontinuous information contained is more comprehensive, which can reduce the missed detection rate of edge pixels. In addition, the operator for edge detection of grayscale images has been verified, and the reliability of the calculation results is good, which improves the accuracy of edge pixel detection.
在其中一个实施例中,如图6所示,步骤404:判断第一边缘像素点是否满足预设串扰条件的步骤具体包括:In one of the embodiments, as shown in FIG. 6, step 404: the step of judging whether the first edge pixel meets the preset crosstalk condition specifically includes:
步骤602,获取第一边缘像素点的边缘测距值和梯度方向。Step 602: Obtain the edge ranging value and the gradient direction of the first edge pixel.
由前述实施例可知,可以通过公式(5)计算得到第二边缘像素点的梯度方向,第二边缘像素点和第一边缘像素点有对应关系,梯度方向即为第一边缘像素点的梯度方向。It can be seen from the foregoing embodiment that the gradient direction of the second edge pixel can be calculated by formula (5), the second edge pixel has a corresponding relationship with the first edge pixel, and the gradient direction is the gradient direction of the first edge pixel. .
或者,也可以直接对深度图像采用边缘检测算子,得到深度图像中深度差分,以此得到深度图像中第一边缘像素点的梯度方向。具体方法可参考灰度图像获得第二边缘像素点的梯度方向的方法。Alternatively, it is also possible to directly use an edge detection operator on the depth image to obtain the depth difference in the depth image, thereby obtaining the gradient direction of the first edge pixel in the depth image. The specific method can refer to the method of obtaining the gradient direction of the second edge pixel point by the gray image.
测距值为物体位姿信息中的一种,因此获取第一边缘像素点的边缘测距值的方法,可以参考前述实施例中计算得到物体位姿信息的多种方法,此处不再赘述。The ranging value is one of the object pose information, so the method of obtaining the edge ranging value of the first edge pixel point can refer to the multiple methods of calculating the object pose information in the foregoing embodiment, which will not be repeated here. .
步骤604,获取第一边缘像素点与梯度方向相同一侧的所有周围像素点的第一平均测距值。Step 604: Obtain a first average ranging value of all surrounding pixels on the same side of the first edge pixel and the gradient direction.
步骤606,获取第一边缘像素点与梯度方向的相反一侧的所有周围像素点的第二平均测距值。Step 606: Obtain a second average ranging value of all surrounding pixels on the opposite side of the first edge pixel to the gradient direction.
垂直于第一边缘像素点的梯度方向设置穿过第一边缘像素点的分割线,分别对分割线两侧的周围像素点求得平均测距值,再与第一边缘像素点的边缘测距值比较。与梯度方向相同一侧的所有周围像素点的平均测距值为第一平均测距值。按前述实施例中计算物体位姿信息的多种方法,求得每个周围像素点的测距值,对所有周围像素点的测距值求平均值即得到第一平均测距值。周围像素点包括与第一边缘像素点相邻的像素点。同理,与梯度方向相反一侧的所有周围像素点的平均测距值为第二平均测距值,计算方法可以与第一平均测距值相同。Set the dividing line that passes through the first edge pixel in the gradient direction perpendicular to the first edge pixel, and calculate the average distance value of the surrounding pixels on both sides of the dividing line, and then measure the distance with the edge of the first edge pixel. Value comparison. The average ranging value of all surrounding pixels on the same side as the gradient direction is the first average ranging value. According to the various methods of calculating the pose information of the object in the foregoing embodiment, the distance measurement value of each surrounding pixel is obtained, and the first average distance measurement value is obtained by averaging the distance measurement values of all surrounding pixels. The surrounding pixels include pixels adjacent to the first edge pixel. Similarly, the average ranging value of all surrounding pixels on the side opposite to the gradient direction is the second average ranging value, and the calculation method can be the same as the first average ranging value.
步骤608,当边缘测距值与第一平均测距值的差值的绝对值大于预设距离阈值以及当边缘测距值与第二平均测距值的差值的绝对值大于预设距离阈值时,则第一边缘像素点满足预设串扰条件。Step 608: When the absolute value of the difference between the edge ranging value and the first average ranging value is greater than the preset distance threshold, and when the absolute value of the difference between the edge ranging value and the second average ranging value is greater than the preset distance threshold When, the first edge pixel meets the preset crosstalk condition.
梯度方向相同一侧的周围像素点的第一测距平均值,与第一边缘像素点的边缘测距值,两者数值相近,说明边缘测距值相较于正确的第一测距平均值没有较大偏差,第一边缘像素点和梯度方向相同一侧的周围像素点探测到的是同一个物体。因此该第一边缘像素点未发生像素串扰,其边缘测距值是正确和可靠的。The first ranging average value of surrounding pixels on the same side of the gradient direction is the edge ranging value of the first edge pixel. The two values are similar, indicating that the edge ranging value is compared to the correct first ranging average There is no large deviation, the first edge pixel and the surrounding pixels on the same side of the gradient direction detect the same object. Therefore, no pixel crosstalk occurs at the first edge pixel point, and its edge ranging value is correct and reliable.
同理,梯度方向相反一侧的周围像素点的第二测距平均值,与第一边缘像素点的边缘测距值,两者数值相近,则第一边缘像素点和梯度方向相反一侧的周围像素点探测到的是同一个物体,第一边缘像素点未发生像素串扰。Similarly, the second ranging average value of surrounding pixels on the opposite side of the gradient direction is equal to the edge ranging value of the first edge pixel. If the two values are similar, then the first edge pixel and the opposite side of the gradient direction The surrounding pixels detect the same object, and no pixel crosstalk occurs at the first edge pixel.
预设距离阈值的确定,与激光雷达的测距精度有关,测距精度越高,预设距离阈值越小;还与激光雷达的测距距离有关,测距距离越远,预设距离阈值越大。The determination of the preset distance threshold is related to the distance measurement accuracy of the lidar. The higher the distance measurement accuracy, the smaller the preset distance threshold; it is also related to the distance measurement distance of the lidar. The longer the distance measurement, the higher the preset distance threshold. Big.
由于周围像素点为与第一边缘像素点相邻的像素点;若第一边缘像素点没有像素串扰,则第一边缘像素点的梯度方向相同一侧和/或相反的一侧的周围像素点,与第一边缘像素点探测到的是同一个物体,即得到的测距值应当相等。考虑到误差和损耗,对第一边缘像素点的梯度方向相同一侧和/或相反一侧的周围像素点的测距值取平均值。当边缘测距值与第一测距平均值、第二测距平均值均相差较大时,例如大于预设距离阈值,说明第一边缘像素点与梯度方向相同一侧和相反一侧的周围像素点探测到的物体均不同,该第一边缘像素点为串扰像素点。Because the surrounding pixels are pixels adjacent to the first edge pixel; if the first edge pixel has no pixel crosstalk, the first edge pixel has the same side and/or the opposite side of the gradient direction. , It is the same object detected by the first edge pixel, that is, the distance measurement value obtained should be equal. Taking into account the error and loss, the distance measurement values of the surrounding pixels on the same side and/or the opposite side of the gradient direction of the first edge pixel are averaged. When the edge ranging value is significantly different from the first ranging average value and the second ranging average value, for example, greater than the preset distance threshold, it indicates that the first edge pixel point is around the same side and the opposite side of the gradient direction The objects detected by the pixels are all different, and the first edge pixel is a crosstalk pixel.
垂直于第一边缘像素点梯度方向的分割线,除了第一边缘像素点,分割线还穿过其他像素点。分割线两侧的深度图像的信息连续性发生了变化,因此分割线上的像素点均为发生变 化的边缘像素点,可以进一步对分割线上的像素点依次进行是否满足预设串扰条件的判断,以此提高串扰像素点的检出率,减少漏检,提高激光雷达的探测准确率;具体判断方法可参照前述方法。若第一边缘像素点满足预设串扰条件,则分割线上的像素点也满足预设串扰条件的可能性较大。The dividing line perpendicular to the gradient direction of the first edge pixel point, in addition to the first edge pixel point, the dividing line also passes through other pixel points. The information continuity of the depth image on both sides of the dividing line has changed, so the pixels on the dividing line are all edge pixels that have changed, and the pixels on the dividing line can be further judged whether they meet the preset crosstalk conditions. In order to improve the detection rate of crosstalk pixels, reduce missed detection, and improve the detection accuracy of lidar; the specific judgment method can refer to the aforementioned method. If the first edge pixel meets the preset crosstalk condition, it is more likely that the pixel points on the dividing line also meet the preset crosstalk condition.
示例性的,以第一边缘像素点及其所有相邻像素点构成的3×3像素阵列的深度图像为例进行说明。如图7所示,P点为第一边缘像素点,P点上的箭头方向为第一边缘像素点的梯度方向。P点的所有周围像素点依次标识为1、2、3、4、6、7、8、9。Illustratively, a depth image of a 3×3 pixel array formed by the first edge pixel point and all adjacent pixels is taken as an example for description. As shown in FIG. 7, point P is the first edge pixel, and the arrow direction on the P point is the gradient direction of the first edge pixel. All surrounding pixels of point P are sequentially identified as 1, 2, 3, 4, 6, 7, 8, 9.
垂直于P点的梯度方向设置穿过P点的分割线,分割线穿过3点、P点和7点,分割线两侧的深度图像的信息连续性发生了变化。与P点梯度方向相同的周围像素点为1、2、4,与P点梯度方向相反的周围像素点为6、8、9。计算机设备分别计算获得像素点1、2、4的测距值为R 1、R 2和R 4;计算像素点1、2、4的测距值的平均值,得到第一平均测距值(R 1+R 2+R 4)/3。计算机设备分别计算获得像素点6、8、9的测距值为R 6、R 8和R 9,计算像素点6、8、9的测距值的平均值,得到第二平均测距值(R 6+R 8+R 9)/3。同时,计算机设备计算获得P点的测距值为R PThe dividing line passing through the P point is set perpendicular to the gradient direction of the P point, and the dividing line passes through 3 points, P points and 7 points, and the information continuity of the depth image on both sides of the dividing line has changed. The surrounding pixels with the same gradient direction as the P point are 1, 2, and 4, and the surrounding pixels with the opposite gradient direction of the P point are 6, 8, and 9. The computer equipment calculates and obtains the distance measurement values of pixels 1 , 2, and 4 respectively as R 1, R 2 and R 4; calculates the average value of the distance measurement values of the pixels 1, 2, 4 to obtain the first average distance measurement value ( R 1 +R 2 +R 4 )/3. The computer equipment calculates and obtains the distance measurement values of pixels 6 , 8, and 9 respectively as R 6, R 8 and R 9, calculates the average value of the distance measurement values of pixels 6, 8, and 9 to obtain the second average distance measurement value ( R 6 +R 8 +R 9 )/3. At the same time, the computer equipment calculates and obtains the distance measurement value of point P as R P.
为了获得P点测距值和第一平均测距值的差值D 1,将P点测距值和第一平均测距值作差并取绝对值,计算式为: In order to obtain the difference value D 1 between the distance measurement value at point P and the first average distance measurement value, the difference between the distance measurement value at point P and the first average distance measurement value and take the absolute value, the calculation formula is:
D 1=|R P-(R 1+R 2+R 4)/3|        (6) D 1 =|R P -(R 1 +R 2 +R 4 )/3| (6)
同理,P点测距值和第二平均测距值的差值D 2,计算式为: In the same way, the difference D 2 between the distance measurement value at point P and the second average distance measurement value is calculated as:
D 2=|R P-(R 6+R 8+R 9)/3|       (7) D 2 =|R P -(R 6 +R 8 +R 9 )/3| (7)
当D 1<e(预设距离阈值)时,认为P点与像素点1、2、4在同一物体表面,不存在像素串扰;当D 2<e时,认为P点与像素点6、8、9在同一物体表面,不存在像素串扰;当D 1>e且D 2>e时,P点满足预设串扰条件,认为P点既不与像素点1、2、4在同一物体表面,又不与像素点6、8、9在同一物体表面,P点存在像素串扰。 When D 1 <e (preset distance threshold), it is considered that P point and pixel points 1, 2, 4 are on the same surface, and there is no pixel crosstalk; when D 2 <e, it is considered that P point and pixel points 6, 8 , 9 is on the same object surface, and there is no pixel crosstalk; when D 1 > e and D 2 > e, point P meets the preset crosstalk condition, and it is considered that point P is neither on the same surface of the object as pixels 1, 2, and 4, And it is not on the same surface of the object as pixels 6, 8, and 9, and there is pixel crosstalk at point P.
同样的,分割线还穿过像素点3和7,当P点满足预设串扰条件时,像素点3和7有较大可能也存在像素串扰的问题。因此,采用上述方法,分别对像素点3和7进行判断是否满足预设串扰条件。Similarly, the dividing line also passes through the pixel points 3 and 7. When the P point meets the preset crosstalk condition, the pixel points 3 and 7 may also have the problem of pixel crosstalk. Therefore, the above method is adopted to determine whether the pixel points 3 and 7 meet the preset crosstalk conditions.
示例性的,以第一边缘像素点及其所有相邻像素点构成的3×3像素阵列的深度图像为例进行说明。如图8所示,P点为第一边缘像素点,P点上的箭头方向为第一边缘像素点的梯度方向。P点的所有周围像素点依次标识为1、2、3、4、6、7、8、9。Illustratively, a depth image of a 3×3 pixel array formed by the first edge pixel point and all adjacent pixels is taken as an example for description. As shown in FIG. 8, point P is the first edge pixel, and the arrow direction on the P point is the gradient direction of the first edge pixel. All surrounding pixels of point P are sequentially identified as 1, 2, 3, 4, 6, 7, 8, 9.
垂直于P点的梯度方向设置穿过P点的分割线,分割线穿过2点、P点和8点,分割线 两侧的深度图像的信息连续性发生了变化。与P点梯度方向相同的周围像素点为1、4、7,与P点梯度方向相反的周围像素点为3、6、9。计算机设备分别计算获得像素点1、4、7的测距值为R 1、R 4和R 7;计算像素点1、2、4的测距值的平均值,得到第一平均测距值(R 1+R 4+R 7)/3。计算机设备分别计算获得像素点3、6、9的测距值为R 3、R 6和R 9,计算像素点3、6、9的测距值的平均值,得到第二平均测距值(R 3+R 6+R 9)/3。同时,计算机设备计算获得P点的测距值为R PThe dividing line passing through the P point is set perpendicular to the gradient direction of the P point. The dividing line passes through the 2 points, P points and 8 points, and the information continuity of the depth image on both sides of the dividing line has changed. The surrounding pixels with the same gradient direction as the P point are 1, 4, and 7, and the surrounding pixels with the opposite gradient direction of the P point are 3, 6, and 9. The computer equipment calculates and obtains the distance measurement values of pixels 1 , 4, and 7 respectively as R 1, R 4 and R 7; calculates the average value of the distance measurement values of pixels 1, 2, and 4 to obtain the first average distance measurement value ( R 1 +R 4 +R 7 )/3. The computer equipment calculates and obtains the distance measurement values of pixels 3 , 6, and 9 respectively as R 3, R 6 and R 9, calculates the average value of the distance measurement values of pixels 3, 6, and 9 to obtain the second average distance measurement value ( R 3 +R 6 +R 9 )/3. At the same time, the computer equipment calculates and obtains the distance measurement value of point P as R P.
P点测距值和第一平均测距值的差值D 1=|R P-(R 1+R 4+R 7)/3|,P点测距值和第二平均测距值的差值D 2=|R P-(R 3+R 6+R 9)/3|。 The difference between the P-point ranging value and the first average ranging value D 1 = |R P -(R 1 +R 4 +R 7 )/3|, the difference between the P-point ranging value and the second average ranging value Value D 2 = |R P -(R 3 +R 6 +R 9 )/3|.
当D 1<e(预设距离阈值)时,认为P点与像素点1、4、7在同一物体表面,不存在像素串扰;当D 2<e时,认为P点与像素点3、6、9在同一物体表面,不存在像素串扰;当D 1>e且D 2>e时,P点满足预设串扰条件,认为P点既不与像素点1、4、7在同一物体表面,又不与像素点3、6、9在同一物体表面,P点存在像素串扰。 When D 1 <e (preset distance threshold), point P is considered to be on the same surface as pixels 1, 4, and 7 and there is no pixel crosstalk; when D 2 <e, point P is considered to be the same as pixel points 3, 6 , 9 is on the same object surface, there is no pixel crosstalk; when D 1 > e and D 2 > e, point P meets the preset crosstalk condition, and it is considered that point P is neither on the same surface of the object as pixels 1, 4, and 7, And it is not on the same surface of the object as pixels 3, 6, and 9, and pixel crosstalk exists at point P.
在本实施例中,计算机设备通过获取第一边缘像素点的边缘测距值和梯度方向,垂直于P点的梯度方向设置穿过P点的分割线,分割线两侧的深度图像的信息连续性发生了变化,分割线穿过的像素点有较有可能位于两个物体的交界处,存在像素串扰的可能性大。计算机设备通过获取第一边缘像素点梯度方向相同一侧的所有周围像素点的第一平均测距值以及梯度方向相反一侧的所有周围像素点的第二平均测距值,再获取边缘测距值与第一平均测距值的差值、边缘测距值与第二平均测距值的差值。由于周围像素点为与第一边缘像素点相邻的像素点;若第一边缘像素点没有像素串扰,则第一边缘像素点的梯度方向相同一侧和/或相反的一侧的周围像素点,与第一边缘像素点探测到的是同一个物体,即得到的测距值应当相近。当边缘测距值与第一测距平均值、第二测距平均值均相差较大时,例如大于预设距离阈值,说明第一边缘像素点与梯度方向相同一侧和相反一侧的周围像素点探测到的物体均不同,该第一边缘像素点为串扰像素点。通过这种方式,对可能存在像素串扰的第一边缘像素点逐一进行判断,提高了串扰像素点的识别准确性;并且也可以通过调整预设距离阈值来调整判断精度,以满足不同系统精度和测距距离的激光雷达的应用,通用性好。In this embodiment, the computer device obtains the edge ranging value and the gradient direction of the first edge pixel point, and sets the dividing line passing through the P point perpendicular to the gradient direction of the P point, and the depth image information on both sides of the dividing line is continuous The performance has changed. The pixels that the dividing line crosses are more likely to be located at the junction of two objects, and the possibility of pixel crosstalk is high. The computer device obtains the edge ranging value by obtaining the first average ranging value of all surrounding pixels on the same side of the gradient direction of the first edge pixel and the second average ranging value of all surrounding pixels on the opposite side of the gradient direction. The difference between the value and the first average ranging value, and the difference between the edge ranging value and the second average ranging value. Because the surrounding pixels are the pixels adjacent to the first edge pixel; if the first edge pixel has no pixel crosstalk, the surrounding pixels on the same side and/or opposite side of the gradient direction of the first edge pixel , It is the same object detected by the first edge pixel, that is, the obtained distance measurement value should be similar. When the edge ranging value is significantly different from the first ranging average value and the second ranging average value, for example, greater than the preset distance threshold, it indicates that the first edge pixel point is around the same side and the opposite side of the gradient direction The objects detected by the pixels are all different, and the first edge pixel is a crosstalk pixel. In this way, the first edge pixels that may have pixel crosstalk are judged one by one, which improves the recognition accuracy of crosstalk pixels; and the judgment accuracy can also be adjusted by adjusting the preset distance threshold to meet the accuracy of different systems. The application of lidar for measuring distance has good versatility.
判断回波图像是否存在串扰像素点的另一种方法为,在其中一个实施例中,激光雷达的工作频率包括至少两种不同的调制频率,如图9所示,步骤204:判断回波图像是否存在串扰像素点的步骤具体包括以下步骤:Another method to determine whether there are crosstalk pixels in the echo image is that, in one of the embodiments, the operating frequency of the lidar includes at least two different modulation frequencies, as shown in FIG. 9, step 204: determine the echo image The steps of whether there are crosstalk pixels specifically include the following steps:
步骤902,当激光雷达的工作频率为第一调制频率时,获取回波图像中每个像素点的第 一测距值。Step 902: When the operating frequency of the lidar is the first modulation frequency, obtain the first ranging value of each pixel in the echo image.
步骤904,当激光雷达的工作频率为第二调制频率时,获取回波图像中每个像素点的第二测距值。Step 904: When the operating frequency of the lidar is the second modulation frequency, obtain the second ranging value of each pixel in the echo image.
步骤906,将每个像素点的第一测距值和第二测距值作差,得到测距差值。In step 906, the first distance measurement value and the second distance measurement value of each pixel are calculated to obtain a distance measurement difference value.
步骤908,当测距差值不为零时,则测距差值不为零的像素点为回波图像的串扰像素点。In step 908, when the distance measurement difference is not zero, the pixel points whose distance measurement difference is not zero are the crosstalk pixels of the echo image.
步骤910,当测距差值为零时,则测距差值为零的像素点不为回波图像的串扰像素点。Step 910: When the distance measurement difference is zero, the pixel with the distance measurement difference of zero is not a crosstalk pixel of the echo image.
如前述,计算得到物体位姿信息的方法有多种。采用连续波式非相干探测时,探测信号被载波调制后出射,通过解算回波信号和探测信号之间的相位差得到距离信息。其计算方法可以如下所示:As mentioned above, there are many ways to calculate the pose information of an object. When using continuous wave incoherent detection, the detection signal is modulated by the carrier wave and then emitted, and the distance information is obtained by calculating the phase difference between the echo signal and the detection signal. The calculation method can be as follows:
如图10所示,激光雷达发射的探测信号表示为:As shown in Figure 10, the detection signal emitted by the lidar is expressed as:
s(t)=a 1+a 2cos(2πft)        (8) s(t)=a 1 +a 2 cos(2πft) (8)
激光雷达接收的回波信号表示为:The echo signal received by the lidar is expressed as:
r(t)=A cos(2πft-2πfτ)+B       (9)r(t)=A cos(2πft-2πfτ)+B (9)
其中,a 1表示探测信号的偏置量,a 2表示探测信号的调制幅值,f表示探测信号的调制频率;A表示回波信号的振幅,B表示回波信号由于背景光照而产生的偏置量,背景光照可以是发射器本身以外的光照,τ表示飞行时间,即探测信号和回波信号之间的时间差,φ=2πfτ表示对应的相位偏移量。 Among them, a 1 represents the offset of the detection signal, a 2 represents the modulation amplitude of the detection signal, f represents the modulation frequency of the detection signal; A represents the amplitude of the echo signal, and B represents the offset of the echo signal due to background illumination. The background illumination can be the illumination outside the transmitter itself, τ represents the flight time, that is, the time difference between the detection signal and the echo signal, and φ=2πfτ represents the corresponding phase offset.
探测信号和回波信号功率的相互关函数表示为:The correlation function between the power of the detection signal and the echo signal is expressed as:
Figure PCTCN2019124280-appb-000006
Figure PCTCN2019124280-appb-000006
令ψ=2πfx、φ=2πfτ。则公式(10)可以表示为:Let ψ=2πfx and φ=2πfτ. Then the formula (10) can be expressed as:
Figure PCTCN2019124280-appb-000007
Figure PCTCN2019124280-appb-000007
计算机设备可以在一个调制周期内等间隔采样四个点,相关函数值为ψ 0=0,ψ 1=π/2,ψ 2=π,ψ 3=3π/2,得到的相互关函数分别为C 0=C(0,φ),C 1=C(π/2,φ),C 2=C(π,φ)和C 3=C(3π/2,φ)。由上述四个等式计算得到回波信号偏置量B以及振幅A,计算公式如下: The computer equipment can sample four points at equal intervals in a modulation period, and the correlation function values are ψ 0 =0, ψ 1 =π/2, ψ 2 =π, ψ 3 =3π/2, and the obtained cross-correlation functions are respectively C 0 =C(0,φ), C 1 =C(π/2,φ), C 2 =C(π,φ) and C 3 =C(3π/2,φ). Calculate the echo signal offset B and amplitude A from the above four equations. The calculation formula is as follows:
Figure PCTCN2019124280-appb-000008
Figure PCTCN2019124280-appb-000008
Figure PCTCN2019124280-appb-000009
Figure PCTCN2019124280-appb-000009
Figure PCTCN2019124280-appb-000010
Figure PCTCN2019124280-appb-000010
探测到的物体的测距值的计算公式如下:The calculation formula for the distance measurement value of the detected object is as follows:
Figure PCTCN2019124280-appb-000011
Figure PCTCN2019124280-appb-000011
其中,d表示物体的测距值,c表示光速。Among them, d represents the distance measurement value of the object, and c represents the speed of light.
若像素点未发生像素串扰,该像素点仅接收到一个物体反射的回波信号,此时为单回波情况,回波信号可以用公式(9)来表示,根据公式(10)-(15)得到测距值的计算公式,如下所示:If pixel crosstalk does not occur, the pixel only receives the echo signal reflected by an object. At this time, it is a single echo situation. The echo signal can be expressed by formula (9), according to formula (10)-(15) ) To obtain the calculation formula of the ranging value, as shown below:
Figure PCTCN2019124280-appb-000012
Figure PCTCN2019124280-appb-000012
其中,c表示光速,τ表示飞行时间。Among them, c represents the speed of light, and τ represents the flight time.
在单回波情况下,测距值d只与飞行时间τ有关,测距值与回波信号的调制频率是无关的。In the case of single echo, the ranging value d is only related to the flight time τ, and the ranging value has nothing to do with the modulation frequency of the echo signal.
若像素点发生像素串扰,该像素点接收到至少两个物体反射的回波信号,此时为双回波或多回波情况,以像素点接收到两个回波信号为例进行说明,公式(9)修正为:If pixel crosstalk occurs, the pixel receives the echo signals reflected by at least two objects. At this time, it is a double-echo or multi-echo situation. Take the pixel receiving two echo signals as an example. The formula (9) Amend to:
r(t)=A 1cos(2πft-2πfτ 1)+B 1+A 2cos(2πft-2πfτ 2)+B 2   (17) r(t)=A 1 cos(2πft-2πfτ 1 )+B 1 +A 2 cos(2πft-2πfτ 2 )+B 2 (17)
其中,A 1表示第一个回波信号的振幅,τ 1表示第一个回波信号与探测信号的时间差,B 1表示第一个回波信号的偏置量,A 2表示第二个回波信号的振幅,τ 2表示第二个回波信号与探测信号之间的时间差,B 2表示第二个回波信号的偏置量。 Among them, A 1 represents the amplitude of the first echo signal, τ 1 represents the time difference between the first echo signal and the detection signal, B 1 represents the offset of the first echo signal, and A 2 represents the second echo signal. The amplitude of the wave signal, τ 2 represents the time difference between the second echo signal and the detection signal, and B 2 represents the offset of the second echo signal.
根据公式(10)-(15)计算得到测距值的计算公式,如下所示:According to formulas (10)-(15), the calculation formula of the ranging value is calculated as follows:
Figure PCTCN2019124280-appb-000013
Figure PCTCN2019124280-appb-000013
此时,测距值与调制频率有关。At this time, the ranging value is related to the modulation frequency.
在激光雷达的调制频段中任意选取两个调制频率,分别为第一调制频率f1和第二调制频率f2。当激光雷达的工作频率为第一调制频率时,获取回波图像中每个像素点的第一测距值。当激光雷达的工作频率为第二调制频率时,获取回波图像中每个像素点的第二测距值。激光雷达工作时在两个调制频率之间交替切换,第一调制频率f1工作若干个周期后,切换至第二 调制频率f2并工作若干个周期。Two modulation frequencies are arbitrarily selected in the modulation frequency band of the laser radar, namely the first modulation frequency f1 and the second modulation frequency f2. When the operating frequency of the lidar is the first modulation frequency, the first ranging value of each pixel in the echo image is obtained. When the operating frequency of the lidar is the second modulation frequency, the second ranging value of each pixel in the echo image is obtained. When the lidar is working, it alternately switches between the two modulation frequencies. After the first modulation frequency f1 works for several cycles, it switches to the second modulation frequency f2 and works for several cycles.
示例性的,如图11所示,在第一调制频率f1调制3个周期,切换后再在第二调制频率f2调制3个周期。第一调制频率f1调制探测信号时,得到ψ=0°、ψ=90°、ψ=180°、ψ=270°四个等间距采样点的回波信号的幅值,分别为C0、C1、C2、C3。根据公式(18)和C0-C3计算得到第一测距值d1。第一调制频率f1工作期间,每个像素点的第一测距值均可通过上述方法计算得到。第二调制频率f2调制探测信号时,得到同样四个等间距采样点ψ=0°、ψ=90°、ψ=180°、ψ=270°的信号幅值,分别为C0’、C1’、C2’、C3’。根据公式(18)和C0’-C3’计算得到第二测距值d2。同理,第二调制频率f2工作期间,每个像素点的第二测距值均可通过上述方法计算得到。Exemplarily, as shown in FIG. 11, 3 cycles are modulated at the first modulation frequency f1, and 3 cycles are modulated at the second modulation frequency f2 after switching. When the first modulation frequency f1 modulates the detection signal, the amplitudes of the echo signals at four equally spaced sampling points of ψ=0°, ψ=90°, ψ=180°, and ψ=270° are obtained, which are C0, C1, C2, C3. The first ranging value d1 is calculated according to formula (18) and C0-C3. During the working period of the first modulation frequency f1, the first ranging value of each pixel can be calculated by the above method. When the second modulation frequency f2 modulates the detection signal, the same four equally spaced sampling points ψ=0°, ψ=90°, ψ=180°, ψ=270° signal amplitudes are obtained, which are C0', C1', C2', C3'. The second ranging value d2 is calculated according to formula (18) and C0'-C3'. In the same way, during the working period of the second modulation frequency f2, the second ranging value of each pixel can be calculated by the above method.
由前述可知,在单回波情况下,测距值d只与飞行时间τ有关,测距值与回波信号的调制频率是无关的;在双回波(或多回波)情况下,测距值d与调制频率有关。因此,激光雷达工作过程中切换不同的调制频率,有像素串扰的像素点对同一个物体探测得到的测距值不同;没有像素串扰的像素点对同一个物体探测得到的测距值相同。From the foregoing, in the case of single echo, the ranging value d is only related to the flight time τ, and the ranging value has nothing to do with the modulation frequency of the echo signal; in the case of double echo (or multiple echo), the measurement The distance value d is related to the modulation frequency. Therefore, by switching between different modulation frequencies during the operation of the lidar, the pixel points with pixel crosstalk can detect the same object with different ranging values; the pixel without pixel crosstalk can detect the same object with the same ranging value.
将每个像素点的第一测距值和第二测距值作差,得到测距差值。以任意一个像素点为例说明,当测距差值为零时,第一测距值和第二测距值相等,测距值不受调制频率影响,该像素点不为回波图像中的串扰像素点。当测距差值不为零时,第一测距值和第二测距值不等,测距值随调制频率发生变化,该像素点为回波图像中的串扰像素点。对所有像素点的测距差值逐一进行判断,获取回波图像中的所有串扰像素点。The difference between the first ranging value and the second ranging value of each pixel point is obtained to obtain the ranging difference. Take any pixel as an example. When the distance difference is zero, the first and second distance values are equal, and the distance value is not affected by the modulation frequency. This pixel is not an echo image. Crosstalk pixels. When the distance measurement difference is not zero, the first distance measurement value and the second distance measurement value are not equal, and the distance measurement value changes with the modulation frequency, and this pixel is a crosstalk pixel in the echo image. The distance measurement difference of all pixels is judged one by one, and all the crosstalk pixels in the echo image are obtained.
在本实施例中,根据连续波式非相干探测的解算特点,使激光雷达工作时包括至少两种不同的调制频率,计算机设备获取第一调制频率工作时的每个像素点的第一测距值,第二调制频率工作时的每个像素点的第二测距值,再将不同调制频率下每个像素点的第一测距值和第二测距值作差得到测距差值。由于像素点发生像素串扰时,会接收到至少两个物体反射的回波信号,相当于一个像素点接收到多个回波,此时测距值与调制频率有关;利用这一特点来逐一判断像素点是否为串扰像素点。若测距差值为零,第一测距值和第二测距值相等,测距值不受调制频率影响,该像素点不为回波图像中的串扰像素点;若测距差值不为零,第一测距值和第二测距值不等,测距值随调制频率发生变化,该像素点为回波图像中的串扰像素点。通过这种方法判断回波图像中是否有像素串扰点,通过调节激光雷达的发射端调制电路使工作的调制频率按需切换即可,在激光雷达正常工作期间可获取测距值进行判断,不影响激光雷达的探测过程;同时,只需对每个像素点的两次测距值作差,计算过程和判断方法简单,计算结果可靠性高,简化运算,提高计算速率,减轻系统的运算负担。In this embodiment, according to the solution characteristics of continuous wave incoherent detection, the lidar is made to include at least two different modulation frequencies when working, and the computer device obtains the first measurement of each pixel when the first modulation frequency is working. Distance value, the second distance value of each pixel when the second modulation frequency is working, and then the difference between the first distance value and the second distance value of each pixel under different modulation frequencies is obtained. . When pixel crosstalk occurs, it will receive echo signals reflected by at least two objects, which is equivalent to a pixel receiving multiple echoes. At this time, the ranging value is related to the modulation frequency; use this feature to determine one by one Whether the pixel is a crosstalk pixel. If the ranging difference is zero, the first ranging value and the second ranging value are equal, the ranging value is not affected by the modulation frequency, and the pixel is not a crosstalk pixel in the echo image; if the ranging difference is not If it is zero, the first ranging value and the second ranging value are not equal, the ranging value changes with the modulation frequency, and this pixel is a crosstalk pixel in the echo image. This method is used to determine whether there are pixel crosstalk points in the echo image. By adjusting the modulation circuit of the laser radar transmitting end, the working modulation frequency can be switched as needed. During the normal operation of the laser radar, the ranging value can be obtained for judgment. Affects the detection process of lidar; at the same time, only the difference between the two ranging values of each pixel point is required. The calculation process and judgment method are simple, the calculation result is highly reliable, the calculation is simplified, the calculation rate is increased, and the calculation burden of the system is reduced .
校正串扰像素点,得到校正后的回波图像的方法可以有多种。There are many ways to correct the crosstalk pixels to obtain the corrected echo image.
在其中一个实施例中,步骤206:校正串扰像素点,得到校正后的回波图像具体包括:选取与串扰像素点相邻的一个像素点,作为备用像素点;将备用像素点的信息复制入串扰像素点,得到校正后的回波图像。In one of the embodiments, step 206: correcting the crosstalk pixel to obtain the corrected echo image specifically includes: selecting a pixel adjacent to the crosstalk pixel as a spare pixel; copying the information of the spare pixel into Crosstalk the pixels to get the corrected echo image.
具体地,计算机设备在串扰像素点相邻的像素点中,选择一个没有像素串扰的像素点作为备用像素点;再将备用像素点的信息复制入串扰像素点,对串扰像素点的信息进行替换,得到校正后的回波图像。示例性的,如图7所示,若P点为串扰像素点,由于像素点3和7均位于垂直于P点梯度方向的分割线上,如前述有较大的可能也是串扰像素点;因此可以选取与P点相邻的像素点1、2、4或者像素点6、8、9作为备用像素点。若选择像素点1作为备用像素点,则将像素点1探测得到的信息复制入P点,替换掉P点原来的信息。Specifically, among the pixels adjacent to the crosstalk pixels, the computer equipment selects a pixel without pixel crosstalk as the spare pixel; then copies the information of the spare pixel into the crosstalk pixel to replace the information of the crosstalk pixel , Get the corrected echo image. Exemplarily, as shown in FIG. 7, if point P is a crosstalk pixel, since pixel points 3 and 7 are located on the dividing line perpendicular to the gradient direction of point P, as mentioned above, there is a greater possibility that it is also a crosstalk pixel; therefore, The pixel points 1, 2, 4 or the pixel points 6, 8, 9 adjacent to the P point can be selected as the spare pixel points. If the pixel point 1 is selected as the spare pixel point, the information detected by the pixel point 1 is copied into the point P, and the original information of the point P is replaced.
在本实施例中,计算机设备选取与串扰像素点相邻的一个像素点作为备用像素点,将没有像素串扰的备用像素点的信息复制入串扰像素点,对串扰像素点进行校正;采用这种方法对所有串扰像素点进行校正,得到校正后的回波图像。串扰像素点在回波图像中往往位于两个或者多个物体的交界处,将串扰像素点中的错误信息用与其相邻的备用像素点的信息替换掉;由于备用像素点不存在像素串扰,且串扰像素点与备用像素点的位置为相邻,备用像素点探测到的物体为串扰像素点探测到的多个物体之一。选用相邻的非像素串扰的像素点作为备用像素点,相当于将备用像素点探测到的某一物体的边界扩展了一个像素点,其余物体的边界退回了一个像素点,操作简便,校正后的回波图像不影响对物体的正常探测,不影响物体探测的准确性。另外,这种校正方法能够在不减少像素点数量的情况下,降低回波图像的误点率,从而提高了物体位姿信息的计算准确性,提高了激光雷达的测距准确性。In this embodiment, the computer device selects a pixel adjacent to the crosstalk pixel as a spare pixel, and copies the information of the spare pixel without pixel crosstalk into the crosstalk pixel to correct the crosstalk pixel; using this The method corrects all the crosstalk pixels and obtains the corrected echo image. Crosstalk pixels are often located at the junction of two or more objects in the echo image. The error information in the crosstalk pixels is replaced with the information of the adjacent spare pixels; because there is no pixel crosstalk in the spare pixels, In addition, the positions of the crosstalk pixel and the spare pixel are adjacent, and the object detected by the spare pixel is one of multiple objects detected by the crosstalk pixel. Adjacent non-pixel crosstalk pixels are selected as spare pixels, which is equivalent to extending the boundary of an object detected by the spare pixel by one pixel, and the boundary of the remaining objects is returned by one pixel. The operation is simple and after correction The echo image does not affect the normal detection of objects, and does not affect the accuracy of object detection. In addition, this correction method can reduce the error rate of echo images without reducing the number of pixels, thereby improving the calculation accuracy of object pose information and improving the accuracy of lidar range finding.
在其中一个实施例中,步骤206:校正串扰像素点,得到校正后的回波图像具体包括:In one of the embodiments, step 206: correcting crosstalk pixels to obtain a corrected echo image specifically includes:
删除串扰像素点的信息,得到校正后的回波图像。Delete the crosstalk pixel information, and get the corrected echo image.
计算机设备在得到得到串扰像素点后,直接将串扰像素点的信息进行删除,对串扰像素点进行校正,采用这种方法对所有串扰像素点进行校正,得到校正后的回波图像。有效避免了串扰像素点对回波图像的准确性造成影响,提高了物体位姿信息的计算准确性。同时,删除串扰像素点的信息,简单直接,不需要其余计算操作,减少计算机设备负担,加快运算速率。After obtaining the crosstalk pixels, the computer device directly deletes the information of the crosstalk pixels and corrects the crosstalk pixels. This method is used to correct all the crosstalk pixels to obtain a corrected echo image. This effectively avoids the impact of crosstalk pixels on the accuracy of the echo image, and improves the accuracy of the calculation of the object's pose information. At the same time, deleting crosstalk pixel information is simple and straightforward, and no other calculation operations are required, reducing the burden on computer equipment and speeding up the calculation speed.
在其中一个实施例中,步骤206:校正串扰像素点,得到校正后的回波图像具体包括: 将串扰像素点分割为多个子像素点;将子像素点相邻的像素点的信息复制入子像素点,得到校正后的回波图像。In one of the embodiments, step 206: correcting the crosstalk pixels to obtain the corrected echo image specifically includes: dividing the crosstalk pixels into a plurality of sub-pixels; copying the information of the pixels adjacent to the sub-pixels into the sub-pixels Pixels, get the corrected echo image.
具体地,计算机设备可以按照预设分割方式将串扰像素点分割为多个子像素点;预设分割方式可以是分割为N×N个子像素点,也可以是沿串扰像素点梯度方向和分割线方向进行分割。每个子像素点的相邻像素点不是串扰像素点,将该相邻像素点的信息复制入子像素点;对串扰像素点的信息进行拆分后替换,得到校正后的回波图像。Specifically, the computer device can divide the crosstalk pixel into a plurality of sub-pixels according to a preset division method; the preset division method can be divided into N×N sub-pixels, or along the gradient direction of the crosstalk pixel and the direction of the dividing line Split. The adjacent pixel of each sub-pixel is not a crosstalk pixel, and the information of the adjacent pixel is copied into the sub-pixel; the information of the crosstalk pixel is split and replaced to obtain a corrected echo image.
示例性的,如图7所示,若P点为串扰像素点,箭头方向为P点的梯度方向,经过P点垂直于梯度方向设置有分割线。如图12所示,根据梯度方向和分割线方向将串扰像素点分割为4个子像素点,分别为P1、P2、P3、P4,即分割线一侧有两个子像素点,另一侧也有两个子像素点。子像素点P1的相邻像素点为像素点4,将像素点4的信息复制入子像素点P1。以此类推,像素点2的信息复制入子像素点P2,像素点6的信息复制入子像素点P3,像素点8的信息复制入子像素点P4。如图13所示,将串扰像素点分为2×2的4个子像素点,分别为P1、P2、P3、P4。将像素点2的信息复制入子像素点P1和P2,像素点8的信息复制入子像素点P3和P4。或者,将像素点4的信息复制入子像素点P1和P3,像素点6的信息复制入子像素点P2和P4。Exemplarily, as shown in FIG. 7, if the P point is a crosstalk pixel, the arrow direction is the gradient direction of the P point, and a dividing line is set perpendicular to the gradient direction through the P point. As shown in Figure 12, the crosstalk pixel is divided into 4 sub-pixels according to the gradient direction and the direction of the dividing line, namely P1, P2, P3, P4, that is, there are two sub-pixels on one side of the dividing line and two on the other side. Sub-pixels. The adjacent pixel point of the sub-pixel point P1 is the pixel point 4, and the information of the pixel point 4 is copied into the sub-pixel point P1. By analogy, the information of the pixel point 2 is copied into the sub-pixel point P2, the information of the pixel point 6 is copied into the sub-pixel point P3, and the information of the pixel point 8 is copied into the sub-pixel point P4. As shown in FIG. 13, the crosstalk pixel is divided into 4 sub-pixels of 2×2, which are respectively P1, P2, P3, and P4. The information of pixel point 2 is copied into sub-pixel points P1 and P2, and the information of pixel point 8 is copied into sub-pixel points P3 and P4. Alternatively, the information of the pixel point 4 is copied into the sub-pixel points P1 and P3, and the information of the pixel point 6 is copied into the sub-pixel points P2 and P4.
在本实施例中,计算机设备将串扰像素点进一步分割为子像素点,并将相邻的没有像素串扰的像素点的信息复制入子像素点,对串扰像素点进行校正;采用这种方法对所有串扰像素点进行校正,得到校正后的回波图像。如前述,串扰像素点在回波图像中通常位于多个物体的交界处,串扰像素点相邻的没有像素串扰的像素点,探测到的物体为串扰像素点探测到的多个物体之一。串扰像素点分割为多个子像素点后,每个子像素点内的信息用相邻的没有像素串扰的像素点的信息代替,相当于按位置关系将多个子像素点划分到多个物体对应的像素点集合中,划分到不同物体的子像素点之间的边界即为不同物体的边界。通过拆解的方式,将串扰像素点分割为多个子像素点后再进行划分,串扰像素点中不同物体的边界更精细和准确;由于每个子像素点包含的信息量较少,即使在复制入相邻像素点的信息时有些偏差,对整个回波图像测距结果的影响不大。In this embodiment, the computer device further divides the crosstalk pixels into sub-pixels, and copies the information of adjacent pixels without pixel crosstalk into the sub-pixels to correct the crosstalk pixels; this method is used to correct the crosstalk pixels. All crosstalk pixels are corrected to obtain a corrected echo image. As mentioned above, the crosstalk pixel is usually located at the junction of multiple objects in the echo image, the adjacent pixel of the crosstalk pixel has no pixel crosstalk, and the detected object is one of the multiple objects detected by the crosstalk pixel. After the crosstalk pixel is divided into multiple sub-pixels, the information in each sub-pixel is replaced with the information of adjacent pixels without pixel crosstalk, which is equivalent to dividing multiple sub-pixels into pixels corresponding to multiple objects according to the positional relationship In the point set, the boundary between the sub-pixel points divided into different objects is the boundary of different objects. Through the disassembly method, the crosstalk pixel is divided into multiple sub-pixels and then divided. The boundaries of different objects in the crosstalk pixel are more refined and accurate; since each sub-pixel contains less information, even if it is copied There are some deviations in the information of adjacent pixels, which has little effect on the entire echo image ranging result.
上述校正串扰像素点,得到校正后的回波图像的方法可以单独使用,也可以同时使用。示例性的,可以对回波图像进行区域划分。回波图像的中心区域相较于外围区域的探测准确率要求高,回波图像的上部主要是高于激光雷达安装位置处的探测结果,分辨率要求较低;因此,可以按照探测准确率要求由高到低将回波图像划分为三个区域,如图14所示,分别为区域A、区域B和区域C,区域A为回波图像的中心区域,区域C为中心区域上方的区域,其余部分为区域B。区域A中的串扰像素点,可以采用分割为子像素点后复制相邻像素点的信 息进行校正;区域B中的像素点,可以采用复制备用像素点的信息进行校正;区域C中的像素点,可以采用删除串扰像素点的信息进行校正。通过多种校正方法同时使用,相互结合,既能够保证校正后得到的回波图像的准确性,也能够减少整个计算机设备的运算量,降低系统压力,提高计算速率。The above-mentioned method of correcting crosstalk pixels to obtain a corrected echo image can be used alone or at the same time. Exemplarily, the echo image may be divided into regions. Compared with the peripheral area, the center area of the echo image requires higher detection accuracy. The upper part of the echo image is mainly higher than the detection result at the installation position of the lidar, and the resolution requirement is lower; therefore, the detection accuracy requirements can be met The echo image is divided into three areas from high to low, as shown in Figure 14, area A, area B, and area C. Area A is the central area of the echo image, and area C is the area above the central area. The rest is area B. Crosstalk pixels in area A can be corrected by copying the information of adjacent pixels after being divided into sub-pixels; pixels in area B can be corrected by copying the information of spare pixels; pixels in area C , You can use the information to delete the crosstalk pixels for correction. Using multiple correction methods at the same time and combining them with each other can not only ensure the accuracy of the echo image obtained after correction, but also reduce the amount of calculation of the entire computer equipment, reduce the system pressure, and increase the calculation rate.
应该理解的是,虽然图3-6以及图9的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图3-6以及图9中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。It should be understood that although the steps in the flowcharts of FIGS. 3-6 and 9 are shown in sequence as indicated by the arrows, these steps are not necessarily executed in the order indicated by the arrows. Unless specifically stated in this article, the execution of these steps is not strictly limited in order, and these steps can be executed in other orders. Moreover, at least part of the steps in Figures 3-6 and Figure 9 may include multiple sub-steps or multiple stages. These sub-steps or stages are not necessarily executed at the same time, but can be executed at different times. The order of execution of the steps or stages is not necessarily performed sequentially, but may be executed alternately or alternately with at least a part of other steps or sub-steps or stages of other steps.
在其中一个实施例中,如图15所示,提供了一种激光雷达测距装置,包括:获取模块1502、判断模块1504、校正模块1506以及计算模块1508,其中:In one of the embodiments, as shown in FIG. 15, a lidar ranging device is provided, including: an acquisition module 1502, a judgment module 1504, a correction module 1506, and a calculation module 1508, wherein:
获取模块1502,用于获取激光雷达接收的回波图像.The acquisition module 1502 is used to acquire the echo image received by the lidar.
判断模块1504,用于判断回波图像是否存在串扰像素点。The judging module 1504 is used for judging whether there are crosstalk pixels in the echo image.
校正模块1506,用于当回波图像存在串扰像素点时,校正串扰像素点,得到校正后的回波图像。The correction module 1506 is used to correct the crosstalk pixels when the echo image has crosstalk pixels to obtain a corrected echo image.
计算模块1508,用于根据校正后的回波图像计算得到物体位姿信息。The calculation module 1508 is used to calculate the posture information of the object according to the corrected echo image.
在其中一个实施例中,判断模块1504还用于获取深度图像的第一边缘像素点;判断第一边缘像素点是否满足预设串扰条件;当第一边缘像素点满足预设串扰条件时,将第一边缘像点确定为回波图像的串扰像素点。In one of the embodiments, the determining module 1504 is also used to obtain the first edge pixel of the depth image; determine whether the first edge pixel meets the preset crosstalk condition; when the first edge pixel meets the preset crosstalk condition, change The first edge image point is determined as the crosstalk pixel point of the echo image.
在其中一个实施例中,判断模块1504还用于获取灰度图像的第二边缘像素点;在深度图像中查找第二边缘像素点的对应像素点;将对应像素点确定为深度图像的第一边缘像素点。In one of the embodiments, the judgment module 1504 is also used to obtain the second edge pixel of the grayscale image; find the corresponding pixel of the second edge pixel in the depth image; determine the corresponding pixel as the first pixel of the depth image Edge pixels.
在其中一个实施例中,判断模块1504还用于获取第一边缘像素点的边缘测距值和梯度方向;获取第一边缘像素点与梯度方向相同一侧的所有周围像素点的第一平均测距值;获取第一边缘像素点与梯度方向的相反一侧的所有周围像素点的第二平均测距值;当边缘测距值与第一平均测距值的差值的绝对值大于预设距离阈值以及当边缘测距值与第二平均测距值的差值的绝对值大于预设距离阈值时,则第一边缘像素点满足预设串扰条件。In one of the embodiments, the judging module 1504 is also used to obtain the edge ranging value and the gradient direction of the first edge pixel; to obtain the first average measurement of all surrounding pixels on the same side of the first edge pixel and the gradient direction. Distance value; get the second average distance value of all surrounding pixels on the opposite side of the first edge pixel and the gradient direction; when the absolute value of the difference between the edge distance value and the first average distance value is greater than the preset The distance threshold and when the absolute value of the difference between the edge distance measurement value and the second average distance measurement value is greater than the preset distance threshold value, the first edge pixel point meets the preset crosstalk condition.
在其中一个实施例中,周围像素点包括与第一边缘像素点相邻的像素点。In one of the embodiments, the surrounding pixels include pixels adjacent to the first edge pixel.
在其中一个实施例中,判断模块1504还用于当激光雷达的工作频率为第一调制频率时,获取回波图像中每个像素点的第一测距值;当激光雷达的工作频率为第二调制频率时,获取回波图像中的每个像素点的第二测距值;将每个像素点的第一测距值和第二测距值作差,得到测距差值;当测距差值不为零时,则测距差值不为零的像素点为回波图像的串扰像素点。In one of the embodiments, the judging module 1504 is also used to obtain the first ranging value of each pixel in the echo image when the working frequency of the lidar is the first modulation frequency; when the working frequency of the lidar is the first When the second modulation frequency is used, the second ranging value of each pixel in the echo image is obtained; the difference between the first ranging value and the second ranging value of each pixel is obtained to obtain the ranging difference; When the distance difference is not zero, the pixels with the distance difference not being zero are the crosstalk pixels of the echo image.
在其中一个实施例中,校正模块1506还用于选取与串扰像素点相邻的一个像素点,作为备用像素点;将备用像素点的信息复制入串扰像素点,得到校正后的回波图像。In one of the embodiments, the correction module 1506 is also used to select a pixel adjacent to the crosstalk pixel as a spare pixel; copy the information of the spare pixel into the crosstalk pixel to obtain a corrected echo image.
在其中一个实施例中,校正模块1506还用于删除串扰像素点的信息,得到校正后的回波图像。In one of the embodiments, the correction module 1506 is also used to delete crosstalk pixel information to obtain a corrected echo image.
在其中一个实施例中,校正模块1506还用于将串扰像素点分割为多个子像素点,将子像素点相邻的像素点的信息复制入子像素点,得到校正后的回波图像。In one of the embodiments, the correction module 1506 is further configured to divide the crosstalk pixel into a plurality of sub-pixels, and copy the information of the adjacent pixels of the sub-pixels into the sub-pixels to obtain a corrected echo image.
关于激光雷达测距装置的具体限定可以参见上文中对于激光雷达测距方法的限定,在此不再赘述。上述激光雷达测距装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。Regarding the specific limitation of the lidar ranging device, please refer to the above limitation on the lidar ranging method, which will not be repeated here. Each module in the above-mentioned lidar ranging device can be implemented in whole or in part by software, hardware, and a combination thereof. The above-mentioned modules may be embedded in the form of hardware or independent of the processor in the computer equipment, or may be stored in the memory of the computer equipment in the form of software, so that the processor can call and execute the operations corresponding to the above-mentioned modules.
在一个实施例中,提供了一种计算机设备,其内部结构图可以如图16所示。该计算机设备包括通过系统总线连接的处理器、存储器、通信接口和数据库。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机可读指令和数据库。该内存储器为非易失性存储介质中的操作系统和计算机可读指令的运行提供环境。该计算机设备的数据库用于存储回波图像和物体位姿信息。该计算机设备的通信接口用于与激光雷达进行连接通信。该计算机可读指令被处理器执行时以实现一种激光雷达测距方法。In one embodiment, a computer device is provided, and its internal structure diagram may be as shown in FIG. 16. The computer equipment includes a processor, a memory, a communication interface and a database connected through a system bus. Among them, the processor of the computer device is used to provide calculation and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system, computer readable instructions, and a database. The internal memory provides an environment for the operation of the operating system and computer-readable instructions in the non-volatile storage medium. The database of the computer equipment is used to store echo images and object pose information. The communication interface of the computer equipment is used to connect and communicate with the lidar. The computer-readable instructions are executed by the processor to realize a lidar ranging method.
本领域技术人员可以理解,图16中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。Those skilled in the art can understand that the structure shown in FIG. 16 is only a block diagram of part of the structure related to the solution of the present application, and does not constitute a limitation on the computer device to which the solution of the present application is applied. The specific computer device may Including more or fewer parts than shown in the figure, or combining some parts, or having a different arrangement of parts.
一个或多个存储有计算机可读指令的非易失性计算机可读存储介质,计算机可读指令被一个或多个处理器执行时,使得一个或多个处理器执行上述各个方法实施例中的步骤。One or more non-volatile computer-readable storage media storing computer-readable instructions. When the computer-readable instructions are executed by one or more processors, the one or more processors execute the steps in each of the foregoing method embodiments. step.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机可读指令来指令相关的硬件来完成,所述的计算机可读指令可存储于一非易失性计算机可读取存储介质中,该计算机可读指令在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程 ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be implemented by instructing relevant hardware through computer-readable instructions. The computer-readable instructions can be stored in a non-volatile computer. In a readable storage medium, when the computer-readable instructions are executed, they may include the processes of the above-mentioned method embodiments. Wherein, any reference to memory, storage, database, or other media used in the embodiments provided in this application may include non-volatile and/or volatile memory. Non-volatile memory may include read-only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM), or flash memory. Volatile memory may include random access memory (RAM) or external cache memory. As an illustration and not a limitation, RAM is available in many forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous chain Channel (Synchlink) DRAM (SLDRAM), memory bus (Rambus) direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM), etc.
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above embodiments can be combined arbitrarily. In order to make the description concise, all possible combinations of the technical features in the above embodiments are not described. However, as long as there is no contradiction in the combination of these technical features, they should be It is considered as the range described in this specification.
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。The above-mentioned embodiments only express several implementation manners of the present application, and the description is relatively specific and detailed, but it should not be understood as a limitation on the scope of the invention patent. It should be pointed out that for those of ordinary skill in the art, without departing from the concept of this application, several modifications and improvements can be made, and these all fall within the protection scope of this application. Therefore, the scope of protection of the patent of this application shall be subject to the appended claims.

Claims (20)

  1. 一种激光雷达测距方法,包括:A laser radar ranging method includes:
    获取激光雷达接收的回波图像;Obtain the echo image received by the lidar;
    判断所述回波图像是否存在串扰像素点;Judging whether there are crosstalk pixels in the echo image;
    当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及When there are crosstalk pixels in the echo image, correct the crosstalk pixels to obtain a corrected echo image; and
    根据所述校正后的回波图像计算得到物体位姿信息。The posture information of the object is calculated according to the corrected echo image.
  2. 根据权利要求1所述的方法,其特征在于,所述回波图像包括深度图像,所述判断所述回波图像是否存在串扰像素点,包括:The method according to claim 1, wherein the echo image includes a depth image, and the determining whether there are crosstalk pixels in the echo image comprises:
    获取所述深度图像的第一边缘像素点;Acquiring the first edge pixel of the depth image;
    判断所述第一边缘像素点是否满足预设串扰条件;及Determining whether the first edge pixel meets a preset crosstalk condition; and
    当所述第一边缘像素点满足预设串扰条件时,将所述第一边缘像素点确定为所述回波图像的串扰像素点。When the first edge pixel meets a preset crosstalk condition, the first edge pixel is determined as the crosstalk pixel of the echo image.
  3. 根据权利要求2所述的方法,其特征在于,所述回波图像还包括灰度图像,所述获取所述深度图像的第一边缘像素点,包括:The method according to claim 2, wherein the echo image further comprises a grayscale image, and the acquiring the first edge pixel point of the depth image comprises:
    获取所述灰度图像的第二边缘像素点;Acquiring second edge pixels of the grayscale image;
    在所述深度图像中查找所述第二边缘像素点的对应像素点;及Searching for the corresponding pixel of the second edge pixel in the depth image; and
    将所述对应像素点确定为所述深度图像的第一边缘像素点。The corresponding pixel is determined as the first edge pixel of the depth image.
  4. 根据权利要求2所述的方法,其特征在于,所述判断所述第一边缘像素点是否满足预设串扰条件,包括:The method according to claim 2, wherein the determining whether the first edge pixel meets a preset crosstalk condition comprises:
    获取所述第一边缘像素点的边缘测距值和梯度方向;Acquiring the edge ranging value and the gradient direction of the first edge pixel;
    获取所述第一边缘像素点与所述梯度方向相同一侧的所有周围像素点的第一平均测距值;Acquiring a first average ranging value of all surrounding pixels on the same side of the first edge pixel and the gradient direction;
    获取所述第一边缘像素点与所述梯度方向相反一侧的所有周围像素点的第二平均测距值;Acquiring a second average ranging value of all surrounding pixels on the opposite side of the first edge pixel to the gradient direction;
    当所述边缘测距值与所述第一平均测距值的差值的绝对值大于预设距离阈值以及当所述边缘测距值与所述第二平均测距值的差值的绝对值大于所述预设距离阈值时,则所述第一边缘像素点满足预设串扰条件。When the absolute value of the difference between the edge ranging value and the first average ranging value is greater than a preset distance threshold and when the absolute value of the difference between the edge ranging value and the second average ranging value When it is greater than the preset distance threshold, the first edge pixel meets the preset crosstalk condition.
  5. 根据权利要求4所述的方法,其特征在于,所述周围像素点包括与所述第一边缘像素点相邻的像素点。The method according to claim 4, wherein the surrounding pixels include pixels adjacent to the first edge pixel.
  6. 根据权利要求1所述的方法,其特征在于,所述激光雷达的工作频率包括至少两种不同的调制频率,所述判断所述回波图像是否存在串扰像素点,包括:The method according to claim 1, wherein the operating frequency of the lidar includes at least two different modulation frequencies, and the determining whether there are crosstalk pixels in the echo image includes:
    当所述激光雷达的工作频率为第一调制频率时,获取所述回波图像中每个像素点的第一测距值;When the operating frequency of the lidar is the first modulation frequency, acquiring the first ranging value of each pixel in the echo image;
    当所述激光雷达的工作频率为第二调制频率时,获取所述回波图像中每个像素点的第二测距值;When the operating frequency of the lidar is the second modulation frequency, acquiring the second ranging value of each pixel in the echo image;
    将每个像素点的第一测距值和第二测距值作差,得到测距差值;Calculate the difference between the first ranging value and the second ranging value of each pixel to obtain the ranging difference;
    当所述测距差值不为零时,则所述测距差值不为零的像素点为所述回波图像的串扰像素点。When the distance measurement difference value is not zero, the pixel points whose distance measurement difference value is not zero are the crosstalk pixels of the echo image.
  7. 根据权利要求1至6任意一项所述的方法,其特征在于,所述校正所述串扰像素点,得到校正后的回波图像,包括:The method according to any one of claims 1 to 6, wherein the correcting the crosstalk pixel points to obtain a corrected echo image comprises:
    选取与所述串扰像素点相邻的一个像素点,作为备用像素点;及Selecting a pixel point adjacent to the crosstalk pixel point as a spare pixel point; and
    将所述备用像素点的信息复制入所述串扰像素点,得到校正后的回波图像。The information of the spare pixel is copied into the crosstalk pixel to obtain a corrected echo image.
  8. 根据权利要求1至6任意一项所述的方法,其特征在于,所述校正所述串扰像素点,得到校正后的回波图像,包括:The method according to any one of claims 1 to 6, wherein the correcting the crosstalk pixel points to obtain a corrected echo image comprises:
    删除所述串扰像素点的信息,得到校正后的回波图像。The information of the crosstalk pixel points is deleted to obtain a corrected echo image.
  9. 根据权利要求1至6任意一项所述的方法,其特征在于,所述校正所述串扰像素点,得到校正后的回波图像,包括:The method according to any one of claims 1 to 6, wherein the correcting the crosstalk pixel points to obtain a corrected echo image comprises:
    将所述串扰像素点分割为多个子像素点;Dividing the crosstalk pixel into a plurality of sub-pixels;
    将所述子像素点相邻的像素点的信息复制入所述子像素点,得到校正后的回波图像。The information of the pixels adjacent to the sub-pixels is copied into the sub-pixels to obtain a corrected echo image.
  10. 一种激光雷达测距装置,包括:A laser radar ranging device includes:
    获取模块,用于获取激光雷达接收的回波图像;The acquisition module is used to acquire the echo image received by the lidar;
    判断模块,用于判断所述回波图像是否存在串扰像素点;A judging module for judging whether there are crosstalk pixels in the echo image;
    校正模块,用于当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及The correction module is used to correct the crosstalk pixels when the echo image has crosstalk pixels to obtain a corrected echo image; and
    计算模块,用于根据所述校正后的回波图像计算得到物体位姿信息。The calculation module is used to calculate the posture information of the object according to the corrected echo image.
  11. 根据权利要求10任意一项所述的装置,其特征在于,所述判断模块还用于获取所述深度图像的第一边缘像素点;判断所述第一边缘像素点是否满足预设串扰条件;及当所述第一边缘像素点满足预设串扰条件时,将所述第一边缘像点确定为所述回波图像的串 扰像素点。The device according to any one of claims 10, wherein the determining module is further configured to obtain the first edge pixel of the depth image; determine whether the first edge pixel satisfies a preset crosstalk condition; And when the first edge pixel meets a preset crosstalk condition, the first edge pixel is determined as the crosstalk pixel of the echo image.
  12. 根据权利要求11所述的装置,其特征在于,所述判断模块还用于获取所述灰度图像的第二边缘像素点;在所述深度图像中查找所述第二边缘像素点的对应像素点;及将所述对应像素点确定为所述深度图像的第一边缘像素点。The device according to claim 11, wherein the judgment module is further configured to obtain a second edge pixel of the grayscale image; search for a pixel corresponding to the second edge pixel in the depth image Point; and determining the corresponding pixel point as the first edge pixel point of the depth image.
  13. 根据权利要求11所述的装置,其特征在于,所述判断模块还用于获取所述第一边缘像素点的边缘测距值和梯度方向;获取所述第一边缘像素点与所述梯度方向相同一侧的所有周围像素点的第一平均测距值;获取所述第一边缘像素点与所述梯度方向的相反一侧的所有周围像素点的第二平均测距值;当所述边缘测距值与所述第一平均测距值的差值的绝对值大于预设距离阈值以及当所述边缘测距值与所述第二平均测距值的差值的绝对值大于所述预设距离阈值时,则所述第一边缘像素点满足预设串扰条件。The device according to claim 11, wherein the judgment module is further configured to obtain an edge ranging value and a gradient direction of the first edge pixel; and obtain the first edge pixel and the gradient direction The first average ranging value of all surrounding pixels on the same side; obtaining the second average ranging value of all surrounding pixels on the opposite side of the first edge pixel and the gradient direction; when the edge The absolute value of the difference between the ranging value and the first average ranging value is greater than a preset distance threshold, and when the absolute value of the difference between the edge ranging value and the second average ranging value is greater than the predicted When the distance threshold is set, the first edge pixel meets the preset crosstalk condition.
  14. 根据权利要求13所述的装置,其特征在于,所述周围像素点包括与所述第一边缘像素点相邻的像素点。The device according to claim 13, wherein the surrounding pixels include pixels adjacent to the first edge pixel.
  15. 根据权利要求10所述的装置,其特征在于,所述判断模块还用于当所述激光雷达的工作频率为第一调制频率时,获取所述回波图像中每个像素点的第一测距值;当所述激光雷达的工作频率为第二调制频率时,获取所述回波图像中每个像素点的第二测距值;将每个像素点的第一测距值和第二测距值作差,得到测距差值;及当所述测距差值不为零时,则所述测距差值不为零的像素点为所述回波图像的串扰像素点。The device according to claim 10, wherein the judgment module is further configured to obtain the first measurement of each pixel in the echo image when the operating frequency of the lidar is the first modulation frequency. Distance value; when the operating frequency of the lidar is the second modulation frequency, the second distance measurement value of each pixel in the echo image is obtained; the first distance value and the second distance value of each pixel are The distance measurement value is differenced to obtain a distance measurement difference value; and when the distance measurement difference value is not zero, then the pixel point with the distance measurement difference value not zero is the crosstalk pixel point of the echo image.
  16. 根据权利要求10至15任意一项所述的装置,其特征在于,所述校正模块还用于选取与所述串扰像素点相邻的一个像素点,作为备用像素点;及将所述备用像素点的信息复制入所述串扰像素点,得到校正后的回波图像。The device according to any one of claims 10 to 15, wherein the correction module is further configured to select a pixel adjacent to the crosstalk pixel as a spare pixel; and set the spare pixel The point information is copied into the crosstalk pixel points to obtain a corrected echo image.
  17. 根据权利要求10至15任意一项所述的装置,其特征在于,所述校正模块还用于删除所述串扰像素点的信息,得到校正后的回波图像。The device according to any one of claims 10 to 15, wherein the correction module is further configured to delete the information of the crosstalk pixel points to obtain a corrected echo image.
  18. 根据权利要求10至15任意一项所述的装置,其特征在于,所述校正模块还用于将所述串扰像素点分割为多个子像素点,将所述子像素点相邻的像素点的信息复制入所述子像素点,得到校正后的回波图像。The device according to any one of claims 10 to 15, wherein the correction module is further configured to divide the crosstalk pixel into a plurality of sub-pixels, and divide the pixel points adjacent to the sub-pixels. The information is copied into the sub-pixel points to obtain a corrected echo image.
  19. 一种计算机设备,包括存储器及一个或多个处理器,所述存储器中储存有计算机可读指令,所述计算机可读指令被所述一个或多个处理器执行时,使得所述一个或多个处理器执行以下步骤:A computer device includes a memory and one or more processors. The memory stores computer-readable instructions. When the computer-readable instructions are executed by the one or more processors, the one or more Each processor performs the following steps:
    获取激光雷达接收的回波图像;Obtain the echo image received by the lidar;
    判断所述回波图像是否存在串扰像素点;Judging whether there are crosstalk pixels in the echo image;
    当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及When there are crosstalk pixels in the echo image, correct the crosstalk pixels to obtain a corrected echo image; and
    根据所述校正后的回波图像计算得到物体位姿信息。The posture information of the object is calculated according to the corrected echo image.
  20. 一个或多个存储有计算机可读指令的非易失性计算机可读存储介质,所述计算机可读指令被一个或多个处理器执行时,使得所述一个或多个处理器执行以下步骤:One or more non-volatile computer-readable storage media storing computer-readable instructions. When the computer-readable instructions are executed by one or more processors, the one or more processors execute the following steps:
    获取激光雷达接收的回波图像;Obtain the echo image received by the lidar;
    判断所述回波图像是否存在串扰像素点;Judging whether there are crosstalk pixels in the echo image;
    当所述回波图像存在串扰像素点时,校正所述串扰像素点,得到校正后的回波图像;及When there are crosstalk pixels in the echo image, correct the crosstalk pixels to obtain a corrected echo image; and
    根据所述校正后的回波图像计算得到物体位姿信息。The posture information of the object is calculated according to the corrected echo image.
PCT/CN2019/124280 2019-12-10 2019-12-10 Laser radar ranging method and apparatus, and computer device and storage medium WO2021114080A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2019/124280 WO2021114080A1 (en) 2019-12-10 2019-12-10 Laser radar ranging method and apparatus, and computer device and storage medium
CN201980050264.9A CN112639516B (en) 2019-12-10 2019-12-10 Laser radar ranging method, laser radar ranging device, computer equipment and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/124280 WO2021114080A1 (en) 2019-12-10 2019-12-10 Laser radar ranging method and apparatus, and computer device and storage medium

Publications (1)

Publication Number Publication Date
WO2021114080A1 true WO2021114080A1 (en) 2021-06-17

Family

ID=75283636

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/124280 WO2021114080A1 (en) 2019-12-10 2019-12-10 Laser radar ranging method and apparatus, and computer device and storage medium

Country Status (2)

Country Link
CN (1) CN112639516B (en)
WO (1) WO2021114080A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4206728A1 (en) * 2021-12-30 2023-07-05 Suteng Innovation Technology Co., Ltd Interference point determining method and apparatus, storage medium, and multi-channel lidar

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116413730A (en) * 2021-12-29 2023-07-11 深圳市速腾聚创科技有限公司 Ranging method, ranging device, storage medium and laser radar
CN116755100B (en) * 2023-08-17 2024-02-02 深圳市速腾聚创科技有限公司 Laser radar device and ranging adjustment method thereof

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105842678A (en) * 2014-10-14 2016-08-10 现代自动车株式会社 System for filtering lidar data in vehicle and method thereof
US20180074196A1 (en) * 2016-05-27 2018-03-15 Harvey Weinberg Hybrid flash lidar system
CN109343025A (en) * 2018-08-14 2019-02-15 清华大学 A kind of emission system of laser radar, detection system and detection method
CN110031823A (en) * 2019-04-22 2019-07-19 上海禾赛光电科技有限公司 It can be used for noise recognition methods and the laser radar system of laser radar
WO2019204438A1 (en) * 2018-04-17 2019-10-24 Continental Automotive Systems, Inc. Crosstalk mitigation circuit for lidar pixel receivers

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2012014077A2 (en) * 2010-07-29 2012-02-02 Waikatolink Limited Apparatus and method for measuring the distance and/or intensity characteristics of objects
DE102016122645A1 (en) * 2016-11-24 2018-05-24 Valeo Schalter Und Sensoren Gmbh Receiving device for an optical detection device, detection device and driver assistance system
CN107292900A (en) * 2017-07-05 2017-10-24 黄河科技学院 A kind of method for detecting image edge and device based on Canny algorithms
CN107290700B (en) * 2017-08-08 2020-12-04 上海联影医疗科技股份有限公司 Phase correction method and device and magnetic resonance system
CN108898139B (en) * 2018-06-04 2022-06-10 上海大学 Laser radar data anti-interference processing method in rainy environment and experimental device thereof
CN110333514B (en) * 2018-10-12 2021-11-30 深圳市速腾聚创科技有限公司 Multi-echo laser radar ranging method and multi-echo laser radar
CN110031821B (en) * 2019-03-25 2020-11-17 白犀牛智达(北京)科技有限公司 Vehicle-mounted obstacle avoidance laser radar waveform extraction method, laser radar and medium

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105842678A (en) * 2014-10-14 2016-08-10 现代自动车株式会社 System for filtering lidar data in vehicle and method thereof
US20180074196A1 (en) * 2016-05-27 2018-03-15 Harvey Weinberg Hybrid flash lidar system
WO2019204438A1 (en) * 2018-04-17 2019-10-24 Continental Automotive Systems, Inc. Crosstalk mitigation circuit for lidar pixel receivers
CN109343025A (en) * 2018-08-14 2019-02-15 清华大学 A kind of emission system of laser radar, detection system and detection method
CN110031823A (en) * 2019-04-22 2019-07-19 上海禾赛光电科技有限公司 It can be used for noise recognition methods and the laser radar system of laser radar

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4206728A1 (en) * 2021-12-30 2023-07-05 Suteng Innovation Technology Co., Ltd Interference point determining method and apparatus, storage medium, and multi-channel lidar

Also Published As

Publication number Publication date
CN112639516A (en) 2021-04-09
CN112639516B (en) 2023-08-04

Similar Documents

Publication Publication Date Title
JP7398506B2 (en) Methods and systems for generating and using localization reference data
WO2021114080A1 (en) Laser radar ranging method and apparatus, and computer device and storage medium
CN109791052B (en) Method and system for classifying data points of point cloud by using digital map
US11042966B2 (en) Method, electronic device, and storage medium for obtaining depth image
US8717228B2 (en) Method and device for detecting target object, and radar apparatus
US11029399B2 (en) System and method for calibrating light intensity
US10410070B2 (en) Step detection device and step detection method
KR20150069927A (en) Device, method for calibration of camera and laser range finder
US20200193624A1 (en) Method and apparatus for dimensioning objects
JP2023068009A (en) Map information creation method
CN117970366A (en) Laser radar with large measuring range
JPWO2018212284A1 (en) Measuring device, measuring method and program

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19956046

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19956046

Country of ref document: EP

Kind code of ref document: A1