A method for controlling an automated mechanical arm of a hoisting platform

By detecting the stability of the lifting position and transmission structure, and adjusting the parameters of the laser positioning assembly and the robot arm, the problem of degradation of the robot arm's running accuracy is solved, and the control accuracy and stability are improved.

CN117506891BActive Publication Date: 2024-12-03BEIJING URBAN CONSTR GROUP
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202311404300.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-10-27
Publication Date
2024-12-03
Estimated Expiration
2043-10-27

AI Technical Summary

Technical Problem

In the prior art, the operating accuracy of the robot arm is reduced due to inaccurate adjustment of the vertical height of the laser positioning assembly, and the laser positioning stability is insufficient.

Method used

By detecting the misalignment area of ​​the lifting position and the connection stability of the transmission structure during the lifting process, adjusting the vertical height of the laser positioning assembly and the movement parameters of the robotic arm, including horizontal movement acceleration and vertical movement rate, to improve the control of the robotic arm Accuracy and stability.

Benefits of technology

By detecting and adjusting the vertical height of the laser positioning assembly and the movement parameters of the robotic arm, the control accuracy and operating stability of the automatic robotic arm of the hoisting platform are improved, and the instability caused by excessive speed is reduced, and in the face of wind force is faced with wind Improve positioning accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117506891B_ABST
    Figure CN117506891B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of mechanical arm control technology, and in particular to a method for controlling an automated mechanical arm of a hoisting platform, comprising: step S1, determining the position of a target hoisting object and planning a moving route through a laser positioning component, and performing grabbing and placing operations on the target hoisting object respectively; step S2, a central control module controlling a visual sensor to detect the misalignment area of ​​the hoisting position of the target hoisting object and determining the accuracy of the hoisting process; step S3, the central control module initially adjusts the vertical height of the laser positioning component, or, preliminarily determines that the connection stability of a transmission structure is lower than an allowable range; step S4, the central control module adjusts the horizontal movement acceleration of the mechanical arm, or, according to the actual pulling force of the mechanical arm, adjusts the vertical movement rate of the mechanical arm; the present invention achieves the improvement of the control accuracy and operation stability of the automated mechanical arm of the hoisting platform.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of mechanical arm control, and in particular to a method for controlling an automated mechanical arm of a hoisting platform. Background Art

[0002] A hoisting platform, also known as an aerial work platform, is a device that can lift the work platform and workers into the air for construction work. Hoisting platforms are usually used for cleaning, decoration, maintenance, and demolition of building exterior walls, as well as maintenance, inspection, and assembly of large equipment such as ships and aircraft.

[0003] Chinese patent publication number: CN113733051 B discloses a six-degree-of-freedom mechanical arm, including a base; the base is installed on a fixed arm connecting rod, and a movable arm connecting rod is rotatably installed on the fixed arm connecting rod; the fixed arm connecting rod and the movable arm connecting rod are symmetrically and rotatably installed with a large arm on the side, a small arm is rotatably installed on the upper end of the large arm, and an adapter is rotatably installed on the lower end of the small arm. The present invention can realize the grabbing of loads of different sizes by adjusting the movable arm; it can adapt to different interface forms of the load by replacing adapters of different structural forms, thereby improving the versatility; visual sensors, joint displacement sensors, etc. can be used to realize automatic identification and positioning of the load interface, and the displacement of the lifting equipment and each joint of the mechanical arm is controlled by the corresponding algorithm through the forward and reverse kinematics solution of the relative position relationship between the load interfaces, so as to realize the automation of the entire lifting process. It can be seen that the six-degree-of-freedom mechanical arm has the following problems: the insufficient stability of the laser positioning caused by the inaccurate adjustment of the vertical height of the laser positioning component leads to a decrease in the operating accuracy of the mechanical arm. Summary of the invention

[0004] To this end, the present invention provides a method for controlling an automated robotic arm of a hoisting platform, so as to overcome the problem in the prior art that the stability of the laser positioning is insufficient due to inaccurate adjustment of the vertical height of the laser positioning component, thereby causing a decrease in the operating accuracy of the robotic arm.

