Kinematic parameter correction method based on odometer error

Through the kinematic parameter correction method based on odometer error, the problem of low rotation accuracy of the dual-wheel differential robot when rotating along the motion is solved, and higher positioning accuracy and safety are achieved, reducing warehousing and operation costs.

CN118977240AActive Publication Date: 2024-11-19CHONGQING SAIMEI SHUZHI TECH CO LTD
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202411080606.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-08
Publication Date
2024-11-19
Estimated Expiration
2044-08-08

AI Technical Summary

Technical Problem

The rotation accuracy of the dual-wheel differential robot is not high in a single scenario such as following rotation, resulting in increased storage and maintenance time and cost, and even threatens personal safety.

Method used

The kinematic parameter correction method based on odometer error is adopted. By establishing a two-wheel differential motion model, the wheel line speed and motor encoder position value are calculated, and the wheel diameter and wheel spacing are corrected to improve the rotation accuracy.

Benefits of technology

In a single scenario, the robot positioning accuracy is significantly improved, the warehousing operation costs are reduced, and the security is improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977240A_ABST
    Figure CN118977240A_ABST
Patent Text Reader

Abstract

The invention provides a method for correcting kinematics parameters based on odometer errors, which comprises the following steps of: establishing a double-wheel differential motion model based on vehicle parameters, and calculating a left wheel linear speed and a right wheel linear speed of the double-wheel differential motion model; respectively calculating corresponding motor encoder position values according to the left wheel linear speed and the right wheel linear speed; calculating the movement change of the vehicle speedometer in combination with the position value of the motor encoder; correcting the wheel diameter proportion of the vehicle in combination with the motion change; correcting the wheel diameter of the vehicle in combination with the movement change and the corrected wheel diameter proportion; correcting the wheel spacing of the vehicle in combination with the motion change; and the corrected wheel diameter and the corrected wheel distance of the vehicle are substituted into the step S2 for motion change verification. The problem that the wheel diameter and the wheel track influence each other in a mainstream calibration method in a double-wheel differential robot model is solved, the wheel diameter and the wheel track are separately calibrated, and the positioning precision of the robot is high under the comprehensive working condition.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of parameter correction, and in particular to a method for kinematic parameter correction based on odometer error. Background Art

[0002] With the development of the logistics industry, improving the efficiency of warehousing and transportation has become a key link in the development of the industry. Warehousing management, cargo picking and handling have gradually shifted from manual to intelligent machinery. Intelligent warehousing is a new goal pursued by major logistics companies, especially the two-wheel differential robot logistics AGV, which has been widely used by major logistics companies due to its low cost and ability to solve the storage, handling and management problems of cargo. The market size is also increasing year by year.

[0003] However, in practical applications, logistics AGVs may face problems such as shaking of cargo shelves, cargo falling, and the higher the load, the higher the risk of cargo falling, especially because there may be certain errors between the actual accuracy of the robot body and the theoretical design model. The dual-wheel differential robot currently uses the UMBmark method, which removes the independence of wheel diameter and wheelbase, and focuses on the calibration method under the coupling of wheel diameter and wheelbase. However, in some single scenarios such as follow-up rotation, the rotation accuracy is not high, which increases the warehouse maintenance time and maintenance costs, reduces the warehouse operation efficiency, and even threatens the personal safety of employees in more serious cases. Summary of the invention

[0004] In response to the problems existing in the prior art, the present invention provides a method for kinematic parameter correction based on odometer errors to solve the technical problems in the prior art that in some single scenarios such as follow-up rotation, the rotation accuracy is not high, resulting in increased warehouse maintenance time and maintenance costs, reduced warehouse operation efficiency, and even more seriously threatening the personal safety of employees.

[0005] The present invention provides a method for correcting kinematic parameters based on odometer error, comprising:

[0006] S1. Establishing a two-wheel differential motion model based on vehicle parameters, calculating the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model, and calculating the corresponding motor encoder position values ​​according to the left wheel linear velocity and the right wheel linear velocity respectively;

