Real-time weight measuring method for scissor lifting mechanism

By using force sensing and motor encoder data, segment calculation and filtering in the scissor lifting mechanism of the AGV car, real-time accurate weight measurement of the AGV car during operation is achieved, and real-time measurement in the prior art is solved. The quality of goods has improved production efficiency and safety.

CN119079869APending Publication Date: 2024-12-06HANGZHOU YANJIANG INTELLIGENT TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202311557548.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-11-21
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

Existing AGV trolleys cannot measure cargo quality in real time during lifting, resulting in increased process and time in transportation, affecting production efficiency, and affecting safety in high-precision applications.

Method used

A real-time weight measurement method for scissor lifting mechanism is adopted, including chassis, force sensing, two fork arms, and loading platform. By measuring the current and encoder angle of the drive motor, a three-dimensional model and displacement curve are established. Acceleration and mass are calculated in segments, and filtered in combination with force sensor data to achieve real-time accurate measurement.

Benefits of technology

Real-time accurate weight measurement of AGV trolley during operation, improve measurement accuracy and production efficiency, reduce manual calculation process, and timely reflect the load exceeding the maximum load or bias load, protecting equipment safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119079869A_ABST
    Figure CN119079869A_ABST
Patent Text Reader

Abstract

The invention discloses a method for measuring lifting weight by using a single sensor. The method comprises the following steps of: 1) obtaining a function relationship between the rotating speed of a motor and the lifting position of a loading platform; 2) recording the rotation angle values of the force sensor, the acceleration sensor and the motor in real time; (3) two moments when the acceleration sensor displays the same numerical value are found; the method comprises the steps of (1) obtaining the height of the loading platform at two moments according to the function relation between the rotating speed of the motor and the rising position of the loading platform, (5) calculating the distance between the loading platform and two connecting points of the fork arm at the two moments, and (6) calculating the lifting weight. The load weight can be measured through one sensor, and the cost is saved on the basis that the measuring precision is guaranteed.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a weight measurement method, more specifically, to a real-time weight measurement method and control method for a lifting platform, and more specifically, to a real-time weight measurement method for a scissor lift mechanism. Background Art

[0002] AGV is a robot that can independently drive and carry objects. It is usually composed of wheels, motors, sensors and computer control systems. At present, AGV technology is developing rapidly and has a wide range of applications. It can play a huge role in automated logistics, intelligent warehousing, electronic manufacturing and other fields.

[0003] However, most of the existing AGV carts only have the function of transporting goods, and do not have the function of measuring the weight of the loaded goods during the lifting process. To know the weight of the loaded goods, most of the existing AGV carts use weighing equipment to measure the weight of the goods before transporting them, and then transmit the weight data to the cart and associate it with other data before moving the goods to the loading platform of the cart for subsequent transportation tasks. In actual implementation on-site use, this method not only increases the process and time of the entire transportation process, but also requires additional cargo weighing equipment to measure the weight in advance. Therefore, although this traditional method can also know the quality of the goods, it is time-consuming and labor-intensive, and seriously affects production efficiency. In addition, in some high-precision application scenarios, whether the load quality can be measured with high precision seriously affects the safety of the production and transportation process. Therefore, the current AGV cart industry needs a method that can realize real-time and accurate weighing of the load during the cart lifting the load.

[0004] In view of the above problems, the present invention proposes a real-time weight measurement method for a scissor lift mechanism. Summary of the invention

[0005] The purpose of the present invention is to solve the problem that the existing AGV trolley cannot be weighed in real time during the lifting process and operation process, and proposes a real-time weight measurement method for a scissor lift mechanism, so that the AGV trolley can accurately measure the lifting weight in real time during operation.

[0006] The present invention achieves the above-mentioned purpose through the following technical solutions:

