Omnidirectional mobile robot motion control method for realizing path tracking

By calculating the position and motion state parameters of the vehicle's central point and pre-seeking point, and controlling the deflection angle and speed of the omnidirectional mobile robot, the problem of path deviation of the omnidirectional mobile robot is solved, and the accuracy and stability of path tracking are improved.

CN118915769APending Publication Date: 2024-11-08WAYZIM TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411078418.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-07
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Omnidirectional mobile robots are prone to path deviations during driving, resulting in collisions and inability to accurately reach the end point, affecting the accuracy of picking and putting goods.

Method used

By determining the projection point and pre-sight point of the vehicle center point on the path to be tracked, and calculating the deflection angle and speed of the steering wheel in combination with the motion state parameters, ensuring that the vehicle moves along the predetermined path.

Benefits of technology

Improves the accuracy and stability of path tracking, ensuring that omnidirectional mobile robots can move along the design path more accurately, reducing the risk of collision with obstacles.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915769A_ABST
    Figure CN118915769A_ABST
Patent Text Reader

Abstract

The invention discloses an omni-directional mobile robot motion control method for realizing path tracking, and relates to the field of control. According to the method, a transverse offset distance can be determined by combining a real-time position of a vehicle center point with path information of a to-be-tracked path; then, on the basis of considering the motion state of the omni-directional mobile robot, determining a preview point in front of the motion direction, and based on the tracking line direction from the center point of the vehicle to the preview point and in combination with the installation position and the motion state parameter of each steering wheel, calculating to obtain the deflection angle and the steering wheel speed of each steering wheel; therefore, the omni-directional mobile robot can be controlled to carry out motion posture adjustment by respectively controlling each steering wheel to move, the to-be-tracked path is tracked better, and the accuracy and the stability of path tracking are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of control, and in particular to a motion control method for an omnidirectional mobile robot for achieving path tracking. Background Art

[0002] With the rapid development of warehousing logistics and intelligent manufacturing production lines, AGV (Automated Guided Vehicle) can complete cargo transportation by traveling along a set path under the guidance of a guiding device, and is widely used in manufacturing, logistics warehousing, chemical industry and special industries. An omnidirectional mobile robot is a common AGV, which includes multiple independently operated steering wheels that can move in all directions, so it has the advantages of flexible movement, small turning radius and large load capacity.

[0003] Although the omnidirectional mobile robot can move along the designed path as a whole, in reality the movement process of the omnidirectional mobile robot is relatively unstable and often produces large deviations from the designed path during driving. On the one hand, it is easy for the omnidirectional mobile robot to collide with other obstacles during driving. On the other hand, it will also cause the omnidirectional mobile robot to be unable to accurately reach the desired path end point, affecting the accuracy of the omnidirectional mobile robot in picking up and placing goods. Summary of the invention

[0004] In view of the above problems and technical requirements, this application proposes a motion control method for an omnidirectional mobile robot that realizes path tracking. The technical solution of this application is as follows:

[0005] A motion control method for an omnidirectional mobile robot for realizing path tracking, the motion control method for an omnidirectional mobile robot comprising:

[0006] Determine the projection point of the vehicle center point of the omnidirectional mobile robot on the path to be tracked, and determine the straight-line distance between the vehicle center point and the projection point as the lateral offset distance d; the omnidirectional mobile robot includes a plurality of steering wheels;

[0007] Determine the preview length L based on the motion state parameters of the omnidirectional mobile robot and the lateral offset distance d d ;

[0008] According to the preview length L d Determine the preview point on the path to be tracked, and determine the direction from the center point of the omnidirectional mobile robot to the preview point as the tracking line direction; wherein the preview point is located behind the projection point along the path direction and the distance between the preview point and the projection point is the preview length L d ;

[0009] According to the installation position of each steering wheel on the omnidirectional mobile robot, the deflection angle and steering wheel speed of each steering wheel on the omnidirectional mobile robot are determined in combination with the motion state parameters of the omnidirectional mobile robot and the direction of the tracking line;

[0010] The steering wheel is controlled to deflect according to the deflection angle of each steering wheel and the steering wheel is driven to move at the corresponding steering wheel speed.