[0007] S2, calculating the motion change of the vehicle odometer in combination with the motor encoder position value;

[0008] S3, correcting the wheel diameter ratio of the vehicle in combination with the movement change;

[0009] S4, correcting the wheel diameter of the vehicle based on the movement change and the corrected wheel diameter ratio;

[0010] S5, correcting the wheel spacing of the vehicle in combination with the movement change;

[0011] S6, bringing the corrected vehicle wheel diameter and wheel spacing into step S2 to perform motion change verification.

[0012] Optionally, the calculating of the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model includes:

[0013]

[0014] ω=(v r -v l ) / d wb

[0015] v c =(v l +v r ) / 2

[0016]

[0017] Among them, V r Indicates the linear speed of the right wheel of the vehicle, V l Represents the vehicle's left wheel linear speed, V c represents the vehicle centerline speed, r c represents the vehicle conversion radius, ω represents the vehicle rotation angular velocity, d wb Indicates the wheel spacing of the vehicle.

[0018] Optionally, the left wheel linear velocity and the right wheel linear velocity respectively calculate the corresponding motor encoder position values, including:

[0019] Calculate the left wheel motor encoder position value corresponding to the left wheel linear velocity of the vehicle:

[0020]

[0021] δ lthe =2×π×v lrps

[0022]

[0023] Among them, V lrps Indicates the theoretical speed of the left wheel motor, d l represents the diameter of the left wheel, π represents the circumference of the circle, N represents the reduction ratio of the reducer in the motor, δ lthe represents the theoretical angular velocity of the left wheel motor, δ l represents the actual angular velocity of the left wheel motor, Ff represents the friction force on the motor, a offsetrepresents the angular displacement of the motor, J represents the rotation crown of the motor, t represents time, T represents the torque applied to the motor, M represents the motor resolution, Fload represents the load force, P l Indicates the left wheel motor encoder position value.

[0024] Optionally, the motor encoder position values ​​corresponding to the left wheel linear velocity and the right wheel linear velocity respectively further include:

[0025] Calculate the right wheel motor encoder position value corresponding to the right wheel linear velocity of the vehicle:

[0026]

[0027] δ rthe =2×π×v rrps

[0028]

[0029] Among them, V rrps Indicates the theoretical speed of the right wheel motor, d r Indicates the right wheel diameter, δ rthe Indicates the theoretical angular velocity of the right wheel motor, δ r Indicates the actual angular velocity of the right wheel motor, P r Indicates the encoder position value of the right wheel motor.

[0030] Optionally, the calculating the motion change of the vehicle odometer in combination with the motor encoder position value includes:

[0031] S201, calculating the left wheel travel distance and the right wheel travel distance of the vehicle:

[0032]

[0033] S202, calculating the driving distances of the left wheel and the right wheel within the Δt time period based on the driving distances of the left wheel and the right wheel:

[0034] ΔS l =S l -S ll

[0035] ΔS r =S r -S rr

[0036]

[0037] Among them, ΔS l Indicates the distance traveled by the left wheel in the Δt period, ΔS rrepresents the distance traveled by the right wheel in the Δt period, Δx represents the distance traveled by the center point of the vehicle in the x direction in the Δt period, and Δy represents the distance traveled by the center point of the vehicle in the y direction in the Δt period;

[0038] S203, recalculate the actual vehicle center line speed, the actual vehicle rotation angular velocity, the vehicle center horizontal coordinate, the vehicle center vertical coordinate and the vehicle cumulative rotation angle:

[0039]

[0040] Among them, v c1 represents the actual vehicle centerline speed, ω1 represents the actual vehicle rotation angular velocity, S x represents the horizontal coordinate of the center of the vehicle body, S y represents the vertical coordinate of the vehicle center, θ represents the cumulative rotation angle of the vehicle, and Δθ represents the cumulative rotation angle of the vehicle within the Δt time period.

[0041] Optionally, the correcting the wheel diameter ratio of the vehicle in combination with the motion change includes:

