Jacking type AGV control method based on permanent magnet motor

By using permanent magnet motor control method in the jacking AGV, precise control of goods and pallets is achieved through image acquisition and inertia calculation, the problems of unstable cargo position and mismatch of rotation inertia are solved, and the handling efficiency and Safety, reducing manual intervention.

CN119093812AActive Publication Date: 2024-12-06GUANGDONG TIANTAI ROBOT CO LTD
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202411236779.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-12-06
Estimated Expiration
2044-09-04

AI Technical Summary

Technical Problem

When transporting goods, the lifting AGV causes handling errors and safety hazards due to unstable cargo position and mismatched rotational inertia, which affects the working efficiency and the stability of cargo stacking.

Method used

The control method based on the permanent magnet motor is adopted, and the midpoint distance between the goods and the pallet is obtained through the image acquisition device, the rotation inertia moment is calculated and the motor angular velocity is adjusted, and the appropriate d-axis and q-axis currents are selected to achieve precise control and stable rotation.

Benefits of technology

It reduces handling errors and safety hazards caused by inaccurate cargo position or mismatch inertia, improves handling efficiency and safety, reduces the need for manual intervention, and reduces labor costs.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119093812A_ABST
    Figure CN119093812A_ABST
Patent Text Reader

Abstract

A control method of a jacking type AGV based on a permanent magnet motor comprises the following steps that a plurality of image obtaining devices are arranged in a line through which the AGV passes, and the image obtaining devices are used for obtaining orthographic projection images when the AGV carries goods; in the orthographic projection image, obtaining a midpoint of the cargo, a vertical distance and a horizontal distance; obtaining the weight of the goods, and obtaining an adjustment coefficient of rotational inertia in a preset adjustment coefficient table according to the weight of the goods and the horizontal distance; according to the vertical distance and the weight of the goods, the initial rotation inertia of the goods is obtained; obtaining the angular velocity V1 of the chassis motor, and calculating the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotation inertia; through accurate calculation and real-time adjustment, carrying errors and potential safety hazards caused by inaccurate cargo positions or mismatched rotation inertia can be reduced, and therefore carrying efficiency and safety are improved. Meanwhile, the intelligent control also reduces the need of manual intervention, and reduces the labor cost.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of permanent magnet motor regulation, and in particular to a control method of a jacking-type AGV based on a permanent magnet motor. Background Art

[0002] The jack-up AGV is an automatic guided vehicle that can lift up and down. When in use, the jack-up AGV is generally driven to move to the top of the shelf, and then the pallet on the top of the AGV is driven to lift up the shelf and the goods on the shelf.

[0003] In order to facilitate the stacking of goods, the general top-lift AGV has the function of keeping the goods in position, that is, while controlling the chassis to turn the AGV, the pallet is controlled to rotate in the opposite direction, so that the goods remain in the same position.

[0004] However, the weight of the cargo on the top load shelf of the AGV is uncertain and constantly changes with the working conditions, so the influence of its friction and inertia on the load pallet is also constantly changing; in addition, when the AGV body itself runs on different road surfaces (such as bumps and insufficient friction), the actual vehicle speed and the issued reference speed will have large deviations and fluctuations. In this case, the control stability and accuracy of the top load pallet cannot be guaranteed. This ultimately leads to changes in the posture of the cargo. During palletizing, the change in posture will cause the cargo to be unable to be stacked in the correct way, and manual intervention is required at this time. This greatly affects the work efficiency and the stability of the overall structure of the cargo pile after stacking. Summary of the invention

[0005] In view of the above-mentioned defects, the purpose of the present invention is to propose a control method for a lifting AGV based on a permanent magnet motor, which solves the problems of handling errors and safety hazards caused by the inability to maintain the position of the goods or the mismatch of the rotational inertia.

[0006] To achieve this purpose, the present invention adopts the following technical solution: a control method of a jacking AGV based on a permanent magnet motor, comprising the following steps:

[0007] Step S1: multiple image acquisition devices are arranged in the route through which the AGV passes, and the image acquisition devices are used to acquire the orthographic projection image of the AGV when it is transporting goods;

