Dual Ackerman Motion Control Method and System for Four-Steering Wheel AGV
By constructing an instantaneous steering center constraint line and calculating discrete quantities and offsets in a four-steering wheel AGV, the problem of inconsistent steering axes of the four steering wheels was solved, achieving efficient motion coordination and stable control of the four-steering wheel AGV, and improving path tracking accuracy and safety under heavy load conditions.
Patent Information
- Application Number
- CN202611309841.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-27
- Publication Date
- 2026-11-10
AI Technical Summary
In practical applications, the existing Ackerman motion control method for four-steering wheel AGVs is affected by the servo response lag of the steering wheels, mechanical installation deviations, tire elastic deformation under heavy load conditions, and changes in ground adhesion. As a result, the steering axes of the four steering wheels are difficult to strictly intersect, leading to inconsistency between the theoretical instantaneous steering center and the actual steering state. It is difficult to effectively distinguish between overall offset and local mismatch, resulting in uncoordinated wheel motion and accumulated path tracking errors.
By obtaining the expected linear velocity and path curvature of the AGV, the theoretical instantaneous steering center is determined, and the instantaneous steering center constraint line is constructed using the actual steering angles of the four steering wheels. The actual instantaneous steering center is solved, the discrete quantity and offset are calculated, the flow splitting decision and the instantaneous steering center are corrected, and the target steering angle and wheel speed of the steering wheels are recalculated to form a cycle-by-cycle closed-loop control.
It improves the motion coordination and control stability of the four-steering wheel AGV under heavy load and limited space, reduces steering mismatch and path tracking error, and enhances operational safety.
Smart Images

