A method and system for correcting the resolution of a wheel encoder

Through the calculation of the change amount of lidar and wheel encoder, the wheel encoder resolution of the single-wheel AGV trolley is corrected, which solves the problem of degradation of positioning accuracy and tracking accuracy caused by wheel wear, and improves the accuracy of the wheel encoder.

CN115597652BActive Publication Date: 2024-11-26GUANGDONG JATEN ROBOT & AUTOMATION
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211239328.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-10-11
Publication Date
2024-11-26
Estimated Expiration
2042-10-11

AI Technical Summary

Technical Problem

The wheel wear of the single-wheel AGV car causes inaccurate wheel odometer data, which reduces positioning accuracy and tracking accuracy.

Method used

Through the calculation of the change amount of lidar and wheel encoder, the initial resolution value of the wheel encoder is obtained, and the resolution mean is calculated through multiple data acquisitions. When the difference between the resolution mean and the initial value is greater than the threshold, the correction is performed. Update the initial resolution value.

Benefits of technology

It effectively improves the accuracy of the wheel encoder and solves the problem of degradation of positioning accuracy and tracking accuracy due to wheel wear.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115597652B_ABST
    Figure CN115597652B_ABST
Patent Text Reader

Abstract

The present invention discloses a method and system for correcting the resolution of a wheel encoder, which is applied to a single-steering wheel AGV trolley. The method includes: obtaining the change amount of the wheel encoder and the change amount of the laser radar within the time period of receiving two adjacent frames of laser radar data; obtaining the initial value of the resolution of the wheel encoder, and calculating the resolution of the wheel encoder according to the change amount of the wheel encoder and the change amount of the laser radar; repeating the above operation N times, outputting the resolution of N wheel encoders, and calculating the mean resolution of the wheel encoder through the N resolutions; judging whether the difference between the mean resolution and the initial resolution value is greater than a set threshold; if so, correcting the initial resolution value of the wheel encoder using the mean resolution. The present invention can effectively correct the resolution of the wheel encoder, and solve the problem of inaccurate data of the wheel odometer and poor positioning accuracy and tracking accuracy of the single-steering wheel AGV trolley due to wheel wear.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of single-steering wheel AGV, and in particular to a resolution correction method and system for a wheel encoder. Background Art

[0002] With the development of AGV, the application scenarios of AGV are becoming more and more diverse, so the requirements for positioning accuracy and tracking accuracy of AGV vehicles are getting higher and higher. Wheel odometer is a method that can use the data obtained from the wheel encoder to estimate the change of object position over time. Accurate wheel odometer is very beneficial to improving AGV positioning accuracy and tracking accuracy.

[0003] In the prior art, the resolution of most wheel encoders is determined according to the initial design parameters. As the single-steering-wheel AGV vehicle travels for a long time, the wheels gradually wear out, which can easily lead to inaccurate data from the wheel odometer on the single-steering-wheel AGV vehicle, thereby causing a decrease in the tracking accuracy and positioning accuracy of the single-steering-wheel AGV vehicle. Summary of the invention

[0004] The purpose of the present invention is to provide a method and system for correcting the resolution of a wheel encoder to solve one or more technical problems existing in the prior art and at least provide a beneficial choice or create conditions.

[0005] The solution of the present invention to solve the technical problem is to provide a resolution correction method and system for a wheel encoder.

[0006] According to an embodiment of the first aspect of the present invention, a method for calibrating the resolution of a wheel encoder is provided, which is applied to a single-steering-wheel AGV trolley, wherein the single-steering-wheel AGV trolley is provided with a laser radar and a wheel encoder, comprising the following steps:

[0007] S100, obtaining a change amount of the wheel encoder and a change amount of the laser radar within a time period of receiving two adjacent frames of laser radar data;

[0008] S200, obtaining an initial value of the resolution of the wheel encoder, and calculating the resolution of the wheel encoder according to a change in the wheel encoder and a change in the laser radar;

[0009] S300, repeating the operations of S100 and S200 N times, outputting the resolutions of N wheel encoders, and calculating the average resolution of the wheel encoder through the N resolutions;

[0010] S400, determining whether the difference between the mean resolution and the initial resolution is greater than a set threshold;

[0011] S500: If yes, use the resolution mean to correct the initial resolution value of the wheel encoder.

[0012] Further, in S100, obtaining the change amount of the wheel encoder and the change amount of the laser radar within the time period of receiving two adjacent frames of laser radar data specifically includes:

[0013] S110, when receiving the laser radar data of the current frame, obtaining the first information L0 of the wheel encoder at the current time t, and obtaining the first position information P0 of the laser radar according to the laser radar data of the current frame;

[0014] S120, when the next frame of laser radar data is received, the second information L1 of the wheel encoder at the next time t+1 is obtained, and the second position information P1 of the laser radar is obtained according to the next frame of laser radar data;