[0042] S301, taking the left wheel diameter and the right wheel diameter of the vehicle as input, and calculating the difference between the right wheel diameter before and after correction by keeping the left wheel diameter unchanged:

[0043]

[0044] Among them, ε r It represents the difference in the diameter of the right wheel before and after correction, and β represents the deviation angle that occurs during vehicle driving;

[0045] S302, the right wheel diameter is combined with the difference between the right wheel diameters before and after correction to obtain the proportionally corrected right wheel diameter:

[0046] d εr =d r +ε r

[0047] Among them, d εr Indicates the right wheel diameter after proportion correction.

[0048] Optionally, the correcting the wheel diameter of the vehicle by combining the motion change and the corrected wheel diameter ratio includes:

[0049]

[0050]

[0051] Among them, d el Indicates the actual left wheel diameter, d er Indicates the actual right wheel diameter.

[0052] Optionally, the correcting the wheel spacing of the vehicle in combination with the movement change includes:

[0053]

[0054] d eb =d wb +ε wb

[0055] Among them, ε wb Indicates the difference between the factory wheel spacing and the actual wheel spacing, d eb Indicates the actual wheel spacing.

[0056] Optionally, the step of substituting the corrected vehicle wheel diameter and wheel spacing into step S2 for motion change verification includes:

[0057] The vehicle wheel spacing d in step S2 is wb Replaced by the actual wheel spacing d eb , the left wheel diameter d l Replaced by the actual revolver diameter d el , the right wheel diameter d r Replaced by the actual right wheel diameter d er , re-verify the motion changes.

[0058] Compared with the prior art, the present invention has the following advantages:

[0059] A kinematic parameter correction method based on odometer error is proposed, which solves the problem of mutual influence between wheel diameter and wheelbase in the mainstream calibration method of the two-wheel differential robot model. The wheel diameter and wheelbase are calibrated separately, which not only has high robot positioning accuracy under comprehensive working conditions, but also can achieve high accuracy in a single scenario (such as follow-up rotation). BRIEF DESCRIPTION OF THE DRAWINGS

[0060] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the invention and, together with the description, serve to explain the principles of the invention.

[0061] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.

[0062] Figure 1 It is a schematic diagram of the method flow of the present invention;

[0063] Figure 2 This is a schematic diagram of the AGV chassis of the present invention;

[0064] Figure 3This is a schematic diagram of the AGV follow-up of the present invention;

[0065] Figure 4 It is a schematic diagram of the motion control input and output of the AGV of the present invention;

[0066] Figure 5 It is a schematic diagram of calculation of the dual-wheel differential model of the AGV of the present invention;

[0067] Figure 6 It is a schematic diagram of the AGV body of the present invention located in a rectangular coordinate system;

[0068] Figure 7 This is a schematic diagram of the AGV wheel diameter ratio correction of the present invention;

[0069] Figure 8 This is a schematic diagram of AGV wheel diameter correction according to the present invention;

[0070] Fig. 9 This is a schematic diagram of AGV wheel spacing correction of the present invention;

[0071] Fig.10 This is a schematic diagram of the angle comparison between the AGV rotating disk and the QR code in the first embodiment of the present invention;

[0072] Fig.11 This is a schematic diagram of the angle comparison between the AGV chassis and the QR code in the first embodiment of the present invention;

[0073] Fig.12 This is a schematic diagram of the angle comparison between the AGV rotating disk and the QR code in the second embodiment of the present invention;

[0074] Fig.13 This is a schematic diagram of the angle comparison between the AGV chassis and the QR code in the second embodiment of the present invention;

[0075] Fig.14 This is a schematic diagram of the angle comparison between the AGV rotating disk and the QR code in the third embodiment of the present invention;

[0076] Fig.15 This is a schematic diagram of the angle comparison between the AGV chassis and the QR code according to the third embodiment of the present invention. DETAILED DESCRIPTION

[0077] In order to make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in the present application, all other implementation cases obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application. The functional units with the same labels in the examples of the present invention have the same and similar structures and functions.