[0005] To achieve the above-mentioned purpose, the present invention provides a method for controlling an automated mechanical arm of a hoisting platform, which is characterized in that it comprises: step S1, determining the position of a target hoisting object by a laser positioning component, planning a hoisting movement route of the mechanical arm according to the position of the target hoisting object, and controlling the mechanical arm to perform grabbing and placing operations on the target hoisting object according to the hoisting movement route by a central control module; step S2, when completing a single grabbing and placing operation on the target hoisting object, the central control module controls the visual sensor to detect the misalignment area of ​​the hoisting position of the target hoisting object, and determines the accuracy of the hoisting process according to the misalignment area detection result; step S3, when determining the accuracy of the hoisting process When the accuracy is lower than the allowable range, the central control module determines to make an initial adjustment to the vertical height of the laser positioning assembly, or, when it is initially determined that the connection stability of the transmission structure is lower than the allowable range, the central control module makes a secondary judgment on the connection stability of the transmission structure according to the action delay duration of the robot arm; step S4, the central control module adjusts the horizontal movement acceleration of the robot arm when it is secondarily determined that the connection stability of the transmission structure is lower than the allowable range, or, adjusts the vertical movement rate of the robot arm according to the actual pulling force of the robot arm; step S5, when completing the initial adjustment of the vertical height of the laser positioning assembly, the central control module makes a secondary adjustment to the vertical height of the laser positioning assembly according to the vibration intensity of the laser positioning assembly.

[0006] Furthermore, in step S2, the central control module determines the accuracy of the hoisting process according to the misalignment area of ​​the hoisting position.

[0007] The central control module determines that the accuracy of the hoisting process is lower than the allowable range under the preset first area condition and the preset second area condition, wherein:

[0008] The central control module adjusts the vertical height of the laser positioning assembly under the preset first area condition;

[0009] The central control module preliminarily determines that the connection stability of the transmission structure is lower than the allowable range under the preset second area condition, and makes a secondary determination on whether the connection stability of the transmission structure is within the allowable range according to the action delay time of the robot arm.

[0010] Among them, the preset first area condition is that the misalignment area of ​​the lifting position is greater than the preset first misalignment area and less than or equal to the preset second misalignment area; the preset second area condition is that the misalignment area of ​​the lifting position is greater than the preset second misalignment area; the preset first misalignment area is smaller than the preset second misalignment area.

[0011] Further, in the step S3, the central control module determines several adjustment methods for increasing the vertical height of the laser positioning assembly according to the difference between the offset area of ​​the hoisting position and the preset first offset area under the preset first area condition,

[0012] Among them, each adjustment method has a different adjustment effect on increasing the vertical height of the laser positioning assembly.

[0013] Further, in the step S3, the central control module performs a secondary determination on the connection stability of the transmission structure according to the action delay time of the robot arm under the preset second area condition.

[0014] The central control module determines for the second time that the connection stability of the transmission structure is lower than the allowable range under the preset first time condition and the preset second time condition, wherein:

[0015] The central control module adjusts the horizontal movement acceleration of the robotic arm under the preset first time condition;

[0016] The central control module preliminarily determines that the resistance of the lifting exceeds the allowable range under the preset second time condition, and performs a secondary determination on whether the resistance of the lifting is within the allowable range according to the actual pulling force of the mechanical arm;

[0017] Among them, the preset first time length condition is that the action delay time of the robot arm is greater than the preset first delay time and is less than or equal to the preset second delay time; the preset second time length condition is that the action delay time of the robot arm is greater than the preset second delay time; the preset first delay time is less than the preset second delay time.

[0018] Further, in the step S4, the central control module determines several adjustment methods for reducing the horizontal movement acceleration of the robotic arm according to the difference between the action delay time of the robotic arm and the preset first delay time under the preset first time condition,

[0019] Among them, each acceleration adjustment method has a different adjustment degree for reducing the acceleration of the horizontal movement of the robot arm.

[0020] Furthermore, in step S4, the central control module performs a secondary determination on whether the lifting resistance is within an allowable range according to the actual pulling force of the mechanical arm under the preset second time condition.

[0021] The central control module determines that the resistance of the lifting exceeds the allowable range under the preset tension condition, and adjusts the vertical movement rate of the mechanical arm;

[0022] Wherein, the preset pulling force condition is that the actual pulling force of the robotic arm is greater than the preset robotic arm pulling force.

[0023] Further, in the step S4, the central control module determines several adjustment methods for reducing the vertical movement rate of the robotic arm according to the difference between the actual pulling force of the robotic arm and the preset pulling force of the robotic arm under the preset pulling force condition,

[0024] Among them, each speed adjustment method has a different adjustment degree for reducing the vertical movement speed of the robot arm.