[0011] A further technical solution is that the motion state parameters of the omnidirectional mobile robot include the tracking speed V and the real-time positive direction of the vehicle body, and determining the deflection angle and steering wheel speed of each steering wheel on the omnidirectional mobile robot includes:

[0012] Determine the walking speed component of the steering wheel according to the tracking speed V of the omnidirectional mobile robot and the direction of the tracking line;

[0013] Determine the rotation speed component of the steering wheel according to the real-time positive direction of the omnidirectional mobile robot combined with the installation position of the steering wheel and the direction of the tracking line;

[0014] The walking speed component and the rotation speed component of the steering wheel are vector-synthesized to obtain the steering wheel speed vector, and the magnitude of the steering wheel speed vector is used as the steering wheel speed of the steering wheel; when the angle ξ between the steering wheel speed vector and the positive direction of the steering wheel zero position of the steering wheel is within the range of [-90°, 90°], the deflection angle of the steering wheel is determined to be ξ, otherwise when ξ+180° is within the range of [-90°, 90°], the deflection angle of the steering wheel is determined to be ξ+180°, or when ξ-180° is within the range of [-90°, 90°], the deflection angle of the steering wheel is determined to be ξ-180°; wherein, a positive deflection angle of the steering wheel indicates that the steering wheel deflects counterclockwise, and a negative deflection angle of the steering wheel indicates that the steering wheel deflects clockwise.

[0015] A further technical solution is that determining the walking speed component of the steering wheel includes:

[0016] The direction of the walking speed component of the steering wheel is determined to be the same as the direction of the tracking line, and the magnitude of the walking speed component of the steering wheel is determined to be the tracking speed V of the omnidirectional mobile robot.

[0017] A further technical solution is that determining the rotation speed component of the steering wheel includes:

[0018] Determine the tracking deviation angle between the tracking line direction and the real-time vehicle positive direction of the omnidirectional mobile robot Tracking deviation angle Starting from the real-time vehicle body positive direction, counterclockwise is positive and clockwise is negative;

[0019] Determine the line between the center point of the vehicle and the steering wheel center according to the installation position of the steering wheel, and determine the direction of the steering wheel rotation speed component perpendicular to the line between the center point of the vehicle and the steering wheel center and the tracking deviation angle The positive and negative correspond to each other;

[0020] According to the tracking deviation angle The size of the steering wheel determines the size of the rotation speed component, tracking the deviation angle The larger it is, the greater the magnitude of the rotational velocity component.

[0021] A further technical solution is that when the tracking deviation angle When it is positive, the direction of the steering wheel's rotational speed component is the direction of the 90° counterclockwise rotation from the vehicle center to the steering wheel center;

[0022] When tracking deviation angle When it is negative, the direction of the steering wheel's rotational velocity component is the direction of a 90° clockwise rotation from the center of the vehicle to the center of the steering wheel.

[0023] A further technical solution is that the magnitude of the rotational speed component of each steering wheel is also related to the distance R between the vehicle center point of the omnidirectional mobile robot and the steering wheel center of each steering wheel, and the larger the distance R is, the larger the magnitude of the rotational speed component is.

[0024] A further technical solution is to use the tracking deviation angle Determining the magnitude of the steering wheel's rotational velocity components includes:

[0025] Determine the magnitude of the steering wheel's rotational velocity component as Among them, K3 is the proportional coefficient, and R is the distance between the vehicle center point of the omnidirectional mobile robot and the steering wheel center of each steering wheel.

[0026] A further technical solution is that the omnidirectional mobile robot motion control method further includes:

[0027] When the omnidirectional mobile robot works in the translation mode, it is directly determined that the steering wheel speeds of each steering wheel are equal and are the tracking speed V of the omnidirectional mobile robot; and when the tracking deviation angle between the tracking line direction and the real-time vehicle body positive direction When the deflection angles of each steering wheel are within the range of [-90°, 90°], the deflection angles of each steering wheel are equal and Otherwise when When the deflection angles of each steering wheel are within the range of [-90°, 90°], the steering angles are equal. or when When the deflection angles of each steering wheel are within the range of [-90°, 90°], the steering angles are equal. Among them, a positive deflection angle of each steering wheel indicates that the steering wheel is deflected counterclockwise, and a negative deflection angle of each steering wheel indicates that the steering wheel is deflected clockwise.