[0008] Step S2: in the orthographic projection image, obtain the midpoint of the cargo, and obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the cargo;

[0009] Step S3: Obtain the weight of the cargo, and obtain the adjustment coefficient of rotational inertia from a preset adjustment coefficient table according to the weight of the cargo and the horizontal distance;

[0010] Obtain the preliminary rotational inertia of the cargo based on the vertical distance and the weight of the cargo;

[0011] The preliminary rotational inertia is adjusted according to the adjustment coefficient of the rotational inertia to obtain the final rotational inertia;

[0012] Step S4: obtaining the angular velocity V1 of the chassis motor, and calculating the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotational inertia;

[0013] Step S5: Select the corresponding d-axis current and q-axis current according to the angular velocity V2 of the tray motor.

[0014] Preferably, the specific steps in step S2 are as follows:

[0015] The orthographic projection image is processed using the Otsu law to obtain a binarization threshold used for the orthographic projection image;

[0016] Binarize the orthographic projection image based on a binarization threshold to obtain a second image;

[0017] Perform contour extraction in the second image;

[0018] Obtain the longest rectangle in the horizontal direction in the second image as the first rectangle;

[0019] The rectangle with the largest area connected above the first rectangle is used as the second rectangle, and the rectangle with the longest horizontal area connected below the first rectangle is used as the third rectangle;

[0020] The midpoints of the second rectangle and the third rectangle are obtained respectively, and the midpoint of the second rectangle is used as the midpoint of the cargo, and the midpoint of the third rectangle is used as the midpoint of the pallet.

[0021] Preferably, the calculation formula of the preliminary rotational inertia in step S3 is as follows:

[0022] Y=m*L 2 ;

[0023] Where m is the weight of the goods, and L is the vertical distance between the midpoint of the upper pallet and the midpoint of the goods.

[0024] Preferably, the calculation formula of the angular velocity V2 in step S4 is as follows:

[0025]

[0026] Where Y′ is the final rotational inertia, I q1 is the q-axis current of the chassis motor, k t is the maximum torque of the tray motor, B is the viscous friction coefficient, C is the integral constant, T Lis the torque of the pallet motor after loading the goods.

[0027] Preferably, the specific steps of step S5 are as follows:

[0028] Determine whether the angular velocity V2 is greater than the velocity threshold. If it is less than the velocity threshold, use the MTPA current control method to generate the corresponding d-axis and q-axis currents.

[0029] If it is greater than, the d-axis current is obtained according to the operating parameters, design parameters and target speed of the motor, and the limit value of the q-axis current is obtained according to the maximum current and the d-axis current.

[0030] Preferably, the steps of obtaining the current of the d-axis according to the operating parameters, design parameters and target speed of the motor are as follows:

[0031] 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 q ' Ref ;

[0032] Get the feedback current I of the q axis in real time q2 , the given current I q Input to the low-pass filter to obtain the second parameter I q ′;

[0033] 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;

[0034] 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;

[0035] 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;

[0036] The d-axis current I is obtained by adding the feedback given term D1 and the feedforward given term D2. d2 .

[0037] Preferably, the formula for obtaining the current feedback given term D1 is as follows:

[0038] D1(t)=K p E(t)+K i ∫E(t)dt;

[0039] Where t is time, K pWith K i They are the proportional gain coefficient and the integral gain coefficient in the PI controller respectively;

[0040] The formula for obtaining the amplification factor Kc is as follows:

[0041]

[0042] Among them I n is the rated current, ω n is the rated speed;

[0043] The formula for obtaining the feedforward given item D2 is as follows:

[0044] D2=-|(ω2-S z )×Kc|; where S z is the speed threshold.

[0045] Preferably, the formula for obtaining the limit value of the q-axis current is as follows:

[0046]

[0047] Among them I max is the maximum output current, I d2 is the current of d axis.

[0048] A control system for a jack-up AGV based on a permanent magnet motor, using a control method for a jack-up AGV based on a permanent magnet motor, comprising an image acquisition module, a determination module, a coefficient module, a regulation module and a control module.

[0049] The image acquisition module is used to set a plurality of image acquisition devices in the route through which the AGV passes, and the image acquisition devices are used to acquire the orthographic projection image of the AGV when carrying goods;