[0025] Further, in step S5, when the central control module completes the initial adjustment of the vertical height of the laser positioning assembly, it determines whether the stability of the laser positioning assembly is within an allowable range according to the vibration intensity of the laser positioning assembly.

[0026] The central control module determines that the stability of the laser positioning component is lower than the allowable range under the preset vibration intensity condition,

[0027] Perform secondary adjustment on the vertical height of the laser positioning assembly;

[0028] Wherein, the preset vibration intensity condition is that the vibration intensity of the laser positioning component is greater than the preset vibration intensity.

[0029] Further, in the step S5, the central control module determines several secondary adjustment methods for increasing the vertical height of the laser positioning assembly according to the difference between the vibration intensity of the laser positioning assembly and the preset vibration intensity under the preset vibration intensity condition,

[0030] Among them, each secondary adjustment method has a different secondary adjustment size for reducing the vertical height of the laser positioning assembly.

[0031] Compared with the prior art, the beneficial effect of the present invention lies in that the method of the present invention detects and adjusts the operating parameters of the hoisting platform and the mechanical arm during the hoisting process by setting steps S1-S5, the central control module performs an initial adjustment on the vertical height of the laser positioning assembly according to the dislocation area of ​​the hoisting position, reduces the influence of low-altitude light on the light emitted by the laser positioning assembly by increasing the vertical height of the laser positioning assembly, or adjusts the horizontal movement acceleration of the mechanical arm according to the action delay time of the mechanical arm, and adjusts the vertical movement rate of the mechanical arm by the actual pulling force of the mechanical arm, reduces the instability of the mechanical arm due to excessive speed by reducing the horizontal or vertical movement rate of the mechanical arm, and, after completing the initial adjustment of the vertical height of the laser positioning assembly, the vertical height of the laser positioning assembly is adjusted for the second time according to the vibration intensity of the laser positioning assembly, the increase in the vertical height causes the laser positioning assembly to shake when facing the influence of wind force, resulting in inaccurate positioning, and the stability of the laser positioning assembly is improved by reducing the vertical height, thereby achieving the improvement of the control accuracy and operation stability of the automated mechanical arm of the hoisting platform.

[0032] Furthermore, the method of the present invention sets a preset first misalignment area and a preset second misalignment area, and the central control module determines the accuracy of the lifting process according to the misalignment area of ​​the lifting position. During the lifting of objects, due to the high dust and light in the low-altitude environment, the operation of the laser positioning assembly will be affected, thereby reducing the accuracy of the positioning assembly. By setting a preset misalignment area difference, a preset first height adjustment coefficient, and a preset second height adjustment coefficient, the central control module adjusts the vertical height of the laser positioning assembly, and by increasing the vertical height of the laser positioning assembly, the degree of intersection between the low-altitude light and the light emitted by the laser positioning assembly is reduced, thereby further improving the control accuracy and operation stability of the automated robotic arm of the lifting platform.

[0033] Furthermore, the method of the present invention sets a preset first delay time and a preset second delay time, and the central control module performs a secondary judgment on the connection stability of the transmission structure according to the action delay time of the robot arm. During the operation of the hoisting platform, the tightness between the operating components decreases due to the long-term transmission structure, so that the object transported by the robot arm cannot reach the specified position, thereby reducing the stability of the equipment operation. By setting the preset delay time difference, the preset first acceleration adjustment coefficient and the preset second acceleration adjustment coefficient, the central control module adjusts the horizontal movement acceleration of the robot arm. By reducing the horizontal movement acceleration of the robot arm, the horizontal movement speed of the robot arm during the hoisting process is reduced, thereby further improving the control accuracy and operation stability of the automated robot arm of the hoisting platform. BRIEF DESCRIPTION OF THE DRAWINGS

[0034] Figure 1 This is an overall flow chart of the method for controlling the automated mechanical arm of a hoisting platform according to an embodiment of the present invention;

[0035] Figure 2 This is a specific flow chart of step S2 of the method for controlling the automated mechanical arm of a hoisting platform according to an embodiment of the present invention;

[0036] Figure 3 This is a specific flow chart of step S3 of the method for controlling the automated mechanical arm of a hoisting platform according to an embodiment of the present invention;

[0037] Figure 4 This is a specific flow chart of step S4 of the method for controlling the automated mechanical arm of a hoisting platform according to an embodiment of the present invention. DETAILED DESCRIPTION

[0038] In order to make the objects and advantages of the present invention more clearly understood, the present invention is further described below in conjunction with embodiments; it should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.