[0015] S130, obtaining a change amount Δ of the wheel encoder according to the first information L0 and the second information L1 of the wheel encoder L , and obtain the change amount Δ of the laser radar according to the first position information P0 and the second position information P1 of the laser radar P .

[0016] Further, in S200, the obtaining of the initial value of the resolution of the wheel encoder and calculating the resolution of the wheel encoder according to the change of the wheel encoder and the change of the laser radar specifically includes:

[0017] Get the initial value scale(old) of the wheel encoder resolution, and adjust the resolution according to the change Δ of the wheel encoder. L and the change in the laser radar Δ P , through the resolution calculation formula:

[0018] scale(new) = Δ p / Δ L *scale(old)

[0019] , calculate the resolution scale(new) of the wheel encoder.

[0020] Further, in S400, the determining whether the difference between the initial resolution value and the average resolution value is greater than a set threshold specifically includes:

[0021] S410, performing a difference calculation between the initial resolution value and the average resolution value to obtain a difference between the initial resolution value and the average resolution value;

[0022] S420: Compare the difference with a set threshold to determine whether the difference is greater than the set threshold.

[0023] Further, in S300, the operations of S100 and S200 are repeated N times, and the resolutions of N wheel encoders are outputted. The average resolution of the wheel encoder is calculated by the N resolutions, and specifically includes:

[0024] The operations of S100 and S200 are repeated N times, and N resolutions of the wheel encoders are output. The average resolution of the wheel encoder is calculated through the N resolutions, wherein the value of N is 10.

[0025] According to an embodiment of the second aspect of the present invention, a wheel encoder resolution correction system is provided, which is applied to a single-steering wheel AGV trolley, wherein the single-steering wheel AGV trolley is provided with a laser radar and a wheel encoder, comprising:

[0026] A change amount acquisition module is used to acquire the change amount of the wheel encoder and the change amount of the laser radar within a time period of receiving two adjacent frames of laser radar data;

[0027] A resolution calculation module, used to obtain an initial value of the resolution of the wheel encoder, and calculate the resolution of the wheel encoder according to the change of the wheel encoder and the change of the laser radar;

[0028] A mean value calculation module, used for repeating the operations of the variation acquisition module and the resolution calculation module N times, outputting N resolutions, and calculating the mean value of the resolution of the wheel encoder through the N resolutions;

[0029] A judgment module, used to judge whether the difference between the mean resolution and the initial resolution is greater than a set threshold;

[0030] The correction module is used to correct the initial resolution value of the wheel encoder using the mean resolution value when the difference between the mean resolution value and the initial resolution value is greater than a set threshold.

[0031] Further, the variation acquisition module includes:

[0032] A current frame information acquisition unit, configured to acquire first information L0 of the wheel encoder at a current time t when receiving the current frame laser radar data, and to obtain first position information P0 of the laser radar according to the current frame laser radar data;

[0033] A next frame information acquisition unit, configured to acquire the second information L1 of the wheel encoder at the next time t+1 when receiving the next frame of laser radar data, and to obtain the second position information P1 of the laser radar according to the next frame of laser radar data;

[0034] A variation calculation unit is used to obtain a variation Δ of the wheel encoder according to the first information L0 and the second information L1 of the wheel encoder. L , and according to the first position information 00 and the second position information P1 of the laser radar, the change amount Δ of the laser radar is obtained P .

[0035] Further, the resolution calculation module includes:

[0036] An initial value acquisition unit, used to acquire an initial value scale(old) of the resolution of the wheel encoder;

[0037] A resolution calculation unit is used to calculate the resolution of the wheel encoder according to the change Δ L , the change of laser radar Δ P And the initial value of resolution scale(old), through the resolution calculation formula:

[0038] scale(new) = Δ p / Δ L *scale(old)

[0039] , calculate the resolution scale(new) of the wheel encoder.

[0040] Further, the judgment module includes:

[0041] A difference calculation unit, used for performing difference calculation on the initial resolution value and the average resolution value to obtain the difference between the initial resolution value and the average resolution value;

[0042] The comparison and judgment unit is used to compare the difference with a set threshold value to judge whether the difference is greater than the set threshold value.

[0043] Further, the mean calculation module includes:

[0044] A repeating unit, used for repeating the operations of the variation acquisition module and the resolution calculation module N times, and outputting N resolutions;

[0045] The mean value calculation unit is used to calculate the mean value of the resolution of the wheel encoder through N resolutions, wherein N is 10.

[0046] The beneficial effects of the present invention are: by using the variation of the wheel encoder and the variation of the laser radar, the resolution of the wheel encoder in the transmission time period of two adjacent frames of laser radar data is obtained, the resolution of N wheel encoders is obtained, and the average value is calculated. When the difference between the resolution average and the resolution initial value is greater than the set threshold, the resolution initial value of the wheel encoder is corrected with the resolution average. The present invention can effectively correct the resolution of the wheel encoder, improve the accuracy of the wheel encoder, and solve the problem that the wheel odometer data is inaccurate due to wheel wear in the single-steering wheel AGV trolley, thereby causing the positioning accuracy and tracking accuracy of the single-steering wheel AGV trolley to deteriorate. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] Figure 1 is a schematic flow chart of a method for calibrating the resolution of a wheel encoder provided by an embodiment of the present invention;