[0078] See also Figure 1 The present invention provides a method for correcting kinematic parameters based on odometer error, comprising:

[0079] S1. Establishing a two-wheel differential motion model based on vehicle parameters, calculating the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model, and calculating the corresponding motor encoder position values ​​according to the left wheel linear velocity and the right wheel linear velocity respectively;

[0080] S2, calculating the motion change of the vehicle odometer in combination with the motor encoder position value;

[0081] S3, correcting the wheel diameter ratio of the vehicle in combination with the movement change;

[0082] S4, correcting the wheel diameter of the vehicle based on the movement change and the corrected wheel diameter ratio;

[0083] S5, correcting the wheel spacing of the vehicle in combination with the movement change;

[0084] S6, bringing the corrected vehicle wheel diameter and wheel spacing into step S2 to perform motion change verification.

[0085] In this embodiment, S1, a two-wheel differential motion model is established based on vehicle parameters, and the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model, as well as the motor encoder position values ​​corresponding to the left wheel linear velocity and the right wheel linear velocity respectively are calculated.

[0086] See also Figure 2 AGV's two-wheel differential chassis consists of two driving wheels located on the left and right sides of the chassis. The vehicle body moves and turns by controlling the different speeds of the left and right wheels. It is usually equipped with one to four universal wheels for auxiliary support. The main chassis include: Turtlebot, sweeping robot, unmanned warehouse AGV cart, wheelchair. The main control method is to control the movement of the vehicle by setting the direction of the vehicle head as the X direction, giving the linear velocity in the X direction and the angular velocity in the Z direction, and calculating the odometer value.

[0087] See also Figure 3 , the tray on top of the vehicle rotates clockwise at a speed ω tray , the vehicle chassis rotates counterclockwise at a speed ω car , when the absolute values ​​of the two angular velocities are equal, the absolute orientation of the pallet remains unchanged, that is, the pallet and the ground remain relatively stationary. This kind of body rotation is called follow-up. What can be observed with the naked eye is that the pallet does not rotate, but the chassis rotates.

[0088] See also Figure 4 and Figure 5 , a two-wheel differential motion model is established based on vehicle parameters, and the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model are calculated:

[0089]

[0090] ω=(v r -v l ) / d wb

[0091] v c =(v l +v r ) / 2

[0092]

[0093] Among them, V r Indicates the linear speed of the right wheel of the vehicle, V l Represents the vehicle's left wheel linear speed, V c represents the vehicle centerline speed, r c represents the vehicle conversion radius, ω represents the vehicle rotation angular velocity, d wb Indicates the wheel spacing of the vehicle.

[0094] The corresponding motor encoder position values ​​are calculated according to the left wheel linear speed and the right wheel linear speed respectively. First, the left wheel motor encoder position value corresponding to the left wheel linear speed of the vehicle is calculated:

[0095]

[0096] δ lthe =2×π×v lrps

[0097]

[0098] Among them, V lrps Indicates the theoretical speed of the left wheel motor, d l represents the diameter of the left wheel, π represents the circumference of the circle, N represents the reduction ratio of the reducer in the motor, δ lthe represents the theoretical angular velocity of the left wheel motor, δ l represents the actual angular velocity of the left wheel motor, Ff represents the friction force on the motor, a offset represents the angular displacement of the motor, J represents the rotation crown of the motor, t represents time, T represents the torque applied to the motor, M represents the motor resolution, Fload represents the load force, P l Indicates the left wheel motor encoder position value.

[0099] Then calculate the right wheel motor encoder position value corresponding to the right wheel linear velocity of the vehicle:

[0100]

[0101] δ rthe =2×π×v rrps

[0102]

[0103] Among them, V rrps Indicates the theoretical speed of the right wheel motor, d r Indicates the right wheel diameter, δ rthe Indicates the theoretical angular velocity of the right wheel motor, δ r Indicates the actual angular velocity of the right wheel motor, P r Indicates the encoder position value of the right wheel motor.

[0104] S2. Calculate the motion change of the vehicle odometer in combination with the motor encoder position value.