[0039] The preferred embodiments of the present invention are described below with reference to the accompanying drawings. It should be understood by those skilled in the art that these embodiments are only used to explain the technical principles of the present invention and are not intended to limit the protection scope of the present invention.

[0040] See also Figure 1 , Figure 2 , Figure 3 as well as Figure 4 As shown, they are respectively an overall flow chart of the automatic mechanical arm control method for a hoisting platform according to an embodiment of the present invention, a specific flow chart of step S2, a specific flow chart of step S3, and a specific flow chart of step S4. The automatic mechanical arm control method for a hoisting platform according to the present invention comprises:

[0041] Step S1, determining the position of the target hoisting object by a laser positioning component, planning the hoisting movement route of the manipulator according to the position of the target hoisting object, and controlling the manipulator to grasp and place the target hoisting object according to the hoisting movement route by a central control module;

[0042] Step S2, when a single grabbing and placing operation of the target hoisting object is completed, the central control module controls the visual sensor to detect the misalignment area of ​​the hoisting position of the target hoisting object, and determines the accuracy of the hoisting process according to the misalignment area detection result;

[0043] Step S3, when it is determined that the accuracy of the hoisting process is lower than the allowable range, the central control module determines to make a primary adjustment to the vertical height of the laser positioning assembly, or, when it is initially determined that the connection stability of the transmission structure is lower than the allowable range, a secondary determination is made on the connection stability of the transmission structure according to the action delay time of the robot arm;

[0044] Step S4, when the central control module determines for the second time that the connection stability of the transmission structure is lower than the allowable range, the central control module adjusts the horizontal movement acceleration of the mechanical arm, or adjusts the vertical movement rate of the mechanical arm according to the actual pulling force of the mechanical arm;

[0045] Step S5, when the initial adjustment of the vertical height of the laser positioning assembly is completed, the central control module performs a secondary adjustment on the vertical height of the laser positioning assembly according to the vibration intensity of the laser positioning assembly.

[0046] Specifically, the specific steps of step S2 include:

[0047] Step S21, the central control module controls the visual sensor to detect the misalignment area of ​​the hoisting position of the target hoisting object;

[0048] In step S22, the central control module determines the accuracy of the hoisting process according to the misalignment area of ​​the hoisting position.

[0049] Specifically, the specific steps of step S3 are:

[0050] Step S31, the central control module determines that the accuracy of the hoisting process is lower than the allowable range and initially adjusts the vertical height of the laser positioning assembly according to the misalignment area of ​​the hoisting position, or preliminarily determines that the connection stability of the transmission structure is lower than the allowable range and obtains the action delay time of the robot arm;

[0051] Step S32: the central control module performs a secondary determination on the connection stability of the transmission structure according to the action delay time of the robot arm.

[0052] Specifically, the specific steps of step S4 are:

[0053] Step S41, the central control module secondarily determines that the connection stability of the dynamic structure is lower than the allowable range and adjusts the horizontal movement acceleration of the mechanical arm, or preliminarily determines that the resistance of the lifting exceeds the allowable range and obtains the actual pulling force of the mechanical arm;

[0054] Step S42, when it is determined that the lifting resistance exceeds the allowable range based on the actual pulling force of the robot arm, the vertical moving speed of the robot arm is adjusted.

[0055] Specifically, the horizontal acceleration of the robotic arm is the ratio of the horizontal running speed of the robotic arm to the time taken for the horizontal speed of the robotic arm to change from zero to the running speed.

[0056] Specifically, the actual pulling force of the mechanical arm is measured by a tension tester arranged between the mechanical arm and the hoisting platform, and the actual pulling force of the mechanical arm is the sum of the gravity and resistance of the hoisted object.

[0057] Specifically, the adjustment of the vertical movement speed of the robot arm is a technical means commonly used by technicians in this field, which will not be elaborated here.

[0058] Specifically, the laser positioning component is a laser positioning laser.

[0059] Specifically, the laser positioning assembly realizes adjustment of the vertical height of the laser positioning assembly through a telescopic rod.

[0060] Specifically, a vibration sensor for detecting the vibration intensity of the laser positioning assembly is provided on the telescopic rod.