[0028] A further technical solution is that the motion state parameters of the omnidirectional mobile robot include a tracking speed V, a preview length L determined according to the motion state parameters of the omnidirectional mobile robot and a lateral offset distance d. d =K1×K2×V, where K1 is a velocity coefficient with a positive value, and K2 is a coefficient negatively correlated with the lateral offset distance d.

[0029] A further technical solution is that the coefficient negatively correlated with the lateral offset distance d Represents the natural index.

[0030] The beneficial technical effects of this application are:

[0031] The present application discloses a motion control method for an omnidirectional mobile robot for realizing path tracking. The method can determine the lateral offset distance according to the real-time position of the center point of the vehicle in combination with the path information of the path to be tracked, so that the preview point in front of the motion direction can be determined on the basis of considering the motion state of the omnidirectional mobile robot. The deflection angle and steering wheel speed of each steering wheel can be calculated based on the direction of the tracking line from the center point of the vehicle to the preview point according to the motion control model of the omnidirectional mobile robot, so that the motion of each steering wheel can be controlled to control the omnidirectional mobile robot to adjust the motion posture, so as to better realize the tracking of the path to be tracked and improve the accuracy and stability of path tracking.

[0032] When the omnidirectional mobile robot needs to work in the translation mode in some special scenarios, this method can also be used to achieve fast tracking of the path to be tracked while maintaining the translation mode, meeting the application needs in different scenarios. BRIEF DESCRIPTION OF THE DRAWINGS

[0033] Figure 1 It is a structural diagram of an omnidirectional mobile robot.

[0034] Figure 2 It is a method flow chart of an omnidirectional mobile robot motion control method according to an embodiment of the present application.

[0035] Figure 3 is based on Figure 1 An application scenario diagram of an omnidirectional mobile robot with a mobile structure.

[0036] Figure 4 It is a schematic diagram of a method for determining the deflection angle of each steering wheel and the steering wheel speed. DETAILED DESCRIPTION

[0037] The specific implementation of the present application is further described below in conjunction with the accompanying drawings.

[0038] The present application discloses a motion control method for an omnidirectional mobile robot for realizing path tracking. The method is directed to an omnidirectional mobile robot comprising a plurality of independently operable steering wheels. When the steering wheels are not controlled to deflect, each steering wheel is at its own steering wheel zero position positive direction. The steering wheel zero position positive direction of each steering wheel is the same, and the steering wheel zero position positive direction is the same as the vehicle body positive direction. C is the origin, and the positive direction of the steering wheel zero position is X C Positive direction, perpendicular to X C The direction pointing to the left side of the omnidirectional mobile robot is Y C Positive direction, establish the body coordinate system O of the omnidirectional mobile robot C -X C Y C .X C The positive direction is the steering wheel zero position positive direction, which is also the vehicle body positive direction. C The position of the steering wheel is known in advance, and after the center point of the vehicle is determined, each steering wheel is C The relative position relationship of the vehicle center point O is known. C The distances to the steering wheel centers of any two steering wheels are equal or unequal.

[0039] Please refer to Figure 1 The structural diagram of the omnidirectional mobile robot is shown in FIG. Figure 1 Take an omnidirectional mobile robot with three steering wheels as an example, and at this time, all three steering wheels are in the positive direction of the steering wheel zero position. Figure 1 In the example, the three steering wheels are arranged in an equilateral triangle structure, and the steering wheel 1 at the front of the omnidirectional mobile robot is located at X C On the positive half axis, the steering wheels 2 and 3 at the rear of the omnidirectional mobile robot are both located at X C Negative semi-axis and relative to X C Axis symmetry. The distance between the steering wheel center O2 of the steering wheel 2 and the steering wheel center O3 of the steering wheel 3 at the rear of the omnidirectional mobile robot is m, and the vertical wheelbase between the steering wheel center O1 of the steering wheel 1 and the connecting line O2O3 of the steering wheel centers of the steering wheels 2 and 3 is n. In addition, for the convenience of calculation, in this case, the center of gravity of the isosceles triangle formed by the three steering wheels can be taken as the center point O of the vehicle. C , then the vehicle center point O can be determined C Distance from the steering wheel center of the three steering wheels The actual steering wheel layout and the vehicle center point O C The selection is flexible and can be determined according to actual needs.