[0048] Figure 2 It is a schematic flow chart of a method for correcting the resolution of a wheel encoder provided in another embodiment of the present invention. DETAILED DESCRIPTION

[0049] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and cannot be understood as limiting the present invention.

[0050] It should be noted that although the functional modules are divided in the system diagram, in some cases, the steps shown or described may be performed in a different order than the module division in the system or the order in the flowchart. The terms "first", "second", etc. in the specification, claims and the above drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence.

[0051] In the description of the present invention, it should be noted that, unless otherwise clearly defined, terms such as setting, installing, connecting, etc. should be understood in a broad sense, and technicians in the relevant technical field can reasonably determine the specific meanings of the above terms in the present invention in combination with the specific content of the technical solution.

[0052] The present invention is applied to a single-steering-wheel AGV. Compared with a dual-steering-wheel AGV, the wheel wear of a single-steering-wheel AGV is more serious, and the positioning accuracy and tracking accuracy are more affected. The AGV mainly uses a wheel odometer and a laser radar for positioning or tracking. Therefore, a wheel encoder and a laser radar are provided on a single-steering-wheel AGV for positioning and tracking.

[0053] According to an embodiment of the first aspect of the present invention, referring to Figure 1In some embodiments of the present invention, a method for calibrating the resolution of a wheel encoder comprises the following steps:

[0054] S100, obtaining a change amount of the wheel encoder and a change amount of the laser radar within a time period of receiving two adjacent frames of laser radar data.

[0055] In this embodiment, when the single-steering wheel AGV is moving, the laser radar collects movement data, the wheel encoder obtains the movement information of the single steering wheel, and the single-steering wheel AGV receives the data frames transmitted by the laser radar, among which two data frames are selected, and these two data frames are adjacent data frames.

[0056] In the time period between the two adjacent frames of data, the change amount of the wheel encoder is obtained, that is, the change amount of the movement information obtained by the wheel encoder during this period of time. In the time period between the two adjacent frames of data, the change amount of the laser radar is obtained, that is, the change amount obtained by the laser radar through the movement data during this period of time.

[0057] S200, obtaining an initial value of the resolution of the wheel encoder, and calculating the resolution of the wheel encoder according to the change of the wheel encoder and the change of the laser radar.

[0058] In this embodiment, the initial value of the resolution of the wheel encoder recorded in the single-steering wheel AGV is obtained. This initial value of the resolution can be understood as the resolution of the wheel encoder before the wheel is worn.

[0059] The resolution of the wheel encoder in the time period between receiving two adjacent frames of laser radar data is obtained by calculating and processing the change of the wheel encoder obtained in S100, the change of the laser radar obtained in S100 and the initial value of the resolution.

[0060] S300, repeating the operations of S100 and S200 N times, outputting the resolutions of N wheel encoders, and calculating the average resolution of the wheel encoders through the N resolutions.

[0061] In this embodiment, the operation of steps S100 and S200 is repeated N times in a loop, so that the resolutions of N wheel encoders can be obtained. The average value of the resolution of the current wheel encoder is obtained by averaging the output N resolutions. That is, the resolution value of the wheel encoder after the wheel is worn is obtained.

[0062] The N resolutions may be obtained through continuous adjacent data frames or through discontinuous adjacent data frames. In some preferred embodiments, the N resolutions may be obtained through continuous adjacent data frames.

[0063] For example: in the time period between the first laser radar data frame and the second laser radar data frame, the resolution of the first wheel encoder is obtained; in the time period between the second laser radar data frame and the third laser radar data frame, the resolution of the second wheel encoder is obtained; .... in the time period between the Mth laser radar data frame and the M+1th laser radar data frame, the resolution of the Nth wheel encoder is obtained. These N resolutions can be obtained through continuous adjacent data frames.

[0064] In the time period between the first laser radar data frame and the second laser radar data frame, the resolution of the first wheel encoder is obtained; in the time period between the fourth laser radar data frame and the fifth laser radar data frame, the resolution of the second wheel encoder is obtained; .... in the time period between the Mth laser radar data frame and the M+1th laser radar data frame, the resolution of the Nth wheel encoder is obtained. These N resolutions can be obtained through discontinuous adjacent data frames.

[0065] S400, determining whether the difference between the average resolution and the initial resolution is greater than a set threshold;

[0066] In this embodiment, it is determined whether the difference between the average resolution obtained in S300 and the initial resolution value of the wheel encoder recorded in the single-steering wheel AGV is greater than the set threshold. In other words, it is determined whether the difference is greater than the set threshold based on the difference between the resolution of the wheel encoder after the wheel is worn and the resolution of the wheel encoder before the wheel is worn. The determination result of this embodiment can not only determine whether the resolution of the wheel encoder needs to be corrected, but also determine the degree of wear of the wheel in the single-steering wheel AGV through data.