Figure CN123067461A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of motion control technology for automated guided vehicles, and in particular to a dual Ackerman motion control method and system for a four-steering wheel AGV. Background Technology
[0002] With the development of intelligent manufacturing, flexible logistics, and automated transfer technologies for large equipment, Automated Guided Vehicles (AGVs) are gradually evolving from traditional light-load, fixed-route transportation to larger, heavier-load, more mobile, and more precise path-tracking vehicles. For AGV chassis using four independently driven steering wheels, Ackerman steering geometry can coordinate the steering angle and wheel speed of each wheel according to the vehicle's wheelbase, track width, and desired motion state, ensuring that the motion direction of each wheel tends to satisfy the geometric relationship of motion around the same instantaneous steering center. Existing heavy-duty AGVs typically use chassis forms such as two-steering-wheel differential, four-steering-wheel single Ackerman, or omnidirectional wheels. Among these, the four-steering-wheel single Ackerman method has the advantages of relatively simple control structure and strong load-bearing capacity, but in heavy-duty AGVs with large wheelbases and track widths, it is easily limited by turning radius, tire lateral slippage, and path-tracking errors. Large-size heavy-duty AGVs using single Ackerman steering suffer from problems such as large turning radius, insufficient adaptability to confined spaces, rear wheel lateral slippage, and amplified kinematic errors. Therefore, dual Ackerman control, where both front and rear steering wheels participate in steering, has gradually become a technical approach to improve the maneuverability of four-steering-wheel AGVs. However, the ideal dual Ackerman model is usually based on the assumption that the steering angle of each steering wheel can accurately reach the theoretical target value and that the steering axes of the four steering wheels can strictly intersect at the same instantaneous steering center. In actual operation, due to the influence of steering wheel servo response lag, mechanical installation deviation, tire elastic deformation under heavy load conditions, changes in ground adhesion, and differences in the dynamic characteristics of each steering actuator, the steering axes corresponding to the four actual steering angles may not strictly intersect at the same point. If the controller still only performs ideal geometric inverse solution based on the desired path curvature and directly issues the theoretical target steering angle and theoretical target wheel speed, it is difficult to quantitatively reflect the consistency of the current four-steering-wheel steering geometry, and it is also difficult to distinguish between the overall instantaneous steering center offset and the local steering dispersion of each steering wheel, which may lead to problems such as wheel motion incoordination, tire lateral drag, and accumulation of path tracking errors.
[0003] CN110209162A This invention provides a four-wheel drive AGV tracking method based on the Ackerman steering principle, which effectively improves the operational stability and speed of AGVs, reduces the turning radius, and enhances load capacity. This invention uses dual cameras mounted on the AGV's underside to capture images of a color strip along the AGV's forward direction. After image processing, the current position and pose of the AGV are obtained. By driving the steering wheels to satisfy the Ackerman principle operator, the synchronization and overload problems of four-wheel drive are solved. It also reduces the trajectory radius of the arc in circular track-following applications, thus reducing dependence on open space and achieving reliable and stable track-following motion of the AGV. This invention can be applied to the field of automation equipment. This technology mainly determines the steering wheel control quantity based on visual tracking results and the Ackerman principle operator. Its control process focuses on completing trajectory tracking based on the vehicle's position and pose, without reconstructing the vehicle's current instantaneous steering center based on the actual steering angles of the four steering wheels, nor evaluating the geometric consistency of four-wheel steering based on the dispersion of the steering axes of each steering wheel relative to the common intersection position. Therefore, when multiple steering wheels cannot simultaneously satisfy the theoretical Ackermann geometry due to execution lag or mechanical deviation, it is difficult to further determine whether the current error belongs to an overall deviation that can be compensated by adjusting the instantaneous steering center, or a discrete anomaly that makes it unsuitable to continue using the current theoretical motion command.
[0004] CN110154787B discloses a dual-steering-wheel unmanned transport vehicle and its control method. The method includes: acquiring the vehicle's travel speed V and path deviation; calculating the travel speed V1 and steering angle θ1 of the front steering wheel and the travel speed V2 and steering angle θ2 of the rear steering wheel based on the travel speed V and path deviation; and controlling the movement of the unmanned transport vehicle based on the travel speed V1, steering angle θ1, and travel speed V2 and steering angle θ2 of the rear steering wheel. The method decomposes the vehicle's travel speed into a coordinate system with the line connecting the centers of the two steering wheels as the X-axis and the perpendicular direction of the line connecting the centers of the two steering wheels as the Y-axis. The travel speed and steering angle of the two steering wheels are calculated in this coordinate system. Only the travel speed V and path deviation of the unmanned transport vehicle need to be known; the rotation radius of the unmanned transport vehicle during its movement does not need to be considered. This method is simple to control, easy to operate, and has good accuracy. This technology establishes a speed and steering angle calculation relationship for the front and rear steering wheels. Its controlled object and motion constraints are mainly concentrated on the dual-steering wheel chassis, without addressing the consistency problem of multiple instantaneous steering center constraint lines under the condition that four independent steering wheels are turning simultaneously. Furthermore, this technology directly calculates the steering wheel control quantities based on the travel speed and path deviation, lacking a feedback analysis process that uses the actual steering angle to construct the current vehicle steering geometry. Therefore, it cannot differentiate subsequent motion control commands based on the spatial offset between the actual and theoretical instantaneous steering centers and the dispersion of the four constraint lines. Summary of the Invention
[0005] The purpose of this section is to outline some aspects of the embodiments of the present invention and to briefly introduce some preferred embodiments. Some simplifications or omissions may be made in this section, as well as in the abstract and title of the present application, to avoid obscuring the purpose of this section, the abstract and title of the invention. Such simplifications or omissions shall not be used to limit the scope of the present invention.
[0006] Given that existing four-steering wheel AGV Ackerman motion control typically calculates the target steering angle and target wheel speed of each steering wheel directly based on an ideal kinematic model, when the actual steering wheel steering angle is affected by servo response lag, mechanical installation deviation, heavy-load tire deformation, and changes in ground adhesion conditions, the steering axes corresponding to the four steering wheels may not maintain the theoretical co-point relationship, resulting in a problem where the theoretical instantaneous steering center is inconsistent with the actual steering state of the vehicle. Therefore, this invention is proposed.
[0007] Therefore, the problem to be solved by this invention is how to identify the current actual instantaneous steering center of the AGV based on the actual steering state of the four steering wheels, and distinguish between the discrete anomaly of the steering geometry of the four steering wheels and the overall offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center, so as to adjust the dual Ackerman motion control command accordingly for different steering states, so as to reduce the inconsistency between the theoretical kinematic solution and the actual steering wheel motion state.
[0008] To solve the above-mentioned technical problems, the present invention provides the following technical solution: In a first aspect, embodiments of the present invention provide a dual Ackerman motion control method for a four-steering wheel AGV, comprising, The desired linear velocity, desired path curvature, and actual steering angles of the four steering wheels of the AGV are obtained. The turning state of the current control cycle is determined based on the desired path curvature, and the theoretical instantaneous steering center corresponding to the desired path curvature is determined. The theoretical target steering angles and theoretical target wheel speeds of the four steering wheels are obtained. Based on the actual steering angles of the four steering wheels and their corresponding installation positions, instantaneous steering center constraint lines are constructed. The actual instantaneous steering center is solved by minimizing the sum of the squares of the distances from each instantaneous steering center constraint line to the common point. The sum of the squares of the distances from each instantaneous steering center constraint line to the actual instantaneous steering center is calculated as a discrete quantity, and the offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center is calculated. Based on the discrete quantity and offset, a flow splitting decision is made to determine whether to correct the instantaneous turning center or use a backup command; Based on the corrected instantaneous steering center, the final target steering angle and final target wheel speed of the four steering wheels are recalculated and sent to each steering wheel servo controller. The actual steering angle of the four steering wheels is then reacquired in the next control cycle.
[0009] Secondly, embodiments of the present invention provide a dual Ackerman motion control system for a four-steering wheel AGV, comprising: The theoretical calculation module is used to obtain the expected linear velocity, expected path curvature, and actual steering angle of the four steering wheels of the AGV. Based on the expected path curvature, it determines the turning state of the current control cycle and determines the theoretical instantaneous steering center corresponding to the expected path curvature, thus obtaining the theoretical target steering angle and theoretical target wheel speed of the four steering wheels. The center identification module is used to construct instantaneous steering center constraint lines based on the actual steering angles of the four steering wheels and their corresponding installation positions. The actual instantaneous steering center is determined by minimizing the sum of the squared distances from each instantaneous steering center constraint line to the common point. The module also calculates the sum of the squared distances from each instantaneous steering center constraint line to the actual instantaneous steering center as a discrete quantity and calculates the offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center. The diversion decision module is used to perform diversion decisions based on discrete quantities and offsets, determining whether to correct the instantaneous turning center or use backup instructions. The collaborative control module is used to recalculate the final target steering angle and final target wheel speed of the four steering wheels based on the corrected instantaneous steering center, send them to the servo controllers of each steering wheel, and reacquire the actual steering angle of the four steering wheels in the next control cycle.
[0010] Thirdly, embodiments of the present invention provide a computer device, including a memory and a processor, wherein the memory stores a computer program, and the processor executes the computer program to implement any step of the above-described dual Ackerman motion control method for a four-steering wheel AGV.
[0011] Fourthly, embodiments of the present invention provide a computer-readable storage medium storing a computer program thereon, wherein: when the computer program is executed by a processor, it implements any step of the above-described dual Ackerman motion control method for a four-steering wheel AGV.
[0012] Compared with the prior art, the beneficial effects of the present invention are as follows: By acquiring the AGV's desired linear velocity, desired path curvature, and actual steering angles of the four steering wheels, and determining the theoretical instantaneous steering center, theoretical target steering angle, and theoretical target wheel speed based on the desired path curvature, the desired motion state is first converted into a reference control quantity that satisfies the double Ackerman geometry relationship, providing a unified reference for subsequent comparison between the actual steering state and the theoretical steering state. By constructing instantaneous steering center constraint lines using the actual steering angles of the four steering wheels and their corresponding installation positions, and solving for the actual instantaneous steering center under the condition of minimizing the sum of the squares of the distances from each constraint line to the common point, the actual steering states of the four steering wheels affected by servo lag, mechanical deviation, or tire deformation can be uniformly mapped to the instantaneous steering center space. The discrete quantity is used to characterize the consistency of the actual steering geometry of the four steering wheels, and the offset quantity is used to characterize the overall deviation of the actual instantaneous steering center from the theoretical instantaneous steering center. This avoids the problem of difficulty in distinguishing between local mismatch and overall offset when correcting based solely on the steering angle error of a single steering wheel. By performing diversion decisions based on discrete quantities and offsets, and combining single-cycle correction upper limits, consistency reduction coefficients, and reliability coefficients to hierarchically limit the compensation amount, while performing a consistency verification and necessary secondary fine-tuning on the corrected instantaneous steering center, the theoretical instantaneous steering center can be corrected under constraints when the actual steering state has good consistency. When the discreteness is large or the correction result does not meet the consistency requirements, the backup command is switched, thereby suppressing the sudden change in steering command caused by one-time overcompensation and improving the matching degree between the correction result and the actual geometric state of the four steering wheels. By combining the number of consecutive correction failures when the correction fails with the command from the previous control cycle or an emergency stop strategy, and after obtaining the instantaneous steering center of effective correction, the final target steering angle and final target wheel speed of the four steering wheels are recalculated and sent to each steering wheel servo controller. Then, the actual steering angle is re-acquired in the next control cycle. This forms a cycle-by-cycle closed-loop control link of theoretical calculation, actual state identification, correction decision, effectiveness verification and command update. This can reduce the possibility of four-wheel steering mismatch, tire lateral drag and path tracking error accumulation while maintaining the maneuverability of dual Ackerman steering. It can also improve the motion coordination, control stability and operational safety of the four-steering wheel AGV under heavy load and confined space steering conditions. Attached Figure Description
[0013] To more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings used in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort. Wherein: Figure 1 A flowchart of the dual Ackerman motion control method for a four-steering wheel AGV; Figure 2 This is a structural diagram of the dual Ackerman motion control system for a four-steering wheel AGV. Detailed Implementation
[0014] To make the above-mentioned objects, features and advantages of the present invention more apparent and understandable, the specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments.
[0015] Based on the embodiments of this invention, all other embodiments obtained by those skilled in the art without inventive effort should fall within the scope of protection of this invention.
[0016] Many specific details are set forth in the following description in order to provide a full understanding of the invention. However, the invention may also be practiced in other ways different from those described herein, and those skilled in the art can make similar extensions without departing from the spirit of the invention. Therefore, the invention is not limited to the specific embodiments disclosed below.
[0017] As mentioned in the background section, existing technologies mainly calculate the steering wheel angle and wheel speed based on the desired linear velocity, path deviation, or desired vehicle motion state according to a preset Ackerman geometry. The control process primarily involves forward kinematic calculation from the desired motion state to the control quantities of each steering wheel, lacking a process for reverse identification of the current steering geometry based on the actual steering angles of the four steering wheels. Especially when the steering axes of the four steering wheels cannot strictly intersect at the same point, existing technologies struggle to quantitatively describe the dispersion between the steering axes and determine whether the current deviation can be corrected by adjusting the instantaneous steering center. This easily leads to the continued use of ideal dual Ackerman control commands even in cases of local steering wheel anomalies. To address these problems, this invention provides a dual Ackerman motion control method for a four-steering-wheel AGV.
[0018] Reference Figures 1-2 , Figure 1 This is a flowchart illustrating a dual Ackerman motion control method for a four-steering wheel AGV according to an embodiment of the present invention. Figure 1 As shown, a dual Ackerman motion control method for a four-steering wheel AGV includes: S1: Obtain the expected linear velocity, expected path curvature, and actual steering angle of the four steering wheels of the AGV. Determine the turning state of the current control cycle based on the expected path curvature, and determine the theoretical instantaneous steering center corresponding to the expected path curvature. Obtain the theoretical target steering angle and theoretical target wheel speed of the four steering wheels.
[0019] S1.1: Obtain the AGV's desired linear velocity, desired path curvature, and the actual steering angle of each of the four steering wheels.
[0020] S1.1.1: The desired linear velocity and desired path curvature are obtained through the host computer scheduling instructions or the human-computer interaction module.
[0021] Specifically, at the start of the current control cycle, the system reads the scheduling instructions from the host computer or the motion instructions generated by the human-machine interaction module. It then reads the desired linear velocity field and the desired path curvature field from the motion instructions, and determines the value corresponding to the desired linear velocity field as the desired linear velocity. The value corresponding to the desired path curvature field is determined as the desired path curvature. .
[0022] Among them, the desired linear velocity The velocity of the geometric center of the AGV body along the current direction of motion, expressed in m / s; the desired linear velocity is defined. The expected linear velocity corresponds to the AGV moving forward. The corresponding AGV moves backward; the desired path curvature. This characterizes the degree and direction of curvature of the currently planned path at the corresponding position of the AGV's geometric center, in units of... ; Specify the desired path curvature When turning left, the desired path curvature The time corresponds to a right turn.
[0023] S1.1.2: The actual steering angle of each of the four steering wheels is collected by the encoder set in the corresponding steering wheel steering mechanism.
[0024] Furthermore, the current encoding positions of the encoders corresponding to the left front steering wheel, right front steering wheel, left rear steering wheel, and right rear steering wheel are read within the current control cycle, and the pre-calibrated encoder zero position is obtained when the rolling direction of the corresponding steering wheel is parallel to the forward direction of the vehicle body. Based on the angle conversion coefficient corresponding to each encoder, the difference between the current encoding position and the corresponding encoder zero position is converted into the actual steering angle. ; In the formula, The actual steering angle of the i-th steering wheel, in rad; represents the angle conversion coefficient of the encoder corresponding to the i-th steering wheel, in rad / count; This represents the current encoding position of the encoder corresponding to the i-th steering wheel, expressed in count. is the encoder zero position of the encoder corresponding to the i-th steering wheel, in count; i is the steering wheel position index, i=1, 2, 3, 4 correspond to the left front steering wheel, right front steering wheel, left rear steering wheel and right rear steering wheel respectively.
[0025] Based on the sampling time corresponding to the current control cycle, the desired linear velocity Desired path curvature and the actual steering angles of each of the four steering wheels. Perform time correlation and assign the actual steering angles of each of the four steering wheels. As input parameters for constructing the instantaneous steering center constraint line in S2.
[0026] S1.2: Compare the absolute value of the desired path curvature with the preset curvature threshold to determine the state and theoretical instantaneous turning center corresponding to the current control cycle.
[0027] S1.2.1: Desired path curvature absolute value With preset curvature threshold Compare them.
[0028] When satisfied When this happens, the current control cycle is determined to be in a turning state: if the desired path curvature is... If the desired path curvature is..., then the turning direction will be determined as a left turn; If so, the turning direction will be determined as a right turn.
[0029] Establish a vehicle coordinate system, with the vehicle's geometric center O as its origin, the right lateral direction of the vehicle as the positive X-axis, and the vehicle's forward direction as the positive Y-axis. On the X-axis, which passes through the vehicle's geometric center O and is perpendicular to the vehicle's forward direction, determine the theoretical instantaneous turning center based on the desired path curvature. Coordinates:
[0030] ; therefore: ; In the formula, For the theoretical instantaneous turning center The horizontal coordinate, in meters; For the theoretical instantaneous turning center The vertical coordinate, in meters.
[0031] When the desired path curvature hour, Theoretically, the instantaneous steering center is located on the left side of the vehicle body; when the desired path curvature... hour, Theoretically, the instantaneous steering center is located on the right side of the vehicle body.
[0032] When satisfied When the current control cycle is determined to be in a straight-line state, the theoretical instantaneous steering center in finite coordinate form is not calculated in the straight-line state, and the theoretical rolling direction corresponding to the four steering wheels is determined to be consistent with the forward direction of the vehicle body. The theoretical target steering angle and theoretical target wheel speed of the four steering wheels are determined according to the straight-line state.
[0033] It should be noted that the preset curvature threshold is determined based on the minimum effective steering angle of the steering wheel mechanism. The specific calibration method is determined as follows after the calculation methods for the theoretical radial direction and theoretical rolling direction in S1.4 and the calculation method for the theoretical target steering angle in S1.5.1 are defined: Take the virtual front wheel position on the longitudinal axis of symmetry of the vehicle body (X=0), at the same longitudinal installation distance as the front steering wheel. As an equivalent reference point; when the theoretical instantaneous turning center is At that time, the radial vector corresponding to the virtual front wheel is According to the vertical direction transformation relationship in S1.4, its rolling direction vector is obtained as follows: According to the steering angle calculation relationship in S1.5.1, the steering angle δ corresponding to the virtual front wheel satisfies... Therefore, when the steering angle reaches the minimum effective steering angle... When the time is right, the corresponding path curvature is the preset curvature threshold. ,have to: ; In the formula, The minimum effective steering angle is denoted by rad; L is the wheelbase in meters. The minimum effective steering angle is pre-calibrated based on the mechanical steering clearance of the steering wheel mechanism, the encoder angle resolution, and the minimum angle command that the steering wheel servo controller can stably respond to. When the steering angle change corresponding to the curvature of the desired path does not reach the minimum effective steering angle, the corresponding control cycle is returned to the straight-line state to reduce the reciprocating adjustments caused by frequent changes in the steering wheel angle under near-straight-line conditions.
[0034] It should be noted that selecting a virtual reference point on the longitudinal axis of symmetry of the vehicle body, rather than the actual front steering wheel mounting position (W / 2, L / 2), is to eliminate the influence of the wheelbase W on the preset curvature threshold during the calibration process, retaining only the mapping relationship between the wheelbase L and the minimum effective steering angle, thereby simplifying the calibration formula and ensuring that the calibration result of the preset curvature threshold is not affected by the wheelbase parameter selection. An alternative implementation method using the actual front steering wheel mounting position for calibration can be derived by those skilled in the art by referring to the above method, and this invention does not exclude this alternative method.
[0035] As a preferred embodiment, the minimum effective steering angle is calibrated as follows: Under static conditions of the AGV, incremental steering angle commands are sent sequentially to the steering servo controller, with a step size of 0.1°. The actual response angle of the steering mechanism is recorded. When the following error between the actual response angle and the command angle is less than 10% of the command angle for the first time, the corresponding command angle is the minimum effective steering angle. For example, for a steering mechanism using a 16-bit absolute encoder and a reduction ratio of 150:1, the minimum effective steering angle is typically calibrated to 0.5°~1.5° (0.0087rad~0.0262rad); correspondingly, when the wheelbase L=1.2m, 2×tan(1.5°) / 1.2≈0.0437m -1 Those skilled in the art can adjust the calibration values within the above range based on the actual model selected.
[0036] S1.3: Obtain the pre-stored wheelbase and track width, and determine the installation position of each of the four steering wheels.
[0037] It should be noted that the wheelbase L is the distance along the longitudinal direction of the vehicle body between the lines connecting the corresponding steering centers of the left and right front steering wheels and the lines connecting the corresponding steering centers of the left and right rear steering wheels, in meters; the track W is the distance along the lateral direction of the vehicle body between the corresponding steering centers of the left and right steering wheels, in meters.
[0038] S1.3.1: Determine the longitudinal mounting distance of the front and rear steering wheels relative to the geometric center of the vehicle body based on half of the wheelbase L. ; In the formula, This represents the longitudinal installation distance, in meters (m).
[0039] S1.3.2: Determine the lateral mounting distances of the left and right steering wheels relative to the geometric center of the vehicle body based on half of the wheelbase W. ; In the formula, This refers to the lateral installation distance, in meters (m).
[0040] S1.3.3: Based on the established vehicle coordinate system, determine the installation positions of the left front steering wheel, right front steering wheel, left rear steering wheel, and right rear steering wheel respectively:
[0041]
[0042]
[0043] ; in, , , and These represent the installation positions of the left front rudder wheel, right front rudder wheel, left rear rudder wheel, and right rear rudder wheel, respectively. The unit of each coordinate component is meters (m).
[0044] For ease of uniform representation, the installation position of any steering wheel is denoted as: ; In the formula, and These are the lateral and longitudinal installation coordinates corresponding to the i-th steering wheel, respectively, in meters.
[0045] S1.4: In the turning state, the theoretical radial direction and theoretical rolling direction of each of the four steering wheels are determined according to the installation position of each steering wheel and the theoretical instantaneous turning center.
[0046] When the absolute value of the desired path curvature is greater than a preset curvature threshold, for any i-th rudder among the four rudder wheels, the rudder wheel installation position is determined according to the rudder wheel installation position. With theoretical instantaneous turning center Construct a theoretical radial vector pointing from the theoretical instantaneous steering center to the rudder wheel mounting position: ; Due to the theoretical instantaneous turning center vertical coordinate ,but: ; In the formula, Let be the theoretical radial vector corresponding to the i-th steering wheel, and let its direction be the theoretical radial direction corresponding to the i-th steering wheel.
[0047] Based on the geometric relationship that the rolling direction and the theoretical radial direction are perpendicular when a wheel makes circular motion around the theoretical instantaneous steering center, the theoretical radial vector is... Perform a vertical transformation to obtain the theoretical rolling candidate vector. : ; In the formula, Theoretical radial vector The horizontal component, Theoretical radial vector The longitudinal component.
[0048] When the longitudinal component of the theoretical rolling candidate vector is greater than or equal to zero, the direction corresponding to the theoretical rolling candidate vector is determined as the theoretical rolling direction; when the longitudinal component of the theoretical rolling candidate vector is less than zero, the opposite direction of the theoretical rolling candidate vector is determined as the theoretical rolling direction.
[0049] This yields the theoretical rolling direction vector corresponding to the i-th steering wheel. : ; in, and Let be the lateral and longitudinal components of the theoretical rolling direction vector corresponding to the i-th steering wheel, respectively; if the desired linear velocity... Then, the theoretical rolling direction vectors corresponding to the four steering wheels are reversed as a whole, and the reversed direction is used as the updated theoretical rolling direction, so that the rolling direction of each steering wheel is consistent with the direction of vehicle movement in the reversed condition; if the desired linear velocity If so, the currently determined theoretical rolling direction remains unchanged.
[0050] Following the above method, the theoretical radial direction and theoretical rolling direction of the left front steering wheel, right front steering wheel, left rear steering wheel and right rear steering wheel are obtained respectively, so that the normal direction of the four steering wheels corresponding to the theoretical rolling direction points to the theoretical instantaneous steering center.
[0051] S1.5: Calculate the theoretical target steering angle of the four steering wheels based on their respective theoretical rolling directions, and determine the theoretical target steering angle of the four steering wheels in the straight-line state.
[0052] It should be noted that the steering angle is positive when the steering wheel rolls from the direction of the vehicle's forward movement to the left of the vehicle body, and negative when the steering wheel rolls from the direction of the vehicle's forward movement to the right of the vehicle body; the positive or negative steering angle is independent of whether the AGV is in a forward or backward state.
[0053] S1.5.1: Calculate the theoretical target steering angles of the left and right front steering wheels.
[0054] Obtain the theoretical rolling direction vectors corresponding to the left front steering wheel and the right front steering wheel respectively. Based on the lateral and longitudinal components of the corresponding theoretical rolling direction vectors, calculate the directional angle between the corresponding theoretical rolling direction and the vehicle's forward direction through the four-quadrant arctangent relationship. ; In the formula, Let be the theoretical target steering angle corresponding to the i-th steering wheel, in rad; and These are the lateral and longitudinal components of the theoretical rolling direction vector corresponding to the i-th steering wheel, respectively.
[0055] The directional angle calculated according to the above formula for the theoretical rolling direction of the left front steering wheel is determined as the theoretical target steering angle of the left front steering wheel; the directional angle calculated according to the above formula for the theoretical rolling direction of the right front steering wheel is determined as the theoretical target steering angle of the right front steering wheel.
[0056] S1.5.2: Calculate the theoretical target steering angles of the left and right rear steering wheels.
[0057] Obtain the theoretical rolling direction vectors corresponding to the left and right rear steering wheels respectively, and calculate the directional angles corresponding to the left and right rear steering wheels according to the four-quadrant arctangent relationship in S1.5.1. Determine the obtained directional angles as the theoretical target steering angles of the left and right rear steering wheels respectively.
[0058] Therefore, the theoretical target steering angles of the left front steering wheel, right front steering wheel, left rear steering wheel, and right rear steering wheel are all calculated independently based on the geometric relationship between their respective installation positions and the same theoretical instantaneous steering center. The pre-defined relationship that the theoretical target steering angle of the rear steering wheel is directly equal to the inverse of the theoretical target steering angle of the corresponding front steering wheel is not used. Within the range of numerical calculation accuracy, the theoretical target steering angle of the rear steering wheel and the theoretical target steering angle of the corresponding front steering wheel satisfy… If the common point constraint relationship is slightly deviated due to the precision of discretization numerical calculation, the result calculated independently by each steering wheel shall prevail; if the current control cycle is in a straight-line state, the theoretical target steering angles corresponding to the four steering wheels shall be set as the straight-line steering angles, and the straight-line steering angles shall be zero. .
[0059] S1.6: Calculate the theoretical target wheel speed for each of the four steering wheels.
[0060] When the absolute value of the desired path curvature is greater than the preset curvature threshold, the theoretical turning angular velocity of the vehicle body is calculated based on the desired linear velocity and the desired path curvature. In the formula, the unit of the theoretical turning angular velocity of the vehicle body is rad / s.
[0061] For any i-th steering wheel among the four steering wheels, according to the theoretical instantaneous steering center and the corresponding steering wheel installation position ), calculate the distance from the theoretical instantaneous steering center to the corresponding steering wheel installation position:; ; because ,but ; In the formula, Let be the theoretical rotation radius corresponding to the i-th steering wheel, in meters.
[0062] Calculate the theoretical rotation radii of the left front steering wheel, right front steering wheel, left rear steering wheel, and right rear steering wheel respectively, using the methods described above.
[0063] Based on the theoretical turning angular velocity of the vehicle body The absolute value and the theoretical rotation radius of each of the four steering wheels Calculate the theoretical wheel speed amplitude for each steering wheel, and determine the direction of motion for each steering wheel according to the sign of the desired linear velocity, to obtain the theoretical target wheel speed for the i-th steering wheel: ; Combination , can be represented as: ; In the formula, Let be the theoretical target wheel speed corresponding to the i-th steering wheel, in m / s; Desired linear velocity The sign function; when the desired linear velocity When the theoretical target wheel speed is at that time, the sign corresponds to the AGV's forward direction; when the desired linear speed is... At that time, the sign of the theoretical target wheel speed corresponds to the backward direction of the AGV. Thus, the forward or backward direction of the AGV and the left or right turn direction are represented separately, avoiding the direct determination of the wheel speed sign by the sign of the vehicle's theoretical turning angular velocity.
[0064] If the current control cycle is in a straight-line state, then the theoretical target wheel speeds corresponding to each of the four steering wheels are all determined as the desired linear speeds: .
[0065] The theoretical target steering angle and theoretical target wheel speed of each of the four steering wheels obtained in the current control cycle are associated and recorded, and transmitted to S4 for final command issuance; at the same time, the theoretical instantaneous steering center, the actual steering angle of each of the four steering wheels, and the installation position of each of the four steering wheels are associated and recorded, and transmitted to S2 in the turning state.
[0066] S2: Construct instantaneous steering center constraint lines based on the actual steering angles of the four steering wheels and their corresponding installation positions. Solve for the actual instantaneous steering center by minimizing the sum of the squares of the distances from each instantaneous steering center constraint line to the common point. Calculate the sum of the squares of the distances from each instantaneous steering center constraint line to the actual instantaneous steering center as the distance discretization quantity, and calculate the offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center.
[0067] S2.1: Obtain the actual steering angle of each of the four steering wheels. And the corresponding installation positions of the four steering wheels. (Read from the associated record in step S1).
[0068] S2.2: For any i-th steering wheel among the four steering wheels, based on the actual steering angle corresponding to that steering wheel... Construct the actual rolling direction vector corresponding to the steering wheel. : ; in, The actual rolling direction vector The horizontal component, The actual rolling direction vector The longitudinal component, The direction is consistent with the actual rolling direction of the i-th steering wheel, and is also consistent with the theoretical rolling direction vector and steering angle. The defined symbol conventions (positive steering angle corresponds to left-side deflection of the vehicle body, and negative lateral component) remain consistent.
[0069] By taking the orthogonal direction of the actual rolling direction vector, we obtain the actual radial direction vector corresponding to the rudder wheel. : ; Wherein, the actual radial direction vector The horizontal component is The vertical component is The actual radial direction vector and the actual rolling direction vector are orthogonal, that is... The actual radial direction vector is the direction from the instantaneous steering center to the installation position of the steering wheel.
[0070] S2.3: Based on the actual radial direction vector corresponding to the i-th steering wheel and the corresponding steering wheel installation position, construct the instantaneous steering center constraint line corresponding to that steering wheel. The equation of the straight line: ; in, Instantaneous turning center constraint line The coordinates of any point on, and Let x and y be the lateral and longitudinal installation coordinates corresponding to the i-th steering wheel, respectively; the equation of this line represents the installation position of the steering wheel. Furthermore, the direction of the straight line with the actual rolling direction vector as the normal vector, i.e., the instantaneous steering center constraint line, is parallel to the actual radial direction vector; the actual instantaneous steering centers of the four steering wheels are all located on their respective instantaneous steering center constraint lines.
[0071] Construct the instantaneous steering center constraint line corresponding to the left front steering wheel in the above manner. Instantaneous steering center constraint line corresponding to the right front steering wheel Instantaneous steering center constraint line corresponding to the left rear steering wheel and the instantaneous steering center constraint line corresponding to the right rear steering wheel .
[0072] S2.4: Assume the actual instantaneous turning center The coordinates are With four instantaneous turning center constraint lines To the actual instantaneous turning center Construct the objective function with the condition of minimizing the sum of squared distances. : ; in The lateral coordinate of the actual instantaneous turning center. Let be the longitudinal coordinate of the actual instantaneous steering center, with dimensions m; the objective function characterizes the overall deviation between the four instantaneous steering center constraint lines and the actual instantaneous steering center, with dimensions m. 2 .
[0073] S2.5: For the objective function The lateral coordinates of the actual instantaneous turning center are respectively and the longitudinal coordinate of the actual instantaneous turning center Find the partial derivatives and set them to zero: ; The above system of equations with zero partial derivatives constitutes the lateral coordinates about the actual instantaneous turning center. and the longitudinal coordinate of the actual instantaneous turning center The system of two linear equations in two variables is solved; the solution is used as the coordinates of the actual instantaneous steering center; before solving the system of two linear equations, the determinant of the coefficient matrix of the system of equations is first calculated; if the absolute value of the determinant is greater than the preset singular threshold (the preset singular threshold is pre-calibrated based on the angle resolution of the steering wheel encoder and the accuracy of numerical calculation, preferably 1×10⁻⁶), then the system of two linear equations in two variables is solved. -6 If the equations are solved using the conventional Gaussian elimination method, the resulting solution is used as the coordinates of the actual instantaneous steering center. If the absolute value of the determinant is less than or equal to the preset singular threshold, it is determined that the actual steering angles of the four steering wheels are close to zero (i.e., currently in an approximately straight-line state). At this time, the coordinates of the actual instantaneous steering center are directly set to equal the coordinates of the theoretical instantaneous steering center. The calculation of the discrete quantity D in S2.6 is skipped, and the discrete quantity D is forcibly set to zero. At the same time, the validity of the actual instantaneous steering center in the current control cycle is marked as approximately straight-line, for use in the S3 diversion decision.
[0074] It should be noted that in the near-straight-ahead state, although the four actual steering angles are very small, the system is still in a turning state (the expected path curvature is greater than the preset curvature threshold). At this time, due to the lag in the steering wheel response, the actual steering angle has not yet been established. The theoretical instantaneous steering center is used as an approximation of the actual instantaneous steering center to avoid calculation crashes caused by the singularity of the coefficient matrix. This approximation is only effective in the current control cycle. In the next control cycle, as the actual steering angle is established, the system will automatically return to the normal solution process.
[0075] S2.6: Substitute the coordinates determined as the actual instantaneous steering center into the linear equations of each instantaneous steering center constraint line, and calculate the distance from each instantaneous steering center constraint line to the actual instantaneous steering center. : ; in, Let be the distance from the i-th instantaneous turning center constraint line to the actual instantaneous turning center, with dimensions in m.
[0076] Calculate the four distances again. The sum of squares D: ; The sum of squares, D, is defined as a discrete quantity, with the dimension m. 2 The discrete quantity D characterizes the degree of dispersion of the four instantaneous steering center constraint lines relative to the actual instantaneous steering center. The larger the D value, the worse the consistency of the steering center constrained by the actual steering angle of the four steering wheels.
[0077] S2.7: Based on the theoretical instantaneous turning center coordinates Calculate the actual instantaneous turning center Relative to the theoretical instantaneous turning center Offset Δ: ; in, This is the lateral offset. The offset is the longitudinal offset, and the dimension is m. The offset Δ represents the positional deviation between the actual instantaneous steering center and the theoretical instantaneous steering center, and is used in S3 to determine whether the theoretical instantaneous steering center needs to be corrected.
[0078] The discrete quantity, offset Δ, and coordinates of the actual instantaneous steering center are associated and recorded, and then transmitted to S3; at the same time, the actual steering angles and actual radial direction vectors corresponding to the four steering wheels are associated and recorded, so as to be used for the determination and calculation of the instantaneous steering center in S3.
[0079] S3: Perform a diversion decision based on the discrete quantity and offset to determine the corrected instantaneous steering center or to use a backup instruction.
[0080] S3.1: Obtain the pre-stored discrete preset threshold. and offset preset threshold And obtain the discrete quantity D, the offset Δ, and the coordinates of the actual instantaneous turning center.
[0081] It should be noted that the discrete quantity D, the offset Δ, and the coordinates of the actual instantaneous steering center are recorded in step S2; the preset threshold for the discrete quantity is pre-calibrated based on the encoder angular resolution of the four steering wheels and the mechanical steering clearance of the steering wheel mechanism, with the dimension being m. 2 In a preferred embodiment, the discrete quantity preset threshold is calibrated as follows: Let the angular resolution of the four steering wheel encoders be ε (unit: rad / count), and the mechanical steering clearance of the steering wheel mechanism be... (Unit: rad), then the measurement uncertainty of the actual steering angle of a single steering wheel According to the distance in S2.6 Definition, The sensitivity to the steering angle deviation of a single steering wheel is approximately the distance from the steering wheel's mounting position to the steering center. Its maximum value is taken as half the sum of the wheelbase L and the track width W. Therefore, the following is obtained: Recommended calculation formula: =4×( ×(L+W) / 2) 2 And take a safety factor.
[0082] For example, when ε = 0.001 rad, =0.003rad, L=1.2m, W=1.0m, =0.004rad, (L+W) / 2=1.1m, taking a safety factor of approximately 4.0, then ≈4×(0.004×1.1) 2 ×4.0≈0.00031m 2 .
[0083] Offset preset threshold The maximum allowable instantaneous turning center position deviation of the AGV body under the desired path curvature is pre-calibrated, with the dimension in meters. As a preferred embodiment, Calibrate as follows: Where η is a preset proportionality coefficient, preferably η = 0.05~0.15. For example, when L = 1.2m, W = 1.0m, and η = 0.1, =0.1m. This threshold represents the maximum allowable linear offset between the actual instantaneous steering center and the theoretical instantaneous steering center during a normal turn of the AGV. Exceeding this value indicates that the deviation between the actual motion state and the theoretical expected state is too large.
[0084] S3.2: Compare the discrete quantity D with the preset threshold value for the discrete quantity. The magnitude of the offset, Δ, is compared with a preset threshold value for the offset. By comparison, the theoretical instantaneous turning center can be determined. Whether to make corrections, specifically: When the discrete quantity D is less than or equal to the preset threshold of discrete quantity And the magnitude of the offset, Δ, is less than or equal to the preset threshold value for the offset. When this happens, the four actual steering angles of the current control cycle are determined. The determined actual instantaneous turning center Relative to the theoretical instantaneous turning center If the deviation is within an acceptable range, then no correction is made to the theoretical instantaneous steering center; instead, the theoretical instantaneous steering center is used as the correction instantaneous steering center. And skip S3.3 to S3.9; When the discrete quantity D is greater than the preset threshold of discrete quantity Or the magnitude of the offset is greater than the preset threshold of the offset. When this happens, the four actual steering angles of the current control cycle are determined. The determined actual instantaneous turning center Relative to the theoretical instantaneous turning center If the deviation exceeds the acceptable range, then proceed to S3.3 to re-establish the theoretical instantaneous steering center. Make corrections; It should be noted that in the dual criteria, the discrete quantity D represents the degree of consistency between the four instantaneous steering center constraint lines and the actual instantaneous steering center. When the discrete quantity D is greater than the preset threshold for discrete quantity, At that time, determine the four actual steering angles. Insufficient consistency between them; the magnitude of the offset represents the degree of deviation between the actual instantaneous steering center and the theoretical instantaneous steering center. When the magnitude of the offset exceeds the preset threshold of the offset... The deviation between the actual motion state and the theoretical expected state is too large.
[0085] S3.3: Theoretical Instantaneous Turning Center Based on Deterministic Correction offset The corresponding offset direction is used as the compensation direction, where the compensation direction is determined by the compensation direction vector. express: ; in, and These are the horizontal and vertical components of the compensation direction vector, respectively, both dimensionless. The magnitude of the offset is denoted by ; the compensation direction is the direction from the theoretical instantaneous steering center to the actual instantaneous steering center, used to bring the corrected instantaneous steering center closer to the actual state of the steering wheel reflected by the actual instantaneous steering center.
[0086] S3.4: Based on the compensation direction, obtain the pre-stored single-cycle correction upper limit. Read the magnitude of the offset and compare it with the upper limit of the single-cycle correction. The values are compared, and the compensation amount for the current control cycle is determined based on whether the discrete quantity D exceeds the threshold. .
[0087] Preferably, the single-cycle correction upper limit is pre-calibrated based on the maximum allowable change in the instantaneous turning center position of the AGV within a single control cycle, with the dimension being m. The single-cycle correction upper limit is less than a preset threshold for the offset. For example, when the control cycle... =20ms, maximum linear velocity When =1.0m / s, It can be calibrated to 0.02m~0.05m.
[0088] S3.4.1: When the magnitude of the offset exceeds the upper limit of the single-cycle correction. When that happens, the upper limit of the single-cycle correction will be adjusted. Determined as the benchmark compensation amount ,Right now When the magnitude of the offset is less than or equal to the upper limit of the single-cycle correction. When the offset magnitude is used, the offset magnitude is determined as the reference compensation amount. ,Right now The dimension of the benchmark compensation is m.
[0089] S3.4.2: Based on the threshold values of the discrete quantity D and the offset magnitude ‖Δ‖, the baseline compensation quantity is corrected in layers to obtain the final compensation quantity. The judgment order is as follows, in order of priority: (1) If the discrete quantity D is less than or equal to the preset threshold of the discrete quantity Furthermore, the magnitude of the offset, ‖Δ‖, is greater than the preset threshold for the offset. Then, the compensation amount is adjusted according to the benchmark compensation amount, and the final compensation amount is... This indicates that the four actual steering angles are in good agreement, but the overall instantaneous steering center is significantly offset from the theoretical position. At this point, the steering geometry of the four steering wheels is coordinated, and there is no need to worry about the risk of discrete deterioration. (2) If the discrete quantity D is greater than the preset threshold of the discrete quantity Furthermore, the magnitude of the offset, ‖Δ‖, is greater than the preset threshold for the offset. Then, a double reduction is applied to the benchmark compensation amount: first, the consistency reduction coefficient is determined based on the proportion of the dispersion. Then multiply by the reliability coefficient γ, where γ is between 0.7 and 0.9 (preferably 0.8), and the final compensation amount is... This indicates that the four actual steering angles are not sufficiently consistent and the actual state deviates too much from the theoretical state, indicating a double abnormal state. (3) If the discrete quantity D is greater than the preset threshold of the discrete quantity (That is, if there is only a lack of consistency, but the offset magnitude has not yet exceeded the preset offset threshold), then the base compensation amount is reduced only according to the proportion of the discrepancy exceeding the threshold, and the consistency reduction coefficient is used. The final compensation amount is ; (4) If the discrete quantity D is less than or equal to the preset threshold of the discrete quantity And the magnitude of the offset, Δ, is less than or equal to the preset threshold value for the offset. This indicates that the four actual steering angles are well consistent with each other. In this case, there is no need to reduce the reference compensation amount, and the final compensation amount is set to... .
[0090] S3.5: Based on compensation direction vector and compensation amount Calculate the compensation vector for the current control cycle. : ; in, and These are the horizontal and vertical components of the compensation vector, respectively, both with the dimension m.
[0091] S3.6: Based on the compensation vector Theoretical instantaneous turning center coordinates Make corrections to obtain the corrected instantaneous turning center. coordinates : ; in, and These are the horizontal and vertical coordinates of the corrected instantaneous turning center, respectively, both in meters.
[0092] S3.7: Calculate the corrected discrete verification value based on the actual steering angle and actual radial direction vector of each of the four steering wheels. The corrected discrete verification value is then compared with the discrete preset threshold. The comparison is performed, and the effectiveness of the correction to the instantaneous steering center is confirmed based on the comparison results.
[0093] Preferred discrete verification value The specific formula is as follows: .
[0094] S3.7.1: When the corrected discrete value is verified Less than or equal to the discrete quantity preset threshold At that time, the correction of the current control cycle will be instantly redirected to the center. coordinates Once the corrected instantaneous steering center is determined to be valid, proceed to step S3.9.
[0095] S3.7.2: When the corrected discrete value is verified Greater than the preset threshold of discrete quantity At that time, the instantaneous turning center is determined. coordinates The consistency verification failed; in this case, if the final compensation amount... Less than the upper limit of single-cycle correction Then the compensation vector of the current control cycle is used. Half of it is used as the fine-tuning compensation vector ,Right now And calculate the instantaneous turning center of the second correction. coordinates : ; in, and These are the lateral and longitudinal coordinates of the instantaneous turning center after the second correction, respectively, both in meters. With secondary correction instantaneous turning center coordinates Replacement correction instantaneous steering center coordinates And calculate the verification value of the second-corrected discrete quantity. : ; Verification value of the second-corrected discrete quantity With discrete quantity preset threshold Comparison: If the second-corrected discrete value is verified Less than or equal to the discrete quantity preset threshold Then the second correction will instantly turn towards the center. coordinates If the instantaneous turning center is determined to be valid, proceed to step S3.9; if the second-order correction discrete value is verified... Greater than the preset threshold of discrete quantity If the second correction fails, the correction status of the current control cycle is marked as correction failure, and the process proceeds to step S3.8. It should be noted that the physical meaning of the above-mentioned halving back-off fine-tuning strategy is as follows: when the discrete verification value still exceeds the threshold after one correction, it indicates that the compensation direction or compensation amount may have overshoot due to the nonlinear error of the actual steering angle. Therefore, back-off is performed with half of the compensation vector, so that the instantaneous steering center of the correction is repositioned between the theoretical instantaneous steering center and the instantaneous steering center of the first correction. This strategy is equivalent to damping the correction step size, which can reduce the risk of discrete quantity deterioration caused by excessive single compensation amount while ensuring the correctness of the correction direction. Moreover, this step is only a single back-off operation and does not constitute a loop iteration, thus ensuring the real-time performance of the control cycle.
[0096] Furthermore, the effectiveness of this fine-tuning strategy is based on the assumption that the compensation direction of the first correction is basically correct, but the compensation step size is too large, resulting in overshoot. When there is a significant nonlinear error or local mismatch in the actual steering angle of the four steering wheels, the compensation direction itself may deviate from the optimal compensation direction. In this case, the backoff strategy may not be able to reduce the verification value of the discrete quantity of the second correction to below the threshold. In this case, the system will directly determine that the second correction has failed and transfer to the S3.8 correction failure handling process, and will no longer perform multiple trial and error compensations to avoid repeated adjustments in invalid directions that cause control response delays and ensure system safety and real-time performance.
[0097] S3.7.3: When the corrected discrete value is verified Greater than the preset threshold of discrete quantity And compensation amount Equal to the upper limit of single-cycle correction If the compensation amount has reached its upper limit and further fine-tuning is not possible, the correction status of the current control cycle will be marked as a correction failure and the process will proceed to S3.8.
[0098] S3.8: For cases where the correction status is marked as correction failure, read the historical correction status and the counter of consecutive correction failures recorded in the previous control cycle. ; Set the counter Adding 1 gives the current number of consecutive correction failures. If the current consecutive correction failure count If the current control cycle fails, it is determined that the first correction has failed, and the final target steering angle and final target wheel speed recorded in the previous control cycle are used as backup instructions for the current control cycle; if the current consecutive correction failure count is... If a persistent deviation is detected in the system, the theoretical target steering angle of the four steering wheels is set to the straight-line steering angle, the theoretical target wheel speed is set to zero, and a steering system abnormality alarm signal is sent to the host computer. At the same time, the current control cycle is marked as an emergency stop state. After using the backup command or executing the emergency stop, the final target steering angle and final target wheel speed of the four steering wheels are recalculated based on the backup command or the command corresponding to the emergency stop and sent to each steering wheel servo controller. If the current control cycle is in a successful correction state or a straight-line state, the continuous correction failure counter is cleared to zero, and the final target steering angle and final target wheel speed of the four steering wheels are recalculated based on the correction instantaneous steering center and sent to each steering wheel servo controller.
[0099] S3.9: Record the coordinates of the effective corrected instantaneous steering center or the coordinates of the secondary corrected instantaneous steering center, and pass them to step S4; simultaneously, record the compensation amount, compensation direction vector, and the corrected discrete value of the current control cycle; if the current control cycle uses a backup command or executes an emergency stop, record the corresponding command mark and pass it to step S4; if the current control cycle is in a corrected success state or a straight-ahead state, set the continuous correction failure counter... Reset to zero.
[0100] S4: Based on the corrected instantaneous steering center, recalculate the final target steering angle and final target wheel speed of the four steering wheels, send them to each steering wheel servo controller, and reacquire the actual steering angle of the four steering wheels in the next control cycle.
[0101] Preferably, if the current control cycle is in a straight-line state, the theoretical target steering angle (all zero) and theoretical target wheel speed (equal to the desired linear velocity) of the four steering wheels determined in S1 are directly determined as the final target steering angle and final target wheel speed of the four steering wheels in the current control cycle, skipping S4.1 to S4.4, and directly entering S4.5 for amplitude limiting processing.
[0102] Specifically, the system reads the corrected instantaneous steering center coordinates or the coordinates of the secondary corrected instantaneous steering center, as well as the backup command flag and emergency stop flag, from the associated records in S3. When the backup command flag is valid, it directly obtains the final target steering angles corresponding to the four steering wheels recorded in the previous control cycle. and the final target wheel speed The final target steering angle for each of the four steering wheels in the current control cycle is... and the final target wheel speed And skip S4.2 to S4.5; when the emergency stop flag is valid, directly set the final target steering angle and the final target wheel speed of each of the four steering wheels to zero, skip S4.2 to S4.5, and report the abnormal status to the host computer.
[0103] It should be noted that the first control cycle after the AGV is powered on or enabled does not contain the historical target steering angle and historical target wheel speed recorded in the previous control cycle. At this time, according to the S3.8 method, the straight steering angle and zero wheel speed are used as the initial historical target steering angle and historical target wheel speed for possible backup instruction scenarios in the first control cycle and the amplitude limit calculation in S4.5.
[0104] S4.1: When both the standby command flag and the emergency stop flag are invalid and the current control cycle is in a turning state, then read the valid corrected instantaneous steering center from S3. coordinates Or a second correction to the instantaneous turning center coordinates Based on the respective mounting positions of the four steering wheels, for any i-th steering wheel among the four steering wheels, a final radial vector is constructed pointing from the effective instantaneous steering center to that steering wheel mounting position. : ; in, For the effective coordinates of the instantaneous steering center, when using the corrected instantaneous steering center... hour, When using a secondary correction instantaneous steering center hour, ; final radial vector The horizontal component is The vertical component is The dimension of each coordinate component is m.
[0105] For the final radial vector Perform a vertical transformation to obtain the final rolling candidate vector. : ; Among them, the final rolling candidate vector The horizontal component is The vertical component is .
[0106] When the longitudinal component of the final rolling candidate vector is greater than or equal to zero, the direction corresponding to the final rolling candidate vector is determined as the final rolling direction; when the longitudinal component of the final rolling candidate vector is less than zero, the opposite direction of the final rolling candidate vector is determined as the final rolling direction; thus, the final rolling direction vector corresponding to the i-th steering wheel is obtained. ,in and These are the lateral and longitudinal components of the final rolling direction vector, respectively.
[0107] If the desired linear velocity Then, the final rolling direction vectors corresponding to the four currently determined steering wheels are reversed as a whole, and the reversed direction is used as the updated final rolling direction; if the desired linear velocity If so, the currently determined final rolling direction remains unchanged.
[0108] S4.3: Based on the final roll direction vector, calculate the directed angle between each final roll direction and the vehicle's forward direction using the four-quadrant arctangent relationship, and obtain the final target steering angle corresponding to the i-th steering wheel. : ; in, Let be the final target steering angle corresponding to the i-th steering wheel, with the dimension rad; calculate the final target steering angles corresponding to the left front steering wheel, right front steering wheel, left rear steering wheel, and right rear steering wheel respectively in the above manner. and .
[0109] S4.4: Based on the desired linear velocity and the coordinates of the effective instantaneous steering center, calculate the final turning angular velocity of the vehicle body in the current control cycle. .
[0110] For any i-th steering wheel among the four steering wheels, based on the coordinates of the effective instantaneous steering center... Calculate the distance from the effective instantaneous steering center to the corresponding steering wheel mounting position, based on the steering wheel mounting position corresponding to that steering wheel. : .
[0111] Based on the absolute value of the vehicle's final turning angular velocity and the respective final turning radius of each of the four steering wheels. Calculate the final wheel speed amplitude for each steering wheel, and determine the direction of motion for each steering wheel according to the sign of the desired linear velocity, thus obtaining the final target wheel speed for the i-th steering wheel. : .
[0112] Combination ,but ; The dimension of the final target wheel speed corresponding to the i-th steering wheel is m / s; the final target wheel speeds corresponding to the left front steering wheel, right front steering wheel, left rear steering wheel, and right rear steering wheel are calculated respectively in the above manner. and .
[0113] S4.5: Read the historical target steering angles of the four steering wheels recorded in the previous control cycle. and historical target speed The final target steering angle calculated in the current control cycle. Turning angle with historical target The absolute value of the difference Threshold for maximum change in steering angle between adjacent control cycles Compare the final target wheel speed calculated in the current control cycle. Compared with historical target speed The absolute value of the difference Threshold for maximum change in wheel speed in adjacent control cycles Compare them.
[0114] Specifically, obtain the pre-stored threshold of the maximum change in steering angle between adjacent control cycles. Threshold for maximum change in wheel speed in adjacent control cycles Threshold for maximum change in steering angle between adjacent control cycles The unit is rad, and the threshold is the maximum change in wheel speed between adjacent control cycles. The dimension of is m / s; when Then, based on the threshold of the maximum change in steering angle between adjacent control cycles... Limit the final target steering angle to obtain the limited final target steering angle. : ; when At that time, maintain the final target steering angle. Unchanged, that is .
[0115] when Then, based on the threshold of the maximum change in wheel speed between adjacent control cycles... Limit the final target wheel speed to obtain the limited final target wheel speed. : ; when At that time, maintain the final target wheel speed. Unchanged, that is ; in, It is a symbolic function.
[0116] It should be noted that the aforementioned limiting operations on the final target steering angle and final target wheel speed are safety protection measures at the level of actuator physical constraints. Because the limiting operation may cause the steering angles of the steering wheels after limiting to no longer strictly satisfy the common-point constraint (i.e., the rolling direction normals of the four steering wheels no longer precisely intersect at the same instantaneous steering center), therefore, after limiting, the steering angle after limiting is used... and wheel speed This serves as an instruction to be issued. However, if the limiting operation causes the absolute value of the deviation between the limited steering angle and the final target steering angle before limiting of any steering wheel to exceed the preset geometric constraint tolerance threshold, then... ( If the deviation is between 0.5° and 1.0°, it is recorded as a following error log and stored in non-volatile memory for offline download and analysis by maintenance personnel. This allows for manual adjustment of the calibration values of the maximum change threshold for steering angle and the maximum change threshold for wheel speed in adjacent control cycles based on actual operating conditions. The geometric constraint tolerance threshold is determined based on the actual dynamic response capability of the steering servo drive. The system itself does not perform automatic parameter adjustments to avoid introducing unpredictable nonlinearity and stability risks into the adaptive algorithm. After the amplitude is limited, the steering angles of each steering wheel may no longer strictly satisfy the common point constraint, but this deviation will be naturally eliminated in the next control cycle by re-acquiring the actual steering angle and recalculating and correcting the instantaneous steering center, rather than being actively corrected in this cycle. Due to the short control cycle (20ms~50ms), this transient geometric constraint deviation will not cause the system to lose control.
[0117] S4.6: Adjust the final target steering angle after limiting the amplitude. and the final target wheel speed after amplitude limiting The commands are sent to the corresponding servo controllers of the four steering wheels via fieldbus; if the current control cycle is an emergency stop state, a zero-speed, zero-angle command is sent.
[0118] It should be noted that the servo controllers corresponding to the four steering wheels drive the steering motors of the corresponding steering wheels to rotate to the target steering angle position according to the received final target steering angle after the amplitude limit, and drive the drive motors of the corresponding steering wheels to rotate to the target wheel speed according to the received final target wheel speed after the amplitude limit.
[0119] S4.7: Record the final target steering angle and final target wheel speed after the current control cycle as the historical target steering angle and historical target wheel speed for the next control cycle; associate and record the coordinates of the corrected instantaneous steering center or the coordinates of the secondary corrected instantaneous steering center used in the current control cycle, for adaptive adjustment of the thresholds of discrete quantity D and offset Δ in S3 of the next control cycle; simultaneously record the correction status (success, standby, emergency stop) and the continuous correction failure counter for the current control cycle. The value is recorded for use in the next cycle.
[0120] At the end of the current control cycle, after recording the final target steering angle and the final target wheel speed after the limit, the next control cycle begins. At the beginning of the next control cycle, S1.1.2 is executed again. The encoders set on the four steering wheel mechanisms collect the current encoding position of each of the four steering wheels. Based on the angle conversion coefficient of each encoder, the difference between the current encoding position and the corresponding encoder zero position is converted into the actual steering angle of each of the four steering wheels. The actual steering angle is used as the input parameter for constructing the instantaneous steering center constraint line in the next control cycle S2.
[0121] In summary, by determining the theoretical instantaneous steering center and the theoretical control quantities of the four steering wheels based on the desired path curvature, a benchmark is provided for dual Ackerman motion control. Instantaneous steering center constraint lines are constructed using the actual steering angles of the four steering wheels, and the actual instantaneous steering center is solved. Discrete quantities are used to characterize the consistency of four-wheel steering, and offset quantities are used to characterize the degree of deviation of the actual steering state from the theoretical state. By making flow-splitting decisions based on discrete quantities and offset quantities, and by limiting and validating the correction quantities, unreliable corrections can be avoided when there is a significant mismatch in the four-wheel steering state. By recalculating the final target steering angle and final target wheel speed based on the effective corrected instantaneous steering center, and combining this with backup commands and a continuous correction failure handling mechanism to form a periodic closed loop, the steering coordination, path tracking stability, and operational safety under abnormal conditions of the four-steering-wheel AGV are improved.
[0122] Based on the teachings of the above embodiments, other aspects of the present invention also propose a dual Ackerman motion control system for a four-steering wheel AGV, such as... Figure 2 As shown, it includes: The theoretical calculation module is used to obtain the expected linear velocity, expected path curvature, and actual steering angle of the four steering wheels of the AGV. Based on the expected path curvature, it determines the turning state of the current control cycle and determines the theoretical instantaneous steering center corresponding to the expected path curvature, thus obtaining the theoretical target steering angle and theoretical target wheel speed of the four steering wheels. The center identification module is used to construct instantaneous steering center constraint lines based on the actual steering angles of the four steering wheels and their corresponding installation positions. The actual instantaneous steering center is determined by minimizing the sum of the squared distances from each instantaneous steering center constraint line to the common point. The module also calculates the sum of the squared distances from each instantaneous steering center constraint line to the actual instantaneous steering center as a discrete quantity and calculates the offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center. The diversion decision module is used to perform diversion decisions based on discrete quantities and offsets, determining whether to correct the instantaneous turning center or use backup instructions. The collaborative control module is used to recalculate the final target steering angle and final target wheel speed of the four steering wheels based on the corrected instantaneous steering center, send them to the servo controllers of each steering wheel, and reacquire the actual steering angle of the four steering wheels in the next control cycle.
[0123] The data flow between the modules of the above system is as follows: The theoretical calculation module transmits the theoretical instantaneous steering center, the actual steering angles of the four steering wheels, and the installation positions of the steering wheels to the center identification module; the center identification module transmits the discrete quantities, offset quantities, and actual instantaneous steering center coordinates to the flow splitting decision module; the flow splitting decision module transmits the effective corrected instantaneous steering center coordinates or backup command markers to the collaborative control module; the collaborative control module sends the final target steering angle and the final target wheel speed to the servo controller and feeds back historical data to each module for use in the next control cycle, forming a cycle-by-cycle closed-loop control link.
[0124] It should be noted that the aforementioned theoretical calculation module, central identification module, diversion decision module, and collaborative control module can be integrated into the same physical device (such as a Siemens S7-1500 PLC) and implemented as software program modules, or they can be deployed in different processors or controllers and interact with each other via fieldbus. The specific implementation method of each module does not constitute a limitation of the present invention.
[0125] This embodiment also provides a computer device applicable to the dual Ackerman motion control method for a four-steering wheel AGV, including a memory and a processor; the memory is used to store computer-executable instructions, and the processor is used to execute the computer-executable instructions to realize the dual Ackerman motion control method for a four-steering wheel AGV as proposed in the above embodiment.
[0126] The computer device can be a terminal, comprising a processor, memory, communication interface, display screen, and input devices connected via a system bus. The processor provides computing and control capabilities. The memory includes non-volatile storage media and internal memory. The non-volatile storage media stores the operating system and computer programs. The internal memory provides an environment for the operation of the operating system and computer programs stored in the non-volatile storage media. The communication interface is used for wired or wireless communication with external terminals; wireless communication can be achieved through Wi-Fi, carrier networks, NFC (Near Field Communication), or other technologies. The display screen can be an LCD screen or an e-ink screen. The input devices can be a touch layer covering the display screen, buttons, a trackball, or a touchpad on the computer device's casing, or an external keyboard, touchpad, or mouse.
[0127] This embodiment also provides a storage medium storing a computer program that, when executed by a processor, implements the dual Ackerman motion control method for a four-steering wheel AGV as proposed in the above embodiment.
[0128] The storage medium proposed in this embodiment and the data storage method proposed in the above embodiments belong to the same inventive concept. Technical details not described in detail in this embodiment can be found in the above embodiments, and this embodiment has the same beneficial effects as the above embodiments.
[0129] It should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention and are not intended to limit it. Although the present invention has been described in detail with reference to preferred embodiments, those skilled in the art should understand that modifications or equivalent substitutions can be made to the technical solutions of the present invention without departing from the spirit and scope of the technical solutions of the present invention, and all such modifications or substitutions should be covered within the scope of the claims of the present invention.
Claims
1. A dual Ackerman motion control method for a four-steering wheel AGV, characterized in that, include: The desired linear velocity, desired path curvature, and actual steering angles of the four steering wheels of the AGV are obtained. The turning state of the current control cycle is determined based on the desired path curvature, and the theoretical instantaneous steering center corresponding to the desired path curvature is determined, thereby obtaining the theoretical target steering angles and theoretical target wheel speeds of the four steering wheels. Based on the actual steering angles of the four steering wheels and their corresponding installation positions, instantaneous steering center constraint lines are constructed respectively. The actual instantaneous steering center is solved by minimizing the sum of the squares of the distances from each instantaneous steering center constraint line to the common point. The sum of the squares of the distances from each instantaneous steering center constraint line to the actual instantaneous steering center is calculated as a discrete quantity, and the offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center is calculated. Based on the discrete quantity and the offset, a diversion decision is made to determine whether to correct the instantaneous steering center or use a backup command. Based on the corrected instantaneous steering center, the final target steering angle and final target wheel speed of the four steering wheels are recalculated and sent to each steering wheel servo controller. The actual steering angle of the four steering wheels is then reacquired in the next control cycle.
2. The dual Ackerman motion control method for a four-steering wheel AGV as described in claim 1, characterized in that, The determination of the corrected instantaneous steering center or the use of a backup command includes: Obtain the pre-stored discrete value preset threshold and offset preset threshold And obtain the discrete quantity D, the offset Δ, and the coordinates of the actual instantaneous turning center; The discrete quantity D is compared with the preset threshold of the discrete quantity. The magnitude of the offset, Δ, is compared with a preset threshold value for the offset. By comparison, the theoretical instantaneous turning center can be determined. Should it be corrected? Theoretical instantaneous turning center based on deterministic correction The offset direction corresponding to the offset Δ is taken as the compensation direction. Based on the compensation direction, obtain the pre-stored single-cycle correction upper limit. Read the magnitude of the offset and compare it with the single-cycle correction upper limit. The values are compared, and the compensation amount for the current control cycle is determined based on whether the discrete quantity D exceeds the threshold. ; According to the compensation vector For the theoretical instantaneous turning center coordinates Make corrections to obtain the corrected instantaneous turning center. coordinates ; Based on the actual steering angle and actual radial direction vector corresponding to each of the four steering wheels, calculate the corrected discrete verification value. The corrected discrete verification value is then compared with the discrete preset threshold. The comparison is performed, and the effectiveness of the correction to the instantaneous steering center is confirmed based on the comparison results.
3. The dual Ackerman motion control method for a four-steering wheel AGV as described in claim 2, characterized in that, Also includes: For cases where the correction status is marked as correction failure, read the historical correction status recorded in the previous control cycle and the counter for the number of consecutive correction failures. ; the counter Adding 1 gives the current number of consecutive correction failures. ; If the current consecutive correction failure count If the current control cycle fails, it is determined that the first correction has failed, and the final target steering angle and final target wheel speed recorded in the previous control cycle are used as backup instructions for the current control cycle; if the current consecutive correction failure count is...
2. If a persistent deviation is detected in the system, the theoretical target steering angle of the four steering wheels is set to the straight-line steering angle, the theoretical target wheel speed is set to zero, and a steering system abnormality alarm signal is sent to the host computer. At the same time, the current control cycle is marked as an emergency stop state. After using the backup command or executing the emergency stop, the final target steering angle and final target wheel speed of the four steering wheels are recalculated based on the backup command or the command corresponding to the emergency stop and sent to each steering wheel servo controller. If the current control cycle is in a successful correction state or a straight-line state, the continuous correction failure counter is cleared to zero, and the final target steering angle and final target wheel speed of the four steering wheels are recalculated based on the corrected instantaneous steering center and sent to each steering wheel servo controller.
4. The dual Ackerman motion control method for a four-steering wheel AGV as described in claim 2, characterized in that, The effectiveness of correcting the instantaneous turning center includes: When the corrected discrete value is verified Less than or equal to the discrete quantity preset threshold At that time, the correction of the current control cycle will be instantly redirected to the center. coordinates Determined as an effective corrective instantaneous steering center; When the corrected discrete value is verified Greater than the preset threshold of the discrete quantity At that time, the instantaneous turning center is determined. coordinates Consistency verification failed; if the final compensation amount Less than the single-cycle correction upper limit Then, the compensation vector of the current control cycle is used. Half of it is used as the fine-tuning compensation vector ,Right now And calculate the instantaneous turning center of the second correction. coordinates ; With the aforementioned secondary correction instantaneous steering center coordinates Replace the corrected instantaneous steering center coordinates And calculate the verification value of the second-corrected discrete quantity. ; The second-corrected discrete value verification value With discrete quantity preset threshold Comparison: If the second-corrected discrete value is verified Less than or equal to the preset threshold of the discrete quantity Then the second correction will be instantaneously turned towards the center. coordinates The instantaneous turning center is determined to be valid; if the second-order correction discrete value is verified... Greater than the preset threshold of the discrete quantity If the second correction fails, the correction status of the current control cycle will be marked as a correction failure. When the corrected discrete value is verified Greater than the preset threshold of the discrete quantity And the compensation amount Equal to the upper limit of single-cycle correction If this happens, the correction status of the current control cycle will be marked as a correction failure.
5. The dual Ackerman motion control method for a four-steering wheel AGV as described in claim 2, characterized in that, The compensation amount The methods for determining this include: When the magnitude of the offset exceeds the single-cycle correction limit When this happens, the single-cycle correction upper limit will be... Determined as the benchmark compensation amount ,Right now When the magnitude of the offset is less than or equal to the single-cycle correction upper limit. When the offset magnitude is used, it is determined as the reference compensation amount. ,Right now ; The reference compensation amount is then corrected in layers based on the threshold values of the discrete quantity D and the offset magnitude ‖Δ‖ to obtain the final compensation amount. The judgment order is as follows, in order of priority: If the discrete quantity D is less than or equal to the preset threshold for discrete quantities Furthermore, the magnitude of the offset, ‖Δ‖, is greater than the preset threshold value for the offset. Then, the correction is made according to the aforementioned benchmark compensation amount, and the final compensation amount is... ; If the discrete quantity D is greater than the preset threshold for the discrete quantity Furthermore, the magnitude of the offset, Δ, is greater than the preset threshold value for the offset. Then, a double reduction is applied to the benchmark compensation amount: first, a consistency reduction coefficient is determined based on the proportion of the dispersion. Multiplying this by the reliability coefficient γ, the final compensation amount is... ; If the discrete quantity D is greater than the preset threshold for the discrete quantity Then, the benchmark compensation amount is reduced only based on the proportion of the discrete amount exceeding the standard, and the consistency reduction coefficient is used. The final compensation amount is ; If the discrete quantity D is less than or equal to the preset threshold of the discrete quantity Furthermore, the magnitude of the offset, Δ, is less than or equal to a preset threshold value for the offset. Therefore, there is no need to reduce the baseline compensation amount; let the final compensation amount be... .
6. The dual Ackerman motion control method for a four-steering wheel AGV as described in claim 5, characterized in that, The method for obtaining the discrete quantity D and the offset Δ includes: Let the actual instantaneous turning center be... The coordinates are With four instantaneous turning center constraint lines To the actual instantaneous turning center We construct the objective function with the condition of minimizing the sum of squared distances. The objective function is given with respect to the actual instantaneous turning center. Horizontal coordinate and the longitudinal coordinate of the actual instantaneous turning center Find the partial derivatives and set them to zero; the system of equations with zero partial derivatives forms the lateral coordinates about the actual instantaneous turning center. and the longitudinal coordinate of the actual instantaneous turning center A system of two linear equations in two variables; solve the system of two linear equations in two variables, and determine the coordinates of the actual instantaneous turning center using the obtained solution; Substitute the coordinates of the actual instantaneous steering center into the linear equations of each instantaneous steering center constraint line to calculate the distance from each instantaneous steering center constraint line to the actual instantaneous steering center. ; then calculate the four distances The sum of squares D, and the sum of squares D is determined as a discrete quantity; Based on the aforementioned theoretical instantaneous turning center coordinates Calculate the actual instantaneous turning center Relative to the theoretical instantaneous turning center The offset Δ.
7. The dual Ackerman motion control method for a four-steering wheel AGV as described in claim 6, characterized in that, The instantaneous steering center constraint line The equations of the straight lines include: Obtain the actual steering angle of each of the four steering wheels. and the corresponding mounting positions of the four steering wheels. ; For any i-th steering wheel among the four steering wheels, based on the actual steering angle corresponding to that steering wheel... Construct the actual rolling direction vector corresponding to the steering wheel. Taking the orthogonal direction of the actual rolling direction vector, we obtain the actual radial direction vector corresponding to the steering wheel; Based on the actual radial direction vector corresponding to the i-th steering wheel and the installation position of the steering wheel, construct the instantaneous steering center constraint line corresponding to the steering wheel. The equation of the straight line.
8. A dual Ackerman motion control system for a four-steering-wheel AGV, based on the dual Ackerman motion control method for a four-steering-wheel AGV according to any one of claims 1 to 7, characterized in that, include: The theoretical calculation module is used to obtain the expected linear velocity, expected path curvature, and actual steering angle of the four steering wheels of the AGV. Based on the expected path curvature, it determines the turning state of the current control cycle and determines the theoretical instantaneous steering center corresponding to the expected path curvature, thereby obtaining the theoretical target steering angle and theoretical target wheel speed of the four steering wheels. The center identification module is used to construct instantaneous steering center constraint lines based on the actual steering angles of the four steering wheels and their corresponding installation positions. The actual instantaneous steering center is solved by minimizing the sum of the squared distances from each instantaneous steering center constraint line to the common point. The module also calculates the sum of the squared distances from each instantaneous steering center constraint line to the actual instantaneous steering center as a discrete quantity, and calculates the offset of the actual instantaneous steering center relative to the theoretical instantaneous steering center. The diversion decision module is used to perform diversion decisions based on the discrete quantity and the offset, and to determine whether to correct the instantaneous turning center or use a backup instruction. The collaborative control module is used to recalculate the final target steering angle and final target wheel speed of the four steering wheels based on the corrected instantaneous steering center, send them to each steering wheel servo controller, and reacquire the actual steering angle of the four steering wheels in the next control cycle.
9. A computer device comprising a memory and a processor, wherein the memory stores a computer program, characterized in that: When the processor executes the computer program, it implements the steps of the dual Ackerman motion control method for the four-steering wheel AGV according to any one of claims 1 to 7.
10. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by the processor, it implements the steps of the dual Ackerman motion control method for the four-steering wheel AGV as described in any one of claims 1 to 7.
Citation Information
Patent Citations
A dual-steering wheel unmanned transport vehicle and its control method
CN110154787B
Four-wheel driving AGV (Automatic Guided Vehicle) tracking method based on Ackermann steering principle
CN110209162A