[0007] A real-time weight measurement method for a scissor lift mechanism adopts a real-time weight measurement device for a scissor lift mechanism, including a chassis, a force sensor, two fork arms, and a loading platform; each fork arm is composed of two mobile brackets, a drive motor, a lead screw, a push block, and a push rod, the mobile bracket is composed of equal-length straight rods hinged to each other, one end of the bottom of the mobile bracket is fixedly hinged to the chassis of the AGV trolley, and the other end is movably connected to the chassis of the AGV trolley, one end of the top of the mobile bracket is fixedly hinged to the loading platform, and the other end is movably connected to the loading platform; the drive motor is connected to the lead screw, the push block is sleeved on the lead screw, the push block is hinged to one end of the push rod, and the other end of the push rod is hinged to the mobile bracket; there are four force sensors installed at the connection between the mobile bracket and the loading platform.

[0008] A real-time weight measurement method for a scissor lift mechanism comprises the following steps:

[0009] 1. Measure the no-load current of the left and right fork arm drive motors:

[0010] Place a load on the AGV trolley and perform several lifting tests. Measure and calculate the average value to obtain the current I1 and I2 of the left and right fork arm drive motors under load. I1 and I2 are the no-load currents of the left and right fork arm drive motors.

[0011] 2. Obtain the functional relationship between the driving motor angle and height by any of the following methods:

[0012] 2.1 Establish a three-dimensional model of the mechanism for simulation. According to the control method of the drive motor, the simulation obtains the drive motor speed and the position of the loading platform rising. The functional relationship between the drive motor encoder angle of the two fork arms and the lifting height H1(θ1) and H2(θ2) is calculated, where H1 and H2 are the lifting heights of the left and right fork arm loading platforms, and θ1 and θ2 are the encoder angles of the drive motors of the left and right fork arms, respectively.

[0013] 2.2 According to the displacement measurement method, the driving motor angle and the lifting position of the loading platform are actually measured, the displacement curve is drawn, and the curve is fitted to obtain the displacement functions H1(θ1) and H2(θ2);

[0014] 3. Determine whether the trolley has entered the load-bearing state:

[0015] Set the trolley to no-load state and read the drive motor current of the left and right fork arms in real time. When the drive motor current is lower than the no-load current, the trolley remains in no-load state. When the drive motor current exceeds the no-load current, the trolley is set to load state.

[0016] 4. Draw real-time displacement curve:

[0017] When the equipment enters the load-bearing state, the angular position of the drive motor encoder is read in real time, and the functions H1(θ1) and H2(θ2) obtained in step 2 are substituted to calculate the lifting height position of the fork arm at this time, and the displacement curve is drawn in real time for the entire lifting process;

[0018] 5. According to the lifting displacement curve, the entire lifting process is divided into n segments according to the linearity;

[0019] 6. Calculate the acceleration of each segment:

[0020] In the lifting process of each section, take its starting point, middle point and end point, and its time points and displacement values ​​are (t1, h1), (t2, h2), (t3, h3) respectively, and the acceleration value a of this section is calculated from them

[0021]

[0022] 7. Calculate the load mass of each section of a single load point

[0023] The average lifting force F of this section is calculated according to the value measured by the force sensor, and thus the mass of this section is calculated to be m=F / a;

[0024] If the segmented interval is long, k (k>3) points can be selected to obtain k-2 accelerations and masses, and then the average of their masses can be taken as the mass of this segment.

[0025] 8. Filter the quality data:

[0026] Step 6 obtains the quality values ​​mi (i=1, 2, ..., n) of n segments in the entire lifting process, and these n data are the data to be filtered.

[0027] A) Calculate the average value of the filtered data to obtain a rough reference M,

[0028] B) Calculate the distance r between each data and the rough reference i =m i -M;

[0029] C) Calculate the average of all the distances obtained

[0030] D) The standard deviation of the calculated distance

[0031] E) Retain Quality data within the range, and data outside the range are eliminated;

[0032] D) Determine whether there is data to be removed, if so, repeat step A, otherwise the filtering is completed;

[0033] 9. Calculate the load mass of a single load point:

[0034] The average value M of the filtered data is the load mass of a single load point.

[0035] 10. Calculate the total mass:

[0036] Repeat steps 7 to 9 for the four load points to obtain the single load mass M of the four load points. i (i=1, 2, 3, 4) then the total load mass is the sum of the four single load masses.

[0037] 11. Calculate the eccentric load