[0067] S500: If yes, the initial resolution value of the wheel encoder is corrected using the resolution mean value.

[0068] In this embodiment, the difference between the mean resolution and the initial resolution is obtained. When the difference between the two is greater than the set threshold, that is, the difference between the resolution of the wheel encoder after the wheel is worn and the resolution of the wheel encoder before the wheel is worn is too large, it can be considered that the wear of the wheel in the single-steering wheel AGV will affect the positioning accuracy. If the resolution before wear is still used, that is, the initial resolution is still used, the positioning accuracy and tracking accuracy will be greatly affected. Therefore, the mean resolution is used to correct the initial resolution, that is, the resolution of the wheel encoder after the wheel is worn is used to replace the resolution of the wheel encoder before the wheel is worn.

[0069] The above method can effectively correct the resolution of the wheel encoder, improve the accuracy of the wheel encoder, and solve the problem that the data of the wheel odometer is inaccurate due to wheel wear in the AGV, thereby causing the positioning accuracy and tracking accuracy of the single-steering wheel AGV to deteriorate.

[0070] Reference Figure 2 , Figure 2 for Figure 1 The detailed process of S100 in the flowchart of an embodiment is shown in FIG. 1 , wherein S100 includes but is not limited to S110, S120 and S130. In S100, the specific process of obtaining the variation includes the following steps:

[0071] S110, when the laser radar data of the current frame is received, the first information L0 of the wheel encoder at the current time t is obtained, and the first position information P0 of the laser radar is obtained according to the laser radar data of the current frame.

[0072] In this embodiment, when the single-steering wheel AGV is moving, the laser radar collects movement data, and the wheel encoder obtains the movement information of the single steering wheel. When a frame of data collected by the laser radar is received, at this moment t, the movement information of the single-steering wheel AGV obtained by the wheel encoder is obtained, that is, the first information L0. And according to the frame of data collected by the received laser radar, based on the laser SLAM positioning algorithm, the first position information P0 of the single-steering wheel AGV at this time is obtained. Among them, the first position information P0 is the information obtained by positioning the single-steering wheel AGV by the laser radar, that is, the position information of the single-steering wheel AGV at this moment t.

[0073] It should be noted that at this time t, the information obtained by the wheel encoder can correspond to the position information obtained by the laser radar, and both obtain information at the same location and at the same time.

[0074] The acquisition method of this embodiment is helpful to reduce the slight errors in data acquisition and calculation of changes, and improves the accuracy of the resolution of the obtained wheel encoder.

[0075] S120, when the next frame of laser radar data is received, the second information L1 of the wheel encoder at the next time t+1 is obtained, and the second position information P1 of the laser radar is obtained according to the next frame of laser radar data.

[0076] In this embodiment, when the single-steering wheel AGV is moving, the laser radar collects movement data, and the wheel encoder obtains the movement information of the single steering wheel. When the next frame of data collected by the laser radar is received, the data of the next frame is adjacent to the current frame data in S110, that is, after receiving the data frame in S110, the data frame in this embodiment is received.

[0077] At this moment t+1, the movement information of the single steering wheel obtained by the wheel encoder is obtained, that is, the second information L1. When the next frame of data collected by the laser radar is received, at this moment t+1, the second position information P1 of the single steering wheel AGV car is obtained based on the laser SLAM positioning algorithm according to the data collected by the received laser radar. Among them, the second position information P1 is the information obtained by positioning the single steering wheel AGV car by the laser radar, that is, the position information of the single steering wheel AGV car at this moment t+1.

[0078] It should be noted that at this moment t+1, the information obtained by the wheel encoder can correspond to the position information obtained by the laser radar, and both obtain information at the same location and at the same time.

[0079] The acquisition method of this embodiment is helpful to reduce the slight errors in data acquisition and calculation of variation, and improve the accuracy of the resolution of the obtained wheel encoder.

[0080] S130, obtaining the change amount Δ of the wheel encoder according to the first information L0 and the second information L1 of the wheel encoder L , and according to the first position information P0 and the second position information P1 of the laser radar, the change amount Δ of the laser radar is obtained P .

[0081] In this embodiment, the first information L0 and the first position information P0 obtained in S110 and the second information L1 and the second position information P1 obtained in S120 are used to calculate the difference between the first information L0 and the second information L1 to obtain the change Δ of the wheel encoder mentioned in S100. L That is to say, during the period from receiving the laser radar data of the current frame to receiving the laser radar data of the next frame, that is, during the period from the current time t to the next time t+1, the change in the movement of the single-steering wheel AGV detected by the wheel encoder is obtained.