[0105] See also Figure 6 AGV two-wheel differential robot odometer calculation refers to the process of calculating the robot's motion trajectory and position change by calculating the rotation angle and moving distance of the robot's two driving wheels, including:

[0106] S201, calculating the left wheel travel distance and the right wheel travel distance of the vehicle:

[0107]

[0108] S202, calculating the driving distances of the left wheel and the right wheel within the Δt time period based on the driving distances of the left wheel and the right wheel:

[0109] ΔS l =S l -S ll

[0110] ΔS r =S r -S rr

[0111]

[0112] Among them, ΔS l Indicates the distance traveled by the left wheel in the Δt period, ΔS r represents the distance traveled by the right wheel in the Δt period, Δx represents the distance traveled by the center point of the vehicle in the x direction in the Δt period, and Δy represents the distance traveled by the center point of the vehicle in the y direction in the Δt period;

[0113] S203, recalculate the actual vehicle center line speed, the actual vehicle rotation angular velocity, the vehicle center horizontal coordinate, the vehicle center vertical coordinate and the vehicle cumulative rotation angle:

[0114]

[0115] Among them, v c1represents the actual vehicle centerline speed, ω1 represents the actual vehicle rotation angular velocity, S x represents the horizontal coordinate of the center of the vehicle body, S y represents the vertical coordinate of the vehicle center, θ represents the cumulative rotation angle of the vehicle, and Δθ represents the cumulative rotation angle of the vehicle within the Δt time period.

[0116] S3. Correcting the wheel diameter ratio of the vehicle in combination with the movement change.

[0117] See also Figure 7 , the vehicle runs from the left QR code position to the right QR code position. At this time, since the factory-given left and right wheel diameters are not the actual left and right wheel diameters, the vehicle deviates with an angle of β. By keeping the left wheel diameter d l Calculate the right wheel diameter d after the change εr .

[0118] S301, taking the left wheel diameter and the right wheel diameter of the vehicle as input, and calculating the difference between the right wheel diameter before and after correction by keeping the left wheel diameter unchanged:

[0119]

[0120] Among them, ε r It represents the difference in the diameter of the right wheel before and after correction, and β represents the deviation angle that occurs during vehicle driving;

[0121] S302, the right wheel diameter is combined with the difference between the right wheel diameters before and after correction to obtain the proportionally corrected right wheel diameter:

[0122] d εr =d r +ε r

[0123] Among them, d εr Indicates the right wheel diameter after proportion correction.

[0124] S4. Correcting the wheel diameter of the vehicle based on the movement change and the corrected wheel diameter ratio.

[0125] See also Figure 8 The vehicle runs from the left QR code position to the right Figure 2 At this time, since the diameter of the right wheel of the vehicle has been corrected in proportion, this test found that the vehicle has been moving in a straight line, but the distance traveled is not the real distance. The following steps can be used to increase or decrease the diameter of the left and right wheels of the vehicle in equal proportion, so that the vehicle can move in a straight line while also traveling an accurate distance.

[0126] The wheel diameter of the vehicle is corrected in combination with the movement change and the corrected wheel diameter ratio, including:

[0127]

[0128] Among them, d el Indicates the actual left wheel diameter, d er Indicates the actual right wheel diameter.

[0129] S5. Correcting the wheel spacing of the vehicle in combination with the movement change.

[0130] See also Fig. 9 , rotate the AGV vehicle in place for n circles, and the actual rotation angle and the theoretical rotation angle differ by Δθ degrees, then the accurate wheel spacing can be calculated.

[0131]

[0132] d eb =d wb +ε wb

[0133] Among them, ε wb Indicates the difference between the factory wheel spacing and the actual wheel spacing, d eb Indicates the actual wheel spacing.

[0134] S6, bringing the corrected vehicle wheel diameter and wheel spacing into step S2 to perform motion change verification.

