WO2019104740A1 - Method and system for measuring odometer compensation coefficient of vision cleaning robot - Google Patents

Method and system for measuring odometer compensation coefficient of vision cleaning robot Download PDF

Info

Publication number
WO2019104740A1
WO2019104740A1 PCT/CN2017/114339 CN2017114339W WO2019104740A1 WO 2019104740 A1 WO2019104740 A1 WO 2019104740A1 CN 2017114339 W CN2017114339 W CN 2017114339W WO 2019104740 A1 WO2019104740 A1 WO 2019104740A1
Authority
WO
WIPO (PCT)
Prior art keywords
visual
sweeping robot
odometer
compensation coefficient
image
Prior art date
Application number
PCT/CN2017/114339
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/CN2017/114339 priority Critical patent/WO2019104740A1/en
Publication of WO2019104740A1 publication Critical patent/WO2019104740A1/en

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present invention relates to the field of factory inspection of visual sweeping robots, and more particularly to a method and system for measuring the compensation coefficient of a visual sweeping robot odometer.
  • the odometer is a key component of a visual sweeping robot used to measure the displacement and movement speed of a visual sweeping robot.
  • the odometer is typically provided with an encoder that calculates the distance traveled based on the angle at which the encoder rotates and the circumference of the wheel. Due to environmental factors or structural factors, the calculated distance between the odometer and the actual distance is different.
  • the odometer is calibrated before leaving the factory, and the compensation coefficient is calculated to compensate the distance calculated by the odometer. The detected distance is accurate.
  • the visual sweeping robot is manually manually calibrated to calculate the compensation coefficient before leaving the factory, so that the measured speed is relatively slow and the accuracy is not very high.
  • a primary object of the present invention is to provide a method for quickly and automatically calibrating a visual sweeping robot odometer.
  • the present invention provides a method for measuring a compensation coefficient of a visual sweeping robot odometer having a fixed size picture, the method comprising the steps of:
  • the compensation coefficient is calculated by dividing the displacement of the actual movement of the visual sweeping robot by 1 ⁇ 2 by the displacement recorded by the odometer by 1 ⁇ 1.
  • the step of calculating the displacement 1 ⁇ 2 of the actual movement of the visual sweeping robot according to the visual system of the visual sweeping robot comprises: ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the feature points in the picture are spatially reconstructed three-dimensionally, and the three-dimensional space coordinates of the feature points are obtained, thereby obtaining three-dimensional information of the image;
  • the step of calculating the displacement 1 ⁇ 2 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image comprises:
  • the step of calculating the scale information 8 corresponding to each scale according to a preset rule includes:
  • the scale information 8 is calculated by dividing the value of the fixed size preset by the picture by the size of the picture in the three-dimensional space by a scale of three.
  • the step of controlling the movement of the visual cleaning robot within the specified environment comprises:
  • the camera controlling the visual cleaning robot is moving in the direction of the vertical picture facing the picture.
  • the method includes the following steps:
  • a plurality of compensation coefficients are calculated a plurality of times, and an average value of the plurality of compensation coefficients is calculated.
  • the picture is a two-dimensional code.
  • the present invention also provides a system for measuring a compensation coefficient of a visual sweeping robot odometer having a fixed size picture, the system comprising:
  • a mobile device configured to control the visual cleaning robot to move a distance within a specified environment, wherein the visual cleaning robot always has a fixedly set picture with a fixed size in the field of view during the moving process;
  • an actual displacement device configured to calculate an actual movement of the visual cleaning robot according to the fixed size picture ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • an odometer displacement device for obtaining a displacement recorded by the odometer 1 ⁇ 1;
  • the compensation coefficient device is configured to calculate the compensation coefficient by dividing the displacement 1 ⁇ 2 of the actual movement of the visual sweeping robot by the displacement 1 ⁇ 1 recorded by the odometer.
  • the actual displacement device includes:
  • a building module configured to perform spatial three-dimensional reconstruction of feature points in the image according to the image captured by the visual sweeping robot, to obtain a three-dimensional space of the feature point, and thereby obtain three-dimensional information of the image;
  • a calculating module configured to calculate, according to the three-dimensional information of the image, a displacement of the actual movement of the visual cleaning robot by 1 ⁇ 2.
  • the calculating module includes:
  • a moving scale sub-module configured to acquire a scale number II of an initial moving position of the visual sweeping robot in the three-dimensional space and an image distance of the fixed size, and a target distance between the end moving position and the fixed size image Degree is 2;
  • a scale information sub-module configured to calculate scale information corresponding to each scale according to a preset rule
  • a calculation sub-module configured to first calculate a difference between the scale numbers 11 and 72 of the initial motion position in the three-dimensional space and the fixed-size image distance, and multiply the difference by the scale information 8 to calculate the visual sweeping robot.
  • the actual movement displacement is 1 ⁇ 2.
  • the scale information sub-module includes:
  • the size of the size used to obtain the picture in the three-dimensional space is 3;
  • the calculating unit calculates the scale information 8 by dividing the value of the fixed size preset by the picture by the size of the picture in the three-dimensional space by 3.
  • the mobile device includes:
  • a vertical module the camera for controlling the visual cleaning robot is moving in the direction of the vertical picture facing the picture.
  • system for measuring a compensation coefficient of a visual sweeping robot odometer further includes:
  • a plurality of calculation means for repeatedly calculating a plurality of compensation coefficients and calculating an average value of the plurality of compensation coefficients.
  • the picture is a two-dimensional code. ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the beneficial effects of the present invention are: using the sensor of the visual sweeping robot to automatically calculate the compensation coefficient, improve the calibration efficiency of the visual sweeping robot, reduce the time of manual calibration, and provide trademarks. Precision.
  • FIG. 1 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 2 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 3 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 4 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 5 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 6 is a schematic structural view of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 7 is a schematic structural diagram of an actual displacement device of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 8 is a schematic structural diagram of a calculation module of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 9 is a schematic structural diagram of a scale information sub-module of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention.
  • FIG. 10 is a schematic structural diagram of a moving device of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention
  • FIG. 11 is a structural diagram showing a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention. ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention is provided.
  • the measurement environment has a fixed size picture, and the method includes the following steps:
  • the compensation coefficient is calculated by dividing the displacement of the actual movement of the visual sweeping robot by 1 ⁇ 2 by the displacement recorded by the odometer 1 ⁇ 1.
  • the visual sweeping robot moves within the environment, the floor is a smooth plane, the visual sweeping robot can move normally, the visual sweeping machine has a vision system, and the visual system uses the machine instead of the human eye to make measurements and Judge.
  • the vision system refers to converting the ingested target into an image signal through a machine vision product (ie, an image capturing device, divided into 0 MOS and 0), and transmitting it to a dedicated image processing system, according to pixel distribution, brightness, color, and the like, Turning into a digitized signal; the vision system performs various operations on these signals to extract features of the target, and then controls the behavior of the device in the field based on the result of the discrimination. It can be used to measure distances.
  • a machine vision product ie, an image capturing device, divided into 0 MOS and 0
  • a dedicated image processing system according to pixel distribution, brightness, color, and the like
  • the vision system performs various operations on these signals to extract features of the target, and then controls
  • the visual sweeping robot is equipped with a vision system that can measure the distance of obstacles in front and obtain map information of the cleaning environment.
  • the picture of the fixed size is always in the field of view thereof, and the visual cleaning robot takes a picture in the field of view of the visually-scanning robot, and uses the fixed-size picture as a reference to measure the visual sweeping.
  • the actual displacement of the robot is 1 ⁇ 2, and then the displacement calculated by the oscilloscope of the visual sweeping robot is read 1 ⁇ 1, and 1 ⁇ 2 is divided by 0 to calculate the compensation coefficient.
  • the step of calculating the displacement 1 ⁇ 2 32 of the actual movement of the visual sweeping robot according to the fixed size picture includes: ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the feature points in the picture are spatially reconstructed three-dimensionally, and the three-dimensional space coordinates of the feature points are obtained, thereby obtaining three-dimensional information of the image;
  • the visual cleaning robot takes a picture of the visual system during the cleaning, and reconstructs the three-dimensional structure of the space according to the taken photo to obtain a three-dimensional space, and then marks the position before the movement of the visual cleaning robot and the position after the movement.
  • the actual moving distance of the visual sweeping robot is calculated to be 1 ⁇ 2 in the three-dimensional space. Establishing a three-dimensional space, more accurate acquisition of the position of the visual sweeping robot, the calculated actual moving distance 1 ⁇ 2 is more accurate.
  • the step of calculating the displacement 1 ⁇ 2 322 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image includes:
  • each dimension has a scale at intervals, and the distance corresponding to the scale refers to the scale information 8 .
  • the distance scale number 11 of the visual sweeping robot and the fixed size is calculated at the starting position, and the distance scale number of the visual sweeping robot and the fixed size is calculated at the end position by 2, and then according to each
  • the scale information 8 of the number of scales can be calculated as 1 ⁇ 2 . Specifically, first calculate the difference between 0 and 1 ⁇ 2, and then multiply the difference by 8 to get 1 ⁇ 2.
  • the size of 8 can be calculated according to preset rules and some parameters preset by the user.
  • the scale number is a two-dimensional vector. In a specific embodiment, a two-dimensional coordinate system is established with a fixed-size image as an origin.
  • the coordinates of the initial position of the sweeping robot are: the eleven of the shell tree is ⁇ 1), the coordinates of the end position are (X 2 ⁇ 2), and the corresponding 12 is 2, ⁇ 2), then the difference between 11 and 12 is calculated according to the formula. ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the steps of 222 include:
  • a fixed-size picture is a picture occupying a certain length and a width, and the length and the width are known, and the length and the width occupied by the standard in the three-dimensional space are calculated. With a degree of 13, the actual length value corresponding to each scale can be clearly obtained.
  • the fixed length is divided by the fixed length of the picture by a number of 3, that is, 8 can be calculated.
  • 13 indicates the number of scales of the width of the picture, and the fixed width is divided by 13 to obtain the scale information 8.
  • the step of controlling the movement of the visual cleaning robot within the specified environment includes:
  • the camera controlling the visual cleaning robot is moving in the direction of the vertical picture facing the picture.
  • the camera of the visual sweeping robot is facing the picture, so that the mirror surface of the camera is parallel to the picture, and the central axis of the camera is directly opposite the middle of the picture, and the picture captured by the camera is always facing, so that the collection is performed.
  • the size error of the picture is smaller, so that the corresponding compensation coefficient is more accurate.
  • the method includes the following steps:
  • the compensation coefficient after the compensation coefficient is calculated, the compensation coefficient inevitably has an error. Moreover, the error is a random error. To further reduce the error, the best method is to perform multiple experimental calculations. Repeat the above steps of 31 ⁇ 4 to obtain a plurality of compensation coefficients, and calculate an average value of the plurality of compensation coefficients. The average value is used as the final compensation coefficient to improve the accuracy of the detection distance of the visual sweeping robot.
  • the picture is a two-dimensional code.
  • the two-dimensional code refers to a picture of data symbol information recorded in a black and white pattern in a plane (two-dimensional direction) by a certain geometric pattern, and the recognition degree is high, the camera After collecting the picture, it is easy to distinguish. ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the method for measuring the compensation coefficient of the visual sweeping robot odometer of the present invention can automatically calculate the compensation coefficient by using the sensor of the visual sweeping robot, improve the calibration efficiency of the visual sweeping robot, and reduce the manual calibration. Time, the accuracy of the trademark.
  • the present invention further provides a system for measuring a compensation coefficient of a visual sweeping robot odometer, wherein the measurement environment has a fixed size picture, and the system includes:
  • the mobile device 1 is configured to control the visual sweeping robot to move a distance within a specified environment, wherein the visual sweeping robot always has a fixedly set fixed-size image in the field of view during the moving process;
  • the actual displacement device 2 is configured to calculate a displacement of the actual movement of the visual sweeping robot by 1 ⁇ 2 according to the fixed size picture;
  • odometer displacement device 3 used to obtain the displacement recorded by the odometer 1 ⁇ 1;
  • the compensation coefficient means 4 is for calculating the compensation coefficient by dividing the displacement 1 ⁇ 2 of the actual movement of the visual sweeping robot by the displacement 1 ⁇ 1 recorded by the odometer.
  • the visual sweeping robot moves in the environment, the floor is a smooth plane, the visual sweeping robot can move normally, the visual sweeping machine has a vision system, and the visual system uses the machine instead of the human eye to make measurements and Judge.
  • the vision system refers to converting the ingested target into an image signal through a machine vision product (ie, an image capturing device, divided into 0 MOS and 0), and transmitting it to a dedicated image processing system, according to pixel distribution, brightness, color, and the like, Turning into a digitized signal; the vision system performs various operations on these signals to extract features of the target, and then controls the behavior of the device in the field based on the result of the discrimination. It can be used to measure distances.
  • a machine vision product ie, an image capturing device, divided into 0 MOS and 0
  • a dedicated image processing system according to pixel distribution, brightness, color, and the like
  • the vision system performs various operations on these signals to extract features of the target, and then controls
  • the visual sweeping robot is equipped with a vision system that can measure the distance of obstacles in front and obtain map information of the cleaning environment.
  • the moving device 1 keeps the fixed-size picture always within its field of view, and the visual sweeping robot takes a picture in the field of view thereof, with the fixed-size picture as a reference, the actual displacement.
  • the device 2 measures the actual movement displacement of the visual sweeping robot by 1 ⁇ 2, and then the odometer displacement device 3 reads the displacement calculated by the odometer of the visual sweeping robot at this distance 1 ⁇ 1, and the compensation coefficient device 4 is divided by 1 ⁇ 2 With 1 ⁇ 1, the compensation coefficient can be calculated.
  • the actual displacement device 2 includes:
  • the building module 21 is configured to: empty the feature points in the image according to the picture collected by the visual cleaning robot ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the calculation module 22 is configured to calculate a displacement 1 ⁇ 2 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image.
  • the visual system takes a picture, and the constructing module 21 reconstructs the three-dimensional structure of the space according to the photograph taken to obtain a three-dimensional space, and then labels the position before the moving of the visual sweeping robot and the position after the moving.
  • the calculation module 22 calculates the actual moving distance 1 ⁇ 2 of the visual sweeping robot in the three-dimensional space. Establishing a three-dimensional space, more accurate acquisition of the position of the visual sweeping robot, the calculated actual moving distance 1 ⁇ 2 is more accurate.
  • the calculating module 22 includes:
  • a moving scale sub-module 22 configured to acquire a scale number II of an initial moving position of the visual sweeping robot in the three-dimensional space and an image distance of the fixed size, and an image distance between the end moving position and the fixed size Scale quantity 2;
  • the scale information sub-module 222 is configured to calculate scale information corresponding to each scale according to a preset rule.
  • the calculation sub-module 223 is configured to first calculate a difference between the scale numbers 11 and 72 of the initial motion position in the three-dimensional space and the image distance of the fixed size, and then multiply the difference by the scale information 8 to calculate the vision.
  • the displacement of the sweeping robot actually moves 1 ⁇ 2.
  • each dimension has a scale at intervals, and the distance corresponding to the scale refers to the scale information 8.
  • the movement scale sub-module 221 calculates the distance scale number II of the visual sweeping robot and the fixed size at the starting position, and calculates the distance scale number 12 of the visual sweeping robot and the fixed size at the end position. Then, the calculation sub-module 223 can calculate 1 ⁇ 2 according to the scale information 8 of each scale number. Specifically, the calculation sub-module 223 first calculates the difference between 1 ⁇ 1 and 1 ⁇ 2, and then multiplies the difference by 8 to obtain 1 ⁇ 2.
  • the size of 8 is calculated by the scale information sub-module 222 according to preset rules and some parameters preset by the user.
  • the scale number is a two-dimensional vector.
  • a two-dimensional coordinate system is established with a fixed-size image as an origin, and the coordinates of the initial position of the sweeping robot are: 11 of the shell tree is ⁇ 1), ending The coordinates of the position are 2 ⁇ 2), and the corresponding 12 is ( ⁇ 2, ⁇ 2), then the difference between 11 and 12 is calculated according to the formula. Can be calculated.
  • the scale information sub-module 222 includes:
  • the calculating unit 2222 is configured to calculate the scale information s by dividing the value of the fixed size preset by the picture by the number of scales T3 of the size of the picture in the three-dimensional space.
  • the fixed-size picture is a picture occupying a certain length and a width, and the length and the width are known, and the obtained size unit 2221 calculates the length and the width in the three-dimensional space.
  • the number of scales T3 occupied in the scale, the actual length value corresponding to each scale can be obtained.
  • the calculating unit 2222 divides the fixed length by the fixed number of scales T3 of the picture according to the preset third calculation formula, that is, s can be calculated. Or, if T3 represents the number of scales of the width of the picture, divide the fixed width by T3.
  • the mobile device 1 includes:
  • the vertical module 11 is configured to control the camera of the visual cleaning robot to move in the direction of the vertical picture facing the picture.
  • the vertical module 11 faces the camera of the visual cleaning robot so that the mirror surface of the camera is parallel to the picture, and the central axis of the camera is directly opposite the middle of the picture, and the picture captured by the camera is always facing. , so that the size error of the captured picture is smaller, and the corresponding compensation coefficient is more accurate.
  • the system for measuring a compensation coefficient of a visual sweeping robot odometer further includes
  • the multi-calculation device 5 is configured to repeatedly calculate a plurality of compensation coefficients and calculate an average value of the plurality of compensation coefficients.
  • the compensation coefficient after the compensation coefficient is calculated, the compensation coefficient inevitably has an error. Moreover, the error is a random error. To further reduce the error, the best method is to perform multiple experimental calculations.
  • the multiple calculation device 5 repeats the operation of the above devices multiple times to obtain a plurality of compensation coefficients, and calculates an average of multiple compensation coefficients. The value is used as the final compensation coefficient to improve the accuracy of the detection distance of the visual sweeping robot.
  • the picture is a two-dimensional code. ⁇ 0 2019/104740 ⁇ (:17 ⁇ 2017/114339
  • the two-dimensional code refers to a picture of data symbol information recorded in a black and white pattern in a plane (two-dimensional direction) by a certain geometric pattern, and the recognition degree is high, the camera After collecting the picture, it is easy to distinguish.
  • the system for measuring the compensation coefficient of the visual sweeping robot odometer can automatically calculate the compensation coefficient by using the sensor of the visual sweeping robot, improve the calibration efficiency of the visual sweeping robot, and reduce the manual calibration. Time, the accuracy of the trademark.

Abstract

A method and a system for measuring an odometer compensation coefficient of a vision cleaning robot. Said method is used to calculate, on the basis of actual displacement as calculated from a fixed-size picture acquired by a cleaning robot during movement, and of displacement as acquired by an odometer, an odometer compensation coefficient. The present method can automatically calculate the compensation coefficient using a sensor of the vision cleaning robot, improving the calibration efficiency and accuracy.

Description

\¥0 2019/104740 卩(:17 \2017/114339  \¥0 2019/104740 卩(:17 \2017/114339
1  1
测量视觉扫地机器人里程计补偿系数的方法及系统 技术领域 Method and system for measuring compensation coefficient of visual sweeping robot odometer
[0001] 本发明涉及到视觉扫地机器人出厂检测领域, 特别是涉及到一种测量视觉扫地 机器人里程计补偿系数的方法及系统。  [0001] The present invention relates to the field of factory inspection of visual sweeping robots, and more particularly to a method and system for measuring the compensation coefficient of a visual sweeping robot odometer.
背景技术  Background technique
[0002] 里程计是视觉扫地机器人上的一种关键部件, 用来测量视觉扫地机器人的位移 和移动速度。 里程计一般设置有编码器, 根据编码器转动的角度以及轮子的周 长计算移动的距离。 因环境因素或结构等因素, 里程计计算出的移动距离与实 际距离有一定的差距, 一般在出厂前都要对里程计进行标定, 计算出补偿系数 对里程计计算出的距离进行补偿, 使之检测的距离准确。  [0002] The odometer is a key component of a visual sweeping robot used to measure the displacement and movement speed of a visual sweeping robot. The odometer is typically provided with an encoder that calculates the distance traveled based on the angle at which the encoder rotates and the circumference of the wheel. Due to environmental factors or structural factors, the calculated distance between the odometer and the actual distance is different. Generally, the odometer is calibrated before leaving the factory, and the compensation coefficient is calculated to compensate the distance calculated by the odometer. The detected distance is accurate.
[0003] 现在视觉扫地机器人在出厂前都是人工手动标定计算出补偿系数, 这样测量出 的速度比较慢, 而且精度也不是很高。  [0003] Nowadays, the visual sweeping robot is manually manually calibrated to calculate the compensation coefficient before leaving the factory, so that the measured speed is relatively slow and the accuracy is not very high.
技术问题  technical problem
[0004] 本发明的主要目的为提供一种可以快速自动标定视觉扫地机器人里程计方法。  [0004] A primary object of the present invention is to provide a method for quickly and automatically calibrating a visual sweeping robot odometer.
问题的解决方案  Problem solution
技术解决方案  Technical solution
[0005] 本发明提出一种测量视觉扫地机器人里程计补偿系数的方法, 该测量环境里有 一个固定尺寸的图片, 所述方法包括步骤:  [0005] The present invention provides a method for measuring a compensation coefficient of a visual sweeping robot odometer having a fixed size picture, the method comprising the steps of:
[0006] 控制视觉扫地机器人在指定的环境内移动一段距离, 其中, 所述视觉扫地机器 人在移动过程中, 其视野内始终含有固定设置的具有固定尺寸的图片;  [0006] controlling the visual sweeping robot to move a distance within a specified environment, wherein the visual sweeping robot has a fixedly set fixed-size image in the field of view during the moving process;
[0007] 根据所述固定尺寸的图片, 计算出视觉扫地机器人实际移动的位移 1^2; [0007] According to the fixed size picture, calculate the displacement of the actual movement of the visual sweeping robot 1 ^ 2;
[0008] 获取里程计记录的位移0 ;  [0008] obtaining the displacement 0 of the odometer record;
[0009] 用视觉扫地机器人实际移动的位移 1^2除以里程计记录的位移1^1, 计算得出补偿 系数。 [0009] The compensation coefficient is calculated by dividing the displacement of the actual movement of the visual sweeping robot by 1 ^ 2 by the displacement recorded by the odometer by 1 ^ 1.
[0010] 进一步地, 所述根据视觉扫地机器人的视觉系统计算出视觉扫地机器人实际移 动的位移1^2的步骤包括: \¥0 2019/104740 卩(:17 \2017/114339 [0010] Further, the step of calculating the displacement 1 ^ 2 of the actual movement of the visual sweeping robot according to the visual system of the visual sweeping robot comprises: \¥0 2019/104740 卩(:17 \2017/114339
2  2
[0011] 根据视觉扫地机器人采集的图片, 将图片中的特征点进行空间三维重构, 得到 所述特征点的三维空间坐标, 进而得到该图像的三维信息; [0011] according to the picture collected by the visual sweeping robot, the feature points in the picture are spatially reconstructed three-dimensionally, and the three-dimensional space coordinates of the feature points are obtained, thereby obtaining three-dimensional information of the image;
[0012] 根据所述图像的三维信息, 计算出所述视觉扫地机器人实际移动的位移 2。  [0012] calculating a displacement 2 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image.
[0013] 进一步地, 所述在根据所述图像的三维信息, 计算出所述视觉扫地机器人实际 移动的位移 1^2的步骤包括: [0013] Further, the step of calculating the displacement 1 ^ 2 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image comprises:
[0014] 获取视觉扫地机器人在所述三维空间内初始运动位置与所述固定尺寸的图像距 离的标度数11和三维空间内结束运动位置与所述固定尺寸的图像距离的标度数了 2;  [0014] obtaining a scale number 11 of the distance between the initial motion position of the visual sweeping robot and the fixed size image in the three-dimensional space and the scale of the distance between the end motion position and the fixed size image in the three-dimensional space by 2;
[0015] 根据预设的规则计算出每个标度对应的尺度信息  [0015] calculating scale information corresponding to each scale according to a preset rule
[0016] 先计算出三维空间内初始运动位置与所述固定尺寸的图像距离的标度数11与三 维空间内初始运动位置与所述固定尺寸的图像距离的标度数的标度数了2的差, 再用该差乘以尺度信息8 , 计算得出视觉扫地机器人实际移动的位移 1^2。 [0016] first calculating a difference between the scale number 11 of the initial motion position in the three-dimensional space and the image distance of the fixed size and the scale number of the scale number of the initial motion position in the three-dimensional space and the image distance of the fixed size, Then multiply the difference by the scale information 8 to calculate the displacement of the actual movement of the visual sweeping robot by 1 ^ 2 .
[0017] 进一步地, 所述根据预设的规则计算出每个标度对应的尺度信息 8的步骤包括 [0017] Further, the step of calculating the scale information 8 corresponding to each scale according to a preset rule includes:
[0018] 获得图片的尺寸在该三维空间中的标度数了3 ; [0018] The size of the obtained picture in the three-dimensional space is 3;
[0019] 用图片预设的固定尺寸的值除以图片的尺寸在该三维空间中的标度数了3 , 计算 出尺度信息 8。  [0019] The scale information 8 is calculated by dividing the value of the fixed size preset by the picture by the size of the picture in the three-dimensional space by a scale of three.
[0020] 进一步地, 所述控制视觉扫地机器人在指定的环境内移动的步骤包括:  [0020] Further, the step of controlling the movement of the visual cleaning robot within the specified environment comprises:
[0021] 控制视觉扫地机器人的摄像头正对所述图片, 沿着垂直图片的方向移动。  [0021] The camera controlling the visual cleaning robot is moving in the direction of the vertical picture facing the picture.
[0022] 进一步地, 所述计算得出补偿系数后包括步骤:  [0022] Further, after the calculating the compensation coefficient, the method includes the following steps:
[0023] 重复多次计算出多个补偿系数, 计算多个补偿系数的平均值。  [0023] A plurality of compensation coefficients are calculated a plurality of times, and an average value of the plurality of compensation coefficients is calculated.
[0024] 进一步地, 所述图片为二维码。  [0024] Further, the picture is a two-dimensional code.
[0025] 本发明还提出一种测量视觉扫地机器人里程计补偿系数的系统, 该测量环境里 有一个固定尺寸的图片, 所述系统包括:  [0025] The present invention also provides a system for measuring a compensation coefficient of a visual sweeping robot odometer having a fixed size picture, the system comprising:
[0026] 移动装置, 用于控制视觉扫地机器人在指定的环境内移动一段距离, 其中, 所 述视觉扫地机器人在移动过程中, 其视野内始终含有固定设置的具有固定尺寸 的图片;  [0026] a mobile device, configured to control the visual cleaning robot to move a distance within a specified environment, wherein the visual cleaning robot always has a fixedly set picture with a fixed size in the field of view during the moving process;
[0027] 实际位移装置, 用于根据所述固定尺寸的图片, 计算出视觉扫地机器人实际移 \¥0 2019/104740 卩(:17 \2017/114339 [0027] an actual displacement device, configured to calculate an actual movement of the visual cleaning robot according to the fixed size picture \¥0 2019/104740 卩(:17 \2017/114339
3 动的位移!^2; 3 moving displacement! ^ 2;
[0028] 里程计位移装置, 用于获取里程计记录的位移 1^1 ; [0028] an odometer displacement device for obtaining a displacement recorded by the odometer 1 ^ 1;
[0029] 补偿系数装置, 用于用视觉扫地机器人实际移动的位移 1^2除以里程计记录的位 移1^1计算得出补偿系数。 [0029] The compensation coefficient device is configured to calculate the compensation coefficient by dividing the displacement 1 ^ 2 of the actual movement of the visual sweeping robot by the displacement 1 ^ 1 recorded by the odometer.
[0030] 进一步地, 所述实际位移装置包括:  [0030] Further, the actual displacement device includes:
[0031] 构建模块, 用于根据视觉扫地机器人采集的图片, 将图片中的特征点进行空间 三维重构, 得到所述特征点的三维空间, 进而得到该图像的三维信息;  [0031] a building module, configured to perform spatial three-dimensional reconstruction of feature points in the image according to the image captured by the visual sweeping robot, to obtain a three-dimensional space of the feature point, and thereby obtain three-dimensional information of the image;
[0032] 计算模块, 用于根据所述图像的三维信息, 计算出所述视觉扫地机器人实际移 动的位移1^2。 And a calculating module, configured to calculate, according to the three-dimensional information of the image, a displacement of the actual movement of the visual cleaning robot by 1 ^ 2.
[0033] 进一步地, 所述计算模块包括:  [0033] Further, the calculating module includes:
[0034] 移动标度子模块, 用于获取视觉扫地机器人在所述三维空间内初始运动位置与 所述固定尺寸的图像距离的标度数II和结束运动位置与所述固定尺寸的图像距 离的标度数了2;  [0034] a moving scale sub-module, configured to acquire a scale number II of an initial moving position of the visual sweeping robot in the three-dimensional space and an image distance of the fixed size, and a target distance between the end moving position and the fixed size image Degree is 2;
[0035] 尺度信息子模块, 用于根据预设的规则计算出每个标度对应的尺度信息  [0035] a scale information sub-module, configured to calculate scale information corresponding to each scale according to a preset rule
[0036] 计算子模块, 用于先计算出三维空间内初始运动位置与所述固定尺寸的图像距 离的标度数 11与72的差, 再用差乘以尺度信息 8 , 计算得出视觉扫地机器人实际 移动的位移 1^2。 [0036] a calculation sub-module, configured to first calculate a difference between the scale numbers 11 and 72 of the initial motion position in the three-dimensional space and the fixed-size image distance, and multiply the difference by the scale information 8 to calculate the visual sweeping robot. The actual movement displacement is 1 ^ 2.
[0037] 进一步地, 所述尺度信息子模块包括:  [0037] Further, the scale information sub-module includes:
[0038] 获得尺寸单元, 用于获得图片的尺寸在该三维空间中的标度数了3 ;  [0038] obtaining a size unit, the size of the size used to obtain the picture in the three-dimensional space is 3;
[0039] 计算单元, 用于用图片预设的固定尺寸的值除以图片的尺寸在该三维空间中的 标度数了3 , 计算出尺度信息8。  [0039] The calculating unit calculates the scale information 8 by dividing the value of the fixed size preset by the picture by the size of the picture in the three-dimensional space by 3.
[0040] 进一步地, 所述移动装置包括:  [0040] Further, the mobile device includes:
[0041] 垂直模块, 用于控制视觉扫地机器人的摄像头正对所述图片, 沿着垂直图片的 方向移动。  [0041] a vertical module, the camera for controlling the visual cleaning robot is moving in the direction of the vertical picture facing the picture.
[0042] 进一步地, 所述测量视觉扫地机器人里程计补偿系数的系统还包括:  [0042] Further, the system for measuring a compensation coefficient of a visual sweeping robot odometer further includes:
[0043] 多次计算装置, 用于重复多次计算出多个补偿系数, 计算多个补偿系数的平均 值。  [0043] A plurality of calculation means for repeatedly calculating a plurality of compensation coefficients and calculating an average value of the plurality of compensation coefficients.
[0044] 进一步地, 所述图片为二维码。 \¥0 2019/104740 卩(:17 \2017/114339 [0044] Further, the picture is a two-dimensional code. \¥0 2019/104740 卩(:17 \2017/114339
4 发明的有益效果  4 beneficial effects of the invention
有益效果  Beneficial effect
[0045] 与现有技术相比, 本发明的有益效果是: 利用视觉扫地机器人自身的传感器就 可以自动完成补偿系数的计算, 提高视觉扫地机器人的标定效率, 减少人工标 定的时间, 提商标定精度。  [0045] Compared with the prior art, the beneficial effects of the present invention are: using the sensor of the visual sweeping robot to automatically calculate the compensation coefficient, improve the calibration efficiency of the visual sweeping robot, reduce the time of manual calibration, and provide trademarks. Precision.
对附图的简要说明  Brief description of the drawing
附图说明  DRAWINGS
[0046] 图 1是本发明一实施例的测量视觉扫地机器人里程计补偿系数的方法的步骤示 意图;  1 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0047] 图 2是本发明一实施例的测量视觉扫地机器人里程计补偿系数的方法的步骤示 意图;  2 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0048] 图 3是本发明一实施例的测量视觉扫地机器人里程计补偿系数的方法的步骤示 意图;  3 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0049] 图 4是本发明一实施例的测量视觉扫地机器人里程计补偿系数的方法的步骤示 意图;  4 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0050] 图 5是本发明一实施例的测量视觉扫地机器人里程计补偿系数的方法的步骤示 意图;  5 is a schematic diagram showing the steps of a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0051] 图 6是本发明一实施例的测量视觉扫地机器人里程计补偿系数的系统的结构示 意图;  6 is a schematic structural view of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0052] 图 7是本发明一实施例的测量视觉扫地机器人里程计补偿系数的系统的实际位 移装置的结构示意图;  7 is a schematic structural diagram of an actual displacement device of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0053] 图 8是本发明一实施例的测量视觉扫地机器人里程计补偿系数的系统的计算模 块的结构示意图;  8 is a schematic structural diagram of a calculation module of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0054] 图 9是本发明一实施例的测量视觉扫地机器人里程计补偿系数的系统的尺度信 息子模块的结构示意图;  9 is a schematic structural diagram of a scale information sub-module of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0055] 图 10是本发明一实施例的测量视觉扫地机器人里程计补偿系数的系统的移动装 置的结构示意图;  10 is a schematic structural diagram of a moving device of a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention;
[0056] 图 11是本发明一实施例的测量视觉扫地机器人里程计补偿系数的系统的结构示 \¥0 2019/104740 卩(:17 \2017/114339 11 is a structural diagram showing a system for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention. \¥0 2019/104740 卩(:17 \2017/114339
5 意图。  5 Intention.
[0057] 本发明目的的实现、 功能特点及优点将结合实施例, 参照附图做进一步说明。  [0057] The implementation, functional features, and advantages of the present invention will be further described with reference to the accompanying drawings.
实施该发明的最佳实施例  BEST MODE FOR CARRYING OUT THE INVENTION
本发明的最佳实施方式  BEST MODE FOR CARRYING OUT THE INVENTION
[0058] 应当理解, 此处所描述的具体实施例仅仅用以解释本发明, 并不用于限定本发 明。  The specific embodiments described herein are intended to be illustrative only and not to limit the invention.
[0059] 参照图 1, 提出本发明一实施例的测量视觉扫地机器人里程计补偿系数的方法 , 该测量环境里有一个固定尺寸的图片, 所述方法包括步骤:  [0059] Referring to FIG. 1, a method for measuring a compensation coefficient of a visual sweeping robot odometer according to an embodiment of the present invention is provided. The measurement environment has a fixed size picture, and the method includes the following steps:
[0060] 81、 控制视觉扫地机器人在指定的环境内移动一段距离, 其中, 所述视觉扫地 机器人在移动过程中, 其视野内始终含有固定设置的具有固定尺寸的图片; [0060] 81, controlling the visual cleaning robot to move a distance within a specified environment, wherein the visual cleaning robot always has a fixedly set picture with a fixed size in the field of view during the movement;
[0061] 82、 根据所述固定尺寸的图片, 计算出视觉扫地机器人实际移动的位移 1^2; [0061] 82, according to the fixed size picture, calculate the displacement of the actual movement of the visual sweeping robot 1 ^ 2;
[0062] 33、 获取里程计记录的位移0 ;  [0062] 33, obtain the displacement 0 recorded by the odometer;
[0063] 4、 用视觉扫地机器人实际移动的位移 1^2除以里程计记录的位移1^1, 计算得 出补偿系数。 [0063] 4. The compensation coefficient is calculated by dividing the displacement of the actual movement of the visual sweeping robot by 1 ^ 2 by the displacement recorded by the odometer 1 ^ 1.
[0064] 本实施例中, 视觉扫地机器人在该环境内移动, 地板是平滑的平面, 视觉扫地 机器人可以正常移动, 视觉扫地机器带有视觉系统, 视觉系统就是用机器代替 人眼来做测量和判断。 视觉系统是指通过机器视觉产品 (即图像摄取装置, 分 0 MOS和 :0两种) 将被摄取目标转换成图像信号, 传送给专用的图像处理系统 , 根据像素分布和亮度、 颜色等信息, 转变成数字化信号; 视觉系统对这些信 号进行各种运算来抽取目标的特征, 进而根据判别的结果来控制现场的设备动 作。 可以用于测量距离, 视觉扫地机器人安装有视觉系统可以测量前方障碍物 的距离、 获取清扫环境的地图信息等。 在该实施例中, 视觉扫地机器人在移动 时, 保持固定尺寸的图片始终位于其视野范围内, 视觉扫地机器人拍摄其视野 范围内的图片, 以该固定尺寸的图片做为参照, 测量出视觉扫地机器人的实际 移动位移1^2, 然后读取在这段距离视觉扫地机器人的里程计计算出的位移 1^1, 用1^2除以 0 , 就可以计算出补偿系数。 [0064] In this embodiment, the visual sweeping robot moves within the environment, the floor is a smooth plane, the visual sweeping robot can move normally, the visual sweeping machine has a vision system, and the visual system uses the machine instead of the human eye to make measurements and Judge. The vision system refers to converting the ingested target into an image signal through a machine vision product (ie, an image capturing device, divided into 0 MOS and 0), and transmitting it to a dedicated image processing system, according to pixel distribution, brightness, color, and the like, Turning into a digitized signal; the vision system performs various operations on these signals to extract features of the target, and then controls the behavior of the device in the field based on the result of the discrimination. It can be used to measure distances. The visual sweeping robot is equipped with a vision system that can measure the distance of obstacles in front and obtain map information of the cleaning environment. In this embodiment, when the visual cleaning robot moves, the picture of the fixed size is always in the field of view thereof, and the visual cleaning robot takes a picture in the field of view of the visually-scanning robot, and uses the fixed-size picture as a reference to measure the visual sweeping. The actual displacement of the robot is 1 ^ 2, and then the displacement calculated by the oscilloscope of the visual sweeping robot is read 1 ^ 1, and 1 ^ 2 is divided by 0 to calculate the compensation coefficient.
[0065] 参照图 2, 进一步地, 所述根据所述固定尺寸的图片, 计算出视觉扫地机器人 实际移动的位移1^2 32的步骤包括: \¥0 2019/104740 卩(:17 \2017/114339 [0065] Referring to FIG. 2, the step of calculating the displacement 1 ^ 2 32 of the actual movement of the visual sweeping robot according to the fixed size picture includes: \¥0 2019/104740 卩(:17 \2017/114339
6  6
[0066] 21、 根据视觉扫地机器人采集的图片, 将图片中的特征点进行空间三维重构 , 得到所述特征点的三维空间坐标, 进而得到该图像的三维信息; [0066] 21. According to the picture collected by the visual sweeping robot, the feature points in the picture are spatially reconstructed three-dimensionally, and the three-dimensional space coordinates of the feature points are obtained, thereby obtaining three-dimensional information of the image;
[0067] 822、 根据所述图像的三维信息, 计算出所述视觉扫地机器人实际移动的位移!^ [0067] 822, information of the three-dimensional image, the cleaning robot calculates the actual movement of the visual displacement! ^
2。 2.
[0068] 本实施例中, 视觉扫地机器人在清扫时, 视觉系统拍照, 并根据拍摄的照片重 建空间三维结构, 得到三维空间, 然后将视觉扫地机器人移动前的位置和移动 后的位置标注在该三维空间中, 在该三维空间中计算出视觉扫地机器人的实际 移动距离1^2。 建立三维空间, 更加精准的获取视觉扫地机器人的位置, 计算出 来的实际移动距离 1^2更加准确。 [0068] In the embodiment, the visual cleaning robot takes a picture of the visual system during the cleaning, and reconstructs the three-dimensional structure of the space according to the taken photo to obtain a three-dimensional space, and then marks the position before the movement of the visual cleaning robot and the position after the movement. In the three-dimensional space, the actual moving distance of the visual sweeping robot is calculated to be 1 ^ 2 in the three-dimensional space. Establishing a three-dimensional space, more accurate acquisition of the position of the visual sweeping robot, the calculated actual moving distance 1 ^ 2 is more accurate.
[0069] 参照图 3 , 进一步地, 所述根据所述图像的三维信息, 计算出所述视觉扫地机 器人实际移动的位移 1^2 322的步骤包括: [0069] Referring to FIG. 3, the step of calculating the displacement 1 ^ 2 322 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image includes:
[0070] 8221. 获取视觉扫地机器人在所述三维空间内初始运动位置与所述固定尺寸的 图像距离的标度数11和三维空间内结束运动位置与所述固定尺寸的图像距离的 标度数了2;  [0070] 8221. Obtain a scale number 11 of the distance between the initial motion position of the visual cleaning robot and the fixed size in the three-dimensional space, and a scale number of the distance between the end motion position and the fixed size image in the three-dimensional space. ;
[0071] 8222、 根据预设的规则计算出每个标度对应的尺度信息  [0071] 8222. Calculate scale information corresponding to each scale according to a preset rule.
[0072] 3223、 先计算出三维空间内初始运动位置与所述固定尺寸的图像距离的标度数 [0072] 3223, first calculating the number of scales of the initial motion position in the three-dimensional space and the image distance of the fixed size
II与三维空间内初始运动位置与所述固定尺寸的图像距离的标度数的标度数了2 的差, 再用该差乘以尺度信息8 , 计算得出视觉扫地机器人实际移动的位移 1^2。 II and the scale of the scale of the initial motion position in the three-dimensional space and the image distance of the fixed size are two, and then multiply the difference by the scale information 8 to calculate the displacement of the actual movement of the visual sweeping robot 1 ^ 2 .
[0073] 本实施例中, 在三维空间中, 每个维度每隔一段距离有一个标度, 该标度对应 的距离就是指尺度信息8。 在该三维空间中, 在起始位置计算出视觉扫地机器人 与所述固定尺寸的距离标度数11, 在结束位置计算出视觉扫地机器人与所述固 定尺寸的距离标度数了2, 然后再根据每个标度数量的尺度信息8 , 就可以计算出 1^2。 具体的, 先计算出 0和1^2的差, 再将得到差乘以8 , 得到 1^2。 其中 8的大小 可以根据预设的规则以及用户预设的一些参数计算出来。 其中, 标度数是一个 二维向量, 在一具体实施例中, 以固定尺寸的图像为原点建立一个二维坐标系[0073] In the embodiment, in the three-dimensional space, each dimension has a scale at intervals, and the distance corresponding to the scale refers to the scale information 8 . In the three-dimensional space, the distance scale number 11 of the visual sweeping robot and the fixed size is calculated at the starting position, and the distance scale number of the visual sweeping robot and the fixed size is calculated at the end position by 2, and then according to each The scale information 8 of the number of scales can be calculated as 1 ^ 2 . Specifically, first calculate the difference between 0 and 1 ^ 2, and then multiply the difference by 8 to get 1 ^ 2. The size of 8 can be calculated according to preset rules and some parameters preset by the user. Wherein, the scale number is a two-dimensional vector. In a specific embodiment, a two-dimensional coordinate system is established with a fixed-size image as an origin.
, 扫地机器人初始位置的坐标是, 贝树应的11就是 ^1), 结束位置的坐标是 (X 2^2) , 对应的 12就是 2,\2), 则计算 11和12的差根据公式
Figure imgf000008_0001
\¥0 2019/104740 卩(:17 \2017/114339
The coordinates of the initial position of the sweeping robot are: the eleven of the shell tree is ^1), the coordinates of the end position are (X 2^2), and the corresponding 12 is 2, \2), then the difference between 11 and 12 is calculated according to the formula.
Figure imgf000008_0001
\¥0 2019/104740 卩(:17 \2017/114339
7 可以计算得到。  7 can be calculated.
[0074] 参照图 4, 进一步地, 所述根据预设的规则计算出每个标度对应的尺度信息 8 [0074] Referring to FIG. 4, further, the scale information corresponding to each scale is calculated according to a preset rule. 8
222的步骤包括:  The steps of 222 include:
[0075] 82221 ^ 获得图片的尺寸在该三维空间中的标度数了3 ; [2215] 82221 ^ The size of the obtained picture in the three-dimensional space has a scale of 3;
[0076] 82222. 用图片预设的固定尺寸的值除以图片的尺寸在该三维空间中的标度数了 [0076] 82222. The value of the fixed size preset by the picture is divided by the size of the picture in the three-dimensional space.
3计算出尺度信息8。 3 Calculate the scale information 8.
[0077] 本实施例中, 在三维空间中, 固定尺寸的图片是一个占有一定长度以及宽度的 图片, 该长度和宽度是已知的, 计算出该长度以及宽度在该三维空间中占用的 标度数 13 , 则每个标度对应的实际长度值可以明显的得到。 根据预设的第三计 算公式, 用固定的长度除以图片的固定长度的标度数量了3 , 即可以计算出 8。 或 者, 13表示图片的宽度的标度数量, 则用固定宽度除以 13 , 得到尺度信息 8。 [0077] In this embodiment, in a three-dimensional space, a fixed-size picture is a picture occupying a certain length and a width, and the length and the width are known, and the length and the width occupied by the standard in the three-dimensional space are calculated. With a degree of 13, the actual length value corresponding to each scale can be clearly obtained. According to the preset third calculation formula, the fixed length is divided by the fixed length of the picture by a number of 3, that is, 8 can be calculated. Or, 13 indicates the number of scales of the width of the picture, and the fixed width is divided by 13 to obtain the scale information 8.
[0078] 参照图 5 , 进一步地, 所述控制视觉扫地机器人在指定的环境内移动的步骤包 括:  [0078] Referring to FIG. 5, further, the step of controlling the movement of the visual cleaning robot within the specified environment includes:
[0079] 311、 控制视觉扫地机器人的摄像头正对所述图片, 沿着垂直图片的方向移动  [0079] 311. The camera controlling the visual cleaning robot is moving in the direction of the vertical picture facing the picture.
[0080] 本实施例中, 将视觉扫地机器人的摄像头正对图片, 使摄像头的镜面平行于图 片, 而且摄像头的中轴线正对着图片的中间, 摄像头采集的图片一直是正对着 的, 使采集的图片的尺寸误差更小, 从而对应的得出的补偿系数精度更高。 [0080] In this embodiment, the camera of the visual sweeping robot is facing the picture, so that the mirror surface of the camera is parallel to the picture, and the central axis of the camera is directly opposite the middle of the picture, and the picture captured by the camera is always facing, so that the collection is performed. The size error of the picture is smaller, so that the corresponding compensation coefficient is more accurate.
[0081] 进一步地, 所述计算得出补偿系数后包括步骤:  [0081] Further, after the calculating the compensation coefficient, the method includes the following steps:
[0082] 85、 重复多次计算出多个补偿系数, 计算多个补偿系数的平均值。  [0082] 85. Calculate a plurality of compensation coefficients repeatedly, and calculate an average value of the plurality of compensation coefficients.
[0083] 本实施例中, 计算得出补偿系数后, 该补偿系数不可避免会存在误差。 而且该 误差是随机误差, 为进一步减小误差, 最好的方法就是多次实验计算, 多次重 复上述 31^4的步骤得出多个补偿系数, 计算多个补偿系数的平均值, 以该平均 值作为最终的补偿系数, 提高视觉扫地机器人的检测距离的精度。  [0083] In this embodiment, after the compensation coefficient is calculated, the compensation coefficient inevitably has an error. Moreover, the error is a random error. To further reduce the error, the best method is to perform multiple experimental calculations. Repeat the above steps of 31^4 to obtain a plurality of compensation coefficients, and calculate an average value of the plurality of compensation coefficients. The average value is used as the final compensation coefficient to improve the accuracy of the detection distance of the visual sweeping robot.
[0084] 进一步地, 所述图片为二维码。  [0084] Further, the picture is a two-dimensional code.
[0085] 本实施例中, 二维码是指是用某种特定的几何图形按一定规律在平面 (二维方 向上) 分布的黑白相间的图形记录数据符号信息的图片, 辨识度高, 摄像头采 集到该图片后, 容易辨别。 \¥0 2019/104740 卩(:17 \2017/114339 [0085] In the embodiment, the two-dimensional code refers to a picture of data symbol information recorded in a black and white pattern in a plane (two-dimensional direction) by a certain geometric pattern, and the recognition degree is high, the camera After collecting the picture, it is easy to distinguish. \¥0 2019/104740 卩(:17 \2017/114339
8  8
[0086] 综上所述, 本发明的测量视觉扫地机器人里程计补偿系数的方法, 利用视觉扫 地机器人自身的传感器就可以自动完成补偿系数的计算, 提高视觉扫地机器人 的标定效率, 减少人工标定的时间, 提商标定精度。 [0086] In summary, the method for measuring the compensation coefficient of the visual sweeping robot odometer of the present invention can automatically calculate the compensation coefficient by using the sensor of the visual sweeping robot, improve the calibration efficiency of the visual sweeping robot, and reduce the manual calibration. Time, the accuracy of the trademark.
[0087] 参照图 6 , 本发明还提出一测量视觉扫地机器人里程计补偿系数的系统, 该测 量环境里有一个固定尺寸的图片, 所述系统包括:  Referring to FIG. 6, the present invention further provides a system for measuring a compensation coefficient of a visual sweeping robot odometer, wherein the measurement environment has a fixed size picture, and the system includes:
[0088] 移动装置 1, 用于控制视觉扫地机器人在指定的环境内移动一段距离, 其中, 所述视觉扫地机器人在移动过程中, 其视野内始终含有固定设置的具有固定尺 寸的图片;  [0088] The mobile device 1 is configured to control the visual sweeping robot to move a distance within a specified environment, wherein the visual sweeping robot always has a fixedly set fixed-size image in the field of view during the moving process;
[0089] 实际位移装置 2, 用于根据所述固定尺寸的图片, 计算出视觉扫地机器人实际 移动的位移 1^2; [0089] The actual displacement device 2 is configured to calculate a displacement of the actual movement of the visual sweeping robot by 1 ^ 2 according to the fixed size picture;
[0090] 里程计位移装置 3, 用于获取里程计记录的位移 1^1 ; [0090] odometer displacement device 3, used to obtain the displacement recorded by the odometer 1 ^ 1;
[0091] 补偿系数装置 4, 用于用用视觉扫地机器人实际移动的位移 1^2除以里程计记录 的位移 1^1, 计算得出补偿系数。 [0091] The compensation coefficient means 4 is for calculating the compensation coefficient by dividing the displacement 1 ^ 2 of the actual movement of the visual sweeping robot by the displacement 1 ^ 1 recorded by the odometer.
[0092] 本实施例中, 视觉扫地机器人在该环境内移动, 地板是平滑的平面, 视觉扫地 机器人可以正常移动, 视觉扫地机器带有视觉系统, 视觉系统就是用机器代替 人眼来做测量和判断。 视觉系统是指通过机器视觉产品 (即图像摄取装置, 分 0 MOS和 :0两种) 将被摄取目标转换成图像信号, 传送给专用的图像处理系统 , 根据像素分布和亮度、 颜色等信息, 转变成数字化信号; 视觉系统对这些信 号进行各种运算来抽取目标的特征, 进而根据判别的结果来控制现场的设备动 作。 可以用于测量距离, 视觉扫地机器人安装有视觉系统可以测量前方障碍物 的距离、 获取清扫环境的地图信息等。 在该实施例中, 视觉扫地机器人在移动 时, 移动装置 1保持固定尺寸的图片始终位于其视野范围内, 视觉扫地机器人拍 摄其视野范围内的图片, 以该固定尺寸的图片作为参照, 实际位移装置 2测量出 视觉扫地机器人的实际移动位移 1^2, 然后里程计位移装置 3读取在这段距离视觉 扫地机器人的里程计计算出的位移 1^1, 补偿系数装置 4用1^2除以 1^1, 就可以计算 出补偿系数。 [0092] In this embodiment, the visual sweeping robot moves in the environment, the floor is a smooth plane, the visual sweeping robot can move normally, the visual sweeping machine has a vision system, and the visual system uses the machine instead of the human eye to make measurements and Judge. The vision system refers to converting the ingested target into an image signal through a machine vision product (ie, an image capturing device, divided into 0 MOS and 0), and transmitting it to a dedicated image processing system, according to pixel distribution, brightness, color, and the like, Turning into a digitized signal; the vision system performs various operations on these signals to extract features of the target, and then controls the behavior of the device in the field based on the result of the discrimination. It can be used to measure distances. The visual sweeping robot is equipped with a vision system that can measure the distance of obstacles in front and obtain map information of the cleaning environment. In this embodiment, when the visual sweeping robot moves, the moving device 1 keeps the fixed-size picture always within its field of view, and the visual sweeping robot takes a picture in the field of view thereof, with the fixed-size picture as a reference, the actual displacement. The device 2 measures the actual movement displacement of the visual sweeping robot by 1 ^ 2, and then the odometer displacement device 3 reads the displacement calculated by the odometer of the visual sweeping robot at this distance 1 ^ 1, and the compensation coefficient device 4 is divided by 1 ^ 2 With 1 ^ 1, the compensation coefficient can be calculated.
[0093] 参照图 7, 进一步地, 所述实际位移装置 2包括:  [0093] Referring to FIG. 7, further, the actual displacement device 2 includes:
[0094] 构建模块 21, 用于根据视觉扫地机器人采集的图片, 将图片中的特征点进行空 \¥0 2019/104740 卩(:17 \2017/114339 [0094] The building module 21 is configured to: empty the feature points in the image according to the picture collected by the visual cleaning robot \¥0 2019/104740 卩(:17 \2017/114339
9 间三维重构, 得到所述特征点的三维空间, 进而得到该图像的三维信息;  9 three-dimensional reconstruction, obtaining a three-dimensional space of the feature point, thereby obtaining three-dimensional information of the image;
[0095] 计算模块 22, 用于根据所述图像的三维信息, 计算出所述视觉扫地机器人实际 移动的位移 1^2。 [0095] The calculation module 22 is configured to calculate a displacement 1 ^ 2 of the actual movement of the visual cleaning robot according to the three-dimensional information of the image.
[0096] 本实施例中, 视觉扫地机器人在清扫时, 视觉系统拍照, 构建模块 21根据拍摄 的照片重建空间三维结构, 得到三维空间, 然后将视觉扫地机器人移动前的位 置和移动后的位置标注在该三维空间中, 计算模块 22在该三维空间中计算出视 觉扫地机器人的实际移动距离1^2。 建立三维空间, 更加精准的获取视觉扫地机 器人的位置, 计算出来的实际移动距离 1^2更加准确。 [0096] In this embodiment, when the visual sweeping robot cleans, the visual system takes a picture, and the constructing module 21 reconstructs the three-dimensional structure of the space according to the photograph taken to obtain a three-dimensional space, and then labels the position before the moving of the visual sweeping robot and the position after the moving. In the three-dimensional space, the calculation module 22 calculates the actual moving distance 1 ^ 2 of the visual sweeping robot in the three-dimensional space. Establishing a three-dimensional space, more accurate acquisition of the position of the visual sweeping robot, the calculated actual moving distance 1 ^ 2 is more accurate.
[0097] 参照图 8, 进一步地, 所述计算模块 22包括:  [0097] Referring to FIG. 8, further, the calculating module 22 includes:
[0098] 移动标度子模块 221, 用于获取视觉扫地机器人在所述三维空间内初始运动位 置与所述固定尺寸的图像距离的标度数II和结束运动位置与所述固定尺寸的图 像距离的标度数量工2;  [0098] a moving scale sub-module 221, configured to acquire a scale number II of an initial moving position of the visual sweeping robot in the three-dimensional space and an image distance of the fixed size, and an image distance between the end moving position and the fixed size Scale quantity 2;
[0099] 尺度信息子模块 222, 用于根据预设的规则计算出每个标度对应的尺度信息 [0099] The scale information sub-module 222 is configured to calculate scale information corresponding to each scale according to a preset rule.
[0100] 计算子模块 223 , 用于先计算出三维空间内初始运动位置与所述固定尺寸的图 像距离的标度数11与72的差, 再用差乘以尺度信息 8 , , 计算得出视觉扫地机器 人实际移动的位移 1^2。 [0100] The calculation sub-module 223 is configured to first calculate a difference between the scale numbers 11 and 72 of the initial motion position in the three-dimensional space and the image distance of the fixed size, and then multiply the difference by the scale information 8 to calculate the vision. The displacement of the sweeping robot actually moves 1 ^ 2.
[0101] 本实施例中, 在三维坐标体系中, 每个维度每隔一段距离有一个标度, 该标度 对应的距离就是指尺度信息 8。 在该三维空间中, 移动标度子模块 221在起始位置 计算出视觉扫地机器人与所述固定尺寸的距离标度数II, 在结束位置计算出视 觉扫地机器人与所述固定尺寸的距离标度数12, 然后计算子模块 223再根据每个 标度数量的尺度信息 8 , 就可以计算出 1^2。 具体的, 计算子模块 223先计算出1^1 和1^2的差, 再将得到差乘以8 , 得到 1^2。 其中 8的大小由尺度信息子模块 222根据 预设的规则以及用户预设的一些参数计算出来。 其中, 标度数是一个二维向量 , 在一具体实施例中, 以固定尺寸的图像为原点建立一个二维坐标系, 扫地机 器人初始位置的坐标是, 贝树应的11就是 ^1), 结束位置的坐标是 2^2), 对 应的 12就是 (\2,\2), 则计算 11和12的差根据公式
Figure imgf000011_0001
可以计算得到。
[0101] In this embodiment, in the three-dimensional coordinate system, each dimension has a scale at intervals, and the distance corresponding to the scale refers to the scale information 8. In the three-dimensional space, the movement scale sub-module 221 calculates the distance scale number II of the visual sweeping robot and the fixed size at the starting position, and calculates the distance scale number 12 of the visual sweeping robot and the fixed size at the end position. Then, the calculation sub-module 223 can calculate 1 ^ 2 according to the scale information 8 of each scale number. Specifically, the calculation sub-module 223 first calculates the difference between 1 ^ 1 and 1 ^ 2, and then multiplies the difference by 8 to obtain 1 ^ 2. The size of 8 is calculated by the scale information sub-module 222 according to preset rules and some parameters preset by the user. Wherein, the scale number is a two-dimensional vector. In a specific embodiment, a two-dimensional coordinate system is established with a fixed-size image as an origin, and the coordinates of the initial position of the sweeping robot are: 11 of the shell tree is ^1), ending The coordinates of the position are 2^2), and the corresponding 12 is (\2, \2), then the difference between 11 and 12 is calculated according to the formula.
Figure imgf000011_0001
Can be calculated.
[0102] 参照图 9, 进一步地, 所述尺度信息子模块 222包括:  [0102] Referring to FIG. 9, further, the scale information sub-module 222 includes:
[0103] 获得尺寸单元 2221, 用于获得图片的尺寸在该三维空间中的标度数据 T3 ;  [0103] obtaining a size unit 2221, for obtaining the scale data T3 of the size of the picture in the three-dimensional space;
[0104] 计算单元 2222, 用于用图片预设的固定尺寸的值除以图片的尺寸在该三维空间 中的标度数 T3, 计算出尺度信息 s。  [0104] The calculating unit 2222 is configured to calculate the scale information s by dividing the value of the fixed size preset by the picture by the number of scales T3 of the size of the picture in the three-dimensional space.
[0105] 本实施例中, 在三维空间中, 固定尺寸的图片是一个占有一定长度以及宽度的 图片, 该长度和宽度是已知的, 获得尺寸单元 2221计算出该长度以及宽度在该 三维空间中占用的标度数 T3 , 则每个标度对应的实际长度值可以明显的得到。 计算单元 2222根据预设的第三计算公式, 用固定的长度除以图片的固定长度的 标度数量 T3 , 即可以计算出 s。 或者, T3表示图片的宽度的标度数量, 则用固定 宽度除以 T3。  [0105] In the embodiment, in the three-dimensional space, the fixed-size picture is a picture occupying a certain length and a width, and the length and the width are known, and the obtained size unit 2221 calculates the length and the width in the three-dimensional space. The number of scales T3 occupied in the scale, the actual length value corresponding to each scale can be obtained. The calculating unit 2222 divides the fixed length by the fixed number of scales T3 of the picture according to the preset third calculation formula, that is, s can be calculated. Or, if T3 represents the number of scales of the width of the picture, divide the fixed width by T3.
[0106] 参照图 10, 进一步地, 所述移动装置 1包括:  [0106] Referring to FIG. 10, further, the mobile device 1 includes:
[0107] 垂直模块 11, 用于控制视觉扫地机器人的摄像头正对所述图片, 沿着垂直图片 的方向移动。  [0107] The vertical module 11 is configured to control the camera of the visual cleaning robot to move in the direction of the vertical picture facing the picture.
[0108] 本实施例中, 垂直模块 11将视觉扫地机器人的摄像头正对图片, 使摄像头的镜 面平行于图片, 而且摄像头的中轴线正对着图片的中间, 摄像头采集的图片一 直是正对着的, 使采集的图片的尺寸误差更小, 从而对应的得出的补偿系数精 度更高。  [0108] In this embodiment, the vertical module 11 faces the camera of the visual cleaning robot so that the mirror surface of the camera is parallel to the picture, and the central axis of the camera is directly opposite the middle of the picture, and the picture captured by the camera is always facing. , so that the size error of the captured picture is smaller, and the corresponding compensation coefficient is more accurate.
[0109] 参照图 11, 进一步地, 所述测量视觉扫地机器人里程计补偿系数的系统还包括  [0109] Referring to FIG. 11, further, the system for measuring a compensation coefficient of a visual sweeping robot odometer further includes
[0110] 多次计算装置 5 , 用于重复多次计算出多个补偿系数, 计算多个补偿系数的平 均值。 [0110] The multi-calculation device 5 is configured to repeatedly calculate a plurality of compensation coefficients and calculate an average value of the plurality of compensation coefficients.
[0111] 本实施例中, 计算得出补偿系数后, 该补偿系数不可避免会存在误差。 而且该 误差是随机误差, 为进一步减小误差, 最好的方法就是多次实验计算, 多次计 算装置 5多次重复上述各装置的运行得出多个补偿系数, 计算多个补偿系数的平 均值, 以该平均值作为最终的补偿系数, 提高视觉扫地机器人的检测距离的精 度。  [0111] In this embodiment, after the compensation coefficient is calculated, the compensation coefficient inevitably has an error. Moreover, the error is a random error. To further reduce the error, the best method is to perform multiple experimental calculations. The multiple calculation device 5 repeats the operation of the above devices multiple times to obtain a plurality of compensation coefficients, and calculates an average of multiple compensation coefficients. The value is used as the final compensation coefficient to improve the accuracy of the detection distance of the visual sweeping robot.
[0112] 进一步地, 所述图片为二维码。 \¥0 2019/104740 卩(:17 \2017/114339 [0112] Further, the picture is a two-dimensional code. \¥0 2019/104740 卩(:17 \2017/114339
11  11
[0113] 本实施例中, 二维码是指是用某种特定的几何图形按一定规律在平面 (二维方 向上) 分布的黑白相间的图形记录数据符号信息的图片, 辨识度高, 摄像头采 集到该图片后, 容易辨别。 [0113] In the embodiment, the two-dimensional code refers to a picture of data symbol information recorded in a black and white pattern in a plane (two-dimensional direction) by a certain geometric pattern, and the recognition degree is high, the camera After collecting the picture, it is easy to distinguish.
[0114] 综上所述, 本发明的测量视觉扫地机器人里程计补偿系数的系统, 利用视觉扫 地机器人自身的传感器就可以自动完成补偿系数的计算, 提高视觉扫地机器人 的标定效率, 减少人工标定的时间, 提商标定精度。  [0114] In summary, the system for measuring the compensation coefficient of the visual sweeping robot odometer can automatically calculate the compensation coefficient by using the sensor of the visual sweeping robot, improve the calibration efficiency of the visual sweeping robot, and reduce the manual calibration. Time, the accuracy of the trademark.
[0115] 以上所述仅为本发明的优选实施例, 并非因此限制本发明的专利范围, 凡是利 用本发明说明书及附图内容所作的等效结构或等效流程变换, 或直接或间接运 用在其他相关的技术领域, 均同理包括在本发明的专利保护范围内。  The above is only a preferred embodiment of the present invention, and is not intended to limit the scope of the invention, and the equivalent structure or equivalent process transformations made by the description of the invention and the drawings are used directly or indirectly. Other related technical fields are equally included in the scope of patent protection of the present invention.

Claims

\¥0 2019/104740 卩(:17 \2017/114339 12 权利要求书 \¥0 2019/104740 卩(:17 \2017/114339 12 Claims
[权利要求 1] 一种测量视觉扫地机器人里程计补偿系数的方法, 其特征在于, 该测 量环境里有一个固定尺寸的图片, 所述方法包括步骤:  [Claim 1] A method of measuring a compensation coefficient of a visual sweeping robot odometer, wherein the measurement environment has a fixed size picture, and the method includes the steps of:
控制视觉扫地机器人在指定的环境内移动一段距离, 其中, 所述视觉 扫地机器人在移动过程中, 其视野内始终含有固定设置的具有固定尺 寸的图片;  Controlling the visual sweeping robot to move a distance within a specified environment, wherein the visual sweeping robot always has a fixedly set fixed-size image in the field of view during the moving process;
根据所述固定尺寸的图片, 计算出视觉扫地机器人实际移动的位移 2;  Calculating a displacement 2 of the actual movement of the visual sweeping robot according to the fixed size picture;
获取里程计记录的位移!^1 ; Obtain the displacement recorded by the odometer! ^ 1 ;
用视觉扫地机器人实际移动的位移 1^2除以里程计记录的位移0, 计 算得出补偿系数。 The compensation coefficient is calculated by dividing the displacement of the actual moving robot by 1 ^ 2 by the displacement 0 recorded by the odometer.
[权利要求 2] 如权利要求 1所述的视觉测量扫地机器人里程计补偿系数的方法, 其 特征在于, 所述根据视觉扫地机器人的视觉系统计算出视觉扫地机器 人实际移动的位移 1^2的步骤包括: [Claim 2] The method for visually measuring the oscilloscope compensation coefficient of the cleaning robot according to claim 1, wherein the step of calculating the displacement of the actual movement of the visual cleaning robot by the visual system of the visual cleaning robot is 1 ^ 2 include:
根据视觉扫地机器人采集的图片, 将图片中的特征点进行空间三维重 构, 得到所述特征点的三维空间坐标, 进而得到该图像的三维信息; 根据所述图像的三维信息, 计算出所述视觉扫地机器人实际移动的位 移 2。  According to the image captured by the visual sweeping robot, the feature points in the image are spatially reconstructed three-dimensionally, and the three-dimensional space coordinates of the feature points are obtained, thereby obtaining three-dimensional information of the image; and the three-dimensional information of the image is used to calculate the The displacement of the visual sweeping robot actually moves 2.
[权利要求 3] 如权利要求 2所述的测量视觉扫地机器人里程计补偿系数的方法, 其 特征在于, 所述根据所述图像的三维信息, 计算出所述视觉扫地机器 人实际移动的位移 1^2的步骤包括: [Claim 3] The method for measuring a compensation coefficient of a visual cleaning robot odometer according to claim 2, wherein the calculating a displacement of the actual movement of the visual cleaning robot according to the three-dimensional information of the image is 1 ^ The steps of 2 include:
获取视觉扫地机器人在所述三维空间内初始运动位置与所述固定尺寸 的图像距离的标度数II和三维空间内结束运动位置与所述固定尺寸 的图像距离的标度数和工2 ;  Obtaining a number of scales II of the distance between the initial moving position of the visual sweeping robot and the image of the fixed size in the three-dimensional space; and a scale number of the distance between the end moving position and the fixed size in the three-dimensional space;
根据预设的规则计算出每个标度对应的尺度信息 先计算出三维空间内初始运动位置与所述固定尺寸的图像距离的标度 数11与三维空间内初始运动位置与所述固定尺寸的图像距离的标度 数的标度数了2的差, 再用该差乘以尺度信息8 , 计算得出视觉扫地机 \¥0 2019/104740 卩(:17 \2017/114339 Calculating the scale information corresponding to each scale according to a preset rule, first calculating the scale number 11 of the initial motion position and the fixed size image distance in the three-dimensional space, and the initial motion position and the fixed size image in the three-dimensional space. The scale of the distance scale is a difference of 2, and the difference is multiplied by the scale information 8 to calculate the visual sweeper. \¥0 2019/104740 卩(:17 \2017/114339
13 器人实际移动的位移 1^2。 13 The actual movement of the person is shifted by 1 ^ 2.
[权利要求 4] 如权利要求 3所述的测量视觉扫地机器人里程计补偿系数的方法, 其 特征在于, 所述根据预设的规则计算出每个标度对应的尺度信息 8的 步骤包括: [Claim 4] The method for measuring the compensation coefficient of the visual sweeping robot odometer according to claim 3, wherein the step of calculating the scale information 8 corresponding to each scale according to a preset rule comprises:
获得图片的尺寸在该三维空间中的标度数了3 ;  The size of the obtained image in the three-dimensional space is 3;
用图片预设的固定尺寸的值除以图片的尺寸在该三维空间中的标度数 13 , 计算出尺度信息8The scale information 8 is calculated by dividing the value of the fixed size preset by the picture by the number of scales 13 of the size of the picture in the three-dimensional space.
[权利要求 5] 如权利要求 1所述的测量视觉扫地机器人里程计补偿系数的方法, 其 特征在于, 所述控制视觉扫地机器人在指定的环境内移动的步骤包括 控制视觉扫地机器人的摄像头正对所述图片, 沿着垂直图片的方向移 动。  [Claim 5] The method for measuring a visual sweeping robot odometer compensation coefficient according to claim 1, wherein the step of controlling the movement of the visually-swept robot within the specified environment comprises controlling the camera of the visual cleaning robot to face The picture moves in the direction of the vertical picture.
[权利要求 6] 如权利要求 1所述的测量视觉扫地机器人里程计补偿系数的方法, 其 特征在于, 所述计算得出补偿系数后包括步骤: 重复多次计算出多个补偿系数, 计算多个补偿系数的平均值。  [Claim 6] The method for measuring a compensation coefficient of a visual sweeping robot odometer according to claim 1, wherein the calculating the compensation coefficient comprises the steps of: calculating a plurality of compensation coefficients repeatedly, and calculating a plurality of times The average of the compensation coefficients.
[权利要求 7] 如权利要求 1所述的测量视觉扫地机器人里程计补偿系数的方法, 其 特征在于, 所述图片为二维码。  [Claim 7] The method of measuring a visual sweeping robot odometer compensation coefficient according to claim 1, wherein the picture is a two-dimensional code.
[权利要求 8] 一种测量视觉扫地机器人里程计补偿系数的系统, 其特征在于, 该测 量环境里有一个固定尺寸的图片, 所述系统包括: 移动装置, 用于控制视觉扫地机器人在指定的环境内移动一段距离, 其中, 所述视觉扫地机器人在移动过程中, 其视野内始终含有固定设 置的具有固定尺寸的图片; [Claim 8] A system for measuring a compensation coefficient of a visual sweeping robot odometer, wherein the measurement environment has a fixed size picture, the system comprising: a mobile device for controlling a visual sweeping robot at a designated Moving a distance within the environment, wherein the visual cleaning robot always has a fixedly set picture with a fixed size in the field of view during the movement;
实际位移装置, 用于根据所述固定尺寸的图片, 计算出视觉扫地机器 人实际移动的位移 1^2; An actual displacement device, configured to calculate a displacement of the actual movement of the visual sweeping robot by 1 ^ 2 according to the fixed size picture;
里程计位移装置, 用于获取里程计记录的位移 1^1 ; An odometer displacement device for obtaining a displacement of the odometer recorded by 1 ^ 1 ;
补偿系数装置, 用于用视觉扫地机器人实际移动的位移 1^2除以里程 计记录的位移 1^1, 计算得出补偿系数。 The compensation coefficient device is used to calculate the compensation coefficient by dividing the displacement of the actual movement of the visual sweeping robot by 1 ^ 2 by the displacement recorded by the odometer by 1 ^ 1.
[权利要求 9] 如权利要求 8所述的测量视觉扫地机器人里程计补偿系数的系统, 其 \¥0 2019/104740 卩(:17 \2017/114339 [Claim 9] The system for measuring a visual sweeping robot odometer compensation coefficient according to claim 8, \¥0 2019/104740 卩(:17 \2017/114339
14 特征在于, 所述实际位移装置包括:  14 is characterized in that the actual displacement device comprises:
构建模块, 用于根据视觉扫地机器人采集的图片, 将图片中的特征点 进行空间三维重构, 得到所述特征点的三维空间, 进而得到该图像的 三维信息;  a building module, configured to perform spatial three-dimensional reconstruction of the feature points in the image according to the image captured by the visual sweeping robot, to obtain a three-dimensional space of the feature point, and thereby obtain three-dimensional information of the image;
计算模块, 用于根据所述图像的三维信息, 计算出所述视觉扫地机器 人实际移动的位移 1^2。 And a calculating module, configured to calculate, according to the three-dimensional information of the image, a displacement of the actual movement of the visual cleaning robot by 1 ^ 2.
[权利要求 10] 如权利要求 9所述的测量视觉扫地机器人里程计补偿系数的系统, 其 特征在于, 所述计算模块包括:  [Claim 10] The system for measuring the compensation coefficient of the visual sweeping robot odometer according to claim 9, wherein the calculating module comprises:
移动标度子模块, 用于获取视觉扫地机器人在所述三维空间内初始运 动位置与所述固定尺寸的图像距离的标度数11和结束运动位置与所 述固定尺寸的图像距离的标度数了2;  a moving scale sub-module, the scale number 11 for obtaining the distance between the initial moving position of the visual sweeping robot and the fixed-size image in the three-dimensional space, and the scale of the distance between the ending moving position and the fixed-size image are 2 ;
尺度信息子模块, 用于根据预设的规则计算出每个标度对应的尺度信 息 ;  a scale information sub-module, configured to calculate scale information corresponding to each scale according to a preset rule;
计算子模块, 用于先计算出三维空间内初始运动位置与所述固定尺寸 的图像距离的标度数 11与72的差, 再用差乘以尺度信息 8 , 计算得出 视觉扫地机器人实际移动的位移 1^2。 a calculation sub-module, configured to first calculate a difference between the scale numbers 11 and 72 of the initial motion position in the three-dimensional space and the fixed-size image distance, and multiply the difference by the scale information 8 to calculate the actual movement of the visual sweeping robot. The displacement is 1 ^ 2.
[权利要求 11] 如权利要求 10所述的测量视觉扫地机器人里程计补偿系数的系统, 其 特征在于, 所述尺度信息子模块包括:  [Claim 11] The system for measuring the compensation coefficient of the visual sweeping robot odometer according to claim 10, wherein the scale information sub-module comprises:
获得尺寸单元, 用于获得图片的尺寸在该三维空间中的标度数了3 ; 计算单元, 用于用图片预设的固定尺寸的值除以图片的尺寸在该三维 空间中的标度数了3 , 计算出尺度信息8。  Obtaining a size unit, the size of the image used to obtain the image is 3 in the three-dimensional space; the calculation unit is used to divide the value of the fixed size preset by the image by the size of the image in the three-dimensional space. , Calculate the scale information 8.
[权利要求 12] 如权利要求 8所述的测量视觉扫地机器人里程计补偿系数的系统, 其 特征在于, 所述移动装置包括:  [Claim 12] The system for measuring a visual sweeping robot odometer compensation coefficient according to claim 8, wherein the mobile device comprises:
垂直模块, 用于控制视觉扫地机器人的摄像头正对所述图片, 沿着垂 直图片的方向移动。  A vertical module, the camera for controlling the visual sweeping robot is moving in the direction of the vertical picture facing the picture.
[权利要求 13] 如权利要求 8所述的测量视觉扫地机器人里程计补偿系数的系统, 其 特征在于, 还包括:  [Claim 13] The system for measuring a compensation coefficient of a visual cleaning robot odometer according to claim 8, further comprising:
多次计算装置, 用于重复多次计算出多个补偿系数, 计算多个补偿系 \¥0 2019/104740 卩(:17 \2017/114339 Multiple calculation devices for repeatedly calculating multiple compensation coefficients and calculating multiple compensation systems \¥0 2019/104740 卩(:17 \2017/114339
15 数的平均值。  The average of 15 numbers.
[权利要求 14] 如权利要求 8所述的测量视觉扫地机器人里程计补偿系数的系统, 其 特征在于, 所述图片为二维码。  [Claim 14] The system for measuring a visual sweeping robot odometer compensation coefficient according to claim 8, wherein the picture is a two-dimensional code.
PCT/CN2017/114339 2017-12-01 2017-12-01 Method and system for measuring odometer compensation coefficient of vision cleaning robot WO2019104740A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/114339 WO2019104740A1 (en) 2017-12-01 2017-12-01 Method and system for measuring odometer compensation coefficient of vision cleaning robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/114339 WO2019104740A1 (en) 2017-12-01 2017-12-01 Method and system for measuring odometer compensation coefficient of vision cleaning robot

Publications (1)

Publication Number Publication Date
WO2019104740A1 true WO2019104740A1 (en) 2019-06-06

Family

ID=66663757

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/114339 WO2019104740A1 (en) 2017-12-01 2017-12-01 Method and system for measuring odometer compensation coefficient of vision cleaning robot

Country Status (1)

Country Link
WO (1) WO2019104740A1 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000282448A (en) * 1999-03-29 2000-10-10 Penta Ocean Constr Co Ltd Compaction condition measurement method and device with gps and camera
US7982951B1 (en) * 2010-11-08 2011-07-19 Robert Innes Digital tracking platform for telescopes
CN103886107A (en) * 2014-04-14 2014-06-25 苏州市华天雄信息科技有限公司 Robot locating and map building system based on ceiling image information
CN107357286A (en) * 2016-05-09 2017-11-17 两只蚂蚁公司 Vision positioning guider and its method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000282448A (en) * 1999-03-29 2000-10-10 Penta Ocean Constr Co Ltd Compaction condition measurement method and device with gps and camera
US7982951B1 (en) * 2010-11-08 2011-07-19 Robert Innes Digital tracking platform for telescopes
CN103886107A (en) * 2014-04-14 2014-06-25 苏州市华天雄信息科技有限公司 Robot locating and map building system based on ceiling image information
CN107357286A (en) * 2016-05-09 2017-11-17 两只蚂蚁公司 Vision positioning guider and its method

Similar Documents

Publication Publication Date Title
EP2543483B1 (en) Information processing apparatus and information processing method
CN110118528B (en) Line structure light calibration method based on chessboard target
JP6415066B2 (en) Information processing apparatus, information processing method, position and orientation estimation apparatus, robot system
CN108177143B (en) Robot positioning and grabbing method and system based on laser vision guidance
EP2438397B1 (en) Method and device for three-dimensional surface detection with a dynamic reference frame
CN111243002A (en) Monocular laser speckle projection system calibration and depth estimation method applied to high-precision three-dimensional measurement
JP2012021958A5 (en)
CN108662987B (en) Calibration method of 2D camera type laser measuring head
CN110378969B (en) Convergent binocular camera calibration method based on 3D geometric constraint
JP6636042B2 (en) Floor treatment method
KR101658576B1 (en) Apparatus and method for measuring distance using image data
JP6589636B2 (en) 3D shape measuring apparatus, 3D shape measuring method, and 3D shape measuring program
JP6441346B2 (en) Optical tracking
CN105960569A (en) Methods of inspecting a 3d object using 2d image processing
JP2014211404A (en) Motion capture method
KR101090082B1 (en) System and method for automatic measuring of the stair dimensions using a single camera and a laser
CN108007472A (en) Measure the method and system of vision sweeping robot odometer penalty coefficient
CN102881040A (en) Three-dimensional reconstruction method for mobile photographing of digital camera
JP2012163346A (en) Apparatus and method for measuring surface shape
Siddique et al. 3d object localization using 2d estimates for computer vision applications
JPWO2021070415A5 (en)
WO2019104740A1 (en) Method and system for measuring odometer compensation coefficient of vision cleaning robot
KR100792852B1 (en) Method for extracting distance of landmark of mobile robot with a single camera
WO2019104741A1 (en) Method and system for measuring compensating coefficient for odometer of visual robot cleaner
US20240085448A1 (en) Speed measurement method and apparatus based on multiple cameras

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: 17933482

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: 17933482

Country of ref document: EP

Kind code of ref document: A1