[0082] The difference between the first position information P0 and the second position information P1 is calculated to obtain the change amount Δ of the laser radar mentioned in S100 P That is to say, during the period from receiving the laser radar data of the current frame to receiving the laser radar data of the next frame, that is, during the period from the current time t to the next time t+1, the change in the movement of the single-steering wheel AGV detected by the laser radar is obtained.

[0083] In some embodiments of the present invention, in S200, the initial value of the resolution recorded in the single-steering wheel AGV is obtained, and according to the change amount of the wheel encoder and the change amount of the laser radar obtained in S100, the process of calculating the resolution specifically includes the following:

[0084] Obtaining the initial value of the resolution of the wheel encoder, that is, obtaining the initial value of the resolution recorded in the single-steering wheel AGV, can be understood as obtaining the resolution of the wheel encoder before the wheel is worn.

[0085] The change of the wheel encoder obtained by S100 L , the change of laser radar Δ P And the initial resolution value recorded in the single-steering wheel AGV car, through the resolution calculation formula:

[0086] scale(new) = Δ p / Δ L *scale(old)

[0087] , substitute it into the calculation to get the resolution scale(new) of the wheel encoder in the period from receiving the current frame of laser radar data to receiving the next frame of laser radar data, that is, from the current time t to the next time t+1. During this period of time, the single-steering wheel AGV moves a certain distance, and the laser radar and wheel encoder both locate this distance and obtain the position change Δ of this distance respectively. P , Δ L The ratio of the two changes is calculated and multiplied by the initial value of the resolution to obtain the resolution of the wheel encoder during this period of time and over this distance.

[0088] Ideally, for the same moving distance in the same time period, the changes obtained by the laser radar and the wheel encoder should be consistent, that is, their ratio is close to 1. However, due to the wear of the single steering wheel, the information obtained by the wheel encoder is not accurate. The resolution calculation formula can be used to know the relationship between the wheel encoder after wear and the wheel encoder after wear for the same moving distance in the same time period.

[0089] In some embodiments of the present invention, in S300, steps S100 and S200 are repeated N times to obtain N resolutions, and the average resolution of the wheel encoder is calculated by the N resolutions as follows:

[0090] Repeat S100 and S200 operations 10 times, output the resolutions of 10 wheel encoders, calculate the average value of these 10 resolutions, and thus obtain the resolution of the encoder after the wheel is worn.

[0091] In this embodiment, the value of N is 10, and the operations of S100 and S200 are repeated 10 times. For example: in the time period between receiving the first laser radar data frame and receiving the second laser radar data frame, the first resolution scale (1) is calculated by S100 and S200; in the time period between receiving the second laser radar data frame and receiving the third laser radar data frame, the second resolution scale (2) is calculated by S100 and S200; .... in the time period between receiving the tenth laser radar data frame and receiving the eleventh laser radar data frame, the tenth resolution scale (10) is calculated by S100 and S200. By repeating the above steps in a loop, the resolutions of 10 wheel encoders are obtained. By calculating the average value of these 10 resolutions, the mean resolution of the current wheel encoder is obtained. This resolution mean can be considered as the resolution of the encoder after the wheel of the single-steering wheel AGV is worn.

[0092] It should be noted that N is preferably 10 in this embodiment. When N is too small, the average resolution obtained is not convincing enough, and a special resolution may appear, resulting in inaccurate values. When N is too large, the average resolution obtained will be close to the initial resolution value. Therefore, N is preferably 10 in this embodiment.

[0093] In some embodiments of the present invention, in S400, determining whether the difference between the initial resolution value and the average resolution value is greater than a set threshold value specifically includes the following steps:

[0094] S410, performing difference calculation on the initial resolution value of the wheel encoder obtained in S200 and the average resolution value of the wheel encoder obtained in S300 to obtain the difference between the average resolution value and the initial resolution value.

[0095] In this embodiment, the difference between the resolution mean and the resolution initial value is taken to confirm the difference between the resolution before wheel wear and the resolution after wheel wear. The obtained difference can also reflect the degree of wear of the wheel of the single-steering wheel AGV vehicle. When the difference is too large, it can be considered that the degree of wear of the wheel of the single-steering wheel AGV vehicle is serious.

[0096] S420, comparing the difference value obtained in S410 with a set threshold value, and determining whether the difference value is greater than the set threshold value.

[0097] In this embodiment, the difference between the mean resolution and the initial resolution is compared with the set threshold. When the difference is greater than the set threshold, it can be considered that the wheel of the single-steering-wheel AGV is too worn, which will cause the data of the wheel odometer on the single-steering-wheel AGV to be inaccurate, thereby causing the tracking accuracy and positioning accuracy of the single-steering-wheel AGV to decrease. Therefore, the initial resolution is corrected by the mean resolution through S500, that is, the resolution of the wheel encoder after wear replaces the resolution of the wheel encoder before wear. This solves the problem of reduced tracking accuracy and positioning accuracy of the single-steering-wheel AGV.