[0038] This method can also measure the eccentric load. Assume that the single load mass at the front point of the left fork arm is M1, the single load mass at the rear point of the left fork arm is M2, the single load mass at the front point of the right fork arm is M3, the single load mass at the rear point of the right fork arm is M4, and the average mass is M. 均 , then the left and right deviation is (M1+M2-M 均 ) / (M3+M4-M 均 ), the front and rear deviation is (M1+M3-M 均 ) / (M2+M4-M 均 );

[0039] The beneficial effects of the present invention are:

[0040] 1. Good real-time performance: This solution can realize real-time measurement of load mass, and promptly respond when the load mass exceeds the maximum carrying capacity of the AGV trolley and when the cargo is overloaded, so as to realize the protection function of the equipment.

[0041] 2. High measurement accuracy: This solution can achieve high-precision measurement of the quality of each lifted cargo. When transferring materials or transporting cargo, the total handling volume can be directly and accurately measured to reduce the manual weighing and calculation process.

[0042] 3. Provide effective data for the drive motor control method: While dynamically measuring the load mass, this solution can also transmit the real-time and accurate measured physical quantities to the control operator, laying a solid foundation for achieving stable control of the drive motor.

[0043] 4. No increase in cost: This solution uses software to achieve real-time measurement of load quality and improve accuracy without increasing hardware costs. It has good economic benefits and broad market prospects.

[0044] 5. In judging whether the AGV is carrying load, the use of current judgment can directly reflect the working condition of the servo motor used for driving. The abnormal current can be used to judge whether the driving motor is faulty and decide whether to stop the operation of the entire device. If a force sensor is used to judge whether it is carrying load, the sensor reading may remain normal due to sensor failure, making it difficult to detect the fault and causing safety hazards in actual application. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] Figure 1 It is a flow chart of the weighing scheme adopted by the present invention.

[0046] Figure 2 It is a filtering flow chart of the present invention.

[0047] Figure 3 It is a schematic diagram of a fork arm of the scissor lift mechanism used in the present invention.

[0048] In the figure, 1-chassis, 2-carrying platform, 3-movable bracket, 4-driving motor, 5-lead screw, 6-push block, 7-push rod DETAILED DESCRIPTION

[0049] The present invention will be further described below in conjunction with the accompanying drawings:

[0050] like Figures 1 to 3 As shown, a real-time weight measurement method for a scissor lift mechanism adopts a real-time weight measurement device for a scissor lift mechanism, including a chassis 1, a force sensor, two fork arms, and a loading platform 22; each of the fork arms is composed of two mobile brackets 3, a drive motor, a lead screw 5, a push block 6, and a push rod 7, the mobile bracket 3 is composed of equal-length straight rods hinged to each other, one end of the bottom of the mobile bracket 3 is fixedly hinged to the chassis 1 of the AGV trolley, and the other end is movably connected to the chassis 1 of the AGV trolley, one end of the top of the mobile bracket 3 is fixedly hinged to the loading platform 2, and the other end is movably connected to the loading platform 2; the drive motor is connected to the lead screw 5, the push block 6 is sleeved on the lead screw 5, the push block 6 is hinged to one end of the push rod 7, and the other end of the push rod 7 is hinged to the mobile bracket 3; there are four force sensors, which are installed at the connection between the mobile bracket 3 and the loading platform 2.

[0051] A real-time weight measurement method for a scissor lift mechanism comprises the following steps:

[0052] 1. Measure the no-load current of the left and right fork arm drive motors 4:

[0053] A load is placed on the AGV trolley for several lifting tests, and the currents I1 and I2 of the left and right fork arm drive motors 4 of the trolley under load are measured and averaged respectively. I1 and I2 are the no-load currents of the left and right fork arm drive motors 4;

[0054] 2. Obtain the functional relationship between the rotation angle and height of the drive motor 4 by any of the following methods:

[0055] 2.1 Establish a three-dimensional model of the mechanism for simulation. According to the control method of the drive motor 4, the speed of the drive motor 4 and the rising position of the loading platform 2 are simulated, and the functional relationship between the encoder angle of the drive motor 4 of the two fork arms and the lifting height H1(θ1) and H2(θ2) are calculated, where H1 and H2 are the lifting heights of the left and right fork arm loading platforms 2, and θ1 and θ2 are the encoder angles of the drive motor 4 of the left and right fork arms;