[0061] The method of the present invention detects and adjusts the operating parameters of the hoisting platform and the mechanical arm during the hoisting process by setting steps S1-S5. The central control module performs an initial adjustment on the vertical height of the laser positioning assembly according to the dislocation area of ​​the hoisting position, and reduces the influence of low-altitude light on the light emitted by the laser positioning assembly by increasing the vertical height of the laser positioning assembly, or adjusts the horizontal movement acceleration of the mechanical arm according to the action delay time of the mechanical arm, and adjusts the vertical movement rate of the mechanical arm by the actual pulling force of the mechanical arm, and reduces the instability of the mechanical arm due to excessive speed by reducing the horizontal or vertical movement rate of the mechanical arm, and after completing the initial adjustment of the vertical height of the laser positioning assembly, the vertical height of the laser positioning assembly is adjusted for the second time according to the vibration intensity of the laser positioning assembly. The increase in the vertical height causes the laser positioning assembly to shake when facing the influence of wind force, resulting in inaccurate positioning. The stability of the laser positioning assembly is improved by reducing the vertical height, thereby achieving the improvement of the control accuracy and operation stability of the automated mechanical arm of the hoisting platform.

[0062] Please continue reading Figure 2 As shown, in step S2, the central control module determines the accuracy of the hoisting process according to the misalignment area of ​​the hoisting position.

[0063] The central control module determines that the accuracy of the hoisting process is lower than the allowable range under the preset first area condition and the preset second area condition, wherein:

[0064] The central control module adjusts the vertical height of the laser positioning assembly under the preset first area condition;

[0065] The central control module preliminarily determines that the connection stability of the transmission structure is lower than the allowable range under the preset second area condition, and performs a secondary determination on whether the connection stability of the transmission structure is within the allowable range according to the action delay time of the robot arm;

[0066] Among them, the preset first area condition is that the misalignment area of ​​the lifting position is greater than the preset first misalignment area and less than or equal to the preset second misalignment area; the preset second area condition is that the misalignment area of ​​the lifting position is greater than the preset second misalignment area; the preset first misalignment area is smaller than the preset second misalignment area.

[0067] Please continue reading Figure 3 As shown, in the step S3, the central control module determines several adjustment methods for increasing the vertical height of the laser positioning assembly according to the difference between the offset area of ​​the hoisting position and the preset first offset area under the preset first area condition,

[0068] Specifically, the dislocation area of ​​the hoisting position is recorded as M, the preset first dislocation area is recorded as M1, the preset second dislocation area is recorded as M2, the difference between the dislocation area of ​​the hoisting position and the preset first dislocation area is recorded as △M, △M=M-M1 is set, and the preset dislocation area difference is recorded as △M0.

[0069] The first adjustment method is that the central control module uses a preset first height adjustment coefficient α1 to adjust the vertical height H of the laser positioning assembly when △M≤△M0;

[0070] The second adjustment method is that the central control module uses a preset second height adjustment coefficient α2 to adjust the vertical height H of the laser positioning assembly when ΔM>ΔM0;

[0071] Among them, 0<α1<α2<1, the vertical height of the laser positioning assembly after adjustment is H'=H×(1+αi), and i=1,2 is set.

[0072] The method of the present invention sets a preset first misalignment area and a preset second misalignment area, and the central control module determines the accuracy of the lifting process according to the misalignment area of ​​the lifting position. During the lifting of the objects, due to the high dust and light in the low-altitude environment, the operation of the laser positioning component will be affected, and the accuracy of the positioning component will be reduced. By setting a preset misalignment area difference, a preset first height adjustment coefficient, and a preset second height adjustment coefficient, the central control module adjusts the vertical height of the laser positioning component, and by increasing the vertical height of the laser positioning component, the degree of intersection between the low-altitude light and the light emitted by the laser positioning component is reduced, thereby further improving the control accuracy and operation stability of the automated robotic arm of the lifting platform.

[0073] Please continue reading Figure 3 As shown, in the step S3, the central control module performs a secondary determination on the connection stability of the transmission structure according to the action delay time of the robot arm under the preset second area condition.

[0074] The central control module determines for the second time that the connection stability of the transmission structure is lower than the allowable range under the preset first time condition and the preset second time condition, wherein:

[0075] The central control module adjusts the horizontal movement acceleration of the robotic arm under the preset first time condition;

[0076] The central control module preliminarily determines that the resistance of the lifting exceeds the allowable range under the preset second time condition, and performs a secondary determination on whether the resistance of the lifting is within the allowable range according to the actual pulling force of the mechanical arm;

[0077] Among them, the preset first time length condition is that the action delay time of the robot arm is greater than the preset first delay time and is less than or equal to the preset second delay time; the preset second time length condition is that the action delay time of the robot arm is greater than the preset second delay time; the preset first delay time is less than the preset second delay time.