[0050] The determination module is used to obtain the midpoint of the goods in the orthographic projection image, and obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the goods;

[0051] The coefficient module is used to obtain the weight of the goods, and obtain the adjustment coefficient of the rotational inertia in a preset adjustment coefficient table according to the weight of the goods and the horizontal distance;

[0052] Obtain the preliminary rotational inertia of the cargo based on the vertical distance and the weight of the cargo;

[0053] The preliminary rotational inertia is adjusted according to the adjustment coefficient of the rotational inertia to obtain the final rotational inertia;

[0054] The regulating module is used to obtain the angular velocity V1 of the chassis motor, and calculate the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotational inertia;

[0055] The control module is used to select corresponding d-axis current and q-axis current according to the angular velocity V2 of the tray motor.

[0056] One of the above technical solutions has the following advantages or beneficial effects: the present invention can reduce handling errors and safety hazards caused by inaccurate cargo position or mismatched rotational inertia through precise calculation and real-time adjustment, thereby improving handling efficiency and safety. At the same time, intelligent control also reduces the need for manual intervention and reduces labor costs. BRIEF DESCRIPTION OF THE DRAWINGS

[0057] Figure 1 is a flow chart of an embodiment of the method of the present invention.

[0058] Figure 2 It is a schematic diagram of the structure of an embodiment of the system of the present invention.

[0059] Figure 3 It is a contour diagram of the orthographic projection of an embodiment of the present invention. DETAILED DESCRIPTION

[0060] 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.

[0061] 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.

[0062] 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.

[0063] like Figures 1 to 3 As shown, a control method of a lifting AGV based on a permanent magnet motor includes the following steps:

[0064] Step S1: multiple image acquisition devices are arranged in the route through which the AGV passes, and the image acquisition devices are used to acquire the orthographic projection image of the AGV when it is transporting goods;

[0065] Step S2: in the orthographic projection image, obtain the midpoint of the cargo, and obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the cargo;

[0066] Step S3: Obtain the weight of the cargo, and obtain the adjustment coefficient of rotational inertia from a preset adjustment coefficient table according to the weight of the cargo and the horizontal distance;

[0067] Obtain the preliminary rotational inertia of the cargo based on the vertical distance and the weight of the cargo;

[0068] The preliminary rotational inertia is adjusted according to the adjustment coefficient of the rotational inertia to obtain the final rotational inertia;

[0069] Step S4: obtaining the angular velocity V1 of the chassis motor, and calculating the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotational inertia;

[0070] Step S5: Select the corresponding d-axis current and q-axis current according to the angular velocity V2 of the tray motor.

[0071] Before the AGV lifts the goods, it will align the position according to the sensing points on the shelf. The center of the pallet is aligned with the center of the shelf. However, there may be alignment deviations. At this time, because the center of mass of the goods is not on the same vertical line as the center of the pallet, the pallet will be affected by the weight of the goods above when it rotates, resulting in different rotation angles of the pallet and the chassis at the same speed, so that the goods cannot maintain the same posture relative to the ground.

[0072] To this end, in the present invention, multiple image acquisition devices are set in the use space of the AGV, wherein the image acquisition device can be a camera. When the AGV is running, the orthographic image of the AGV when carrying goods will be acquired, and then the orthographic image will be analyzed to obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the goods. The corresponding rotational inertia adjustment coefficient and preliminary rotational inertia can be known from the vertical distance and horizontal distance. The rotational inertia adjustment coefficient can be obtained through multiple sets of experiments, wherein the experimental data can constitute the adjustment coefficient table shown below.

[0073]

[0074] After selecting the corresponding rotational inertia adjustment coefficient according to the weight of the cargo and the horizontal distance, the final rotational inertia can be obtained by multiplying the rotational inertia adjustment coefficient by the preliminary rotational inertia.

[0075] The final rotational inertia is a factor that affects the rotation of the tray. The angular velocity V2 can be adjusted by the final rotational inertia, so that when the tray and the chassis rotate at different angular velocities, the angles after rotation can be kept consistent.