[0098] It should be noted that when the difference is less than the set threshold, it can be considered that the wear of the wheel of the single-steering wheel AGV is not serious. At this time, the initial resolution value can be used as the positioning parameter, or the mean resolution value can be used as the positioning parameter to correct the initial resolution value.

[0099] According to an embodiment of the second aspect of the present invention, in some embodiments of the present invention, a resolution correction system for a wheel encoder includes: a variation acquisition module, a resolution calculation module, a mean value calculation module, a judgment module and a correction module.

[0100] The change acquisition module is used to obtain the change of the wheel encoder and the change of the laser radar in the time period between receiving two adjacent frames of data, wherein this data frame is the mobile data frame collected by the laser radar when the single-steering wheel AGV is moving.

[0101] The resolution calculation module obtains the initial value of the resolution of the wheel encoder recorded in the single-steering wheel AGV. The variation of the laser radar and the variation of the wheel encoder sent by the variation acquisition module are received. The resolution of the wheel encoder in the time period between receiving two adjacent frames of data is calculated through the variation of the wheel encoder, the variation of the laser radar and the initial value of the resolution.

[0102] The mean value calculation module is used to repeat the operations of the variation acquisition module and the resolution calculation module N times. The resolution calculation module outputs N resolutions to the mean value calculation module, and the mean value of the resolution of the wheel encoder is calculated through the N resolutions. The mean value of the resolution of the current wheel encoder is obtained by averaging the output N resolutions. That is, the value of the resolution of the wheel encoder after the wheel is worn is obtained.

[0103] The N resolutions may be obtained through continuous adjacent data frames or through discontinuous adjacent data frames. In some preferred embodiments, the N resolutions may be obtained through continuous adjacent data frames.

[0104] The judgment module receives the resolution mean value output by the mean value calculation module and the resolution initial value sent by the resolution calculation module, and makes a difference between the resolution mean value and the resolution initial value to determine whether the difference between the resolution mean value and the resolution initial value is greater than a set threshold.

[0105] That is to say, by judging whether the difference is greater than a set threshold value based on the difference between the resolution of the wheel encoder after the wheel is worn and the resolution of the wheel encoder before the wheel is worn, the degree of wear of the steering wheel can be judged.

[0106] When the correction module receives the judgment result sent by the judgment module that the difference between the resolution mean value and the resolution initial value is greater than the set threshold, the resolution mean value is used to correct the resolution initial value.

[0107] In this embodiment, the change acquisition module acquires the change of the wheel encoder and the change of the laser radar in the time period between receiving two adjacent frames of data. The resolution calculation module obtains the resolution of the wheel encoder in this time period based on the change of the two. The mean calculation module obtains the resolution of N wheel encoders and calculates their average value.

[0108] The judgment module determines whether the difference between the mean resolution and the initial resolution is greater than a set threshold. If so, the correction module corrects the initial resolution with the mean resolution. The present invention can effectively correct the resolution of the wheel encoder, improve the accuracy of the wheel encoder, and solve the problem that the wheel odometer data is inaccurate due to wheel wear in the single-steering wheel AGV, thereby causing the positioning accuracy and tracking accuracy of the single-steering wheel AGV to deteriorate.

[0109] In some embodiments of the present invention, the variation acquisition module includes: a current frame information acquisition unit, a next frame information acquisition unit and a variation calculation unit.

[0110] The function of the current frame information acquisition unit is: when the single-steering wheel AGV is moving, the laser radar collects movement data, and the wheel encoder obtains the movement information of the single steering wheel. When a frame of data collected by the laser radar is received, at this moment t, the movement information of the single steering wheel obtained by the wheel encoder is obtained, that is, the first information L0. When a frame of data collected by the laser radar is received, at this moment t, according to the data collected by the received laser radar, based on the laser SLAM algorithm, the first position information P0 is obtained. The first position information P0 is the information obtained by positioning the single-steering wheel AGV by the laser radar, that is, the position information of the single-steering wheel AGV at this moment t.

[0111] The function of the next frame information acquisition unit is as follows: when the single-steering wheel AGV moves, the laser radar collects movement data, and the wheel encoder obtains the movement information of the single steering wheel. When the next frame of data collected by the laser radar is received, the data of the next frame is adjacent to the current frame data in S110, that is, after receiving the data frame in S110, the data frame in this embodiment is received.

[0112] At this moment t+1, the movement information of the single steering wheel obtained by the wheel encoder is obtained, that is, the second information L1. When the next frame of data collected by the laser radar is received, at this moment t+1, the second position information P1 is obtained based on the laser SLAM algorithm according to the data collected by the received laser radar. The second position information P1 is the information obtained by positioning the single steering wheel AGV car through the laser radar, that is, the position information of the single steering wheel AGV car at this moment t+1.

[0113] The function of the variation calculation unit is to receive the first information L0 and the first position information P0 sent by the current frame information acquisition unit, and to receive the second information L1 and the second position information P1 sent by the next frame information acquisition unit.