[0040] For the convenience of calculation, take any point in the plane as the origin O W Establish the global coordinate system O of the plane W -XW Y W , please combine Figure 2 The method flow chart and Figure 3 Application scenario diagram, Figure 3 The application scenario diagram is Figure 1 Based on the structure of the omnidirectional mobile robot, the motion control method of the omnidirectional mobile robot comprises the following steps:

[0041] Step 1: determine the projection point of the vehicle center point of the omnidirectional mobile robot on the path to be tracked, and determine the straight-line distance between the vehicle center point and the projection point as the lateral offset distance d.

[0042] After initializing the position of the omnidirectional mobile robot, the vehicle center point O of the omnidirectional mobile robot can be determined. C In the global coordinate system O W -X W Y W The initialization coordinates of the vehicle center point O can be known in real time during the subsequent movement of the omnidirectional mobile robot. C In the global coordinate system O W -X W Y W In addition, the path to be tracked is a pre-planned path. Generally, a continuous path to be tracked is discretized into several discrete tracking points and the coordinates of these points are recorded in the global coordinate system. Therefore, it can be considered that the curve form of the path to be tracked is in the global coordinate system O. W -X W Y W Therefore, according to the known vehicle center point O C The coordinates of the vehicle center point O can be determined by solving the projection method of the point on the line. C The projection point M on the path to be tracked, and the vehicle center point O can also be calculated C The straight-line distance from the projection point M is taken as the lateral offset distance d.

[0043] Step 2: Determine the preview length L according to the motion state parameters of the omnidirectional mobile robot and the lateral offset distance d d .

[0044] The motion state parameters of the omnidirectional mobile robot include the tracking speed V. In one embodiment, the preview length L is determined according to the motion state parameters of the omnidirectional mobile robot and the lateral offset distance d. d =K1×K2×V. Wherein, K1 is the velocity coefficient of the positive velocity, and K2 is the coefficient negatively correlated with the lateral offset distance d.

[0045] In one embodiment, in order to have a better preview effect, the coefficients are obtained according to the standard normal equation Represents the natural index.

[0046] Step 3: According to the preview length L d Determine the preview point N on the path to be tracked. The preview point N is located after the projection point M along the path direction, and the distance between the preview point N and the projection point M is the preview length L. d .

[0047] As mentioned above, the path to be tracked can be considered to be composed of continuous discrete tracking points. The distance between two adjacent discrete tracking points is very close. Therefore, the straight-line distance between the two discrete tracking points can be directly calculated within the allowable error range as the distance between the two discrete tracking points. Starting from the projection point M, the distances between each discrete tracking point are calculated and added in the direction of the path until the preview length L is reached. d The preview point N can be determined when W -X W Y W Determine the vehicle center point O of the omnidirectional mobile robot C The direction to the preview point N is the tracking line direction

[0048] Step 4: According to the installation position of each steering wheel on the omnidirectional mobile robot, combined with the motion state parameters of the omnidirectional mobile robot and the direction of the tracking line Determine the deflection angle and steering wheel speed of each steering wheel on an omnidirectional mobile robot.

[0049] The installation position of each steering wheel on the omnidirectional mobile robot indicates that the steering wheel center of each steering wheel is in the vehicle body coordinate system O C -X C Y C Therefore, in determining the vehicle center point O C In the global coordinate system O W -X W Y W After the coordinates in the global coordinate system are obtained, the steering wheel center of each steering wheel can be determined in the global coordinate system O by converting the coordinates between the vehicle body coordinate system and the global coordinate system. W -X W Y W The coordinates in .

[0050] The motion state parameters of the omnidirectional mobile robot include not only the tracking speed V of the omnidirectional mobile robot, but also the real-time positive direction of the vehicle body, which is the X coordinate of the vehicle body coordinate system. C The positive direction of the axis, that is The vector is in the global coordinate system O W -X WY W The vector in .