[0078] Please continue reading Figure 4 As shown, in the step S4, the central control module determines several adjustment methods for reducing the horizontal movement acceleration of the robotic arm according to the difference between the action delay time of the robotic arm and the preset first delay time under the preset first time condition,

[0079] Among them, each acceleration adjustment method has a different adjustment degree for reducing the acceleration of the horizontal movement of the robot arm.

[0080] Specifically, the action delay time of the robot arm is recorded as C, the preset first delay time is recorded as C1, the preset second delay time is recorded as C2, the difference between the action delay time of the robot arm and the preset first delay time is recorded as △C, △C=C-C1 is set, and the preset delay time difference is recorded as △C0.

[0081] The first acceleration adjustment method is that the central control module uses a preset first acceleration adjustment coefficient β1 to adjust the horizontal movement acceleration A of the robotic arm when △C≤△C0;

[0082] The second acceleration adjustment method is that the central control module uses a preset second acceleration adjustment coefficient β2 to adjust the horizontal movement acceleration A of the robot arm when ΔC>ΔC0;

[0083] Among them, 0<β1<β2<1, the adjusted horizontal movement acceleration of the robot arm is A'=A×(1-βk), and k is set to 1,2.

[0084] The method of the present invention sets a preset first delay time and a preset second delay time, and the central control module performs a secondary determination on the connection stability of the transmission structure according to the action delay time of the robot arm. During the operation of the hoisting platform, the tightness between the operating components decreases due to the long-term transmission structure, so that the object transported by the robot arm cannot reach the specified position, which reduces the stability of the equipment operation. By setting a preset delay time difference, a preset first acceleration adjustment coefficient, and a preset second acceleration adjustment coefficient, the central control module adjusts the horizontal movement acceleration of the robot arm, and reduces the horizontal movement speed of the robot arm during the hoisting process by reducing the horizontal movement acceleration of the robot arm, and further

[0085] The control accuracy and operation stability of the automated robotic arm of the lifting platform have been improved.

[0086] Please continue reading Figure 4As shown, in the step S4, the central control module performs a secondary determination on whether the lifting resistance is within the allowable range according to the actual pulling force of the mechanical arm under the preset second time condition.

[0087] The central control module determines that the resistance of the lifting exceeds the allowable range under the preset tension condition, and adjusts the vertical movement rate of the mechanical arm;

[0088] Wherein, the preset pulling force condition is that the actual pulling force of the robotic arm is greater than the preset robotic arm pulling force.

[0089] Please continue reading Figure 4 As shown, in the step S4, the central control module determines several adjustment methods for reducing the vertical movement rate of the mechanical arm according to the difference between the actual pulling force of the mechanical arm and the preset mechanical arm pulling force under the preset pulling force condition.

[0090] Among them, each speed adjustment method has a different adjustment degree for reducing the vertical movement speed of the robot arm.

[0091] Specifically, the actual pulling force of the robot arm is recorded as F, the preset pulling force of the robot arm is recorded as F0, the difference between the actual pulling force of the robot arm and the preset pulling force of the robot arm is recorded as △F, △F=F-F0 is set, and the preset pulling force difference is recorded as △F0.

[0092] The first rate adjustment method is that the central control module uses a preset second rate adjustment coefficient δ2 to adjust the vertical movement rate V of the robot arm when △F≤△F0;

[0093] The second speed adjustment method is that the central control module uses a preset first speed adjustment coefficient δ1 to adjust the vertical movement speed V of the robot arm when ΔF>ΔF0;

[0094] Among them, 0<δ1<δ2<1, the vertical moving speed of the adjusted robot arm is V'=V×δg, and g=1,2 is set.

[0095] Please continue reading Figure 1 As shown, in the step S5, when the central control module completes the initial adjustment of the vertical height of the laser positioning assembly, it determines whether the stability of the laser positioning assembly is within the allowable range according to the vibration intensity of the laser positioning assembly.

[0096] The central control module determines that the stability of the laser positioning assembly is lower than the allowable range under the preset vibration intensity condition, and performs a secondary adjustment on the vertical height of the laser positioning assembly;

[0097] Wherein, the preset vibration intensity condition is that the vibration intensity of the laser positioning component is greater than the preset vibration intensity.