[0076] However, since the adjusted angular velocity V2 may exceed the speed threshold, causing the tray motor to enter the weak magnetic field control stage, it is necessary to select different current control methods according to the size of the angular velocity V2.

[0077] The present invention can reduce handling errors and potential safety hazards caused by inaccurate cargo position or mismatched rotational inertia through precise calculation and real-time adjustment, thereby improving handling efficiency and safety. At the same time, intelligent control also reduces the need for manual intervention and reduces labor costs.

[0078] Preferably, the specific steps in step S2 are as follows:

[0079] The orthographic projection image is processed using the Otsu law to obtain a binarization threshold used for the orthographic projection image;

[0080] Binarize the orthographic projection image based on a binarization threshold to obtain a second image;

[0081] Perform contour extraction in the second image;

[0082] Obtain the longest rectangle in the horizontal direction in the second image as the first rectangle;

[0083] The rectangle with the largest area connected above the first rectangle is used as the second rectangle, and the rectangle with the longest horizontal area connected below the first rectangle is used as the third rectangle;

[0084] The midpoints of the second rectangle and the third rectangle are obtained respectively, and the midpoint of the second rectangle is used as the midpoint of the cargo, and the midpoint of the third rectangle is used as the midpoint of the pallet.

[0085] Since there is a background image in the orthographic projection image, in order to avoid the background image from affecting the vertical distance and horizontal distance, the orthographic projection image will be binarized first to obtain the second image, in which the background image has been removed. Figure 3As shown in the figure, since the transported shelf is generally wider than the goods, and the AGV is small in size, the shelf (first rectangle) can be quickly found through the longest rectangle in the horizontal direction in the extracted contour, and the goods (second rectangle) and pallet (third rectangle) above and below it can be quickly found through the shelf.

[0086] It is worth noting that when the image acquisition device takes a picture of the AGV, the image acquisition device will take the picture only when the AGV reaches the corresponding shooting point. This ensures that the relationship between the pixel points in each orthographic projection image and the actual distance remains unique, so that the actual horizontal distance and vertical distance can be better determined according to the midpoint of the second rectangle and the midpoint of the third rectangle.

[0087] Preferably, the calculation formula of the preliminary rotational inertia in step S3 is as follows:

[0088] Y=m*L 2 ;

[0089] Where m is the weight of the goods, and L is the vertical distance between the midpoint of the upper pallet and the midpoint of the goods.

[0090] Preferably, the calculation formula of the angular velocity V2 in step S4 is as follows:

[0091]

[0092] Where Y′ is the final rotational inertia, I q1 is the q-axis current of the chassis motor, k t is the maximum torque of the tray motor, B is the viscous friction coefficient, C is the integral constant, T L is the torque of the pallet motor after loading the goods.

[0093] Preferably, the specific steps of step S5 are as follows:

[0094] Determine whether the angular velocity V2 is greater than the velocity threshold. If it is less than the velocity threshold, use the MTPA current control method to generate the corresponding d-axis and q-axis currents.

[0095] If it is greater than, the d-axis current is obtained according to the operating parameters, design parameters and target speed of the motor, and the limit value of the q-axis current is obtained according to the maximum current and the d-axis current.

[0096] When the speed is greater than the threshold, the permanent magnet motor will enter the stage of weak magnetic control. At this time, in addition to ensuring the speed, it is also necessary to consider the stability during steering. Avoid unstable rotation causing the goods to deviate, thereby affecting the horizontal distance.

[0097] Preferably, the steps of obtaining the current of the d-axis according to the operating parameters, design parameters and target speed of the motor are as follows:

[0098] 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 ;

[0099] Get the feedback current I of the q axis in real time q2 , the given current I q Input to the low-pass filter to obtain the second parameter I' q ;

[0100] 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.

[0101] 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;

[0102] 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.

[0103] 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.

[0104] 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;

[0105] The d-axis current I is obtained by adding the feedback given term D1 and the feedforward given term D2. d2 .