[0056] 2.2 According to the displacement measurement method, the angle of the driving motor 4 and the rising position of the loading platform 2 are actually measured, the displacement curve is drawn, and the curve is fitted to obtain the displacement functions H1(θ1) and H2(θ2);

[0057] 3. Determine whether the trolley has entered the load-bearing state:

[0058] Set the trolley to no-load state and read the current of the drive motor 4 of the left and right fork arms in real time. When the current of the drive motor 4 is lower than the no-load current, the trolley is set to the no-load state. When the current of the drive motor 4 exceeds the no-load current, the trolley is set to the load state.

[0059] 4. Draw real-time displacement curve:

[0060] When the equipment enters the load-bearing state, the angular position of the encoder of the driving motor 4 is read in real time, and the functions H1(θ1) and H2(θ2) obtained in step 2 are substituted to calculate the lifting height position of the fork arm at this time, and the displacement curve is drawn in real time for the entire lifting process;

[0061] 5. According to the lifting displacement curve, the entire lifting process is divided into n segments according to the linearity;

[0062] 6. Calculate the acceleration of each segment:

[0063] In the lifting process of each section, take its starting point, middle point and end point, and its time points and displacement values ​​are (t1, h1), (t2, h2), (t3, h3) respectively, and the acceleration value a of this section is calculated from them

[0064]

[0065] 7. Calculate the load mass of each section of a single load point:

[0066] The average lifting force F of this section is calculated according to the value measured by the force sensor, and then the mass of this section m=F / a is calculated; if the segmented interval is long, k (k>3) points can be selected, k-2 accelerations and masses can be obtained, and the average value of their masses can be used as the mass of this section.

[0067] 8. Filter the quality data:

[0068] Step 6 obtains the quality values ​​mi (i=1, 2, ..., n) of n segments in the entire lifting process, and these n data are the data to be filtered.

[0069] A) Calculate the average value of the filtered data to obtain a rough reference M,

[0070] B) Calculate the distance r between each data and the rough reference i =m i -M;

[0071] C) Calculate the average of all the distances obtained

[0072] D) The standard deviation of the calculated distance

[0073] E) Retain Quality data within the range, and data outside the range are eliminated;

[0074] D) Determine whether there is data to be removed, if so, repeat step A, otherwise the filtering is completed;

[0075] 9. Calculate the load mass of a single load point:

[0076] The average value M of the filtered data is the load mass of a single load point.

[0077] 10. Calculate the total mass:

[0078] Repeat steps 7 to 9 for the four load points to obtain the single load mass M of the four load points. i (i=1, 2, 3, 4) then the total load mass is the sum of the four single load masses.

[0079] 11. Calculate the eccentric load

[0080] This method can also measure the eccentric load. Assume that the single load mass at the front point of the left fork arm is M1, the single load mass at the rear point of the left fork arm is M2, the single load mass at the front point of the right fork arm is M3, the single load mass at the rear point of the right fork arm is M4, and the average mass is M. 均 ,

[0081] Then the left and right deviation is (M1+M2-M 均 ) / (M3+M4-M 均 ),

[0082] The front and rear deviation is (M1+M3-M 均 ) / (M2+M4-M 均 );

[0083] In the actual measurement process, the specific position in the n-stage lifting process can be determined based on the lifting displacement position during measurement, and then the mass value calculated at this time can be retrieved and presented to the tester.

[0084] When the drive motor 4 is in a load-bearing state, the same method is used to measure the load mass of the AGV when the lifting height is reduced, and the masses during lifting and lowering are combined to obtain an average value to obtain a more accurate final load mass.

[0085] In the actual test process, the rotation angle of the drive motor 4 of the two fork arms and the reset position of the slider may not always be fully executed according to the instructions, so there will be errors in the measurement. This solution uses a learning algorithm to learn the error value and eliminate the processing error in the subsequent data calculation and processing, thereby further improving the measurement accuracy.