[0114] The difference between the first position information P0 and the second position information P1 is calculated to obtain the change Δ of the laser radar. P . Calculate the difference between the first information L0 and the second information L1 to obtain the change Δ of the wheel encoder L , and the change of the laser radar Δ P The change of the wheel encoder Δ L Send to the resolution calculation module.

[0115] In some embodiments of the present invention, the resolution calculation module includes: an initial value acquisition unit and a resolution calculation unit.

[0116] The initial value acquisition unit is used to acquire the initial value of the resolution of the wheel encoder recorded in the single-steering wheel AGV trolley, and send the initial value of the resolution to the resolution calculation unit.

[0117] The resolution calculation unit is used to receive the laser radar change Δ sent by the change calculation unit. P The change of the wheel encoder Δ L , and receive the resolution initial value sent by the initial value acquisition unit. According to the change of the wheel encoder Δ L , the change of laser radar Δ P And the initial value of resolution scale(old), through the resolution calculation formula:

[0118] scale(new) = Δ p / Δ L*scale(old)

[0119] , substitute it into the calculation to get the wheel encoder resolution scale(new) in the time period from receiving the current frame of LiDAR data to receiving the next frame of LiDAR data, that is, in the time period from the current time t to the next time t+1. And send the wheel encoder resolution scale(new) in this time period to the mean calculation module.

[0120] In some embodiments of the present invention, the mean value calculation module includes: a repetition unit and a mean value calculation unit.

[0121] The function of the repeating unit is to repeat the operations of the variation acquisition module and the resolution calculation module N times, receive N resolutions sent by the resolution calculation unit, and output these N resolutions to the mean calculation unit, where N is 10.

[0122] For example: in the time period between receiving the first laser radar data frame and receiving the second laser radar data frame, the first resolution scale (1) is calculated by the variation acquisition module and the resolution calculation module, the repeating unit receives the first resolution scale (1) sent by the resolution calculation unit, and the variation acquisition module and the resolution calculation module are operated again; in the time period between receiving the second laser radar data frame and receiving the third laser radar data frame, the second resolution scale (2) is calculated by S100 and S200, the repeating unit receives the second resolution scale (2) sent by the resolution calculation unit, and the variation acquisition module and the resolution calculation module are operated again; .... In the time period between receiving the Mth laser radar data frame and receiving the M+1th laser radar data frame, the Nth resolution scale (N) is calculated by S100 and S200, the repeating unit receives the Nth resolution scale (N) sent by the resolution calculation unit, and the resolutions of the N wheel encoders are obtained. These N resolutions are output to the mean value calculation unit.

[0123] The function of the mean value calculation unit is to receive the N resolutions sent by the repeating unit, and calculate the average value of the N resolutions to obtain the mean value of the resolution of the current wheel encoder, that is, to obtain the value of the resolution of the wheel encoder after the wheel is worn.

[0124] It should be noted that N is preferably 10 in this embodiment. When N is too small, the average resolution obtained is not convincing enough, and a special resolution may appear, resulting in inaccurate values. When N is too large, the average resolution obtained will be close to the initial resolution value. Therefore, N is preferably 10 in this embodiment.

[0125] In some embodiments of the present invention, the judgment module includes: a difference calculation unit and a comparison judgment unit.

[0126] The difference calculation unit is used to receive the mean resolution value of the wheel encoder output by the mean calculation unit and the initial resolution value of the wheel encoder sent by the resolution calculation unit, make a difference between the mean resolution value and the initial resolution value, and send the difference value to the comparison and judgment unit.

[0127] The difference between the resolution before and after wheel wear can be confirmed based on the difference. The difference obtained can also reflect the degree of wear of the wheel of the single-steering wheel AGV. When the difference is too large, it can be considered that the degree of wear of the wheel of the single-steering wheel AGV is serious.

[0128] The comparison and judgment unit is used to receive the difference sent by the difference calculation unit and compare the obtained difference with the set threshold. When the difference is greater than the set threshold, it can be considered that the wheel of the single-steering wheel AGV is worn too much. When the difference is greater than the set threshold, the judgment result is sent to the correction module.

[0129] It should be noted that when the difference is less than the set threshold, it can be considered that the wear of the wheel of the single-steering wheel AGV is not serious. At this time, the initial resolution value can be used as the positioning parameter, or the mean resolution value can be used as the positioning parameter to correct the initial resolution value.

[0130] The preferred embodiments of the present invention are described in detail above, but the invention is not limited to the embodiments. Those skilled in the art may make various equivalent modifications or substitutions without violating the spirit of the invention. These equivalent modifications or substitutions are all included in the scope defined by the claims of this application.

Claims