[0106] In the present invention, feedback control and feedforward control are combined, and the d-axis current is obtained through a simple addition operation. The d-axis current can be accurately obtained without relying on a complex algorithm. The feedforward given item D1 of the weak magnetic current can improve the speed response of the motor speed during rapid switching, and the feedback given item of the weak magnetic current ensures the speed stability of the motor under heavy load conditions. The weak magnetic control method has low calculation amount, simple structure and high operation stability.

[0107] Preferably, the formula for obtaining the current feedback given term D1 is as follows:

[0108] D1(t)=K p E(t)+K i ∫E(t)dt;

[0109] 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;

[0110] The formula for obtaining the amplification factor Kc is as follows:

[0111]

[0112] Among them I n is the rated current, ω n is the rated speed;

[0113] The formula for obtaining the feedforward given item D2 is as follows:

[0114] D2=-|(ω2-S z )×Kc|; where S z is the speed threshold.

[0115] Preferably, the formula for obtaining the limit value of the q-axis current is as follows:

[0116]

[0117] Among them I max is the maximum output current, I d2 is the current of d axis.

[0118] Since the q-axis current is directly related to the electromagnetic torque, precise control of the q-axis current can ensure the torque required by the motor output. However, too high a q-axis current may cause the motor to overheat or be damaged. Therefore, by limiting the maximum value of the q-axis current command, it is possible to ensure that the motor operates within a safe range while optimizing the torque output. Too high a q-axis current may cause the motor to produce large torque fluctuations during dynamic response, affecting the stable operation of the motor. For this reason, in the present invention, the q-axis current is limited by the maximum output current and the d-axis, the purpose of which is to weaken the motor magnetic field, reduce the back electromotive force when the power input voltage is limited, and achieve the purpose of increasing the motor speed, so whether to switch to weak magnetic control will be determined based on the angular velocity of the permanent magnet motor.

[0119] A control system for a jack-up AGV based on a permanent magnet motor, using a control method for a jack-up AGV based on a permanent magnet motor, comprising an image acquisition module, a determination module, a coefficient module, a regulation module and a control module.

[0120] The image acquisition module is used to set a plurality of image acquisition devices in the route through which the AGV passes, and the image acquisition devices are used to acquire the orthographic projection image of the AGV when carrying goods;

[0121] The determination module is used to obtain the midpoint of the goods in the orthographic projection image, and obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the goods;

[0122] The coefficient module is used to obtain the weight of the goods, and obtain the adjustment coefficient of the rotational inertia in a preset adjustment coefficient table according to the weight of the goods and the horizontal distance;

[0123] Obtain the preliminary rotational inertia of the cargo based on the vertical distance and the weight of the cargo;

[0124] The preliminary rotational inertia is adjusted according to the adjustment coefficient of the rotational inertia to obtain the final rotational inertia;

[0125] The regulating module is used to obtain the angular velocity V1 of the chassis motor, and calculate the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotational inertia;

[0126] The control module is used to select corresponding d-axis current and q-axis current according to the angular velocity V2 of the tray motor.

[0127] 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.

[0128] 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 control method for a lifting AGV based on a permanent magnet motor, characterized in that: The steps include: Step S1: multiple image acquisition devices are arranged in the route through which the AGV passes, and the image acquisition devices are used to acquire the orthographic projection image of the AGV when it is transporting goods; Step S2: in the orthographic projection image, obtain the midpoint of the cargo, and obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the cargo; Step S3: Obtain the weight of the cargo, and obtain the adjustment coefficient of rotational inertia from a preset adjustment coefficient table according to the weight of the cargo and the horizontal distance; Obtain the preliminary rotational inertia of the cargo based on the vertical distance and the weight of the cargo; The preliminary rotational inertia is adjusted according to the adjustment coefficient of the rotational inertia to obtain the final rotational inertia; Step S4: obtaining the angular velocity V1 of the chassis motor, and calculating the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotational inertia; Step S5: Select the corresponding d-axis current and q-axis current according to the angular velocity V2 of the tray motor.