[0051] Each steering wheel in the omnidirectional mobile robot can be operated independently, and the deflection angles of any two steering wheels relative to the positive direction of their respective steering wheel zero positions are the same or different, and the steering wheel speeds of any two steering wheels are the same or different. The deflection angle of each steering wheel relative to the positive direction of the steering wheel zero position is in the range of [-90°, 90°], where a positive deflection angle of the steering wheel indicates a counterclockwise deflection, and a negative deflection angle of the steering wheel indicates a clockwise deflection.

[0052] The omnidirectional mobile robot can change the direction of the vehicle body through the combination of the deflection angle and the steering wheel speed of each steering wheel, so that the vehicle body posture can be flexibly adjusted. The movement of each steering wheel is a two-degree-of-freedom combined movement process of translation and rotation. Therefore, in one embodiment, the movement parameters of the steering wheel in the two degrees of freedom are determined respectively, including performing the following steps for each steering wheel, please refer to Figure 4 Schematic diagram:

[0053] (1) According to the tracking speed V of the omnidirectional mobile robot combined with the direction of the tracking line Determining the walking speed component on the translational degree of freedom of the steering wheel includes: determining that the direction of the walking speed component of the steering wheel is the same as the walking speed component in the tracking line direction, and determining that the magnitude of the walking speed component of the steering wheel is the tracking speed V of the omnidirectional mobile robot.

[0054] For example, Figure 3 In the application scenario diagram, determine the walking speed component of the steering wheel 1 Travel speed component of steering wheel 2 And the walking speed component of steering wheel 3 The directions are the same and along the tracking line as well as are all the same size and are the tracking speed V.

[0055] (2) According to the real-time positive direction of the omnidirectional mobile robot Combined with the installation position of the steering wheel and the direction of the tracking line Determine the rotational velocity components of the steering wheel in the rotational degree of freedom, including:

[0056] Determine the tracking line direction Real-time vehicle positive direction of omnidirectional mobile robot Tracking deviation angle Tracking deviation angle Starting from the real-time vehicle positive direction, counterclockwise is positive and clockwise is negative. Figure 3 To track the deviation angle Take negative as an example.

[0057] Determine the vehicle center point O according to the installation position of the steering wheel C and the steering wheel center, and then determine that the direction of the rotational velocity component of the steering wheel is perpendicular to the vehicle center point O C The line between the steering wheel center and the tracking deviation angle Specifically, when the tracking deviation angle is the positive time, with the vehicle center point O C The direction of the steering wheel's rotational speed component is the direction of the line connecting the steering wheel to the steering wheel center and rotating 90° counterclockwise. When it is negative, the vehicle center point O C The direction of the steering wheel's rotational speed component is the direction of the steering wheel's rotational speed component by 90° clockwise from the direction of the line to the steering wheel's center.

[0058] For example, Figure 3 In the application scenario diagram, the deviation angle is tracked Take negative as an example, determine the rotation speed component of steering wheel 1 So Start by rotating 90° clockwise and determine the rotational velocity component of steering wheel 2 So Start by rotating 90° clockwise and determine the rotational velocity component of steering wheel 2 So Start by rotating 90° clockwise, such as Figure 3 Tracking deviation angle The positive case can be determined similarly.

[0059] In addition, according to the tracking deviation angle The size of the steering wheel determines the size of the rotation speed component, tracking the deviation angle The larger the value, the larger the magnitude of the rotational velocity component. In one embodiment, the magnitude of the rotational velocity component of each steering wheel is also related to the distance from the steering wheel center to the vehicle center point O of the omnidirectional mobile robot. C The larger the distance R, the larger the magnitude of the rotation speed component. Based on this, in one embodiment, in order to achieve a better control effect, the magnitude of the rotation speed component of the steering wheel is determined to be Among them, K3 is a preset proportional coefficient.

[0060] (3) Performing vector synthesis on the walking speed component and the rotation speed component of each steering wheel to obtain the steering wheel speed vector of the steering wheel, and determining the deflection angle and steering wheel speed of the steering wheel according to the magnitude and direction of the steering wheel speed vector, including:

[0061] When determining the steering wheel speed, the magnitude of the steering wheel speed vector is directly used as the steering wheel speed of the steering wheel.

