AGV steering wheel control method and system based on permanent magnet motor
By obtaining the AGV position and speed in real time, calculating the steering angle and selecting the appropriate permanent magnet motor control method, the AGV steering wheel cornering angle problem is solved, the AGV navigation accuracy and safety is improved, and efficient and accurate driving is ensured.
Patent Information
- Application Number
- CN202411236780.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-04
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-09-04
AI Technical Summary
When turning, the AGV rudder wheel has a problem with the turning angle of the rudder wheel, which leads to poor AGV control accuracy, which may cause the AGV to collide with the opposite AGV.
By obtaining the position and speed of the AGV in real time, calculating the steering angles of the front and rear wheels, and selecting the appropriate permanent magnet motor control method according to the deviation angle, so as to achieve accurate speed adjustment and steering control.
It improves the navigation accuracy and safety of AGV, ensures that the AGV can travel along the trajectory efficiently and accurately, and avoids collisions with the opposite AGV.
Smart Images

Figure CN118928069A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of steering wheel control, and in particular to an AGV steering wheel control method and system based on a permanent magnet motor. Background Art
[0002] Automated Guided Vehicles (AGVs), automatic guided vehicles, laser guided vehicles. The most notable feature is that they are unmanned. AGVs are equipped with an automatic guidance system, which can ensure that the system can automatically drive along the predetermined route without the need for manual guidance, and automatically transport goods or materials from the starting point to the destination.
[0003] The AGV steering wheel refers to an integrated mechanical mechanism that inherits the drive motor and the steering motor. After the steering wheel is installed, the AGV can achieve simultaneous steering and translation operations. The AGV steering wheel has strong adaptability and can be quickly deployed on the AGV. In conjunction with the existing line navigation technology, the AGV can realize automatic navigation and detour avoidance functions. When turning, the AGV usually turns by customizing the trajectory. When customizing the trajectory, the turning trajectory is generally calculated by several points on a continuous curve. However, in this way, since the car is running dynamically, there is a deviation between the motion trajectory of the AGV and the given trajectory route. The movement of the vehicle is based on the response to the deviation. During the dynamic adjustment process, it will not overlap with the trajectory, affecting the accuracy of the AGV control. In severe cases, it may cause the AGV to collide with the opposite AGV. Summary of the invention
[0004] In view of the above defects, the purpose of the present invention is to propose an AGV steering wheel control method and system based on a permanent magnet motor. When the AGV turns, the steering wheel turning angle problem causes the AGV control accuracy to be poor.
[0005] To achieve this purpose, the present invention adopts the following technical solution: a method for controlling an AGV steering wheel based on a permanent magnet motor, comprising the following steps:
[0006] The position of the AGV is obtained in real time. When the AGV enters a turning point, the traveling speed V of the AGV and the tangent angle b of the trajectory are obtained, wherein the traveling speed V includes the front wheel speed V1 and the rear wheel speed V2;
[0007] According to the traveling speed V of the unmanned guided vehicle, the steering angle θ1 of the front wheels and the steering angle θ2 of the rear wheels are calculated respectively;
[0008] Obtain the deviation angle A1 of the front wheel and the deviation angle A2 of the rear wheel according to the steering angle θ1, the steering angle θ2 and the tangent angle b of the trajectory;
[0009] According to the magnitudes of the deviation angle A1 and the deviation angle A2, the control mode of the front wheel permanent magnet motor and the control mode of the rear wheel permanent magnet motor are selected respectively.
[0010] Preferably, the steps of obtaining the steering angle θ1 and the steering angle θ2 are as follows:
[0011] Construct a cross coordinate system with the AGV's length direction as the y-axis and the AGV's width direction as the x-axis;
[0012] Obtain the velocity component V1y of the front wheel velocity V1 in the y-axis direction and the velocity component V2y of the rear wheel velocity V2 in the y-axis direction respectively;
[0013] Obtain the velocity difference between the velocity component V1y and the velocity component V2y;
[0014] The steering angle θ1 is calculated based on the speed difference, the speed component V1y of the front wheel speed V1 in the y-axis direction, and the speed component V1x of the front wheel speed V1 in the x-axis direction;
[0015] The steering angle θ2 is calculated based on the speed difference, the speed component V2y of the front wheel speed V2 in the y-axis direction, and the speed component V2x of the front wheel speed V2 in the x-axis direction;
[0016] The formula for obtaining the steering angle θ1 is as follows:
[0017]
[0018] The formula for obtaining the steering angle θ2 is as follows:
[0019]
[0020] Where ΔV is the speed difference, and A is the angle between the center line of the front and rear wheels relative to the center axis of the AGV.
[0021] Preferably, the control mode includes a first control mode and a second control mode;
[0022] When the deviation angle A1 or the deviation angle A2 is smaller than the angle threshold, the first control mode is adopted;
[0023] When the deviation angle A1 or the deviation angle A2 is greater than the angle threshold, the first control method is used to make the speed of the permanent magnet motor reach the speed threshold, and then the second control method is used.
[0024] Preferably, the first control method is to use the MTPA current control method to generate corresponding d-axis and q-axis currents, and input the corresponding d-axis current and q-axis current into the controller to drive the front wheel or the rear wheel to rotate.
[0025] Preferably, the second control mode is:
[0026] Get the given current I of the q axis in real time qRef , the given current I qRef Input to the low-pass filter to get the first parameter I' qRef ;
[0027] Get the feedback current I of the q axis in real time q , the given current I q Input to the low-pass filter to obtain the second parameter I' q ;
[0028] Get the first parameter I' qRef and the second parameter I′ q The difference E is used as the input of the PI controller to obtain the current feedback given term D1;
[0029] According to the rated current I n and rated speed ω n Calculate the amplification factor Kc of the feedforward given term of the weak magnetic current;
[0030] The speed increment of the current weak magnetic field is obtained, and the speed increment is adjusted by the amplification factor Kc to obtain the current feedback given item D2;
[0031] The d-axis current I is obtained by adding the feedback given term D1 and the feedforward given term D2. d ;
[0032] The q-axis current limit value is obtained through the maximum current and the d-axis current, and the q-axis current limit value is updated as the current q-axis current;
[0033] The corresponding d-axis current and q-axis current are input into the controller to drive the front wheel or rear wheel to rotate.
[0034] Preferably, the formula for obtaining the current feedback given term D1 is as follows:
[0035] D1(t)=K p E(t)+K i ∫E(t)dt;
[0036] Where t is time, K p With K i They are the proportional gain coefficient and the integral gain coefficient in the PI controller respectively;
[0037] The formula for obtaining the amplification factor Kc is as follows:
[0038]
[0039] Among them I n is the rated current, ωn is the rated speed;
[0040] The formula for obtaining the feedforward given item D2 is as follows:
[0041] D2=-(S t -S z )×Kc|; where S t is the target speed, S z is the speed threshold.
[0042] The formula for obtaining the limit value of the q-axis current is as follows:
[0043]
[0044] Among them I max is the maximum output current, I d is the current of d axis.
[0045] An AGV steering wheel control system based on a permanent magnet motor, using the AGV steering wheel control method based on a permanent magnet motor, comprising a data acquisition module, a steering angle calculation module, a deviation calculation module and a control module;
[0046] The acquisition module is used to acquire the position of the AGV in real time. When the AGV enters a turning point, the traveling speed V of the AGV and the tangent angle b of the trajectory are acquired, wherein the traveling speed V includes the front wheel speed V1 and the rear wheel speed V2;
[0047] The steering angle calculation module is used to calculate the front wheel steering angle θ1 and the rear wheel steering angle θ2 according to the travel speed V of the unmanned guided vehicle;
[0048] The deviation calculation module is used to obtain the deviation angle A1 of the front wheel and the deviation angle A2 of the rear wheel according to the steering angle θ1, the steering angle θ2 and the tangent angle b of the trajectory;
[0049] The control module is used to select the control mode of the front wheel permanent magnet motor and the control mode of the rear wheel permanent magnet motor according to the size of the deviation angle A1 and the deviation angle A2.
[0050] Preferably, the steering angle calculation module includes a coordinate construction submodule, a component acquisition submodule and a calculation submodule;
[0051] The coordinate construction submodule is used to construct a cross coordinate system, with the length direction of the AGV as the y-axis and the width direction of the AGV as the x-axis;
[0052] The component acquisition submodule is used to respectively acquire the speed component V1y of the front wheel speed V1 in the y-axis direction and the speed component V2y of the rear wheel speed V2 in the y-axis direction;
[0053] The calculation submodule is used to calculate the steering angle θ1 according to the speed difference, the speed component V1y of the front wheel speed V1 in the y-axis direction, and the speed component V1x of the front wheel speed V1 in the x-axis direction;
[0054] The steering angle θ2 is calculated based on the speed difference, the speed component V2y of the front wheel speed V2 in the y-axis direction, and the speed component V2x of the front wheel speed V2 in the x-axis direction.
[0055] Preferably, the control module includes a first control submodule and a second control submodule;
[0056] The first control submodule is used to adopt a first control mode when the deviation angle A1 or the deviation angle A2 is less than the angle threshold;
[0057] The second control submodule is used for adopting the second control mode after adopting the first control mode to make the speed of the permanent magnet motor reach the speed threshold when the deviation angle A1 or the deviation angle A2 is greater than the angle threshold.
[0058] One of the above technical solutions has the following advantages or beneficial effects: The present invention achieves high-precision, high-efficiency and high-safety unmanned guided vehicle navigation and control by acquiring the position, speed and trajectory information of the AGV in real time, and performing precise speed adjustment and steering control, as well as intelligent motor control selection based on the information. BRIEF DESCRIPTION OF THE DRAWINGS
[0059] Figure 1 1 is a schematic diagram of the decomposition of the front and rear wheel speeds of an AGV in one embodiment of the present invention.
[0060] Figure 2 is a flow chart of an embodiment of the method of the present invention.
[0061] Figure 3 It is a schematic diagram of the structure of an embodiment of the system of the present invention. DETAILED DESCRIPTION
[0062] The embodiments of the present invention are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals represent the same or similar elements or elements having the same or similar functions from beginning to end. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present invention, and cannot be understood as limiting the present invention.
[0063] In the description of the embodiments of the present invention, the terms "first" and "second" are used for descriptive purposes only and are not to be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Thus, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the embodiments of the present invention, the meaning of "plurality" is two or more, unless otherwise clearly and specifically defined.
[0064] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the present invention, unless otherwise specified, the meaning of "plurality" is two or more. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0065] like Figures 1 to 3 As shown, a method for controlling an AGV steering wheel based on a permanent magnet motor includes the following steps:
[0066] The position of the AGV is obtained in real time. When the AGV enters a turning point, the traveling speed V of the AGV and the tangent angle b of the trajectory are obtained, wherein the traveling speed V includes the front wheel speed V1 and the rear wheel speed V2;
[0067] According to the traveling speed V of the unmanned guided vehicle, the steering angle θ1 of the front wheels and the steering angle θ2 of the rear wheels are calculated respectively;
[0068] Obtain the deviation angle A1 of the front wheel and the deviation angle A2 of the rear wheel according to the steering angle θ1, the steering angle θ2 and the tangent angle b of the trajectory;
[0069] According to the magnitudes of the deviation angle A1 and the deviation angle A2, the control mode of the front wheel permanent magnet motor and the control mode of the rear wheel permanent magnet motor are selected respectively.
[0070] like Figure 1As shown, the present invention is applied to a dual-steering wheel AGV trolley, in which a front wheel and a rear wheel are respectively provided, and the front wheel and the rear wheel are respectively steered by a separate permanent magnet motor. When planning the trajectory, the turning point can be marked. When the AGV travels along the trajectory, it can be judged whether it has entered the turning point according to its own position. When it contacts the turning point, it is necessary to obtain the current AGV's travel speed and the tangent angle b of the trajectory. Then, the steering angle between the front wheel and the rear wheel is obtained, and the steering angle is compared with the tangent angle b of the trajectory to immediately judge whether the steering of the front wheel or the rear wheel is deviated. When the deviation angle A1 or the deviation angle A2 is not 0, it means that the steering of the front wheel or the rear wheel is deviated, so that the AGV cannot effectively turn along the trajectory. At this time, it is necessary to continue to compensate for the deviation angle of the front wheel and the rear wheel, so that the steering angle of the front and rear wheels is consistent with the tangent angle b of the trajectory. Since the speed needs to be adjusted in a very short time, the permanent magnet motor needs to use a higher speed to adjust the steering angle so that the front and rear wheels can be adjusted quickly. However, when the deviation angle is too large, the permanent magnet motor will enter the stage of weak magnetic control. Therefore, it is necessary to select the corresponding control method of the permanent magnet motor according to the deviation angle A1 and the deviation angle A2 to achieve fast and smooth steering adjustment.
[0071] The present invention achieves high-precision, high-efficiency and high-safety unmanned guided vehicle navigation and control by acquiring the position, speed and trajectory information of the AGV in real time, and performing precise speed adjustment and steering control and intelligent motor control selection accordingly.
[0072] Preferably, the steps of obtaining the steering angle θ1 and the steering angle θ2 are as follows:
[0073] Construct a cross coordinate system with the AGV's length direction as the y-axis and the AGV's width direction as the x-axis;
[0074] Obtain the velocity component V1y of the front wheel velocity V1 in the y-axis direction and the velocity component V2y of the rear wheel velocity V2 in the y-axis direction respectively;
[0075] Obtain the velocity difference between the velocity component V1y and the velocity component V2y;
[0076] The steering angle θ1 is calculated based on the speed difference, the speed component V1y of the front wheel speed V1 in the y-axis direction, and the speed component V1x of the front wheel speed V1 in the x-axis direction;
[0077] The steering angle θ2 is calculated based on the speed difference, the speed component V2y of the front wheel speed V2 in the y-axis direction, and the speed component V2x of the front wheel speed V2 in the x-axis direction;
[0078] The formula for obtaining the steering angle θ1 is as follows:
[0079]
[0080] The formula for obtaining the steering angle θ2 is as follows:
[0081]
[0082] Where ΔV is the speed difference, and A is the angle between the center line of the front and rear wheels relative to the center axis of the AGV.
[0083] By directly measuring and calculating the speed difference between the front and rear wheels on the y-axis (i.e. the AGV's forward direction), the dynamic behavior of the AGV during steering can be more accurately evaluated. This calculation method based on the actual velocity component can more directly reflect the actual situation of steering than the traditional method based on sensors such as gyroscopes or encoders, and helps to improve the accuracy of steering control.
[0084] In addition, the steering angle is compensated by the speed difference, which can compensate for the system errors caused by mechanical wear, load changes or external environmental factors (such as uneven ground) to a certain extent, thereby improving the stability and robustness of the entire AGV system.
[0085] Preferably, the control mode includes a first control mode and a second control mode;
[0086] When the deviation angle A1 or the deviation angle A2 is smaller than the angle threshold, the first control mode is adopted;
[0087] When the deviation angle A1 or the deviation angle A2 is greater than the angle threshold, the first control method is used to make the speed of the permanent magnet motor reach the speed threshold, and then the second control method is used.
[0088] In the control of a permanent magnet motor, the corresponding rotation control of the permanent magnet motor is achieved by controlling the input current.
[0089] When adjusting the deviation angle of the front wheel or rear wheel by adjusting the rotation of the permanent magnet motor, in order to adjust as quickly as possible, a relatively large current is generally used for control. At this time, the speed of the permanent magnet motor will be gradually increased stably. Moreover, there is a linear relationship between the number of rotations of the permanent magnet motor and the angles rotated by the front and rear wheels. Therefore, in the process of gradually increasing the speed stably, when the speed of the permanent magnet motor reaches the speed threshold, the steering angle of the front wheel or rear wheel is fixed. When the deviation angle A1 or the deviation angle A2 is less than the angle threshold, the permanent magnet motor has not reached the speed threshold in the process of gradually increasing the speed, and the adjustment of the front wheel or rear wheel can be satisfied. Therefore, at this time, it is only necessary to control the current of the permanent magnet motor by the first control method. When the deviation angle A1 or the deviation angle A2 is greater than the angle threshold, it means that after the speed of the permanent magnet motor reaches the threshold, the deviation angle A1 or the deviation angle A2 has not yet completed the adjustment, so that it is the same as the tangent angle b of the trajectory. However, at this time, the permanent magnet motor has entered the stage of weak magnetic control, so at this time, it can only be replaced with the second control method to realize the current control of the permanent magnet motor. If the permanent magnet motor continues to use the first control method to adjust the current when it enters the weak magnetic field control stage, the permanent magnet motor will not be able to work smoothly. At this time, jitter may occur, affecting the accuracy of angle adjustment.
[0090] Preferably, the first control method is to use the MTPA current control method to generate corresponding d-axis and q-axis currents, and input the corresponding d-axis current and q-axis current into the controller to drive the front wheel or the rear wheel to rotate.
[0091] In one embodiment of the present invention, the current I d Set it to 0 and then calculate the minimum current I q To generate as much torque as possible, so that the motor can quickly increase the speed and quickly adjust the steering angle of the front or rear wheels.
[0092] Since the d-axis current of the motor is always zero under the control mode of Id=0, the electromagnetic interference and vibration caused by the change of the d-axis current are reduced, which helps to maintain the stable operation of the permanent magnet motor.
[0093] Preferably, the second control mode is:
[0094] Get the given current I of the q axis in real time qRef , the given current I qRef Input to the low-pass filter to get the first parameter I' qRef ;
[0095] Get the feedback current I of the q axis in real time q , the given current I q Input to the low-pass filter to obtain the second parameter I' q;
[0096] By acquiring the given current and feedback current of the q-axis in real time and applying a low-pass filter for processing, more stable and accurate current parameters can be obtained. This method helps to accurately control the operation of the motor and improve stability and reliability.
[0097] Get the first parameter I' qRef and the second parameter I′ q The difference E is used as the input of the PI controller to obtain the current feedback given term D1;
[0098] By calculating the difference E between the given current and the feedback current and using it as the input of the PI controller, a feedback given term D1 for adjusting the current can be obtained. The PI controller can effectively reduce the error and improve the accuracy of current control.
[0099] According to the rated current I n and rated speed ω n The amplification factor Kc of the feedforward given item of the weak magnetic current is calculated; the calculated amplification factor Kc is determined based on the rated current and rated speed of the motor, and the speed increment is adjusted by the amplification factor Kc, which can ensure that the motor runs in an efficient and stable state.
[0100] The speed increment of the current weak magnetic field is obtained, and the speed increment is adjusted by the amplification factor Kc to obtain the current feedback given item D2;
[0101] The d-axis current I is obtained by adding the feedback given term D1 and the feedforward given term D2. d ;
[0102] The q-axis current limit value is obtained through the maximum current and the d-axis current, and the q-axis current limit value is updated as the current q-axis current;
[0103] The corresponding d-axis current and q-axis current are input into the controller to drive the front wheel or rear wheel to rotate.
[0104] By selecting the maximum limit value of the q-axis current as the input of the q-axis current, the permanent magnet motor can be driven to rotate at the fastest speed while ensuring the stable operation of the permanent magnet motor, thereby speeding up the adjustment speed of the steering angle of the front or rear wheels.
[0105] Preferably, the formula for obtaining the current feedback given term D1 is as follows:
[0106] D1(t)=K p E(t)+K i ∫E(t)dt;
[0107] Where t is time, K p With Ki They are the proportional gain coefficient and the integral gain coefficient in the PI controller respectively;
[0108] The formula for obtaining the amplification factor Kc is as follows:
[0109]
[0110] Among them I n is the rated current, ω n is the rated speed;
[0111] The formula for obtaining the feedforward given item D2 is as follows:
[0112] D2=-(S t -S z )×Kc|; where S t is the target speed, S z is the speed threshold.
[0113] The formula for obtaining the limit value of the q-axis current is as follows:
[0114]
[0115] Among them I max is the maximum output current, I d is the current of d axis.
[0116] An AGV steering wheel control system based on a permanent magnet motor, using the AGV steering wheel control method based on a permanent magnet motor, comprising a data acquisition module, a steering angle calculation module, a deviation calculation module and a control module;
[0117] The acquisition module is used to acquire the position of the AGV in real time. When the AGV enters a turning point, the traveling speed V of the AGV and the tangent angle b of the trajectory are acquired, wherein the traveling speed V includes the front wheel speed V1 and the rear wheel speed V2;
[0118] The steering angle calculation module is used to calculate the front wheel steering angle θ1 and the rear wheel steering angle θ2 according to the travel speed V of the unmanned guided vehicle;
[0119] The deviation calculation module is used to obtain the deviation angle A1 of the front wheel and the deviation angle A2 of the rear wheel according to the steering angle θ1, the steering angle θ2 and the tangent angle b of the trajectory;
[0120] The control module is used to select the control mode of the front wheel permanent magnet motor and the control mode of the rear wheel permanent magnet motor according to the size of the deviation angle A1 and the deviation angle A2.
[0121] Preferably, the steering angle calculation module includes a coordinate construction submodule, a component acquisition submodule and a calculation submodule;
[0122] The coordinate construction submodule is used to construct a cross coordinate system, with the length direction of the AGV as the y-axis and the width direction of the AGV as the x-axis;
[0123] The component acquisition submodule is used to respectively acquire the speed component V1y of the front wheel speed V1 in the y-axis direction and the speed component V2y of the rear wheel speed V2 in the y-axis direction;
[0124] The calculation submodule is used to calculate the steering angle θ1 according to the speed difference, the speed component V1y of the front wheel speed V1 in the y-axis direction, and the speed component V1x of the front wheel speed V1 in the x-axis direction;
[0125] The steering angle θ2 is calculated based on the speed difference, the speed component V2y of the front wheel speed V2 in the y-axis direction, and the speed component V2x of the front wheel speed V2 in the x-axis direction.
[0126] Preferably, the control module includes a first control submodule and a second control submodule;
[0127] The first control submodule is used to adopt a first control mode when the deviation angle A1 or the deviation angle A2 is less than the angle threshold;
[0128] The second control submodule is used for adopting the second control mode after adopting the first control mode to make the speed of the permanent magnet motor reach the speed threshold when the deviation angle A1 or the deviation angle A2 is greater than the angle threshold.
[0129] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "illustrative embodiments", "examples", "specific examples", or "some examples" means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.
[0130] Although the embodiments of the present invention have been shown and described above, it is to be understood that the above embodiments are exemplary and are not to be construed as limitations of the present invention. A person skilled in the art may make changes, modifications, substitutions and variations to the above embodiments within the scope of the present invention.
Claims
1. A method for controlling an AGV steering wheel based on a permanent magnet motor, characterized in that: The steps include: Acquire the position of the AGV in real time. When the AGV enters a turning point, acquire the AGV's travel speed V and the tangent angle b of the trajectory, where the travel speed V includes the front wheel speed V1 and the rear wheel speed V2; According to the travel speed V of the automated guided vehicle, the front wheel steering angle θ1 and the rear wheel steering angle θ2 are calculated respectively; Obtain the front wheel deviation angle A1 and the rear wheel deviation angle A2 according to the steering angle θ1, the steering angle θ2, and the tangent angle b of the trajectory; According to the size of the deviation angle A1 and the deviation angle A2, the control mode of the front wheel permanent magnet motor and the control mode of the rear wheel permanent magnet motor are selected respectively.
2. The AGV steering wheel control method based on a permanent magnet motor according to claim 1, characterized in that: The steps for obtaining the steering angle θ1 and the steering angle θ2 are as follows: Construct a cross coordinate system with the AGV's length direction as the y-axis and the AGV's width direction as the x-axis; Obtain the velocity component V1y of the front wheel velocity V1 in the y-axis direction and the velocity component V2y of the rear wheel velocity V2 in the y-axis direction respectively; Obtain the velocity difference between the velocity component V1y and the velocity component V2y; The steering angle θ1 is calculated based on the speed difference, the speed component V1y of the front wheel speed V1 in the y-axis direction, and the speed component V1x of the front wheel speed V1 in the x-axis direction; The steering angle θ2 is calculated based on the speed difference, the speed component V2y of the front wheel speed V2 in the y-axis direction, and the speed component V2x of the front wheel speed V2 in the x-axis direction; The formula for obtaining the steering angle θ1 is as follows: The formula for obtaining the steering angle θ2 is as follows: Where ΔV is the speed difference, and A is the angle between the center line of the front and rear wheels relative to the center axis of the AGV.
3. The AGV steering wheel control method based on a permanent magnet motor according to claim 1, characterized in that: The control mode includes a first control mode and a second control mode; When the deviation angle A1 or the deviation angle A2 is smaller than the angle threshold, the first control mode is adopted; When the deviation angle A1 or the deviation angle A2 is greater than the angle threshold, the first control method is used to make the speed of the permanent magnet motor reach the speed threshold, and then the second control method is used.
4. The AGV steering wheel control method based on a permanent magnet motor according to claim 3 is characterized in that: The first control method is to use the MTPA current control method to generate corresponding d-axis and q-axis currents, and input the corresponding d-axis current and q-axis current into the controller to drive the front wheel or the rear wheel to rotate.
5. The AGV steering wheel control method based on a permanent magnet motor according to claim 3 is characterized in that: The second control mode is: Get the given current I of the q axis in real time qRef , the given current I qRef Input to the low-pass filter to get the first parameter I' qRef ; Get the feedback current I of the q axis in real time q , the given current I q Input to the low-pass filter to obtain the second parameter I' q ; Get the first parameter I q ' Ref With the second parameter I q The difference E of ′ is used as the input of the PI controller to obtain the current feedback given term D1; According to the rated current I n and rated speed ω n Calculate the amplification coefficient Kc of the feedforward given term of the weakening magnetic current; obtain the current weakening speed increment, adjust the speed increment by the amplification coefficient Kc, and obtain the current feedback given term D2; The d-axis current I is obtained by adding the feedback given term D1 and the feedforward given term D2. d ; The q-axis current limit value is obtained through the maximum current and the d-axis current, and the q-axis current limit value is updated as the current q-axis current; The corresponding d-axis current and q-axis current are input into the controller to drive the front or rear wheels to rotate.
6. The method for controlling an AGV steering wheel based on a permanent magnet motor according to claim 5, characterized in that: The formula for obtaining the current feedback given term D1 is as follows: D1(t)=K p E(t)+K i ∫E(t)dt; Where t is time, K p With K i are the proportional gain coefficient and integral gain coefficient in the PI controller respectively; The formula for obtaining the amplification coefficient Kc is as follows: Among them I n is the rated current, ω n is the rated speed; The formula for obtaining the feedforward given item D2 is as follows: D2=-|(S t -S z )×Kc|; where S t is the target speed, S z is the speed threshold; The formula for obtaining the limit value of the q-axis current is as follows: Among them I max is the maximum output current, I d is the current of the d-axis.
7. An AGV steering wheel control system based on a permanent magnet motor, characterized in that: An AGV steering wheel control method based on a permanent magnet motor according to any one of claims 1 to 6 comprises a data acquisition module, a steering angle calculation module, a deviation calculation module and a control module; The acquisition module is used to acquire the position of the AGV in real time. When the AGV enters a turning point, the AGV's travel speed V and the tangent angle b of the trajectory are acquired, wherein the travel speed V includes the front wheel speed V1 and the rear wheel speed V2; The steering angle calculation module is used to calculate the front wheel steering angle θ1 and the rear wheel steering angle θ2 according to the travel speed V of the unmanned guided vehicle; The deviation calculation module is used to obtain the deviation angle A1 of the front wheel and the deviation angle A2 of the rear wheel according to the steering angle θ1, the steering angle θ2 and the tangent angle b of the trajectory; The control module is used to select a control mode for the front wheel permanent magnet motor and a control mode for the rear wheel permanent magnet motor according to the magnitudes of the deviation angle A1 and the deviation angle A2.
8. The AGV steering wheel control system based on a permanent magnet motor according to claim 7, characterized in that: The steering angle calculation module includes a coordinate construction submodule, a component acquisition submodule and a calculation submodule; The coordinate construction submodule is used to construct a cross coordinate system with the AGV's length direction as the y-axis and the AGV's width direction as the x-axis; The component acquisition submodule is used to respectively acquire the speed component V1y of the front wheel speed V1 in the y-axis direction and the speed component V2y of the rear wheel speed V2 in the y-axis direction; The calculation submodule is used to calculate the steering angle θ1 according to the speed difference, the speed component V1y of the front wheel speed V1 in the y-axis direction, and the speed component V1x of the front wheel speed V1 in the x-axis direction; The steering angle θ2 is calculated based on the speed difference, the speed component V2y of the front wheel speed V2 in the y-axis direction, and the speed component V2x of the front wheel speed V2 in the x-axis direction.
9. The AGV steering wheel control system based on a permanent magnet motor according to claim 7, characterized in that: The control module includes a first control submodule and a second control submodule; The first control submodule is configured to adopt a first control mode when the deviation angle A1 or the deviation angle A2 is less than an angle threshold; The second control submodule is configured to, when the deviation angle A1 or the deviation angle A2 is greater than the angle threshold, adopt a first control method to make the speed of the permanent magnet motor reach the speed threshold, and then adopt a second control method.
Citation Information
Patent Citations
Turning control system of AGV
CN111376732A
Layered fault-tolerant control method for four-wheel independent electrically-driven port AGV
CN114987226A
Advanced navigation and guidance system and method for an automatic guided vehicle (AGV)
US20120316722A1
Cited By
Omnidirectional unmanned forklift steering control system and method
CN120774360A
BLDCM coordination control method for multi-motor vehicle
CN120921948A