2. The control method of a lifting AGV based on a permanent magnet motor according to claim 1 is characterized in that: The specific steps in step S2 are as follows: The orthographic projection image is processed using the Otsu law to obtain a binarization threshold used for the orthographic projection image; Binarize the orthographic projection image based on a binarization threshold to obtain a second image; Perform contour extraction in the second image; Obtain the longest rectangle in the horizontal direction in the second image as the first rectangle; The rectangle with the largest area connected above the first rectangle is used as the second rectangle, and the rectangle with the longest horizontal area connected below the first rectangle is used as the third rectangle; The midpoints of the second rectangle and the third rectangle are obtained respectively, and the midpoint of the second rectangle is used as the midpoint of the cargo, and the midpoint of the third rectangle is used as the midpoint of the pallet.

3. The control method of a lifting AGV based on a permanent magnet motor according to claim 1 is characterized in that: The calculation formula of the preliminary rotational inertia in step S3 is as follows: Y=m*L 2 ; Where m is the weight of the goods, and L is the vertical distance between the midpoint of the upper pallet and the midpoint of the goods.

4. The control method of a lifting AGV based on a permanent magnet motor according to claim 1 is characterized in that: The calculation formula of the angular velocity V2 in step S4 is as follows: Where Y′ is the final rotational inertia, I q1 is the q-axis current of the chassis motor, k t is the maximum torque of the tray motor, B is the viscous friction coefficient, C is the integral constant, T L is the torque of the pallet motor after loading the goods.

5. The control method of a lifting AGV based on a permanent magnet motor according to claim 1 is characterized in that: The specific steps of step S5 are as follows: Determine whether the angular velocity V2 is greater than the velocity threshold. If it is less than the velocity threshold, use the MTPA current control method to generate the corresponding d-axis and q-axis currents. If it is greater than, the d-axis current is obtained according to the operating parameters, design parameters and target speed of the motor, and the limit value of the q-axis current is obtained according to the maximum current and the d-axis current.

6. The control method of a lifting AGV based on a permanent magnet motor according to claim 5 is characterized in that: The steps for obtaining the current of the d-axis according to the operating parameters, design parameters and target speed of the motor are as follows: 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 q2 , the given current I q Input to the low-pass filter to obtain the second parameter I q ′; 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; 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; 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; The d-axis current I is obtained by adding the feedback given term D1 and the feedforward given term D2. d2 .

7. The control method of a lifting AGV based on a permanent magnet motor according to claim 6 is 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 They are the proportional gain coefficient and the integral gain coefficient in the PI controller respectively; The formula for obtaining the amplification factor 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=-|(ω2-S z )×Kc|; where S z is the speed threshold.

8. The control method of a lifting AGV based on a permanent magnet motor according to claim 6 is characterized in that: 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 d2 is the current of d axis.

9. A control system for a jacking AGV based on a permanent magnet motor, characterized in that: A control method for a jacking AGV based on a permanent magnet motor according to any one of claims 1 to 8, comprising an image acquisition module, a determination module, a coefficient module, an adjustment module and a control module; The image acquisition module is used to set a plurality of image acquisition devices in the route through which the AGV passes, and the image acquisition devices are used to acquire the orthographic projection image of the AGV when carrying goods; The determination module is used to obtain the midpoint of the goods in the orthographic projection image, and obtain the vertical distance and horizontal distance between the midpoint of the pallet on the AGV and the midpoint of the goods; The coefficient module is used to obtain the weight of the goods, and obtain the adjustment coefficient of the rotational inertia in a preset adjustment coefficient table according to the weight of the goods and the horizontal distance; Obtain the preliminary rotational inertia of the cargo based on the vertical distance and the weight of the cargo; The preliminary rotational inertia is adjusted according to the adjustment coefficient of the rotational inertia to obtain the final rotational inertia; The regulating module is used to obtain the angular velocity V1 of the chassis motor, and calculate the angular velocity V2 of the tray motor according to the angular velocity V1 and the final rotational inertia; The control module is used to select corresponding d-axis current and q-axis current according to the angular velocity V2 of the tray motor.

Citation Information

Patent Citations

  • AGV trolley carrying control method and system, intelligent terminal and lifting mechanism

    CN117148811A

  • Modularized heavy-load mobile equipment oriented to intelligent workshop and loading control method of modularized heavy-load mobile equipment

    CN117227378A

  • Travel cart

    JP2007297189A