[0062] When determining the steering wheel's deflection angle, when the angle ξ between the steering wheel velocity vector and the steering wheel zero position positive direction of the steering wheel is within the range of [-90°, 90°], the steering wheel's deflection angle is directly determined to be ξ. Otherwise, the angle is processed by adding or subtracting 180° to the range of [-90°, 90°]: when ξ+180° is within the range of [-90°, 90°], the steering wheel's deflection angle is determined to be ξ+180°, or when ξ-180° is within the range of [-90°, 90°], the steering wheel's deflection angle is determined to be ξ-180°.

[0063] In another embodiment, in some special application scenarios, the omnidirectional mobile robot will also be controlled to work in the translation mode. In this mode, the direction of the omnidirectional mobile robot is always unchanged. For example, in some narrow passages, in order to avoid the omnidirectional mobile robot turning and colliding with the two sides of the passage, the omnidirectional mobile robot will be controlled to work in the translation mode. In the translation mode, it can be directly determined that the steering wheel speeds of each steering wheel are equal and are the tracking speed V of the omnidirectional mobile robot. And when the tracking line direction With the real-time vehicle body positive direction Tracking deviation angle When the deflection angles of each steering wheel are within the range of [-90°, 90°], the deflection angles of each steering wheel are equal and Otherwise when When the deflection angles of each steering wheel are within the range of [-90°, 90°], the steering angles are equal. or when When the deflection angles of each steering wheel are within the range of [-90°, 90°], the steering angles are equal.

[0064] Step 5, control the steering wheel deflection according to the deflection angle of each steering wheel and drive the steering wheel to move at the corresponding steering wheel speed. During the movement of the omnidirectional mobile robot, executing steps 1 to 5 for control tracking at predetermined time intervals can more accurately control the omnidirectional mobile robot to move along the path to be tracked.

[0065] The above is only a preferred embodiment of the present application, and the present application is not limited to the above embodiments. It is understood that other improvements and changes directly derived or associated by those skilled in the art without departing from the spirit and concept of the present application should be considered to be included in the protection scope of the present application.

Claims

1. A motion control method for an omnidirectional mobile robot for path tracking, characterized in that: The omnidirectional mobile robot motion control method comprises: Determine a projection point of a vehicle center point of the omnidirectional mobile robot on the path to be tracked, and determine a straight-line distance between the vehicle center point and the projection point as a lateral offset distance d; the omnidirectional mobile robot includes a plurality of steering wheels; Determine the preview length L according to the motion state parameters of the omnidirectional mobile robot and the lateral offset distance d d ; According to the preview length L d Determine the preview point on the path to be tracked, and determine the direction from the center point of the omnidirectional mobile robot to the preview point as the tracking line direction; wherein the preview point is located behind the projection point along the path direction and the distance between the preview point and the projection point is the preview length L d ; Determine the deflection angle and steering wheel speed of each steering wheel on the omnidirectional mobile robot according to the installation position of each steering wheel on the omnidirectional mobile robot, combined with the motion state parameters of the omnidirectional mobile robot and the direction of the tracking line; The steering wheel is controlled to deflect according to the deflection angle of each steering wheel and the steering wheel is driven to move at the corresponding steering wheel speed.

2. The omnidirectional mobile robot motion control method according to claim 1, characterized in that: The motion state parameters of the omnidirectional mobile robot include the tracking speed V and the real-time vehicle body positive direction. The deflection angle and steering wheel speed of each steering wheel on the omnidirectional mobile robot are determined as follows: Determine the walking speed component of the steering wheel according to the tracking speed V of the omnidirectional mobile robot in combination with the direction of the tracking line; Determine the rotation speed component of the steering wheel according to the real-time positive direction of the vehicle body of the omnidirectional mobile robot in combination with the installation position of the steering wheel and the direction of the tracking line; A steering wheel velocity vector is obtained by performing vector synthesis on the walking speed component and the rotation speed component of the steering wheel, and the magnitude of the steering wheel velocity vector is used as the steering wheel speed of the steering wheel; when the angle ξ between the steering wheel velocity vector and the positive direction of the steering wheel zero position of the steering wheel is in the range of [-90°, 90°], the deflection angle of the steering wheel is determined to be ξ, otherwise when ξ+180° is in the range of [-90°, 90°], the deflection angle of the steering wheel is determined to be ξ+180°, or when ξ-180° is in the range of [-90°, 90], the deflection angle of the steering wheel is determined to be ξ-180°; wherein, a positive deflection angle of the steering wheel indicates that the steering wheel deflects counterclockwise, and a negative deflection angle of the steering wheel indicates that the steering wheel deflects clockwise.