[0086] The above embodiments are only preferred embodiments of the present invention and are not limitations of the technical solutions of the present invention. Any technical solution that can be implemented on the basis of the above embodiments without creative work should be deemed to fall within the scope of protection of the patent of the present invention.

Claims

1. A real-time weight measurement method for a scissor lift mechanism, characterized in that: The following steps are involved: 1) Measure the no-load current of the left and right fork arm drive motors (4): A load is placed on the AGV trolley for several lifting tests, and the currents I1 and I2 of the left and right fork arm drive motors (4) of the trolley under load are measured and averaged to obtain the currents I1 and I2, which are the no-load currents of the left and right fork arm drive motors (4); 2) Obtain the functional relationship between the rotation angle and height of the drive motor (4): A three-dimensional model of the mechanism is established for simulation, and the driving motor (4) is simulated according to the control method of the driving motor (4). The rotation speed and the position of the loading platform (2) are used to calculate the functional relationship between the encoder angle of the driving motor (4) of the two forks and the lifting height, H1 (θ1) and H2 (θ2), wherein H1 and H2 are the lifting heights of the left and right fork loading platforms (2), and θ1 and θ2 are the encoder angles of the driving motor (4) of the left and right forks, respectively. 3) Determine whether the car has entered the load-bearing state: The trolley is set to a no-load state and the current of the drive motors (4) of the left and right fork arms is read in real time. When the current of the drive motor (4) is lower than the no-load current, the trolley is kept in the no-load state. When the current of the drive motor (4) exceeds the no-load current, the trolley is set to a load state. 4) Draw real-time displacement curve: When the device enters the load-bearing state, the angular position of the encoder of the driving motor (4) is read in real time, and the functions H1(θ1) and H2(θ2) obtained in step 2 are substituted to calculate the lifting height position of the fork arm at this time, and a displacement curve is drawn in real time for the entire lifting process; 5) According to the lifting displacement curve, the entire lifting process is divided into n segments according to the linearity; 6) Calculate the acceleration of each segment: In the lifting process of each section, take its starting point, middle point and end point, and its time points and displacement values ​​are (t1, h1), (t2, h2), (t3, h3) respectively, and the acceleration value a of this section is calculated from them 7) Calculate the load mass of each section of a single load point The average lifting force F of this section is calculated according to the value measured by the force sensor, and thus the mass of this section is calculated to be m=F / a; If the segment interval is long, k (k>3) points can be selected to obtain k-2 accelerations and masses, and then the average of their masses is taken as the mass of this segment; 8) Filter the quality data: Step 6 obtains the quality values ​​mi (i=1, 2, ..., n) of n segments in the entire lifting process, and these n data are the data to be filtered; A) Calculate the average value of the filtered data to obtain a rough reference M, B) Calculate the distance r between each data and the rough reference i =m i -M; C) Calculate the average of all the distances obtained D) The standard deviation of the calculated distance E) Retain Quality data within the range, and data outside the range are eliminated; D) Determine whether there is data to be removed, if so, repeat step A, otherwise the filtering is completed; 9) Calculate the load mass of a single load point: The average value M of the filtered data is the load mass of a single load point. 10) Calculate the total mass: Repeat steps 7 to 9 for the four load points to obtain the single load mass M of the four load points. i (i=1, 2, 3, 4) then the total load mass is the sum of the masses of the four single loads; 11) Calculate the eccentric load This method can also measure the eccentric load. Assume that the single load mass at the front point of the left fork arm is M1, the single load mass at the rear point of the left fork arm is M2, the single load mass at the front point of the right fork arm is M3, the single load mass at the rear point of the right fork arm is M4, and the average mass is M. 均 , Then the left and right deviation is (M1+M2-M 均 ) / (M3+M4-M 均 ), The front and rear deviation is (M1+M3-M 均 ) / (M2+M4-M 均 ).

2. A real-time weight measurement method for a scissor lift mechanism according to claim 1, characterized in that: The step 2) adopts a displacement measurement method to actually measure the angle of the drive motor (4) and the rising position of the loading platform (2), draw a displacement curve, and fit the curve to obtain displacement functions H1 (θ1) and H2 (θ2).