[0098] Please continue reading Figure 1As shown, in the step S5, the central control module determines several secondary adjustment methods for increasing the vertical height of the laser positioning assembly according to the difference between the vibration intensity of the laser positioning assembly and the preset vibration intensity under the preset vibration intensity condition,

[0099] Among them, each secondary adjustment method has a different secondary adjustment size for reducing the vertical height of the laser positioning assembly.

[0100] Specifically, the vibration intensity of the laser positioning component is recorded as Z, the preset vibration intensity is recorded as Z0, and the difference between the vibration intensity of the laser positioning component and the preset vibration intensity is recorded as △Z. △Z=Z-Z0, and the preset vibration intensity difference is recorded as △Z0.

[0101] The first secondary adjustment method is that the central control module uses the preset fourth adjustment coefficient α4 to perform secondary adjustment on the vertical height H' of the adjusted laser positioning assembly when ΔZ≤ΔZ0;

[0102] The second secondary adjustment method is that the central control module uses a preset third adjustment coefficient α3 to perform secondary adjustment on the vertical height H' of the adjusted laser positioning assembly when ΔZ>ΔZ0;

[0103] Wherein, 0<α3<α4<1, the vertical height of the laser positioning assembly after secondary adjustment is H″=H'×αj, and j=3,4 is set.

[0104] Example 1

[0105] In this embodiment 1, the delay time difference △C0 is preset to be 3s, the first acceleration adjustment coefficient β1 is preset to be 0.2, the second acceleration adjustment coefficient β2 is preset to be 0.3, and the horizontal movement acceleration of the robot arm A is 3m / s 2 ,

[0106] In this embodiment, ΔC=2s is obtained, the central control module determines ΔC≤ΔC0 and uses β1 to adjust the horizontal movement acceleration of the robot arm. The adjusted horizontal movement acceleration of the robot arm is A'=3m / s 2 ×(1-0.2)=2.4m / s 2 .

[0107] In this embodiment 1, after obtaining ΔC, ΔC is determined and the corresponding adjustment coefficient is used to adjust the horizontal movement acceleration of the robot arm. By reducing the horizontal movement acceleration of the robot arm, the degree of change of the horizontal movement speed is reduced, thereby improving the stability of the robot arm operation.

[0108] So far, the technical solutions of the present invention have been described in conjunction with the preferred embodiments shown in the accompanying drawings. However, it is easy for those skilled in the art to understand that the protection scope of the present invention is obviously not limited to these specific embodiments. Without departing from the principle of the present invention, those skilled in the art can make equivalent changes or substitutions to the relevant technical features, and the technical solutions after these changes or substitutions will fall within the protection scope of the present invention.

[0109] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. A method for controlling an automated mechanical arm of a hoisting platform, characterized in that: include: Step S1, determining the position of the target hoisting object by a laser positioning component, planning the hoisting movement route of the manipulator according to the position of the target hoisting object, and controlling the manipulator to grasp and place the target hoisting object according to the hoisting movement route by a central control module; Step S2, when a single grabbing and placing operation of the target hoisting object is completed, the central control module controls the visual sensor to detect the misalignment area of ​​the hoisting position of the target hoisting object, and determines the accuracy of the hoisting process according to the misalignment area detection result; Step S3, when it is determined that the accuracy of the hoisting process is lower than the allowable range, the central control module determines to make a primary adjustment to the vertical height of the laser positioning assembly, or, when it is initially determined that the connection stability of the transmission structure is lower than the allowable range, a secondary determination is made on the connection stability of the transmission structure according to the action delay time of the robot arm; Step S4, when the central control module determines for the second time that the connection stability of the transmission structure is lower than the allowable range, the central control module adjusts the horizontal movement acceleration of the mechanical arm, or adjusts the vertical movement rate of the mechanical arm according to the actual pulling force of the mechanical arm; Step S5, when the initial adjustment of the vertical height of the laser positioning assembly is completed, the central control module performs a secondary adjustment on the vertical height of the laser positioning assembly according to the vibration intensity of the laser positioning assembly.

2. The method for controlling the automated mechanical arm of a hoisting platform according to claim 1, characterized in that: In step S2, the central control module determines the accuracy of the hoisting process according to the misalignment area of ​​the hoisting position. The central control module determines that the accuracy of the hoisting process is lower than the allowable range under the preset first area condition and the preset second area condition, wherein: The central control module adjusts the vertical height of the laser positioning assembly under the preset first area condition; The central control module preliminarily determines that the connection stability of the transmission structure is lower than the allowable range under the preset second area condition, and makes a secondary determination on whether the connection stability of the transmission structure is within the allowable range according to the action delay time of the robot arm.

