WO2021103659A1 - 反光信标夹角误差补偿方法、自动行走设备以及存储介质 - Google Patents
反光信标夹角误差补偿方法、自动行走设备以及存储介质 Download PDFInfo
- Publication number
- WO2021103659A1 WO2021103659A1 PCT/CN2020/108787 CN2020108787W WO2021103659A1 WO 2021103659 A1 WO2021103659 A1 WO 2021103659A1 CN 2020108787 W CN2020108787 W CN 2020108787W WO 2021103659 A1 WO2021103659 A1 WO 2021103659A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- beacon
- angle
- laser
- reflective
- formula
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 80
- 238000004364 calculation method Methods 0.000 claims description 20
- 230000033001 locomotion Effects 0.000 claims description 15
- 238000012545 processing Methods 0.000 claims description 15
- 238000004891 communication Methods 0.000 claims description 14
- 238000004590 computer program Methods 0.000 claims description 9
- 230000006870 function Effects 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 238000013480 data collection Methods 0.000 description 3
- 238000009795 derivation Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000008054 signal transmission Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Definitions
- the invention relates to the field of household appliances, in particular to a method for compensating the included angle error of a reflective beacon, an automatic traveling device and a storage medium.
- the position of the autonomous vehicle when it moves in space can usually be determined by the laser positioning method.
- a laser turntable is arranged in the automatic traveling equipment, and a laser emitting device, a laser receiving device and an angle encoder are arranged on the laser turntable.
- a plurality of reflective beacons are placed in the working area of the autonomous vehicle in advance, and the coordinates of the multiple reflective beacons in the working area of the autonomous vehicle are known.
- the laser emitting device When the automatic traveling equipment is moving, the laser emitting device emits a rotating laser scanning beam to the outside at a certain angular velocity 360°.
- the reflective beacon forms parallel to the laser.
- the laser reflection beam of the scanning beam then, the laser receiving device receives the laser reflection beam, and at the same time, the angle encoder detects the angle between the laser reflection beam and the traveling direction of the automatic traveling equipment, that is, each reflective beacon in the traveling direction of the automatic traveling equipment.
- the included angle with the walking direction of the automatic traveling device by calculating and comparing these included angles of multiple reflective beacons, the navigation and positioning system of the automatic traveling device can calculate the coordinates of the current automatic traveling device in the working area.
- the time when the reflective beacon sends out the reflected laser signal is different from the time when the laser turntable receives the reflected laser signal, and the time when the laser turntable sends out the laser signal is different from the moment when the laser reflection signal is received.
- the automatic walking equipment is always in motion , The laser turntable is always in a rotating state, resulting in the inaccurate value of the angle of the reflective beacon obtained by the encoder. Therefore, the coordinate position of the automatic propelling equipment is certainly not accurate enough to be measured by the angle of multiple reflective beacons. Equipment for precise positioning and control.
- the purpose of the present invention is to provide a method for compensating the included angle error of the reflective beacon, an automatic traveling device and a storage medium, which are used to solve the problem that the included angle of the reflective beacon acquired by the current automatic traveling device during a constant linear movement along a fixed direction is not accurate enough. The problem.
- the present invention provides a method for compensating the included angle error of a reflective beacon.
- the method includes: when the automatic traveling equipment moves in a straight line at a uniform speed in a first direction, obtaining the laser turntable from a stationary state to the mth position.
- the beacon angle error compensation formula is the function formula of the first beacon angle with respect to the rotation time of the laser turntable when the automatic traveling equipment moves in a straight line at a uniform speed in the first direction.
- the first beacon angle is the laser reflection signal emitted by the first reflective beacon and the automatic The angle between the walking directions of the walking equipment.
- the method further includes: acquiring the first beacon angle signal transmitted from the laser signal processing module of the autonomous vehicle to the positioning calculation module of the autonomous vehicle for the communication duration T com ; and calculating the first beacon angle signal.
- the compensation time length of the beacon angle T final T sync + T com ; according to the compensation time length T final , the compensation angle value of the first beacon angle is calculated through the first beacon angle error compensation formula.
- the method further comprising: when the self-propelled equipment uniform linear motion in a first direction, the laser turntable obtaining the actual measured first beacon angle A n and the corresponding actual rotational turntable laser Duration T n , where n is the number of rotations of the laser turntable.
- the method further includes: according to at least two sets of data (A n , T n ), a least squares fitting formula is used to calculate an error compensation formula about the first beacon angle.
- the method further includes: according to at least two sets of data (A n , T n ), a weighted least squares fitting formula is used to calculate an error compensation formula about the first beacon angle .
- the method further includes: acquiring the first beacon angle signal transmitted from the laser signal processing module of the autonomous vehicle to the positioning calculation module of the autonomous vehicle for the communication duration T com ; and calculating the first beacon angle signal.
- the compensation duration of the beacon angle T final T sync + T com ; the time difference t1 between the actual rotation duration T n and the compensation duration T final is obtained; the weight coefficient is calculated Among them, ⁇ is a constant greater than zero; according to at least two sets of data (A n , T n ) and a weighting coefficient c, an error compensation formula about the first beacon angle is calculated through a weighted least squares formula.
- the method further comprising: after the laser continuously rotating turret ring 5, five different data acquisition (A n, T n) corresponding to; 5 groups according to different data (A n, T n ), through the least squares fitting formula, the error compensation formula about the first beacon angle is calculated.
- the method further includes: setting n to values m-5, m-4, m-3, m-2, and m-1, respectively, and obtaining the five nearest to the time T sync.
- Group data (A m-5 , T m-5 ), (A m-4 , T m-4 ), (A m-3 , T m-3 ), (A m-2 , T m-2 ), and (A m-1 , T m-1 ).
- the method further includes: measuring the actual first beacon angle through an angle encoder in the laser turntable; and receiving the first beacon angle signal sent by the angle encoder.
- the method further includes: obtaining an error compensation formula of the second beacon angle, and calculating the second beacon angle according to the rotation time length T sync through the second beacon angle error compensation formula The compensation angle value of the third beacon angle; obtain the error compensation formula of the third beacon angle, and calculate the compensation angle value of the third beacon angle according to the rotation time T sync through the third beacon angle error compensation formula; The compensation angle value of, obtain the coordinate position of the automatic traveling equipment.
- the autonomous walking device is a lawn mower robot.
- the present invention also provides an autonomous walking device, including a memory and a processor, the memory stores a computer program that can run on the processor, and the processor implements any of the above-mentioned procedures when the program is executed. The steps in the method of compensating the angle error of the reflective beacon.
- the present invention also provides a storage medium, the storage medium is stored in a computer program, wherein the computer program is executed by a processor to realize the steps in the method for compensating the included angle error of the reflective beacon in any one of the above items. .
- the present invention has the following beneficial effects: in the uniform linear motion of the automatic traveling equipment in the first direction, the angle error compensation formula about the included angle of the reflective beacon is obtained, and the obtained current rotation time of the laser turntable is To calculate the compensation angle value of the current reflective beacon to compensate the included angle of the reflective beacon; at the same time, after the laser turntable rotates 5 times, obtain the rotation time when the laser turntable rotates to the starting position of the current turn, according to this 5
- the rotation time after the circle is used to calculate the compensation angle values of all reflective beacons, so as to analyze the coordinate position of the autonomous vehicle through the compensation angle values of multiple reflective beacons, that is, the current position information of the autonomous vehicle in the working area, so as to facilitate Precise positioning and control of automatic walking equipment.
- Fig. 1 is a flowchart of a method for compensating the included angle error of a reflective beacon in an embodiment of the present invention
- Fig. 2 is a schematic diagram of a module of an autonomous walking device in an embodiment of the present invention.
- an embodiment of the present invention provides a method for compensating the included angle error of a reflective beacon.
- the method includes the following steps. The method is described below:
- the S4 calculates the compensation angle value of the first beacon angle according to the rotation time length T sync through the first beacon angle error compensation formula, where the first beacon angle error compensation formula is the uniform linear motion of the automatic traveling equipment in the first direction
- the first beacon angle is a function formula of the rotation time of the laser turntable
- the first beacon angle is the angle between the laser reflection signal emitted by the first reflective beacon and the walking direction of the autonomous vehicle.
- multiple reflective beacons are placed in advance, and the position coordinates of the multiple reflective beacons in the working area are known.
- the time when the laser turntable sends out the laser signal and the time when the laser reflection signal is received and the moment when the reflected laser signal is sent out by the reflective beacon are not at the same time point, and the automatic traveling equipment is always in the walking state, and the laser turntable is always in the rotating state. Factors will cause the angle of the collected or acquired reflective beacon to be inaccurate, so angle error compensation is required.
- At least three reflective beacons are provided, and the automatic walking equipment can be analyzed and positioned by obtaining the compensation angle values of the at least three reflective beacons at the same time.
- the embodiment of the present invention takes the first reflective beacon as an example to specifically describe the error compensation method.
- an error compensation formula for the included angle of the first reflective beacon can be calculated in advance, that is, the first beacon angle error compensation formula.
- the prerequisite for the calculation of the error compensation formula is that the automatic traveling equipment moves in a linear motion state at a constant speed in the first direction, that is, when the automatic traveling equipment has a stable direction and travels at a constant speed, the error compensation formula is applicable.
- the angle of the lower reflective beacon is compensated more accurately.
- the first direction refers to the current walking direction of the automatic traveling equipment.
- the first reflective beacon or the actual included angle of the first beacon and the corresponding laser turntable rotation time can be measured first, and the error compensation formula can be calculated based on the two data, that is, the first beacon angle relative to the laser turntable Function formula for rotation duration.
- the specific function formula can also be calculated according to formulas such as the least square method or the weighted least square method.
- the time when the laser turntable rotates to the start position of the mth circle is taken as the multiple The synchronization point of time when the included angle of two reflective beacons is acquired, and m ⁇ 6, that is, the laser turntable has rotated at least 5 times from a stationary state.
- the time point T at which the laser turntable rotates to the starting position of the current turn after the laser turntable rotates at least 5 turns from the stationary state is obtained sync , according to the pre-obtained reflective beacon angle error compensation formula, calculate the corresponding reflective beacon compensation angle value, correct the angle of the current reflective beacon; use the time point corresponding to T sync as synchronization to obtain other reflective beacons The synchronization time point of the included angle, so as to facilitate the subsequent analysis of the coordinate position of the autonomous walking device through the compensation angle value of multiple reflective beacons.
- step S4 the method further includes:
- the compensation angle value of the first beacon angle is calculated through the first beacon angle error compensation formula.
- the automatic walking equipment system includes a laser signal processing module (scanner) and a positioning calculation module (main).
- the laser signal processing module (scanner) can be used to produce angle data, save historical angle data, or create calculation formulas; positioning calculations
- the module (main) can be used to collect communication time or calculate the estimated angle; when data signals such as angle and time are transmitted from the laser signal processing module (scanner) to the positioning calculation module (main), there is a certain communication time difference T com .
- T sync time the synchronization time
- step S4 the method further includes:
- the laser turntable obtaining the actual measured first beacon angle A n and the corresponding actual rotational turntable laser duration T n, where, n-laser serial number of rotations of the turntable .
- the first beacon angle error compensation formula can be calculated by the least square method or the weighted least square method formula.
- the actual included angle A n of the first reflective beacon and the current collection time point T n can be collected first, that is, the first reflective beacon included angle A is acquired or collected at the same time.
- n and the rotation time of the laser turntable T n and multiple sets of data (A n , T n ) obtained through multiple acquisitions or collections, and then combined with the derivation formula of the least square method or weighted least square method to derive the specific first letter Standard angle error compensation formula.
- the specific first beacon angle error compensation formula refers to a formula containing specific parameter values. After the rotation time is substituted into the formula, the determined compensation angle value can be calculated.
- step S31 the method further includes:
- a least squares method is used to fit the formula to calculate an error compensation formula about the first beacon angle.
- step S31 the method further includes:
- a weighted least squares fitting formula is used to calculate an error compensation formula about the first beacon angle.
- the first beacon angle error compensation formula obtained is the linear function formula of the first beacon angle with respect to the rotation time of the laser turntable, which can be obtained through two or more sets of measured data (A n , T n ) to calculate the parameters in the formula to obtain a specific first beacon angle error compensation formula.
- step S35 the method specifically includes:
- ⁇ is a constant greater than zero
- an error compensation formula about the first beacon angle is calculated through a weighted least squares formula.
- the choice of the weight coefficient c is not limited.
- the time difference t1 between the acquisition time point of the measured data and the compensation time point T final can be obtained, and the reciprocal of the time difference t1 is used as the weighting coefficient; in addition, to avoid the case where the denominator is 0, a constant ⁇ greater than zero is added.
- the reciprocal of the sum of t1 and ⁇ is used as the final weighting coefficient c, namely Therefore, a specific first beacon angle error compensation formula can be derived and calculated.
- step S33 the method specifically includes:
- step S331 the method specifically includes:
- the formula in order to ensure the fitting accuracy of the least squares formula, can be calculated by using 5 sets of measured data (A n , T n ).
- the 5 sets of different data are data obtained by continuous rotation of the laser turntable for 5 revolutions, which can avoid the problem of inconsistent data resulting in poor formula fitting accuracy.
- the obtained angle compensation value is also more accurate; because the communication time difference is fixed, the five sets of measured data closest to the synchronization time T sync can be obtained, and the specific first beacon angle can be derived from these five sets of measured data Error compensation formula.
- step S31 the method specifically includes:
- step S31 the method specifically includes:
- the laser turntable has a mechanical zero point.
- the laser signal processing module scanner
- the laser signal processing module can obtain a mechanical zero signal; record the time interval between the appearance of two adjacent mechanical zero signals to get the laser turntable rotation
- the required time t round in the actual rotation process, the rotation time of each circle of the laser turntable may be different.
- the actual rotation time T n of the laser turntable In order to obtain the actual rotation time T n of the laser turntable, first obtain the total consumption time t round of the laser turntable rotating n-1 revolutions, and obtain the time difference from the current mechanical zero point of the laser turntable to the time when the laser reflection signal is received, that is, the laser turntable The time difference t2 from the start position of the nth circle to the time when the laser reflection signal from the first reflective beacon is received; calculate the sum of t round and t2, and finally obtain the actual rotation time T n of the laser turntable.
- the mechanical zero point of the laser turntable coincides with the zero point of the angle encoder itself, and the zero point signal of the angle encoder is the trigger signal for all calculation and processing functions in the automatic traveling equipment system.
- the angle encoder is set in the laser turntable and is used to detect the angle between the reflected laser beam and the traveling direction of the automatic traveling equipment, that is, the angle between each reflective beacon. After detecting the actual included angle of the first reflective beacon, the angle encoder may send the actual included angle information to the positioning calculation module (main) for calculation and processing.
- step S4 the method further includes:
- the coordinate position of the autonomous walking device is obtained.
- three reflective beacons are provided in this embodiment, and the autonomous device is analyzed and positioned by obtaining the compensation angle values of the three reflective beacons.
- the compensation angle values of the other two reflective beacons can be obtained through the above method steps; the compensation angle value can be the compensation angle value corresponding to the synchronization time point T sync , or can be the compensation angle value corresponding to the compensation time point T final Corresponding compensation angle value.
- the three compensation angle values are obtained by obtaining the angle compensation values of the three reflective beacons, namely the first beacon angle compensation angle value, the second beacon angle compensation angle value, and the third beacon angle compensation angle value, the three compensation angle values, To analyze and calculate the specific coordinate position information of the automatic walking equipment.
- an embodiment of the present invention also provides an autonomous walking device, including a memory and a processor, the memory stores a computer program that can run on the processor, and the processor executes the program When realizing the steps in the method for compensating the included angle error of the reflective beacon as described in any one of the above.
- the automatic walking equipment is a lawn mower robot.
- the autonomous walking device in the embodiment of the present invention is a lawn mower robot.
- the embodiment of the present invention also provides a storage medium, the storage medium is stored in a computer program, and when the computer program is executed by a processor, the steps in the method for compensating the included angle error of the reflective beacon as described in any one of the above are implemented.
- the autonomous walking device is a lawn mower robot, and three reflective beacons are pre-placed in the work area, and the position coordinates of the three reflective beacons in the work area are known.
- this error compensation method is only applicable when the lawn mower robot moves along the first direction in a motion state where the direction is unchanged and moving at a constant speed.
- the first direction refers to the current walking direction of the lawn mower robot.
- T sync the rotation duration T sync when the laser turntable rotates from a static state to the start position of the mth circle, where the integer m ⁇ 6, that is, the time point when the laser turntable reaches the start position of the current circle after rotating at least 5 times is T sync , using T sync as the time point for synchronously acquiring the included angles of the three reflective beacons, so as to calculate the compensation angle values corresponding to the three reflective beacons.
- the laser turntable on the lawn mower robot When the lawn mower robot moves at a constant speed along the first direction, the laser turntable on the lawn mower robot also rotates at a constant speed; when the laser turntable rotates to the nth circle, the angle encoder on the laser turntable can detect the first a reflective beacon actual angle a n, and acquires a n corresponding to the laser turntable rotation length T n, form a set of measured data (a n, T n); where, T n corresponding to the time point laser turret received The moment of the laser emission signal from the first reflective beacon.
- the laser turntable 's 5 continuous rotations closest to the synchronization time point T sync or compensation time point T final can be used as the measurement data collection range to obtain the corresponding continuous five sets of measured data (A m- 5 , T m-5 ), (A m-4 , T m-4 ), (A m-3 , T m-3 ), (A m-2 , T m-2 ) and (A m-1 , T m-1 ), and form a measured data matrix.
- the time difference between the rotation of the laser turntable from the start position of the nth circle to the moment when the laser reflection signal is received is t2
- the total consumed time for the laser turntable to rotate n-1 times is t round
- the actual rotation time of the laser turntable T n is t2 and t both the round and
- Found angle A n is obtained from the angle encoder for detecting the positioning of the rear case to a calculation module (main) performs calculation processing.
- the angle error compensation formula can be obtained by deriving the formula by the weighted least squares method.
- the weight coefficient c needs to be determined first: Obtain the time difference t1 between each actual rotation duration T n and the compensation time point T final Calculate the sum of the time difference t1 and the constant ⁇ greater than zero, and use the reciprocal of the sum of the two as the weight coefficient c corresponding to each actual rotation time T n, namely As a result, five corresponding weight coefficients are calculated one by one, and a weight matrix is formed.
- the formula is derived by the weighted least square method, and the specific first reflective beacon error compensation formula is calculated.
- the specific second reflective beacon error compensation formula and the specific third reflective beacon error compensation formula can also be obtained.
- the angle compensation values corresponding to the three reflective beacons are calculated through three error compensation formulas, so as to further analyze and obtain the coordinate position information of the lawn mower robot in the working area.
- the present invention provides a reflective beacon angle error compensation method, an automatic traveling device, and a storage medium.
- the method takes into account the effect of error compensation and obtains that after the laser turntable rotates at least 5 times from a stationary state, the laser turntable Rotate to the time point T sync of the starting position of the current circle, calculate the corresponding reflective beacon compensation angle value according to the pre-obtained reflective beacon angle error compensation formula, and correct the included angle of the reflective beacon; take T sync as Synchronously obtain the time points of the included angles of other reflective beacons, so as to facilitate subsequent analysis of the coordinate position information of the autonomous walking device through the compensation angle values of multiple reflective beacons.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种反光信标夹角误差补偿方法、自动行走设备以及存储介质，误差补偿方法包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T sync，其中，整数m≥6（S2）；根据旋转时长T sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角（S4）；可解决目前自动行走设备在沿着固定方向匀速直线运动过程中获取的反光信标夹角不够准确的问题。
Description
本发明涉及家用电器领域，尤其涉及一种反光信标夹角误差补偿方法、自动行走设备及存储介质。
目前，自动行走设备在空间中移动时所在的位置通常可通过激光定位方法来确定。自动行走设备内设置激光转台，激光转台上设有激光发射装置、激光接收装置以及角度编码器。自动行走设备的工作区域则预先放置多个反光信标，且多个反光信标在自动行走设备工作区域的坐标是已知的。
自动行走设备在行进的过程中，激光发射装置以一定的角速度360°水平向外部发射旋转的激光扫描光束，激光扫描光束扫过每个预置的反光信标时，反光信标形成平行于激光扫描光束的激光反射光束；接着，激光接收装置接收激光反射光束，同时通过角度编码器检测激光反射光束和自动行走设备行走方向上的夹角，即在自动行走设备行走方向上每个反光信标与自动行走设备行走方向的夹角；通过计算比对多个反光信标的这些夹角，自动行走设备的导航定位系统即可计算出当前自动行走设备在工作区域所处的坐标。
反光信标发出反射激光信号的时间与激光转台接收激光反射信号的时间不同，且激光转台发出激光信号时刻与接收激光反射信号时刻两者不同，激光发射反射过程中，自动行走设备一直处于运动状态，激光转台也一直处于旋转状态，导致编码器获取的反光信标夹角值并不准确，从而通过多个反光信标的夹角来测算自动行走设备的坐标位置也必然不够准确，无法对自动行走设备进行精准定位与控制。
发明内容
本发明的目的在于提供一种反光信标夹角误差补偿方法、自动行走设备以及存储介质，用来解决目前自动行走设备在沿着固定方向匀速直线运动过程中获取的反光信标夹角不够准确的问题。
为了实现上述发明目的之一，本发明提供一种反光信标夹角误差补偿方法，所述方法包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T
sync，其中，整数m≥6；根据旋转时长T
sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。
作为本发明一实施方式的进一步改进，所述方法还包括：获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T
com；计算第一信标角度的补偿时长T
final＝T
sync+T
com；根据补偿时长T
final，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值。
作为本发明一实施方式的进一步改进，所述方法还包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A
n以及相应的激光转台实际旋转时长T
n，其中，n为激光转台的旋转圈数序号。
作为本发明一实施方式的进一步改进，所述方法还包括：根据至少两组数据(A
n，T
n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
作为本发明一实施方式的进一步改进，所述方法还包括：根据至少两组数据(A
n，T
n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
作为本发明一实施方式的进一步改进，所述方法还包括：获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模 块的通讯时长T
com；计算第一信标角度的补偿时长T
final＝T
sync+T
com；获取实际旋转时长T
n与补偿时长T
final之间的时间差t1；计算权重系数
其中，β为大于零的常数；根据至少两组数据(A
n，T
n)与权重系数c，通过加权最小二乘法公式，计算得到关于第一信标角度的误差补偿公式。
作为本发明一实施方式的进一步改进，所述方法还包括：在激光转台连续旋转5圈之后，获取对应的5组不同数据(A
n，T
n)；根据5组不同数据(A
n，T
n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
作为本发明一实施方式的进一步改进，所述方法还包括：将n分别取值m-5、m-4、m-3、m-2以及m-1，获取与时刻T
sync最邻近的五组数据(A
m-5，T
m-5)、(A
m-4，T
m-4)、(A
m-3，T
m-3)、(A
m-2，T
m-2)以及(A
m-1，T
m-1)。
作为本发明一实施方式的进一步改进，所述方法还包括：获取激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；获取激光转台旋转n-1圈的消耗时长t
round；计算激光转台实际旋转时长T
n＝t2+t
round。
作为本发明一实施方式的进一步改进，所述方法还包括：通过激光转台内的角度编码器测量实际的第一信标角度；接收角度编码器发出的第一信标角度信号。
作为本发明一实施方式的进一步改进，所述方法还包括：获取第二信标角度的误差补偿公式，根据旋转时长T
sync，通过第二信标角度误差补偿公式，计算出第二信标角度的补偿角度值；获取第三信标角度的误差补偿公式，根据旋转时长T
sync，通过第三信标角度误差补偿公式，计算出第三信标角度的补偿角度值；根据三个信标相应的补偿角度值，获取自动行走设备的坐标位置。
作为本发明一实施方式的进一步改进，所述自动行走设备为割草机器人。
本发明还提供一种自动行走设备，包括存储器与处理器，所述存储器存储有可在所述处理器上运行的计算机程序，所述处理器执行所述程序时实现上述任意一项所述的反光信标夹角误差补偿方法中的步骤。
本发明还提供一种存储介质，所述存储介质存储于计算机程序，其特征在 于，所述计算机程序被处理器执行时实现上述任意一项所述的反光信标夹角误差补偿方法中的步骤。
与现有技术相比，本发明的有益效果在于：在自动行走设备在第一方向匀速直线运动中，通过获取关于反光信标夹角的角度误差补偿公式，并根据获取的激光转台当前旋转时长来计算当前反光信标的补偿角度值，以对反光信标夹角进行误差补偿；同时，在激光转台旋转5圈之后，获取激光转台旋转至当前一圈起始位置时的旋转时长，根据这个5圈之后的旋转时长来计算所有反光信标的补偿角度值，以便通过多个反光信标的补偿角度值分析出自动行走设备的坐标位置，即自动行走设备在工作区域当前所处的位置信息，从而便于精准定位与控制自动行走设备。
图1是本发明实施例中反光信标夹角误差补偿方法的流程图；
图2是本发明实施例中自动行走设备的模块示意图。
为使本申请的目的、技术方案和优点更加清楚，下面将结合本申请具体实施方式及相应的附图对本申请技术方案进行清楚、完整地描述。显然，所描述的实施方式仅是本申请一部分实施方式，而不是全部的实施方式。基于本申请中的实施方式，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施方式，都属于本申请保护的范围。
下面详细描述本发明的实施方式，实施方式的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的，仅用于解释本发明，而不能理解为对本发明的限制。
如图1所示，本发明实施例提供了一种反光信标夹角误差补偿方法，所述方法包括以下若干步骤，下面对所述方法进行说明：
S2当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T
sync，其中，整数m≥6；
S4根据旋转时长T
sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。
在移动机器人等自动行走设备的工作区域中，预先放置多个反光信标，且多个反光信标在工作区域内的位置坐标等信息是已知的。
实际行走过程中，激光转台发出激光信号时刻与接收激光反射信号时刻以及反光信标发出反射激光信号时刻均不在同一时刻点，且自动行走设备一直处于行走状态，激光转台也一直处于旋转状态，这些因素会导致采集或获取的反光信标夹角不准确，因此需要进行角度误差补偿。
本发明实施例中，设置有至少三个反光信标，可通过获取同一时刻至少三个反光信标的补偿角度值对自动行走设备进行分析定位。
本发明实施例以第一反光信标为例，对误差补偿方法进行具体描述。
为补偿时差、运动状态等因素对第一反光信标夹角采集带来的误差，可事先计算出对第一反光信标夹角的误差补偿公式，即第一信标角度误差补偿公式。为保证误差补偿的精度，误差补偿公式的推算前提是自动行走设备在第一方向匀速直线运动状态，即自动行走设备方向稳定不变、匀速行走时，误差补偿公式才适用，可对此运动状态下的反光信标夹角进行较精确的补偿。其中，第一方向是指自动行走设备当前的行走方向。
其中，可先测量第一反光信标或第一信标的实际夹角、对应的激光转台旋转时长这两种数据，根据两种数据计算得出误差补偿公式，即第一信标角度关于激光转台旋转时长的函数公式。具体的函数公式也可以是根据最小二乘法或加权最小二乘法等公式计算得出。
为对自动行走设备进行定位计算，需要获取同一时刻多个反光信标的补偿 角度值。考虑到激光转台旋转至每圈起始位置即机械零点时，可触发自动行走设备的所有计算与处理功能，本实施例中，将激光转台旋转至第m圈起始位置时的时间点作为多个反光信标夹角获取的同步时间点，且m≥6，即激光转台从静止状态开始旋转了至少5圈。
先获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T
sync，再通过上述获取的第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，对第一反光信标的夹角进行修正。
此外，还可在旋转时长T
sync基础上考虑数据信号传输的时差，将信号传输时差与旋转时长T
sync两者之和作为最终的补偿时长数值，来计算第一信标角度的补偿角度值。
本实施例中的反光信标夹角误差补偿方法，在考虑误差补偿效果的情况下，获取在激光转台从静止状态旋转至少5圈之后、激光转台旋转至当前一圈起始位置的时间点T
sync，根据预先获得的反光信标角度误差补偿公式，计算出对应的反光信标补偿角度值，对当前反光信标的夹角进行修正；并将T
sync对应的时间点作为同步获取其他反光信标夹角的同步时间点，从而方便后续通过多个反光信标的补偿角度值来分析出自动行走设备的坐标位置。
进一步的，在步骤S4之后，所述方法还包括：
获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T
com；
计算第一信标角度的补偿时长T
final＝T
sync+T
com；
根据补偿时长T
final，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值。
本发明实施例中，自动行走设备系统包括激光信号处理模块(scanner)与定位计算模块(main)，激光信号处理模块(scanner)可用于生产角度数据、保存历史角度数据或创建推算公式；定位计算模块(main)可用于搜集通讯时间或计算推算角；角度、时间等数据信号从激光信号处理模块(scanner)传输至定位计算模块(main)时，存在一定的通信时差T
com。
为保证误差补偿精度，在同步时间T
sync时间基础上考虑这个通信时差，即计算补偿时长T
final＝T
sync+T
com，通过补偿时长T
final来计算补偿角度值，即将补偿角度值作为对第一反光信标夹角的修正。
当然，当通信时差T
com足够小时，也可以忽略不计，不纳入考虑。
进一步的，在步骤S4之前，所述方法还包括：
S31当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A
n以及相应的激光转台实际旋转时长T
n，其中，n为激光转台的旋转圈数序号。
本发明实施例中，第一信标角度误差补偿公式可通过最小二乘法或加权最小二乘法公式计算得出。
在自动行走设备沿着第一方向这个固定方向匀速运动时，可先采集第一反光信标的实际夹角A
n以及当前采集时间点T
n，即同时获取或采集第一反光信标夹角A
n与激光转台旋转时长T
n；并通过多次获取或采集得到的多组数据(A
n，T
n)，然后结合最小二乘法或加权最小二乘法的推导公式，推导出具体的第一信标角度误差补偿公式。其中，具体的第一信标角度误差补偿公式是指包含具体参数数值的公式，将旋转时长代入公式后，可计算出确定的补偿角度值。
进一步的，在步骤S31之后，所述方法还包括：
S33根据至少两组数据(A
n，T
n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
进一步的，在步骤S31之后，所述方法还包括：
S35根据至少两组数据(A
n，T
n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
在利用最小二乘法或加权最小二乘法推导公式推导时，得到的第一信标角度误差补偿公式为第一信标角度关于激光转台旋转时长的线性函数公式，可通过两组或多组实测数据(A
n，T
n)来计算出公式中的参数，从而得到具体的第一信标角度误差补偿公式。
进一步的，对于步骤S35，所述方法具体包括：
获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T
com；
计算第一信标角度的补偿时长T
final＝T
sync+T
com；
获取实际旋转时长T
n与补偿时长T
final之间的时间差t1；
计算权重系数
其中，β为大于零的常数；
根据至少两组数据(A
n，T
n)与权重系数c，通过加权最小二乘法公式，计算得到关于第一信标角度的误差补偿公式。
在通过加权最小二乘法推导公式计算具体的第一信标角度误差补偿公式时，权重系数c的选择不限。
实测数据(A
n，T
n)的采集时间点越接近补偿时间点T
final，实测数据的可信度越高，最终得到的第一信标角度的补偿角度值也越准确。
基于此，可获取实测数据的采集时间点与补偿时间点T
final之间的时间差t1，将时间差t1的倒数作为权重系数；此外，为避免分母为0的情况，添加大于零的常数β，将t1与β两者之和的倒数作为最终的权重系数c，即
由此，可推导计算出具体的第一信标角度误差补偿公式。
当然，当通信时差T
com足够小可以忽略不计时，也可只获取实测数据的采集时间点与同步时间T
sync之间的时间差，并将此时间差的倒数作为最终的权重系数，来推导计算具体公式。
进一步的，对于步骤S33，所述方法具体包括：
S331在激光转台连续旋转5圈之后，获取对应的5组不同数据(A
n，T
n)；
S333根据5组不同数据(A
n，T
n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
进一步的，对于步骤S331，所述方法具体包括：
将n分别取值m-5、m-4、m-3、m-2以及m-1，获取与时刻T
sync最邻近的五组数据(A
m-5，T
m-5)、(A
m-4，T
m-4)、(A
m-3，T
m-3)、(A
m-2，T
m-2)以及(A
m-1，T
m-1)。
本发明实施例中，为保证最小二乘法公式的拟合精度，可通过5组实测数 据(A
n，T
n)来计算公式。
较佳的，5组不同数据(A
n，T
n)是通过激光转台连续旋转5圈获取的数据，可避免数据不连续导致公式拟合精度不高的问题。
此外，实测数据的采集时间点越接近同步时间点T
sync或补偿时间点T
final时，实测数据的可信度越高，推导得到的最小二乘法拟合公式的拟合精度也越高，计算得到的角度补偿值也越准确；由于通讯时差是固定不变的，因此，可获取与同步时间T
sync最邻近的五组实测数据，根据这五组实测数据推导出具体的第一信标角度误差补偿公式。
由此，通过递进式选取与T
sync时刻最接近的五组实测数据，来推导角度误差补偿公式，可极大提高误差补偿公式的拟合精度，避免间隔时间过长、实测数据采集不够及时带来的拟合精度问题。
进一步的，对于步骤S31，所述方法具体包括：
获取激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；
获取激光转台旋转n-1圈的消耗时长t
round；
计算激光转台实际旋转时长T
n＝t2+t
round。
进一步的，对于步骤S31，所述方法具体包括：
通过激光转台内的角度编码器测量实际的第一信标角度；
接收角度编码器发出的第一信标角度信号。
激光转台具有机械零点，当激光转台旋转至机械零点时，激光信号处理模块(scanner)可以得到一个机械零信号；记录相邻两个机械零信号出现的时间间隔，即可得到激光转台旋转一周所需要的时长t
round；实际旋转过程中，激光转台每一圈的旋转时长可能不相同。
为得到激光转台实际旋转时长T
n，可先获取激光转台旋转n-1圈的总消耗时长t
round，并获取激光转台从当前一圈机械零点至接收到激光反射信号时的时差，即激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；计算t
round与t2两者之和，可最终得到激光转台实际旋转时长 T
n。
此外，激光转台的机械零点与角度编码器自身的零点重合，角度编码器的零点信号是自动行走设备系统中所有计算与处理功能的触发信号。角度编码器设于激光转台内，用于检测激光反射光束和自动行走设备行走方向上的夹角，即每个反光信标的夹角。在检测到第一反光信标的实际夹角后，角度编码器可将实际夹角信息发送给定位计算模块(main)进行计算与处理。
进一步的，在步骤S4之后，所述方法还包括：
获取第二信标角度的误差补偿公式，根据旋转时长T
sync，通过第二信标角度误差补偿公式，计算出第二信标角度的补偿角度值；
获取第三信标角度的误差补偿公式，根据旋转时长T
sync，通过第三信标角度误差补偿公式，计算出第三信标角度的补偿角度值；
根据三个信标相应的补偿角度值，获取自动行走设备的坐标位置。
为了对自动行走设备进行定位计算，本实施例中设置有三个反光信标，通过获取三个反光信标的补偿角度值来对自动行走设备进行分析定位。
与第一反光信标类似，可通过上述方法步骤获取其他两个反光信标的补偿角度值；补偿角度值可以是与同步时间点T
sync对应的补偿角度值，也可以是与补偿时间点T
final对应的补偿角度值。
较佳的，通过获取三个反光信标的角度补偿值，即第一信标角度补偿角度值、第二信标角度补偿角度值、以及第三信标角度补偿角度值这三个补偿角度值，来分析计算自动行走设备具体的坐标位置信息。
如图2所示，本发明实施例还提供了一种自动行走设备，包括存储器与处理器，所述存储器存储有可在所述处理器上运行的计算机程序，所述处理器执行所述程序时实现如上任意一项所述的反光信标夹角误差补偿方法中的步骤。
进一步的，所述自动行走设备为割草机器人。
具体的，本发明实施例中的自动行走设备为割草机器人。
本发明实施例还提供了一种存储介质，所述存储介质存储于计算机程序，所述计算机程序被处理器执行时实现如上任意一项所述的反光信标夹角误差补 偿方法中的步骤。
下面针对反光信标夹角误差补偿方法进行整体描述：
本发明实施例中，自动行走设备为割草机器人，其工作区域中预先放置三个反光信标，且三个反光信标在工作区域内的位置坐标等信息是已知的。
为对割草机器人进行分析定位，需要获取同一时刻三个反光信标的夹角。为补偿时差、运动状态等因素对反光信标夹角带来的误差，需要对三个反光信标的夹角一一进行误差补偿，以最终获取同一时刻三个反光信标的补偿角度值。
需要说明的是，本发明实施例中，当割草机器人沿着第一方向以方向不变、匀速移动的运动状态运动时，本误差补偿方法才适用。第一方向是指割草机器人当前的行走方向。
获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T
sync，其中，整数m≥6，即激光转台在旋转至少5圈之后到达当前一圈起始位置时的时间点为T
sync，将T
sync作为同步获取三个反光信标夹角的时间点，从而来计算三个反光信标对应的补偿角度值。
考虑到角度、时间等信号从激光信号处理模块(scanner)传输至定位计算模块(main)时存在通讯时差，可先获取这个通信时差T
com，然后计算补偿时长T
final＝T
sync+T
com，将补偿时长T
final对应的时间点作为最终同步获取三个反光信标夹角的时间点，以便计算三个反光信标对应的补偿角度值。
在割草机器人沿着第一方向方向不变、匀速运动时，割草机器人上的激光转台也一直匀速旋转；当激光转台旋转至第n圈时，可通过激光转台上的角度编码器检测第一反光信标实际夹角A
n，并获取与A
n对应的激光转台旋转时长T
n，形成一组实测数据(A
n，T
n)；其中，T
n对应的时间点是激光转台接收到第一反光信标发出的激光发射信号的时刻。
为保证实测数据采集的及时有效，可将激光转台最接近同步时间点T
sync或补偿时间点T
final的连续5圈旋转作为实测数据采集范围，以获取对应的连续五组实测数据(A
m-5，T
m-5)、(A
m-4，T
m-4)、(A
m-3，T
m-3)、(A
m-2，T
m-2)以及(A
m-1，T
m-1)，并形成实测数据矩阵。
其中，激光转台从第n圈起始位置旋转至接收到激光反射信号时刻的时差为t2，激光转台旋转n-1圈的总消耗时长为t
round，激光转台实际旋转时长T
n为t2与t
round两者之和；实测角度A
n由角度编码器检测得到后壳发送给定位计算模块(main)进行计算处理。
为提高拟合精度，可通过加权最小二乘法推导公式来获取角度误差补偿公式，为此，需要先确定权重系数c：获取每个实际旋转时长T
n与补偿时间点T
final之间的时间差t1，计算时间差t1与大于零的常数β两者之和，将两者之和的倒数作为与每个实际旋转时长T
n对应的权重系数c，即
由此，一一计算得到对应的5个权重系数，并形成权重矩阵。
然后，根据上述实测数据矩阵与上述权重矩阵，通过加权最小二乘法推导公式，计算得到具体的第一反光信标误差补偿公式。
类似的，通过上述方法与步骤，可同样得到具体的第二反光信标误差补偿公式以及具体的第三反光信标误差补偿公式。
最终，根据补偿时长T
final，通过三个误差补偿公式计算得到三个反光信标对应的角度补偿值，以便进一步分析得到割草机器人在工作区域内的坐标位置信息。
综上，本发明提供的反光信标夹角误差补偿方法、自动行走设备以及存储介质，所述方法在考虑误差补偿效果的情况下，获取在激光转台从静止状态旋转至少5圈之后、激光转台旋转至当前一圈起始位置的时间点T
sync，根据预先获得的反光信标角度误差补偿公式，计算对应的反光信标补偿角度值，对反光信标夹角进行修正；并将T
sync作为同步获取其他反光信标夹角的时间点，从而方便后续通过多个反光信标的补偿角度值分析自动行走设备的坐标位置信息。
应当理解，虽然本说明书按照实施方式加以描述，但并非每个实施方式仅包含一个独立的技术方案，说明书的这种叙述方式仅仅是为清楚起见，本领域技术人员应当将说明书作为一个整体，各实施方式中的技术方案也可以经适当组合，形成本领域技术人员可以理解的其他实施方式。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具 体说明，并非用以限制本发明的保护范围，凡未脱离本发明技艺精神所作的等效实施方式或变更均应包含在本发明的保护范围之内。
Claims (14)
- 一种反光信标夹角误差补偿方法，其特征在于，包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长T sync，其中，整数m≥6；根据旋转时长T sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值，其中，第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式，第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。
- 根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，步骤“根据旋转时长T sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值”具体包括：获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T com；计算第一信标角度的补偿时长T final＝T sync+T com；根据补偿时长T final，通过第一信标角度误差补偿公式，计算出第一信标角度的最终补偿角度值。
- 根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，在步骤“根据旋转时长T sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值”之前，所述方法还包括：当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A n以及相应的激光转台实际旋转时长T n，其中，n为激光转台的旋转圈数序号。
- 根据权利要求3所述的反光信标夹角误差补偿方法，其特征在于，在步骤“当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A n以及相应的激光转台实际旋转时长T n，其中，n为激光转台的旋 转圈数序号”之后，所述方法还包括：根据至少两组数据(A n，T n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
- 根据权利要求3所述的反光信标夹角误差补偿方法，其特征在于，在步骤“当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A n以及相应的激光转台实际旋转时长T n，其中，n为激光转台的旋转圈数序号”之后，所述方法还包括：根据至少两组数据(A n，T n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
- 根据权利要求5所述的反光信标夹角误差补偿方法，其特征在于，步骤“根据至少两组数据(A n，T n)，通过加权最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式”具体包括：获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长T com；计算第一信标角度的补偿时长T final＝T sync+T com；获取实际旋转时长T n与补偿时长T final之间的时间差t1；计算权重系数其中，β为大于零的常数；
根据至少两组数据(A n，T n)与权重系数c，通过加权最小二乘法公式，计算得到关于第一信标角度的误差补偿公式。 - 根据权利要求4所述的反光信标夹角误差补偿方法，其特征在于，步骤“根据至少两组数据(A n，T n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式”具体包括：在激光转台连续旋转5圈之后，获取对应的5组不同数据(A n，T n)；根据5组不同数据(A n，T n)，通过最小二乘法拟合公式，计算得到关于第一信标角度的误差补偿公式。
- 根据权利要求7所述的反光信标夹角误差补偿方法，其特征在于，步骤“在激光转台连续旋转5圈之后，获取对应的5组不同数据(A n，T n)”具体 包括：将n分别取值m-5、m-4、m-3、m-2以及m-1，获取与时刻T sync最邻近的五组数据(A m-5，T m-5)、(A m-4，T m-4)、(A m-3，T m-3)、(A m-2，T m-2)以及(A m-1，T m-1)。
- 根据权利要求3所述的反光信标夹角误差补偿方法，其特征在于，步骤“当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A n以及相应的激光转台实际旋转时长T n，其中，n为激光转台的旋转圈数序号”具体包括：获取激光转台从第n圈起始位置时至接收到第一反光信标发出的激光反射信号时的时差t2；获取激光转台旋转n-1圈的消耗时长t round；计算激光转台实际旋转时长T n＝t2+t round。
- 根据权利要求3所述的反光信标夹角误差补偿方法，其特征在于，步骤“当自动行走设备在第一方向匀速直线运动时，获取激光转台实际测得的第一信标角度A n以及相应的激光转台实际旋转时长T n，其中，n为激光转台的旋转圈数序号”具体包括：通过激光转台内的角度编码器测量实际的第一信标角度；接收角度编码器发出的第一信标角度信号。
- 根据权利要求1所述的反光信标夹角误差补偿方法，其特征在于，在步骤“根据旋转时长T sync，通过第一信标角度误差补偿公式，计算出第一信标角度的补偿角度值”之后，所述方法还包括：获取第二信标角度的误差补偿公式，根据旋转时长T sync，通过第二信标角度误差补偿公式，计算出第二信标角度的补偿角度值；获取第三信标角度的误差补偿公式，根据旋转时长T sync，通过第三信标角度误差补偿公式，计算出第三信标角度的补偿角度值；根据三个信标相应的补偿角度值，获取自动行走设备的坐标位置。
- 一种自动行走设备，包括存储器与处理器，所述存储器存储有可在所 述处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现权利要求1至11任意一项所述的反光信标夹角误差补偿方法中的步骤。
- 根据权利要求12所述的自动行走设备，其特征在于，所述自动行走设备为割草机器人。
- 一种存储介质，所述存储介质存储于计算机程序，其特征在于，所述计算机程序被处理器执行时实现权力要求1至11任意一项所述的反光信标夹角误差补偿方法中的步骤。
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911163982.5 | 2019-11-25 | ||
| CN201911163982.5A CN112947396B (zh) | 2019-11-25 | 2019-11-25 | 反光信标夹角误差补偿方法、自动行走设备以及存储介质 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2021103659A1 true WO2021103659A1 (zh) | 2021-06-03 |
Family
ID=76129800
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/CN2020/108787 WO2021103659A1 (zh) | 2019-11-25 | 2020-08-13 | 反光信标夹角误差补偿方法、自动行走设备以及存储介质 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN112947396B (zh) |
| WO (1) | WO2021103659A1 (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115373433B (zh) * | 2022-10-25 | 2023-01-13 | 季华实验室 | 转台运动补偿方法、装置、设备及存储介质 |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5446356A (en) * | 1993-09-09 | 1995-08-29 | Samsung Electronics Co., Ltd. | Mobile robot |
| CN101413785A (zh) * | 2008-10-27 | 2009-04-22 | 西安交通大学 | 基于双旋转激光平面发射机网络的定位系统误差补偿方法 |
| CN202853619U (zh) * | 2012-07-16 | 2013-04-03 | 苏州科瓴精密机械科技有限公司 | 一种移动机器人的定位系统 |
| CN103969654A (zh) * | 2013-01-28 | 2014-08-06 | 苏州科瓴精密机械科技有限公司 | 移动机器人系统 |
| CN104316081A (zh) * | 2014-10-17 | 2015-01-28 | 中国人民解放军国防科学技术大学 | 基于激光陀螺的转台分度误差检测方法 |
| CN105026884A (zh) * | 2013-01-09 | 2015-11-04 | 卡尔蔡司工业测量技术有限公司 | 用于求取旋转位置求取系统的误差的方法 |
| CN105353758A (zh) * | 2015-11-10 | 2016-02-24 | 闫夙 | 一种精密自动割草机分布式信标激光定位与轨迹控制系统 |
| CN108957466A (zh) * | 2018-04-18 | 2018-12-07 | 广东宝乐机器人股份有限公司 | 移动机器人的雷达数据补偿方法、装置、设备和存储介质 |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3570372B2 (ja) * | 2000-11-08 | 2004-09-29 | 株式会社デンソー | 車両用現在位置検出装置、車両用現在位置表示装置、ナビゲーション装置および記録媒体 |
| TW201215915A (en) * | 2010-10-12 | 2012-04-16 | Univ Nat Formosa | Calibration method of laser pointing device |
| JP5836026B2 (ja) * | 2011-09-08 | 2015-12-24 | 三菱重工業株式会社 | 誤差周波数成分取得装置、回転角度取得装置およびモータ制御装置 |
| KR101390466B1 (ko) * | 2012-11-20 | 2014-05-07 | 한국과학기술원 | 이동로봇 및 레이저 스캐너가 고속으로 움직일 때 측정된 스캔 거리 데이터들의 동적 오차 보정 방법 및 이를 이용한 스캔 거리 데이터 측정 장치 |
| JP2014228514A (ja) * | 2013-05-27 | 2014-12-08 | 三菱電機株式会社 | 角度校正装置および角度校正方法 |
| EP2835616A1 (en) * | 2013-08-09 | 2015-02-11 | Ams Ag | Position sensor device to determine a position of a moving device |
| CN104034351A (zh) * | 2014-06-05 | 2014-09-10 | 哈尔滨工程大学 | 基于增量法的动态条件下高精度光纤陀螺性能测试方法 |
| CN206095171U (zh) * | 2016-09-30 | 2017-04-12 | 长春师范大学 | 直线激光器姿态调整机构 |
-
2019
- 2019-11-25 CN CN201911163982.5A patent/CN112947396B/zh active Active
-
2020
- 2020-08-13 WO PCT/CN2020/108787 patent/WO2021103659A1/zh active Application Filing
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5446356A (en) * | 1993-09-09 | 1995-08-29 | Samsung Electronics Co., Ltd. | Mobile robot |
| CN101413785A (zh) * | 2008-10-27 | 2009-04-22 | 西安交通大学 | 基于双旋转激光平面发射机网络的定位系统误差补偿方法 |
| CN202853619U (zh) * | 2012-07-16 | 2013-04-03 | 苏州科瓴精密机械科技有限公司 | 一种移动机器人的定位系统 |
| CN105026884A (zh) * | 2013-01-09 | 2015-11-04 | 卡尔蔡司工业测量技术有限公司 | 用于求取旋转位置求取系统的误差的方法 |
| CN103969654A (zh) * | 2013-01-28 | 2014-08-06 | 苏州科瓴精密机械科技有限公司 | 移动机器人系统 |
| CN104316081A (zh) * | 2014-10-17 | 2015-01-28 | 中国人民解放军国防科学技术大学 | 基于激光陀螺的转台分度误差检测方法 |
| CN105353758A (zh) * | 2015-11-10 | 2016-02-24 | 闫夙 | 一种精密自动割草机分布式信标激光定位与轨迹控制系统 |
| CN108957466A (zh) * | 2018-04-18 | 2018-12-07 | 广东宝乐机器人股份有限公司 | 移动机器人的雷达数据补偿方法、装置、设备和存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112947396A (zh) | 2021-06-11 |
| CN112947396B (zh) | 2024-10-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103477185B (zh) | 用于确定对象表面的3d坐标的测量系统 | |
| US9958268B2 (en) | Three-dimensional measuring method and surveying system | |
| CN105865451B (zh) | 用于移动机器人室内定位的方法和设备 | |
| US11460561B2 (en) | Surveying device, and calibration method and calibration program for surveying device | |
| US10209361B2 (en) | Positioning device for an optical triangulation sensor | |
| CN110208771B (zh) | 一种移动二维激光雷达的点云强度改正方法 | |
| CN105572679B (zh) | 一种二维扫描型激光雷达的扫描数据修正方法及系统 | |
| US20060197944A1 (en) | Survey system | |
| US20050034036A1 (en) | Method for correcting data of several opto-electronic sensors | |
| CN107490375B (zh) | 定点悬停精度测量装置、方法及无人飞行器 | |
| WO2021019446A1 (en) | System and method for inter-sensor calibration | |
| CN109813526B (zh) | 一种基于天文定位的光学望远镜外场跟踪精度检测方法 | |
| WO2021103659A1 (zh) | 反光信标夹角误差补偿方法、自动行走设备以及存储介质 | |
| CN106323267A (zh) | 果园作业农业机器人行间定位方法 | |
| US9784842B2 (en) | Surveying instrument | |
| CN109814126A (zh) | 一种移动式平面激光雷达植物形态测量装置 | |
| CN106643521B (zh) | 一种农作物冠层高度的检测方法及装置 | |
| CN107917693B (zh) | 一种基于光学测距的倾斜测量装置及测量方法 | |
| CN106405527A (zh) | 一种可自适应补偿被测地形高程变化的机载LiDAR装置 | |
| Roberts et al. | Kinematic positioning using a robotic total station as applied to small-scale UAVs | |
| CN111522441B (zh) | 空间定位方法、装置、电子设备及存储介质 | |
| CN114858093B (zh) | 一种快速三维扫描仪的使用方法 | |
| CN110672117B (zh) | 基于单观察哨数字望远镜的小航路捷径运动目标航迹获取方法 | |
| US20240168155A1 (en) | Determining the locations of components of a location-determining system in an environment | |
| CN117288183A (zh) | 基于角度的机器人重定位方法 |
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: 20891923 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: 20891923 Country of ref document: EP Kind code of ref document: A1 |