[0135] See also Fig.10 and Fig.11 , the AGV is rotated twice in place and the angles are compared. Based on the kinematic parameter test of the factory initial value of wheel diameter and wheelbase, after being substituted into step S2, Fig.10 It can be seen that the difference between the rotation angle of the rotating disk (red curve) after two rotations in place and the actual rotation angle of the QR code (blue curve) is 0.4451 rad. Fig.11 It can be seen that after two rotations in place, the chassis rotation angle (red curve) differs from the true value of the QR code (blue curve) by 0.4447 rad.

[0136] See also Fig.12 and Fig.13 , the AGV is rotated twice in place and the angles are compared. The wheel diameter and wheelbase test calibrated by the commonly used calibration method UMBmark calibration algorithm are substituted into step S2. Fig.12 It can be seen that the difference between the tray rotation angle (red curve) and the true value angle of the QR code (blue curve) is 0.2677 rad. Fig.13 It can be seen that the disc rotation angle (red curve) and the true value angle of the QR code (blue curve) differ by 0.2661 rad.

[0137] See also Fig.14 and Fig.15, the AGV rotates twice in place and then compares the angles. The kinematic parameter correction algorithm based on the odometer error is tested and substituted into step S2. Fig.14 It can be seen that the difference between the tray rotation angle (red curve) and the true value angle of the QR code (blue curve) is 0.0408 rad. Fig.15 It can be seen that the difference between the vehicle body rotation angle (green curve) and the true value angle of the QR code (blue curve) is 0.0413 rad.

[0138] In summary, it can be seen that in some single scenarios (such as rotating in situ), the cumulative rotation angle accuracy of the vehicle proposed by the present invention is higher.

[0139] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.

[0140] The foregoing is merely a specific embodiment of the present invention, which enables those skilled in the art to understand or implement the present invention. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features claimed herein.

Claims

1. A method for kinematic parameter correction based on odometer error, characterized in that: include: S1. Establishing a two-wheel differential motion model based on vehicle parameters, calculating the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model, and calculating the corresponding motor encoder position values ​​according to the left wheel linear velocity and the right wheel linear velocity respectively; S2, calculating the motion change of the vehicle odometer in combination with the motor encoder position value; S3, correcting the wheel diameter ratio of the vehicle in combination with the movement change; S4, correcting the wheel diameter of the vehicle based on the movement change and the corrected wheel diameter ratio; S5, correcting the wheel spacing of the vehicle in combination with the movement change; S6, bringing the corrected vehicle wheel diameter and wheel spacing into step S2 to perform motion change verification.

2. The method for kinematic parameter correction based on odometer error according to claim 1, characterized in that: The method of calculating the left wheel linear velocity and the right wheel linear velocity of the two-wheel differential motion model includes: ω=(v r -v l ) / d wb v c =(v l +v r ) / 2 Among them, V r Indicates the linear speed of the right wheel of the vehicle, V l Represents the vehicle's left wheel linear speed, V c represents the vehicle centerline speed, r c represents the vehicle conversion radius, ω represents the vehicle rotation angular velocity, d wb Indicates the wheel spacing of the vehicle.

3. The method for kinematic parameter correction based on odometer error according to claim 2, characterized in that: The left wheel linear velocity and the right wheel linear velocity respectively calculate the corresponding motor encoder position values, including: Calculate the left wheel motor encoder position value corresponding to the left wheel linear velocity of the vehicle: d lthe =2×π×v lrps Among them, V lrps Indicates the theoretical speed of the left wheel motor, d l represents the diameter of the left wheel, π represents the circumference of the circle, N represents the reduction ratio of the reducer in the motor, δ lthe represents the theoretical angular velocity of the left wheel motor, δ l represents the actual angular velocity of the left wheel motor, Ff represents the friction force on the motor, a offset represents the angular displacement of the motor, J represents the rotational inertia of the motor, t represents time, T represents the torque applied to the motor, M represents the motor resolution, Fload represents the load force, P l Indicates the left wheel motor encoder position value.