3. The motion control method of an omnidirectional mobile robot according to claim 2, characterized in that: Determining the walking speed component of the steering wheel includes: It is determined that the direction of the walking speed component of the steering wheel is the same as the direction of the tracking line, and the magnitude of the walking speed component of the steering wheel is determined to be the tracking speed V of the omnidirectional mobile robot.

4. The omnidirectional mobile robot motion control method according to claim 2, characterized in that: Determining the rotational velocity component of the steering wheel comprises: Determine the tracking deviation angle between the tracking line direction and the real-time vehicle body positive direction of the omnidirectional mobile robot Tracking deviation angle Starting from the real-time vehicle body positive direction, counterclockwise is positive and clockwise is negative; Determine the line between the center point of the vehicle and the steering wheel center of the steering wheel according to the installation position of the steering wheel, determine the direction of the rotation speed component of the steering wheel is perpendicular to the line between the center point of the vehicle and the steering wheel center of the steering wheel and is perpendicular to the tracking deviation angle The positive and negative correspond to each other; According to the tracking deviation angle The size of the steering wheel's rotation speed component determines the size of the tracking deviation angle The larger it is, the greater the magnitude of the rotational velocity component.

5. The motion control method of an omnidirectional mobile robot according to claim 4, characterized in that: When tracking deviation angle When it is positive, the direction of the rotation speed component of the steering wheel is the direction of the line connecting the center point of the vehicle to the center of the steering wheel and rotating 90° counterclockwise; When tracking deviation angle When it is negative, the direction of the rotation speed component of the steering wheel is the direction of 90° clockwise rotation from the direction of the line connecting the center point of the vehicle to the steering wheel center.

6. The motion control method of an omnidirectional mobile robot according to claim 5, characterized in that: The magnitude of the rotational speed component of each steering wheel is also related to the distance R between the steering wheel center of the steering wheel and the vehicle center point of the omnidirectional mobile robot, and the larger the distance R is, the larger the magnitude of the rotational speed component is.

7. The motion control method of an omnidirectional mobile robot according to claim 6, characterized in that: According to the tracking deviation angle Determining the magnitude of the rotational velocity component of the steering wheel includes: Determine the magnitude of the rotational velocity component of the steering wheel as Among them, K3 is the proportionality coefficient.

8. The motion control method of an omnidirectional mobile robot according to claim 1, characterized in that: The omnidirectional mobile robot motion control method also includes: When the omnidirectional mobile robot works in the translation mode, it is directly determined that the steering wheel speeds of each steering wheel are equal and are the tracking speed V of the omnidirectional mobile robot; and when the tracking deviation angle between the tracking line direction and the real-time vehicle body positive direction When the deflection angles of each steering wheel are within the range of [-90°, 90°], the deflection angles of each steering wheel are equal and Otherwise when When the deflection angles of each steering wheel are within the range of [-90°, 90°], the steering angles are equal. or when When the deflection angles of each steering wheel are within the range of [-90°, 90°], the steering angles are equal. Among them, a positive deflection angle of each steering wheel indicates that the steering wheel is deflected counterclockwise, and a negative deflection angle of each steering wheel indicates that the steering wheel is deflected clockwise.

9. The motion control method of an omnidirectional mobile robot according to claim 1, characterized in that: The motion state parameters of the omnidirectional mobile robot include a tracking speed V, a preview length L determined according to the motion state parameters of the omnidirectional mobile robot and the lateral offset distance d. d =K1×K2×V, wherein K1 is a velocity coefficient with a positive value, and K2 is a coefficient negatively correlated with the lateral offset distance d.

10. The motion control method of an omnidirectional mobile robot according to claim 9, characterized in that: The coefficient negatively correlated with the lateral offset distance d Represents the natural index.