[go: up one dir, main page]

CN108957466B - 移动机器人的雷达数据补偿方法、装置、设备和存储介质 - Google Patents

移动机器人的雷达数据补偿方法、装置、设备和存储介质 Download PDF

Info

Publication number
CN108957466B
CN108957466B CN201810346872.1A CN201810346872A CN108957466B CN 108957466 B CN108957466 B CN 108957466B CN 201810346872 A CN201810346872 A CN 201810346872A CN 108957466 B CN108957466 B CN 108957466B
Authority
CN
China
Prior art keywords
radar
position information
time sequence
sensor
data
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201810346872.1A
Other languages
English (en)
Other versions
CN108957466A (zh
Inventor
王行知
丁璜
王立磊
杨锴
郑卓斌
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangzhou Coayu Robot Co Ltd
Original Assignee
Guangdong Bona Robot Corp ltd
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 Guangdong Bona Robot Corp ltd filed Critical Guangdong Bona Robot Corp ltd
Priority to CN201810346872.1A priority Critical patent/CN108957466B/zh
Publication of CN108957466A publication Critical patent/CN108957466A/zh
Priority to EP19787948.9A priority patent/EP3770636A4/en
Priority to PCT/CN2019/077020 priority patent/WO2019201022A1/zh
Priority to US17/048,513 priority patent/US20210165077A1/en
Application granted granted Critical
Publication of CN108957466B publication Critical patent/CN108957466B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • 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/4808Evaluating distance, position or velocity data
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/06Systems determining position data of a target
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/06Systems determining position data of a target
    • G01S13/42Simultaneous measurement of distance and other co-ordinates
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/52Discriminating between fixed and moving objects or between objects moving at different speeds
    • G01S13/522Discriminating between fixed and moving objects or between objects moving at different speeds using transmissions of interrupted pulse modulated waves
    • G01S13/524Discriminating between fixed and moving objects or between objects moving at different speeds using transmissions of interrupted pulse modulated waves based upon the phase or frequency shift resulting from movement of objects, with reference to the transmitted signals, e.g. coherent MTi
    • G01S13/5242Discriminating between fixed and moving objects or between objects moving at different speeds using transmissions of interrupted pulse modulated waves based upon the phase or frequency shift resulting from movement of objects, with reference to the transmitted signals, e.g. coherent MTi with means for platform motion or scan motion compensation, e.g. airborne MTI
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • 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/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/021Auxiliary means for detecting or identifying radar signals or the like, e.g. radar jamming signals
    • 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/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • G01S7/4004Means for monitoring or calibrating of parts of a radar system
    • G01S7/4026Antenna boresight
    • 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/497Means for monitoring or calibrating
    • G01S7/4972Alignment of sensor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/027Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Optics & Photonics (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本申请涉及一种移动机器人的雷达数据补偿方法、装置、设备和存储介质。方法包括:获取均匀时间序列;根据位置传感器获取数据的时间戳和位置传感器获取到的位置信息,确定均匀时间序列对应的位置信息;根据角度传感器获取数据的时间戳和角度传感器获取到的角度信息,确定均匀时间序列对应的角度信息;根据均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。采用本方法能够提高对雷达数据点补偿的准确性。

Description

移动机器人的雷达数据补偿方法、装置、设备和存储介质
技术领域
本申请涉及机器人技术领域,特别是涉及一种移动机器人的雷达数据补偿方法、装置、设备和存储介质。
背景技术
随着互联网技术和自动化技术的发展,机器人科技现今越趋成熟,例如,扫地机器人因为操作简单、使用方便,越来越多地走入了人们生活。
目前,为了对机器人进行定位和运动轨迹规划,在机器人内部设置了里程计和陀螺仪,机器人可以通过里程计获取机器人的位置数据,通过陀螺仪获取机器人的角度数据。还可以在机器人上设置激光雷达传感器,通过激光雷达传感器获取的数据确定机器人的位置数据和角度数据,由于激光雷达传感器获取数据时,若机器人处于运动状态,会导致激光雷达传感器在发射激光点时刻和接收激光点时刻,机器人处于不同的位置,使得激光雷达传感器最终获取的数据存在偏差。因此,可以采用里程计、陀螺仪获取到的位置数据和角度数据线性回推激光雷达数据的每一个时间点获取的位置数据和角度数据,以对激光雷达传感器的数据进行校正。
但是,由于激光雷达传感器获取雷达数据点的频率远高于里程计和陀螺仪获取数据的频率,因此,采用里程计和陀螺仪获取的位置数据和角度数据对激光雷达传感器的数据进行校正,得到的位置数据和角度数据存在较大的误差,影响数据校正的准确性。
发明内容
基于此,有必要针对上述技术问题,提供一种能够提高雷达传感器数据补偿准确性的移动机器人的雷达数据补偿方法、装置、设备和存储介质。
一种移动机器人的雷达数据补偿方法,所述方法包括:
获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在其中一个实施例中,所述根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息,包括:
根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;
采用预设的滤波参数对所述插值后得位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
在其中一个实施例中,所述根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,包括:
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;所述运动补偿模型用于表示障碍点的位置与所述雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系;
根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在其中一个实施例中,所述根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,包括:
确定所述均匀时间序列对应的位置信息的第一插值评分;
确定所述均匀时间序列对应的角度信息的第二插值评分;
确定所述雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分;
根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;
若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在其中一个实施例中,所述根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,包括:
根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;
根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度。
在其中一个实施例中,所述获取均匀时间序列,包括:
根据所述位置传感器的采样频率确定采样时间间隔;
根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
一种移动机器人的雷达数据补偿装置,包括:
获取模块,用于获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
第一确定模块,用于根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
第二确定模块,用于根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
第三确定模块,用于根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
补偿模块,用于根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在其中一个实施例中,所述第一确定模块具体用于根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;采用预设的滤波参数对所述插值后得位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
在其中一个实施例中,所述补偿模块具体用于根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点;所述运动补偿模型用于表示障碍点的位置与所述雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系。
在其中一个实施例中,所述补偿模块根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,包括:
所述补偿模块确定所述均匀时间序列对应的位置信息的第一插值评分;确定所述均匀时间序列对应的角度信息的第二插值评分;确定所述雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分;根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在其中一个实施例中,所述第三确定模块具体用于根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度。
在其中一个实施例中,所述获取模块具体用于根据所述位置传感器的采样频率确定采样时间间隔;根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:
获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
上述移动机器人的雷达数据补偿方法、装置、设备和存储介质,获取均匀时间序列,根据位置传感器获取数据的时间戳和传感器获取到的位置信息,确定均匀时间序列对应的位置信息,根据角度传感器获取数据的时间戳和角度传感器获取到的角度信息,确定均匀时间序列对应的角度信息,根据均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,由于均匀时间序列的任意两个相邻时间点之间的时间间隔均相等,在对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点时,位置传感器、角度传感器、雷达传感器均采用了均匀时间序列,也即位置传感器、角度传感器、雷达传感器的采样频率是统一的,从而降低了由于各传感器的采样频率不一致造成的位置数据和角度数据的误差,提高了数据校正的准确性,进一步提高了对雷达传感器获取到的数据进行补偿的准确性。
附图说明
图1为一个实施例中数据补偿方法的应用环境图;
图2为本申请一实施例提供的一种移动机器人的雷达数据补偿方法流程图;
图3为本申请实施例提供的一种传感器获取数据的时间序列示意图;
图4为图2所示实施例中的步骤202的一种可能的实现方式的流程图;
图5为图2所示实施例中的步骤204的一种可能的实现方式的流程图;
图6为本申请实施例提供的一种雷达传感器获取数据的时间序列示意图;
图7为本申请一实施例提供的速度矢量示意图;
图8为图2所示实施例中的步骤205的一种可能的实现方式的流程图;
图9为本申请一实施例提供的运动补偿模型示意图;
图10为图8所示实施例中步骤802的一种可能的实现方式的流程图;
图11为本申请实施例提供的一种移动机器人的雷达数据补偿装置的框图;
图12为本申请一实施例提供的一种设备的内部结构图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
本申请提供的移动机器人的雷达数据补偿方法,可以应用于如图1所示的应用环境中。其中,机器人1、服务器2和终端3之间可以通过网络进行通信。其中,终端3可以但不限于是各种个人计算机、笔记本电脑、智能手机、平板电脑和便携式可穿戴设备,服务器2可以用独立的服务器或者是多个服务器组成的服务器集群来实现。例如,机器人1可以为扫地机器人,扫地机器人上装有角度传感器、位置传感器和雷达传感器,雷达传感器可以为激光旋转雷达传感器。
图2为本申请一实施例提供的一种移动机器人的雷达数据补偿方法流程图。该方法的执行主体可以为图1中的机器人1、服务器2和终端3中的任意一个。如图2所示,该方法包括以下步骤:
步骤201、获取均匀时间序列,均匀时间序列的任意两个相邻时间点之间的时间间隔均相等。
在本实施例中,均匀时间序列可以是预先设置的一个时间序列,也可以是在雷达数据补偿过程中实时计算获得的一个序列,例如,可以预先设置一个时间间隔相等的时间序列,也可以根据位置传感器、角度传感器的采样频率来计算均匀时间序列。
如图3所示,位置传感器获取位置信息的时间戳为1t1,1t2,1t3,…,1tn,角度传感器获取角度信息的时间戳为2t1,2t2,2t3,…,2tn,雷达传感器获取雷达数据时刻为3t1,3t2, 3t3,…,3tn,均匀时间序列1t'1,1t'2,1t'3,…,1t'n
步骤202、根据位置传感器获取数据的时间戳和位置传感器获取到的位置信息,确定均匀时间序列对应的位置信息。
在本实施例中,可以根据位置传感器获取到的位置信息和位置传感器获取数据的时间戳进行插值运算,确定均匀时间序列对应的位置信息。或者,还可以先根据位置传感器获取数据的时间戳对位置传感器获取到的位置信息进行插值运算,然后对插值得到的位置信息进行校正,将校正后的位置数据作为均匀时间序列对应的位置信息。
如图3所示,可以根据位置传感器获取位置信息的时间戳1t1,1t2,1t3,…,1tn,对位置传感器获取到的位置数据进行插值运算,得到均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息。或者,还可以对插值得到的位置信息进行校正,将校正后的位置信息作为均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息。
其中,位置传感器用于获取机器人的位置信息,对机器人进行定位。该位置传感器可以是里程计等测量行程的装置,也可以是全球定位系统(Global Positioning System,GPS)等定位装置,且该位置传感器集成在机器人内部或安装在机器人上。
步骤203、根据角度传感器获取数据的时间戳和角度传感器获取到的角度信息,确定均匀时间序列对应的角度信息。
在本实施例中,可以根据角度传感器获取数据的时间戳,对角度传感器获取到的角度信息进行插值,得到均匀时间序列对应的角度信息。
如图3所示,可以根据角度传感器获取角度信息的时间戳2t1,2t2,2t3,…,2tn,对角度传感器获取到的角度信息进行插值运算,得到均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的角度信息。
其中,角度传感器用于获取机器人的角度信息,以确定机器人的运动方向。该角度传感器可以为电子罗盘或陀螺仪等装置,集成在机器人内部或安装在机器人上。
步骤204、根据均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息。
在本实施例中,如图3所示,可以根据均匀时间序列1t'1,1t'2,1t'3,…,1t'n,对均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息和角度信息进行插值运算,得到雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息。
步骤205、根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
其中,雷达传感器获取数据点时刻为雷达传感器获取每个数据点对应的时间戳;雷达数据获取时刻为雷达传感器每旋转360度对应的时间点。
在本实施例中,可以根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,直接对雷达传感器获取雷达数据每个时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,或者,还可以根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息得到运动补偿模型,采用运动补偿模型对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
其中,雷达传感器可以为激光雷达传感器、微波雷达传感器、激光旋转雷达传感器等,雷达传感器可以设置在机器人上,一般设置在机器人的最高点,但并不一次为限。
本申请实施例提供的移动机器人的雷达数据补偿方法,获取均匀时间序列,根据位置传感器获取数据的时间戳和传感器获取到的位置信息,确定均匀时间序列对应的位置信息,根据角度传感器获取数据的时间戳和角度传感器获取到的角度信息,确定均匀时间序列对应的角度信息,根据均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,由于均匀时间序列的任意两个相邻时间点之间的时间间隔均相等,在对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点时,位置传感器、角度传感器、雷达传感器均采用了均匀时间序列,也即位置传感器、角度传感器、雷达传感器的采样频率是统一的,从而降低了由于各传感器的采样频率不一致造成的位置数据和角度数据的误差,提高了数据校正的准确性,进一步提高了对雷达传感器获取到的数据进行补偿的准确性。
可选地,在上述图2所示实施例的基础上,若均匀时间序列不是预先设定的时间序列,可以根据位置传感器或角度传感器的采样频率确定第一时间序列。
可选地,步骤201“获取均匀时间序列”的一种可能的实现方式,包括:根据所述位置传感器的采样频率确定采样时间间隔;根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
在本实施例中,可以根据位置传感器的采样频率确定均匀时间序列。如图3所示,位置传感器获取数据的时间戳1t1,1t2,1t3,…,1tn,角度传感器获取数据的时间戳为2t1,2t2, 2t3,…,2tn,雷达传感器获取雷达数据时刻为3t1,3t2,3t3,…,3tn。例如,若位置传感器的采样频率为20Hz,则采样时间间隔为50ms,以位置传感器获取数据的第一个时间戳1t1为起点,每隔50ms取一个时间点,组成均匀时间序列1t′1,1t′2,1t′3,…,1t′n
可选地,步骤201“获取均匀时间序列”的另一种可能的实现方式,包括:根据角度传感器的采样频率确定采样时间间隔;根据采样时间间隔,以角度传感器获取数据的第一个时间戳为起点,确定均匀时间序列。
在本实施例中,如图3所示,也可以根据角度传感器获取数据的时间序列为2t1, 2t2,2t3,…,2tn来确定均匀时间序列,例如,若角度传感器的采样频率为10Hz,则采样间隔为10ms,以角度传感器获取数据的时间序列为2t1,2t2,2t3,…,2tn的第一个时间点2t1为起点,每隔10ms取一个时间点,组成均匀时间序列1t'1,1t'2,1t'3,…,1t'n
图4为图2所示实施例中的步骤202的一种可能的实现方式的流程图。如图4所示,步骤202“根据位置传感器获取数据的时间戳和位置传感器获取到的位置信息,确定均匀时间序列对应的位置信息”,包括:
步骤401、根据位置传感器获取数据的时间戳,对位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息。
在本实施例中,如图3所示,可以根据位置传感器获取数据的时间戳1t1,1t2, 1t3,…,1tn,对传感器获取到的位置信息进行插值运算,得到插值后的位置信息。
步骤402、采用预设的滤波参数对插值后的位置信息进行滤波,得到均匀时间序列对应的位置信息。
在本实施例中,为了减小线性插值过程中的误差,可以预先设置一些滤波参数,根据该滤波参数对插值后的位置信息进行滤波,得到均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息。滤波方式可以为卡尔曼滤波、维纳滤波、非线性滤波等,其中,卡尔曼滤波可以是标准卡尔曼滤波,也可以是类似的扩展卡尔曼滤波(extended kalman filter,EKF)、无损卡尔曼滤波(unscented kalman filter,UKF)或粒子滤波等算法。表1为本申请实施例提供的一种卡尔曼滤波参数表。如表1所示,该滤波参数包括状态量X、观测量Z、状态矩阵A、观测矩阵H、过程噪声Q和测量噪声。其中,观测量Z可以为均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息。
表1
Figure GDA0001720891850000111
Figure GDA0001720891850000121
在本实施例中,利用均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息作为观测量Z,利用表1的参数对插值后的位置信息进行滤波可以得到均匀时间序列对应的位置数据。
本申请实施例提供的移动机器人的雷达数据补偿方法,根据位置传感器获取数据的时间戳,对传感器获取到的位置信息进行插值运算,得到插值后的位置信息,采用预设的滤波参数对插值后的位置信息进行滤波,得到均匀时间序列对应的位置信息,由于采用了滤波参数对插值后的位置信息进行滤波,使得得到的均匀时间序列对应的位置信息更加接近移动机器人的实际位置,能够有效估计移动机器人在任意时刻的位置信息,提高移动机器人的定位精度。
图5为图2所示实施例中的步骤204的一种可能的实现方式的流程图。如图5所示,步骤204“根据均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息”,包括:
步骤501、根据均匀时间序列和均匀时间序列对应的角度信息,确定雷达传感器获取数据点时刻。
图6为本申请实施例提供的一种雷达传感器获取数据的时间序列示意图,图6中,3it1,3it2,3it3,…,3itn为雷达传感器获取数据点时刻,3t1,3t2,3t3,…,3tn为雷达传感器获取雷达数据时刻,雷达数据获取时刻为雷达传感器每旋转360度对应的时间点,此时雷达传感器将雷达传感器旋转一周(360度)时获取各雷达数据组成一帧数据上传至处理器,该处理器为移动机器人、终端或服务器的处理器。由于雷达传感器的数据和位置传感器的数据是独立获取的,机器人无法直接获取到雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn对应的运动数据。位置传感器获取数据的时间间隔一般可以为50ms,由于50ms很短暂,可以认为机器人在一个时间间隔内的速度和位置的变化是均匀的,且,雷达传感器获取的每一帧数据的时间点对应的雷达传感器的旋转角度为360°,可以认为雷达传感器的旋转速度恒定,因此,可以利用均匀时间序列1t'1,1t'2,1t'3,…,1t'n和均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的角度位置,推算出雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn
步骤502、根据均匀时间序列,对均匀时间序列对应的位置信息和角度信息进行插值运算,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度。
在本实施例中,可以根据均匀时间序列1t'1,1t'2,1t'3,…,1t'n,对均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的位置信息和角度信息进行插值运算,确定雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn的移动机器人的位置信息和角度。
可选地,还可以根据均匀时间序列对应的位置信息和角度信息来获得移动机器人的速度,如图7所示,V指物体(移动机器人)的运动速度在观察者视线方向的速度分量,即速度矢量在视线方向的投影,V指与物体V垂直方向的速度分量。图7中的Vtot指的是机器人的速度(矢量),图6中显示的就是沿不同方向的两个速度分量,一个在坐标系x、y轴方向上的分量,另外就是在径向速度和方向速度上的分量。可以根据机器人当前速度在x、y轴方向上的分量Vx、Vy以及机器人在均匀时间序列1t'1,1t'2,1t'3,…,1t'n对应的角度信息,计算雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn中每个时间点的径向速度V和法向速度V
图8为图2所示实施例中的步骤205的一种可能的实现方式的流程图。如图8所示,步骤205“根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点”,包括:
步骤801、根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;运动补偿模型用于表示障碍点的位置与雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系。
在本实施例中,雷达传感器获取到的雷达数据并不是移动机器人的位置数据和角度数据,需要对雷达数据进行一定的运算处理之后才能得到雷达传感器获取雷达数据时刻对应的位置信息和角度信息。例如,激光雷达传感器的其工作原理是向目标发射探测信号(激光束),然后将接收到的从目标反射回来的信号(目标回波),将目标反射回来的信号与发射信号进行比较,作适当处理后,就可获得目标的距离、方位、高度、速度、姿态、甚至形状等参数。
在本实施例中,如图9所示,将雷达传感器获取雷达数据时刻3t1,3t2,3t3,…,3tn对应的位置信息和角度信息标记为O0点,坐标为(x0,y00),雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn中各时间点对应的位置信息和角度信息标记为O1点,坐标为(x1,y11),A点为障碍点,A点的坐标为(xA,yA),经过运算后,得到A点与O1点的相对关系为极坐标(ρA1A1),A点与O0的相对关系为极坐标(ρA0A0),运动补偿模型为(ρA0A0)。
其中,各参数计算公式如下:
xA=x1A1*cos(θ1A1),
yA=y1A1*sin(θ1A1),
Figure GDA0001720891850000141
Figure GDA0001720891850000142
步骤802、根据运动补偿模型,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在本实施例中,采用上述的运动补偿模型对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点后,将各时间点的数据重新排列成雷达数据传感器的数据格式,作为后续程序的输入数据,例如,将补偿后的数据作为定位建图模型的输入数据。
本实施例提供的移动机器人的雷达数据补偿方法,根据雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型,根据运动补偿模型,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,由于运动补偿模型用于表示障碍点的位置与雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系,相当于根据障碍点与移动机器人位置之间的相对关系确定机器人的实际位置,可以有效减少机器人自身运动对雷达数据的影响,提高系统工作的鲁棒性和定位建图的准确性。
可选地,在图8所示实施例的基础上,还可以对各插值运算的结果进行评分,当评分较高时,进行运动补偿。如图10所示,步骤802“根据运动补偿模型,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点”,包括:
步骤1001、确定均匀时间序列对应的位置信息的第一插值评分。
在本实施例中,第一插值评分可以包括对均匀时间序列1t'1,1t'2,1t'3,…,1t'n中每个时间点对应的位置信息的插值评分和对经过滤波后的位置信息的插值评分。例如,可以对每个均匀时间序列1t'1,1t'2,1t'3,…,1t'n中每个时间点对应的位置信息进行打分,再对滤波后的位置信息进行评分,求出二者的平均值作为第一插值评分;或者,也可以直接将均匀时间序列1t'1,1t'2,1t'3,…,1t'n中每个时间点对应的位置信息的插值评分作为第一插值评分值。
其中,第一插值评分值可以包括均匀时间序列1t'1,1t'2,1t'3,…,1t'n中每个时间点对应的位置信息的插值评分,也可以是均匀时间序列1t'1,1t'2,1t'3,…,1t'n中所有时间点对应的位置信息的插值评分的平均值。
步骤1002、确定均匀时间序列对应的角度信息的第二插值评分。
在本实施例中,可以对每个均匀时间序列1t'1,1t'2,1t'3,…,1t'n中每个时间点对应的角度信息进行打分,得到第二插值评分。
其中,第二插值评分可以包括均匀时间序列1t'1,1t'2,1t'3,…,1t'n中每个时间点对应的角度信息的插值评分,也可以是均匀时间序列1t'1,1t'2,1t'3,…,1t'n中所有时间点对应的角度信息的插值评分的平均值。
步骤1003、确定雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分。
在本实施例中,可以对雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn中每个时间点对应的位置信息进行打分,得到第三插值评分。
其中,第三插值评分可以包括雷达传感器获取数据点时刻3it1,3it2,3it3,…,3itn中每个时间点对应的位置信息的插值评分,也可以是雷达传感器获取数据点时刻3it1,3it2, 3it3,…,3itn中所有时间点对应的位置信息的插值评分的平均值。
步骤1004、根据第一插值评分、第二插值评分和第三插值评分,计算平均插值评分。
步骤1005、若平均插值评分大于预设阈值,则根据运动补偿模型,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在本实施例中,由于进行了多次的线性插值运算,使得最终得到的数据会有一定的误差,因此,可以为各插值操作运算进行评分。插值点越接近两端点的插值评分越高,插值点越远离两端点的插值评分越低。将所有插值操作的评分累加,获得最终运动补偿过程的平均插值评分,若该平均插值评分越高说明各插值操作可信度越高,所获得结果的准确性越高,则进行运动补偿工作;若平均插值评分过低说明插值操作误差较大,所获结果存在较大误差,不适宜进行运动补偿工作。
本申请实施例提供的数据补偿方法,确定均匀时间序列对应的位置信息的第一插值评分,确定均匀时间序列对应的角度信息的第二插值评分,确定雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分,根据第一插值评分、第二插值评分和第三插值评分,计算平均插值评分,若平均插值评分大于预设阈值,则根据运动补偿模型,对雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,由于平均插值评分越高说明各插值操作可信度越高,所获得结果的准确性越高,因此,在平均插值评分大于预设阈值时进行运动补偿,可以提高运动补偿的准确性,从而提高机器人系统工作的鲁棒性。
应该理解的是,虽然图2-10的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图2-10中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
图11为本申请实施例提供的一种移动机器人的雷达数据补偿装置的框图,如图11所示,该装置包括:获取模块11、第一确定模块12、第二确定模块13、第三确定模块14和补偿模块15。
获取模块11,用于获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
第一确定模块12,用于根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
第二确定模块13,用于根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
第三确定模块14,用于根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
补偿模块15,用于根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
可选地,所述第一确定模块12具体用于根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;采用预设的滤波参数对所述插值后得位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
可选地,所述补偿模块15具体用于根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点;所述运动补偿模型用于表示障碍点的位置与所述雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系。
可选地,所述补偿模块15根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点,包括:
所述补偿模块15确定所述均匀时间序列对应的位置信息的第一插值评分;确定所述均匀时间序列对应的角度信息的第二插值评分;确定所述雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分;根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
可选地,所述第三确定模块14具体用于根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度。
可选地,所述获取模块11具体用于根据所述位置传感器的采样频率确定采样时间间隔;根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
关于上述移动机器人的雷达数据补偿装置的具体限定可以参见上文中对于数据补偿方法的限定,在此不再赘述。上述数据补偿装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于图1所示的机器人、服务器、终端中的处理器中,也可以以软件形式存储于图1所示的机器人、服务器、终端中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种设备,该计算机设备可以是如图1所示的机器人、服务器或终端,其内部结构图可以如图12所示。该设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中,该设备的处理器用于提供计算和控制能力。该设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该设备的数据库用于存储各种位置数据、角度数据、时间序列等。该设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种如图2-图10任一实施例所述的数据补偿方法。
本领域技术人员可以理解,图12中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,提供了一种设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现以下步骤:
获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在一个实施例中,处理器执行计算机程序时,步骤“所述根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息”,包括:根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;采用预设的滤波参数对所述插值后得位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
在一个实施例中,处理器执行计算机程序时,步骤“所述根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点”,包括:
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;所述运动补偿模型用于表示障碍点的位置与所述雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系;根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在一个实施例中,处理器执行计算机程序时,步骤“所述根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点”,包括:确定所述均匀时间序列对应的位置信息的第一插值评分;确定所述均匀时间序列对应的角度信息的第二插值评分;确定所述雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分;根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在一个实施例中,处理器执行计算机程序时,步骤“所述根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息”,包括:根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度。
在一个实施例中,处理器执行计算机程序时,步骤“所述获取均匀时间序列”,包括:根据所述位置传感器的采样频率确定采样时间间隔;根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:
获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在一个实施例中,计算机程序被处理器执行时,步骤“所述根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息”,包括:根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;采用预设的滤波参数对所述插值后得位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
在一个实施例中,计算机程序被处理器执行时,步骤“所述根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点”,包括:根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;所述运动补偿模型用于表示障碍点的位置与所述雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系;根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在一个实施例中,计算机程序被处理器执行时,步骤“所述根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点”,包括:确定所述均匀时间序列对应的位置信息的第一插值评分;确定所述均匀时间序列对应的角度信息的第二插值评分;确定所述雷达传感器获取数据点时刻的移动机器人的位置信息的第三插值评分;根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
在一个实施例中,计算机程序被处理器执行时,步骤“所述根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息”,包括:根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度。
在一个实施例中,计算机程序被处理器执行时,步骤“所述获取均匀时间序列”,包括:根据所述位置传感器的采样频率确定采样时间间隔;根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(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)等。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。

Claims (10)

1.一种移动机器人的雷达数据补偿方法,其特征在于,所述方法包括:
获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息,包括:根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度;
根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;所述运动补偿模型用于表示障碍点的位置与所述雷达传感器获取数据点时刻的移动机器人的实际位置之间的相对关系;
确定所述均匀时间序列对应的位置信息的第一插值评分;所述第一插值评分包括对均匀时间序列中每个时间点对应的位置信息的插值评分和对经过滤波后的位置信息的插值评分;
根据所述角度传感器获取数据的时间戳对所述角度传感器获取到的角度信息进行插值运算,确定所述均匀时间序列对应的角度信息;对所述均匀时间序列对应的角度信息进行评分,得到第二插值评分;
根据所述均匀时间序列,对所述均匀时间序列对应的位置信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息;对所述雷达传感器获取数据点时刻中每个时间点对应的位置信息进行打分,得到第三插值评分;
根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;
若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
2.根据权利要求1所述的方法,其特征在于,所述根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息,包括:
根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;
采用预设的滤波参数对所述插值后的位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
3.根据权利要求1或2所述的方法,其特征在于,所述获取均匀时间序列,包括:
根据所述位置传感器的采样频率确定采样时间间隔;
根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
4.根据权利要求2所述方法,其特征在于,所述滤波参数为卡尔曼滤波参数。
5.根据权利要求1所述的方法,其特征在于,所述获取雷达数据时刻为所述雷达传感器每旋转360度对应的时间点。
6.一种移动机器人的雷达数据补偿装置,其特征在于,包括:
获取模块,用于获取均匀时间序列,所述均匀时间序列的任意两个相邻时间点之间的时间间隔均相等;
第一确定模块,用于根据位置传感器获取数据的时间戳和所述位置传感器获取到的位置信息,确定所述均匀时间序列对应的位置信息;
第二确定模块,用于根据角度传感器获取数据的时间戳和所述角度传感器获取到的角度信息,确定所述均匀时间序列对应的角度信息;
第三确定模块,用于根据所述均匀时间序列对应的位置信息和角度信息,确定雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息;所述第三确定模块具体用于根据所述均匀时间序列和所述均匀时间序列对应的角度信息,确定所述雷达传感器获取数据点时刻;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息和角度信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度;补偿模块,用于根据所述雷达传感器获取数据点时刻的移动机器人的位置信息和角度信息与所述雷达传感器获取雷达数据时刻对应的位置信息和角度信息,确定运动补偿模型;根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点;确定所述均匀时间序列对应的位置信息的第一插值评分;所述第一插值评分包括对均匀时间序列中每个时间点对应的位置信息的插值评分和对经过滤波后的位置信息的插值评分;根据所述角度传感器获取数据的时间戳对所述角度传感器获取到的角度信息进行插值运算,确定所述均匀时间序列对应的角度信息;对所述均匀时间序列对应的角度信息进行评分,得到第二插值评分;根据所述均匀时间序列,对所述均匀时间序列对应的位置信息进行插值运算,确定所述雷达传感器获取数据点时刻的移动机器人的位置信息;对所述雷达传感器获取数据点时刻中每个时间点对应的位置信息进行打分,得到第三插值评分;根据所述第一插值评分、所述第二插值评分和所述第三插值评分,计算平均插值评分;若所述平均插值评分大于预设阈值,则根据所述运动补偿模型,对所述雷达传感器获取雷达数据时刻对应的各雷达数据点进行补偿,以得到雷达数据获取时刻对应的各雷达数据点的运动补偿点。
7.根据权利要求6所述的装置,其特征在于,所述第一确定模块具体用于根据所述位置传感器获取数据的时间戳,对所述位置传感器获取到的位置信息进行插值运算,得到插值后的位置信息;采用预设的滤波参数对所述插值后的位置信息进行滤波,得到所述均匀时间序列对应的位置信息。
8.根据权利要求6或7所述的装置,其特征在于,所述获取模块具体用于根据所述位置传感器的采样频率确定采样时间间隔;根据所述采样时间间隔,以所述位置传感器获取数据的第一个时间戳为起点,确定所述均匀时间序列。
9.一种移动机器人的雷达数据补偿设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至5中任一项所述方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至5中任一项所述的方法的步骤。
CN201810346872.1A 2018-04-18 2018-04-18 移动机器人的雷达数据补偿方法、装置、设备和存储介质 Active CN108957466B (zh)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201810346872.1A CN108957466B (zh) 2018-04-18 2018-04-18 移动机器人的雷达数据补偿方法、装置、设备和存储介质
EP19787948.9A EP3770636A4 (en) 2018-04-18 2019-03-05 RADAR DATA COMPENSATION METHOD FOR MOBILE ROBOT, DEVICE, AND STORAGE MEDIA
PCT/CN2019/077020 WO2019201022A1 (zh) 2018-04-18 2019-03-05 移动机器人的雷达数据补偿方法、设备和存储介质
US17/048,513 US20210165077A1 (en) 2018-04-18 2019-03-05 Radar data compensation method for mobile robot, device, and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810346872.1A CN108957466B (zh) 2018-04-18 2018-04-18 移动机器人的雷达数据补偿方法、装置、设备和存储介质

Publications (2)

Publication Number Publication Date
CN108957466A CN108957466A (zh) 2018-12-07
CN108957466B true CN108957466B (zh) 2022-01-25

Family

ID=64498737

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810346872.1A Active CN108957466B (zh) 2018-04-18 2018-04-18 移动机器人的雷达数据补偿方法、装置、设备和存储介质

Country Status (4)

Country Link
US (1) US20210165077A1 (zh)
EP (1) EP3770636A4 (zh)
CN (1) CN108957466B (zh)
WO (1) WO2019201022A1 (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108957466B (zh) * 2018-04-18 2022-01-25 广东宝乐机器人股份有限公司 移动机器人的雷达数据补偿方法、装置、设备和存储介质
CN108680185B (zh) * 2018-04-26 2020-09-22 广东宝乐机器人股份有限公司 移动机器人的陀螺仪数据校正方法、装置和设备
EP3901573A4 (en) * 2018-12-17 2022-07-06 Chiba Institute of Technology INFORMATION PROCESSING DEVICE AND MOBILE ROBOT
CN112214009B (zh) * 2019-06-25 2022-07-26 上海商汤临港智能科技有限公司 传感器数据处理方法、装置、电子设备及系统
WO2021016936A1 (zh) * 2019-07-31 2021-02-04 深圳市大疆创新科技有限公司 数据校正方法、移动平台及非易失性计算机可读存储介质
CN112947396B (zh) * 2019-11-25 2024-10-18 苏州科瓴精密机械科技有限公司 反光信标夹角误差补偿方法、自动行走设备以及存储介质
CN113739828B (zh) * 2020-05-29 2023-06-16 上海禾赛科技有限公司 测量光电编码器的码盘的角度的方法、电路、设备和介质
CN111829515A (zh) * 2020-07-09 2020-10-27 新石器慧通(北京)科技有限公司 一种时间同步方法、装置、车辆及存储介质
CN111708048B (zh) * 2020-08-19 2021-02-05 深圳市速腾聚创科技有限公司 点云的运动补偿方法、装置和系统
CN112083400A (zh) * 2020-08-21 2020-12-15 达闼机器人有限公司 运动物体及其传感器的标定方法、装置、存储介质
CN112819861B (zh) * 2021-02-26 2024-06-04 广州小马慧行科技有限公司 点云的运动补偿方法、装置与计算机可读存储介质
CN113721631A (zh) * 2021-09-08 2021-11-30 汤恩智能科技(上海)有限公司 传感器数据处理方法、系统及可读存储介质
CN114513752B (zh) * 2021-12-30 2024-02-27 山东信通电子股份有限公司 一种移动终端定位控制方法、设备及介质
CN115147373B (zh) * 2022-07-04 2025-03-07 华南农业大学 一种基于探地雷达对硬质异物的检测方法、装置

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101067656A (zh) * 2007-05-25 2007-11-07 北京航空航天大学 一种位置姿态系统的硬件时间同步方法
CN103323840A (zh) * 2012-03-22 2013-09-25 中国科学院电子学研究所 干涉sar回波数据与平台运动及姿态数据的时间对准方法

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103777201A (zh) * 2012-10-19 2014-05-07 中国航天科工集团第二研究院二〇七所 基于gps数据的机载sar运动补偿方法
CN103823209B (zh) * 2014-02-13 2016-04-13 中国科学院电子学研究所 用于轻小型合成孔径雷达系统中低成本运动误差测量装置
JP6365251B2 (ja) * 2014-02-28 2018-08-01 パナソニック株式会社 レーダ装置
US10518407B2 (en) * 2015-01-06 2019-12-31 Discovery Robotics Apparatus and methods for providing a reconfigurable robotic platform
CN104714231B (zh) * 2015-02-01 2017-02-22 中国传媒大学 一种基于完全互补序列和相位补偿的mimo sar成像方法
CA3006421C (en) * 2015-12-14 2018-10-23 Mitsubishi Electric Corporation Synthetic aperture radar
TW201807523A (zh) * 2016-08-22 2018-03-01 金寶電子工業股份有限公司 移動式機器人的即時導航方法
CN106556826B (zh) * 2016-11-24 2018-12-04 国网山东省电力公司电力科学研究院 变电站巡检机器人定位导航用二维激光雷达标定装置及方法
CN107300919B (zh) * 2017-06-22 2021-06-15 中国科学院深圳先进技术研究院 一种机器人及其行进控制方法
CN107738852B (zh) * 2017-11-30 2020-03-31 歌尔科技有限公司 定位方法、定位地图构建方法及机器人
CN108957466B (zh) * 2018-04-18 2022-01-25 广东宝乐机器人股份有限公司 移动机器人的雷达数据补偿方法、装置、设备和存储介质

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101067656A (zh) * 2007-05-25 2007-11-07 北京航空航天大学 一种位置姿态系统的硬件时间同步方法
CN103323840A (zh) * 2012-03-22 2013-09-25 中国科学院电子学研究所 干涉sar回波数据与平台运动及姿态数据的时间对准方法

Also Published As

Publication number Publication date
US20210165077A1 (en) 2021-06-03
WO2019201022A1 (zh) 2019-10-24
EP3770636A4 (en) 2022-05-04
CN108957466A (zh) 2018-12-07
EP3770636A1 (en) 2021-01-27

Similar Documents

Publication Publication Date Title
CN108957466B (zh) 移动机器人的雷达数据补偿方法、装置、设备和存储介质
US10852139B2 (en) Positioning method, positioning device, and robot
WO2018112926A1 (zh) 定位方法、终端和服务器
CN113701745B (zh) 一种外参变化检测方法、装置、电子设备及检测系统
CN110579738B (zh) 运动目标方向角获取方法及终端设备
CN110887493B (zh) 基于局部地图匹配的轨迹推算方法、介质、终端和装置
CN105103089B (zh) 用于基于视频输入生成准确传感器校正的系统和方法
CN109856640B (zh) 一种基于反光柱或反光板的单线激光雷达二维定位方法
CN113066127B (zh) 一种在线标定设备参数的视觉惯性里程计方法和系统
WO2022205750A1 (zh) 点云数据生成方法、装置、电子设备及存储介质
CN107782311A (zh) 可移动终端的移动路径规划方法及装置
CN113310505A (zh) 传感器系统的外参标定方法、装置及电子设备
CN113554712B (zh) 自动驾驶车辆的配准方法、装置、电子设备和车辆
CN116147614A (zh) 设备定位方法、装置、电子设备、存储介质和程序产品
CN115616642A (zh) 一种位置数据的纠正处理方法、装置、设备及存储介质
CN112966059B (zh) 针对定位数据的数据处理方法、装置、电子设备和介质
CN112578363B (zh) 激光雷达运动轨迹获取方法及装置、介质
CN114245459B (zh) 基于pdr模型的融合定位方法、装置、计算机设备及介质
CN113124861A (zh) 空间辅助的电子设备定位方法、装置、计算机设备及介质
CN111007553B (zh) 被测对象的导航方法、装置、计算机设备和存储介质
CN113777635B (zh) 一种全球导航卫星数据校准方法、装置、终端及存储介质
CN111189450A (zh) 智慧社区内儿童丢失的自动检测方法、设备及存储介质
CN119046669B (zh) 高维序贯图优化的零空间降维协方差估计方法及系统
CN116185046B (zh) 一种移动机器人的定位方法、移动机器人及介质
CN112649815B (zh) 处理数据的方法和装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220620

Address after: 510000 No. 30, haogang Avenue, Dagang Town, Nansha District, Guangzhou City, Guangdong Province

Patentee after: GUANGZHOU COAYU ROBOT Co.,Ltd.

Address before: 518000 2nd and 3rd floors, block D, No. 438, Donghuan Road, Shajing street, Bao'an District, Shenzhen City, Guangdong Province

Patentee before: GUANGDONG BONA ROBOT Corp.,Ltd.

PP01 Preservation of patent right
PP01 Preservation of patent right

Effective date of registration: 20230320

Granted publication date: 20220125