4. The method for kinematic parameter correction based on odometer error according to claim 3, characterized in that: The motor encoder position values ​​corresponding to the left wheel linear velocity and the right wheel linear velocity respectively also include: Calculate the right wheel motor encoder position value corresponding to the right wheel linear velocity of the vehicle: d rthe =2×π×v rrps Among them, V rrps Indicates the theoretical speed of the right wheel motor, d r Indicates the right wheel diameter, δ rthe Indicates the theoretical angular velocity of the right wheel motor, δ r Indicates the actual angular velocity of the right wheel motor, P r Indicates the encoder position value of the right wheel motor.

5. The method for kinematic parameter correction based on odometer error according to claim 4, characterized in that: The step of calculating the motion change of the vehicle odometer in combination with the motor encoder position value includes: S201, calculating the left wheel travel distance and the right wheel travel distance of the vehicle: S202, calculating the driving distances of the left wheel and the right wheel within the Δt time period based on the driving distances of the left wheel and the right wheel: ΔS l =S l -S ll ΔS r =S r -S rr Among them, ΔS l Indicates the distance traveled by the left wheel in the Δt period, ΔS r represents the distance traveled by the right wheel in the Δt period, Δx represents the distance traveled by the center point of the vehicle in the x direction in the Δt period, and Δy represents the distance traveled by the center point of the vehicle in the y direction in the Δt period; S203, recalculate the actual vehicle center line speed, the actual vehicle rotation angular velocity, the vehicle center horizontal coordinate, the vehicle center vertical coordinate and the vehicle cumulative rotation angle: Among them, v c1 represents the actual vehicle centerline speed, ω1 represents the actual vehicle rotation angular velocity, S x represents the horizontal coordinate of the vehicle center, S represents the vertical coordinate of the vehicle center, θ represents the cumulative rotation angle of the vehicle, and Δθ represents the cumulative rotation angle of the vehicle within the Δt time period.

6. The method for kinematic parameter correction based on odometer error according to claim 5, characterized in that: The correcting the wheel diameter ratio of the vehicle in combination with the motion change includes: S301, taking the left wheel diameter and the right wheel diameter of the vehicle as input, and calculating the difference between the right wheel diameter before and after correction by keeping the left wheel diameter unchanged: Among them, ε r It represents the difference in the diameter of the right wheel before and after correction, and β represents the deviation angle that occurs during vehicle driving; S302, the right wheel diameter is combined with the difference between the right wheel diameters before and after correction to obtain the proportionally corrected right wheel diameter: d εr =d r +e r Among them, d εr Indicates the right wheel diameter after proportion correction.

7. The method for kinematic parameter correction based on odometer error according to claim 6, characterized in that: The step of correcting the wheel diameter of the vehicle by combining the motion change and the corrected wheel diameter ratio includes: Among them, d el Indicates the actual left wheel diameter, d er Indicates the actual right wheel diameter.

8. The method for kinematic parameter correction based on odometer error according to claim 7, characterized in that: The step of correcting the wheel spacing of the vehicle in combination with the movement change includes: d eb =d wb +e wb Among them, ε wb Indicates the difference between the factory wheel spacing and the actual wheel spacing, d eb Indicates the actual wheel spacing.

9. The method for kinematic parameter correction based on odometer error according to claim 8, characterized in that: Substituting the corrected vehicle wheel diameter and wheel spacing into step S2 for motion change verification includes: The vehicle wheel spacing d in step S2 wb Replaced by the actual wheel spacing d eb , the left wheel diameter d l Substituted with the actual revolver diameter d el , the right wheel diameter d r Replaced by the actual right wheel diameter d er , re-verify the motion changes.

Citation Information

Patent Citations

  • Device for automatic controlling final position of moving element

    CN101004610A

  • Method and device for calibrating odometer parameters of double-wheel differential robot

    CN111380562A

  • Method for judging RTK abnormal value in automatic driving integrated navigation system

    CN112731483A

  • Mileage calibration method and device for double-wheel differential model, equipment and storage medium

    CN113029201A

  • Industrial robot laser positioning and coordinated motion control method

    CN115857509A