1. A method for calibrating the resolution of a wheel encoder, characterized in that: Applied to a single-steering-wheel AGV, which is equipped with a laser radar and a wheel encoder, including: S100, obtaining a change amount of the wheel encoder and a change amount of the laser radar within a time period of receiving two adjacent frames of laser radar data; S200, obtaining an initial value of the resolution of the wheel encoder, and calculating the resolution of the wheel encoder according to a change in the wheel encoder and a change in the laser radar; S300, repeating the operations of S100 and S200 N times, outputting the resolutions of N wheel encoders, and calculating the average resolution of the wheel encoder through the N resolutions; S400, determining whether the difference between the mean resolution and the initial resolution is greater than a set threshold; S500, if yes, correcting the initial resolution value of the wheel encoder using the resolution mean value; In S100, obtaining the change amount of the wheel encoder and the change amount of the laser radar within the time period of receiving two adjacent frames of laser radar data specifically includes: S110, when receiving the laser radar data of the current frame, obtaining the first information of the wheel encoder at the current time t , and obtain the first position information of the laser radar according to the current frame laser radar data ; S120, when the next frame of laser radar data is received, the second information of the wheel encoder at the next time t+1 is obtained , and obtain the second position information of the laser radar according to the next frame of laser radar data ; S130, according to the first information of the wheel encoder And the second information , get the change of wheel encoder , and according to the first position information of the laser radar and second location information , get the change of laser radar ; In S200, the obtaining of the initial value of the resolution of the wheel encoder and calculating the resolution of the wheel encoder according to the change of the wheel encoder and the change of the laser radar specifically includes: Get the initial value of the resolution of the wheel encoder , and according to the change in the wheel encoder and the change in the laser radar , through the resolution calculation formula: , Calculate the resolution of the wheel encoder .

2. The method for calibrating the resolution of a wheel encoder according to claim 1, characterized in that: In S400, the determining whether the difference between the initial resolution value and the average resolution value is greater than a set threshold specifically includes: S410, performing a difference calculation between the initial resolution value and the average resolution value to obtain a difference between the initial resolution value and the average resolution value; S420: Compare the difference with a set threshold to determine whether the difference is greater than the set threshold.

3. The method for calibrating the resolution of a wheel encoder according to claim 1, characterized in that: In S300, the steps of repeating the operations of S100 and S200 N times, outputting N resolutions of the wheel encoders, and calculating the average resolution of the wheel encoder using the N resolutions specifically include: Repeat the operations of S100 and S200 N times, output N resolutions of the wheel encoder, and calculate the average resolution of the wheel encoder through the N resolutions, where N is 10.

4. A resolution correction system for a wheel encoder, characterized in that: Applied to a single-steering-wheel AGV, which is equipped with a laser radar and a wheel encoder, including: A change amount acquisition module is used to acquire the change amount of the wheel encoder and the change amount of the laser radar within a time period of receiving two adjacent frames of laser radar data; A resolution calculation module, used to obtain an initial value of the resolution of the wheel encoder, and calculate the resolution of the wheel encoder according to the change of the wheel encoder and the change of the laser radar; A mean value calculation module, used for repeating the operations of the variation acquisition module and the resolution calculation module N times, outputting N resolutions, and calculating the mean value of the resolution of the wheel encoder through the N resolutions; A judgment module, used to judge whether the difference between the resolution mean and the resolution initial value is greater than a set threshold; A correction module, configured to correct the initial resolution value of the wheel encoder using the mean resolution value when the difference between the mean resolution value and the initial resolution value is greater than a set threshold; The variation acquisition module comprises: The current frame information acquisition unit is used to acquire the first information of the wheel encoder at the current time t when receiving the current frame laser radar data , and obtain the first position information of the laser radar according to the current frame laser radar data ; The next frame information acquisition unit is used to acquire the second information of the wheel encoder at the next time t+1 when receiving the next frame of laser radar data. , and obtain the second position information of the laser radar according to the next frame of laser radar data ; A variation calculation unit is used to calculate the variation according to the first information of the wheel encoder. And the second information , get the change of wheel encoder , and according to the first position information of the laser radar and second location information , get the change of laser radar ; The resolution calculation module comprises: An initial value acquisition unit, used to acquire the initial value of the resolution of the wheel encoder ; A resolution calculation unit is used to calculate the resolution of the wheel encoder according to the change of the wheel encoder. 、The change of LiDAR and initial resolution , through the resolution calculation formula: , Calculate the resolution of the wheel encoder .

5. A wheel encoder resolution correction system according to claim 4, characterized in that: The judging module comprises: A difference calculation unit, used for performing difference calculation on the initial resolution value and the average resolution value to obtain the difference between the initial resolution value and the average resolution value; The comparison and judgment unit is used to compare the difference with a set threshold value to judge whether the difference is greater than the set threshold value.

6. A wheel encoder resolution correction system according to claim 4, characterized in that: The mean value calculation module comprises: A repeating unit, used for repeating the operations of the variation acquisition module and the resolution calculation module N times, and outputting N resolutions; The mean value calculation unit is used to calculate the mean value of the resolution of the wheel encoder through N resolutions, wherein N is 10.