3. The method for controlling the automated mechanical arm of a hoisting platform according to claim 2, characterized in that: The preset first area condition is that the misalignment area of ​​the hoisting position is greater than the preset first misalignment area and is less than or equal to the preset second misalignment area; the preset second area condition is that the misalignment area of ​​the hoisting position is greater than the preset second misalignment area; the preset first misalignment area is smaller than the preset second misalignment area.

4. The method for controlling the automated mechanical arm of a hoisting platform according to claim 3, characterized in that: In the step S3, the central control module determines several adjustment methods for increasing the vertical height of the laser positioning assembly according to the difference between the offset area of ​​the hoisting position and the preset first offset area under the preset first area condition. Among them, each adjustment method has a different adjustment effect on increasing the vertical height of the laser positioning assembly.

5. The method for controlling the automated mechanical arm of a hoisting platform according to claim 4, characterized in that: In step S3, the central control module performs a secondary determination on the connection stability of the transmission structure according to the action delay time of the robot arm under the preset second area condition. The central control module determines for the second time that the connection stability of the transmission structure is lower than the allowable range under the preset first time condition and the preset second time condition, wherein: The central control module adjusts the horizontal movement acceleration of the robotic arm under the preset first time condition; The central control module preliminarily determines that the resistance of the lifting exceeds the allowable range under the preset second time condition, and performs a secondary determination on whether the resistance of the lifting is within the allowable range according to the actual pulling force of the mechanical arm; Among them, the preset first time length condition is that the action delay time of the robot arm is greater than the preset first delay time and is less than or equal to the preset second delay time; the preset second time length condition is that the action delay time of the robot arm is greater than the preset second delay time; the preset first delay time is less than the preset second delay time.

6. The method for controlling the automated mechanical arm of a hoisting platform according to claim 5, characterized in that: In step S4, the central control module determines several adjustment methods for reducing the horizontal movement acceleration of the robotic arm according to the difference between the action delay time of the robotic arm and the preset first delay time under the preset first time condition. Among them, each acceleration adjustment method has a different adjustment degree for reducing the horizontal movement acceleration of the robotic arm.

7. The method for controlling an automated mechanical arm of a hoisting platform according to claim 6, characterized in that: In step S4, the central control module performs a secondary determination on whether the lifting resistance is within an allowable range according to the actual pulling force of the robotic arm under the preset second time condition. The central control module determines that the resistance of the lifting exceeds the allowable range under the preset tension condition, and adjusts the vertical movement rate of the mechanical arm; Wherein, the preset pulling force condition is that the actual pulling force of the robotic arm is greater than the preset robotic arm pulling force.

8. The method for controlling the automated mechanical arm of a hoisting platform according to claim 7, characterized in that: In step S4, the central control module determines several adjustment methods for reducing the vertical movement rate of the robotic arm according to the difference between the actual pulling force of the robotic arm and the preset pulling force of the robotic arm under the preset pulling force condition. Among them, each speed adjustment method has a different adjustment degree for reducing the vertical movement speed of the robot arm.

9. The method for controlling an automated mechanical arm of a hoisting platform according to claim 8, characterized in that: In step S5, when the central control module completes the initial adjustment of the vertical height of the laser positioning assembly, it determines whether the stability of the laser positioning assembly is within the allowable range according to the vibration intensity of the laser positioning assembly. The central control module determines that the stability of the laser positioning assembly is lower than the allowable range under the preset vibration intensity condition, and performs a secondary adjustment on the vertical height of the laser positioning assembly; Wherein, the preset vibration intensity condition is that the vibration intensity of the laser positioning component is greater than the preset vibration intensity.

10. The method for controlling an automated mechanical arm of a hoisting platform according to claim 9, characterized in that: In step S5, the central control module determines several secondary adjustment methods for increasing the vertical height of the laser positioning assembly according to the difference between the vibration intensity of the laser positioning assembly and the preset vibration intensity under the preset vibration intensity condition. Among them, each secondary adjustment method has a different secondary adjustment size for reducing the vertical height of the laser positioning assembly.

Citation Information

Patent Citations

  • A six-degree-of-freedom robotic arm

    CN113733051B

  • Multi-degree-of-freedom general heavy-load hoisting manipulator structure based on visual guidance

    CN114571494A

  • High-precision hoisting positioning device and method for bridge swivel

    CN116253245A