A stable control system for automatically grabbing cone heads

By using robotic arms and sensors in the automatic grasping system to measure parameters during the grabbing process and adjust the action parameters, the problem of the claw grab mechanism sliding and shaking when grabbing the tapered roller is solved, achieving more stable and Accurate grabbing action.

CN118559722BActive Publication Date: 2024-11-08JIANGSU PERMANENT STEEL STRUCTURE
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411054414.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-02
Publication Date
2024-11-08
Estimated Expiration
2044-08-02

AI Technical Summary

Technical Problem

The existing hand claw type grasping mechanism is prone to slip when grabbing tapered rollers, and the spring mechanism is prone to fatigue and insufficient elasticity. The robot shakes when grasping objects and moves, resulting in inaccurate placement and incorrectness, and cannot be corrected accordingly. The last grab action parameters are adjusted to the next grab action.

Method used

A stable control system for automatic gripping cone head is designed, including robotic arms, controllers, distance sensors, vibration sensors, displacement sensors and limiting platforms, by measuring the initial distance, final distance, amplitude and transfer during the gripping process Rate, adjust the action parameters of the robotic arm to ensure the stability and accuracy of the grasp.

Benefits of technology

It effectively improves the stability and practicality of the automatic gripping cone head device, reduces the object's shaking due to inertia, corrects the position offset, and improves the efficiency of the gripping action.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118559722B_ABST
    Figure CN118559722B_ABST
Patent Text Reader

Abstract

The present invention relates to the technical field of manipulators, and in particular to a stable control system for automatically grasping a cone head, wherein the system comprises: a manipulator arm, which is used to grasp a cone and transfer the cone to a limiting platform; a distance sensor, which is used to measure the distance between the manipulator arm and the cone; a vibration sensor, which is used to measure the amplitude of the manipulator arm when it moves; a displacement sensor, which is used to measure the displacement of a grasping head of the manipulator arm; a controller, which is used to adjust the action of the manipulator arm according to the measurement result; and a limiting platform, which is used to fix bolts and adjust the position of the cone so that the position of the cone corresponds to the position of the bolt. The present invention effectively detects various parameters in the action of the manipulator arm grasping the cone at a single time by arranging the above-mentioned device, thereby guiding the adjustment of subsequent grasping actions, improving the efficiency of the grasping action, and effectively improving the stability and practicality of the automatic grasping cone head device.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of manipulators, and in particular to a stable control system for automatically grasping a cone head. Background Art

[0002] The manipulator can imitate certain movements and functions of human hands and arms, and is an automatic operating device used to grasp, move objects or operate tools according to a fixed procedure. It can replace heavy labor to achieve mechanization and automation of production, and can operate in harmful environments to protect personal safety. Therefore, it is widely used in machinery manufacturing, metallurgy, electronics, light industry and atomic energy. The manipulator is prone to shaking when grasping objects of unconventional shapes, which affects the placement of objects and is easy to damage the manipulator. Excessive shaking will cause the placement of the grasped object to deviate.

[0003] Chinese patent application publication number: CN118143723A discloses a hand-claw type grasping mechanism for bearings, which belongs to the field of grasping mechanism technology, and discloses a hand-claw type grasping mechanism for bearings, including a fixed support assembly and a tapered roller body, the upper end of the fixed support assembly is fixedly installed with a driving assembly, one end of the driving assembly is fixedly installed with a clamping assembly, the upper end of the clamping assembly is fixedly connected with a movable assembly, and the clamping assembly includes a mounting member. The invention avoids the situation that the material cannot be grasped by the iron clamp when grasping the material manually by setting the coordination of the first connecting block and the second connecting block, the first connecting block, the second connecting block and the first spring telescopic rod resist the tapered roller body, the second connecting block moves toward the mounting member, and the first spring telescopic rod gives an elastic force to the second connecting block, so as to better grasp the tapered roller body, so as to make the grasping of the tapered roller more stable, while reducing the labor cost and improving the work efficiency.

[0004] Chinese patent application publication number: CN115258661A discloses a gripper device and a material transfer system thereof, which includes a mounting seat, an upper gripper and a lower gripper mechanism, wherein the upper gripper is connected and fixed to the mounting seat, and a gripping support point located above the material is arranged thereon; the lower gripper mechanism includes a power drive unit, a lower gripper and a gripper rotating member, and the outer edge of the material to be gripped on the side of the gripping support point of the upper gripper is also provided with a rotation support for the middle part of the gripper rotating member The chuck rotating member is a rotating shaft fulcrum; one end of the chuck rotating member is driven by a power driving unit, and the other free end of the chuck rotating member is fixedly connected to a lower chuck; the power driving unit drives the chuck rotating member to rotate at a certain angle with the rotating shaft fulcrum as the rotation center, and drives the lower chuck connected to the free end to deflect by a certain angle. The lower chuck is supported by the bottom of the material to be grasped and clamps the material relative to the upper clamping support point. The automatic grasping, transfer and automatic discharge of the material are realized through the gripper device, which is convenient for automatic transfer during plate loading or plate processing, and effectively improves production efficiency.

[0005] However, the above method has the following problems: the tapered roller is prone to slipping when grasping the claw-type grasping mechanism, and the spring mechanism is prone to fatigue, resulting in insufficient elastic force causing the tapered roller to slip. In the process of the mechanical gripper grasping the object and moving it, it will shake due to inertia, resulting in the mechanical gripper being unable to accurately place the grasped object, unable to correct objects with offset placement positions, and unable to correct the next grasping action based on the action parameters of the previous grasping action. Summary of the invention

[0006] To this end, the present invention provides a stable control system for automatically grasping a cone head, which is used to overcome the problem in the prior art that the claw-type grasping mechanism is prone to slipping when grasping the tapered roller, and the spring mechanism is prone to fatigue, resulting in insufficient elastic force causing the tapered roller to slip. In the process of the mechanical gripper grasping the object and moving it, inertia will cause shaking, resulting in the mechanical gripper being unable to accurately place the grasped object, unable to correct objects with offset placement positions, and unable to correct the next grasping action based on the action parameters of the previous grasping action.

[0007] To achieve the above object, the present invention provides a stable control system for automatically grabbing a cone head, comprising:

[0008] A mechanical arm, which is used to grab the cone and transfer the cone to the limiting platform;

[0009] A controller connected to the robot arm, for obtaining measurement results at different stages of a grasping process and adjusting the transfer rate, initial distance value and final distance value of the robot arm according to the measurement results at the next stage of the same grasping process or the corresponding stage of the next grasping process, including the grasping stage, the transfer stage and the stabilization stage;

[0010] The measurement result includes the initial distance value, the final distance value, the amplitude value and the transfer rate.

[0011] Furthermore, it also includes:

[0012] a distance sensor, which is connected to the robot arm and the controller, respectively, for measuring the distance between the robot arm and the cone at the beginning of the grasping phase and at the end of the stabilization phase, and generating an initial distance value and a final distance value, respectively;

[0013] A vibration sensor, which is connected to the robot arm and the controller respectively, and is used to measure the amplitude of the gripping head of the robot arm and generate an amplitude value;

[0014] A displacement sensor, which is connected to the robot arm and the controller respectively, and is used to measure the displacement of the robot arm grabbing head per unit time to generate a transfer rate;

[0015] The limiting platform is connected to the mechanical arm and is used to fix the bolts and adjust the position of the cone so that the position of the cone corresponds to the position of the bolts.

[0016] Further, the controller obtains an initial distance value at the beginning of the grasping stage and a first amplitude value at the end of the grasping stage, and compares the first amplitude value with a maximum set value;

[0017] If the first amplitude value is greater than the maximum set value, the controller determines that the initial distance value is too large and reduces the initial distance value at the beginning of the next grasping stage;

[0018] If the first amplitude value is not greater than the maximum set value, the controller determines that the initial distance value is normal and performs grasping with the same initial distance value at the beginning of the next grasping stage;

[0019] The maximum setting value is negatively correlated with the weight of the cone being grasped.

[0020] Further, the controller obtains a first transfer rate in the transfer phase and a second amplitude value at the end of the transfer phase, and compares the second amplitude value with the maximum set value;

[0021] If the second amplitude value is greater than the maximum set value, the controller determines that the first transfer rate is too large and reduces the first transfer rate in the next transfer stage;

[0022] If the second amplitude value is not greater than the maximum set value, the controller determines that the first transfer rate is normal and drives the robot arm at the same first transfer rate in the next transfer stage.

[0023] Further, when the stabilization phase begins, if the second amplitude value is greater than the maximum set value, the controller reduces the first transfer rate;

[0024] If the second amplitude value is not greater than the maximum setting value, the controller keeps the first transfer rate unchanged.

[0025] Further, at the end of the stable phase, the controller obtains a third amplitude value and a second transfer rate of the stable phase, and compares the third amplitude value with the maximum set value;

[0026] If the third amplitude value is greater than the maximum set value, the controller determines that the second transfer rate is too large and reduces the first transfer rate in the next transfer stage;

[0027] If the third amplitude value is not greater than the maximum set value, the controller determines that the second transfer rate is normal and drives the robot arm at the same second transfer rate in the next stable stage.

[0028] Furthermore, at the end of the stabilization stage, if the third amplitude value is greater than the maximum set value, the robotic arm stops until the third amplitude value is no greater than the maximum set value and then releases the grasped cone.

[0029] Further, when the robotic arm releases the grabbing head, the cone falls onto the limit platform, and the controller acquires the final distance value. If the cone falls into the effective area of ​​the limit platform, the controller releases the grabbing head with the same final distance value next time.

[0030] If the cone falls outside the effective area of ​​the limiting platform, the controller reduces the final distance value when the gripping head is released next time.

[0031] Furthermore, the limiting platform is composed of a fixed part and a movable part, and the movable part pushes the cone that falls in the effective area to the fixed part.

[0032] Furthermore, the controller obtains the height between the gripping head and the limiting platform measured by the distance sensor and keeps the height always greater than the final distance value.

[0033] Compared with the prior art, the beneficial effect of the present invention lies in that the system of the present invention utilizes the method of setting up the above-mentioned devices to effectively detect various parameters in the action of the robot arm grabbing the cone in a single time, thereby guiding the adjustment of subsequent grabbing actions, improving the efficiency of the grabbing action, and effectively improving the stability and practicality of the automatic grabbing cone head device.

[0034] Furthermore, by detecting the initial distance at the beginning of the grasping stage and the amplitude value at the end of the grasping stage, the amplitude value at the end of the grasping stage corresponding to the initial distance at the beginning of different grasping stages is analyzed. By adjusting the initial distance at the beginning of the grasping stage and then adjusting the amplitude value at the end of the grasping stage, the inertial shaking of the object during grasping is effectively reduced, and the stability and practicality of the automatic grasping cone head device are further improved.

[0035] Furthermore, by detecting the transfer rate and amplitude value and adjusting the transfer rate of the robot arm, the transfer time is effectively reduced while reducing the vibration amplitude of the grasped object, further improving the stability and practicality of the automatic grasping cone head device.

[0036] Furthermore, by setting a limit platform, the position of the cone can be further adjusted after the robotic arm places the cone, which effectively corrects the object with offset placement position and further improves the stability and practicality of the automatic cone head grasping device. BRIEF DESCRIPTION OF THE DRAWINGS

[0037] Figure 1 It is a schematic diagram of the structure of the stable control system for automatically grabbing the cone head of the present invention;

[0038] Figure 2 This is a structural diagram of a mechanical arm grabbing a cone according to an embodiment of the present invention;

[0039] Figure 3 This is a structural diagram of a position limiting platform according to an embodiment of the present invention;

[0040] Figure 4 It is a logic diagram of the controller action at each stage of the present invention;

[0041] Among them: 1, robotic arm; 2, cone; 3, limiting platform; 31, fixed part; 32, moving part; 33, effective area; 4, distance sensor; 5, vibration sensor; 6, displacement sensor; 7, bolt; 8, grabbing head. DETAILED DESCRIPTION

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

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

[0044] It should be noted that, in the description of the present invention, terms such as "up", "down", "left", "right", "inside" and "outside" indicating directions or positional relationships are based on the directions or positional relationships shown in the drawings. This is merely for the convenience of description and does not indicate or imply that the device or element must have a specific orientation, be constructed and operated in a specific orientation. Therefore, it cannot be understood as a limitation on the present invention.

[0045] In addition, it should be noted that in the description of the present invention, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For those skilled in the art, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0046] See also Figure 1 As shown, it is a schematic diagram of the structure of the stable control system for automatically grabbing the cone head of the present invention, a stable control system for automatically grabbing the cone head, comprising:

[0047] A robotic arm, which is used to grab the cone and transfer the cone to a limiting platform;

[0048] A controller connected to the robot arm to obtain measurement results at different stages of a grasping process and adjust the transfer rate, initial distance value and final distance value of the robot arm according to the measurement results at the next stage of the same grasping process or the corresponding stage of the next grasping process, including the grasping stage, the transfer stage and the stabilization stage;

[0049] The measurement results include the initial distance value, the final distance value, the amplitude value and the transfer rate.

[0050] Specifically, a stable control system for automatically grabbing a cone head also includes:

[0051] A distance sensor is connected to the robot arm and the controller, respectively, to measure the distance between the robot arm and the cone at the beginning of the grasping phase and at the end of the stabilization phase, and to generate an initial distance value and a final distance value, respectively;

[0052] A vibration sensor is connected to the robot arm and the controller respectively, and is used to measure the amplitude of the gripping head of the robot arm and generate an amplitude value;

[0053] A displacement sensor is connected to the robot arm and the controller respectively, and is used to measure the displacement of the robot arm grab head per unit time to generate a transfer rate;

[0054] The limiting platform is connected to the mechanical arm and is used to fix the bolts and adjust the position of the cone so that the position of the cone corresponds to the position of the bolts.

[0055] See also Figure 2 As shown, it is a structural diagram of a robotic arm grasping a cone in an embodiment of the present invention; wherein, one end of the robotic arm 1 is fixed; a grasping head 8 is arranged at the other end of the robotic arm; the cone 2 is released by the grasping head 8 and falls onto a limiting platform 3; a distance sensor 4 is connected to the robotic arm 1; a vibration sensor 5 is connected to the robotic arm 1; a displacement sensor 6 is connected to the robotic arm 1; and a bolt 7 is connected to the cone 2 after the position of the cone 2 is fixed on the limiting platform 3.

[0056] Specifically, the system of the present invention utilizes the method of setting up the above-mentioned devices to effectively detect various parameters in the action of the robot arm grabbing the cone in a single time, thereby guiding the adjustment of subsequent grabbing actions, improving the efficiency of the grabbing action, and effectively improving the stability and practicality of the automatic grabbing cone head device.

[0057] See also Figure 4 As shown, it is a logic diagram of the controller action in each stage of the present invention. The controller obtains the initial distance value at the beginning of the grasping stage and the first amplitude value at the end of the grasping stage, and compares the first amplitude value with the maximum set value;

[0058] If the first amplitude value is greater than the maximum set value, the controller determines that the initial distance value is too large and reduces the initial distance value at the beginning of the next grasping phase;

[0059] If the first amplitude value is not greater than the maximum set value, the controller determines that the initial distance value is normal and performs grasping with the same initial distance value at the beginning of the next grasping stage;

[0060] Example 1: In this example, the maximum setting value is 2 cm, and the controller obtains an initial distance value of 1 cm at the beginning of the grasping stage. If the first amplitude value at the end of the grasping stage is 3 cm, which is greater than the maximum setting value, the controller determines that the initial distance value is too large and adjusts the initial distance value at the beginning of the next grasping stage to 0.5 cm;

[0061] If the first amplitude value at the end of the grasping phase is 1 cm, which is less than the maximum set value, the controller determines that the initial distance value is normal and continues to grasp with the initial distance value of 1 cm at the beginning of the next grasping phase.

[0062] Among them, the maximum setting value is negatively correlated with the weight of the cone being grasped.

[0063] In one embodiment, the weight of the cone being grabbed is 0.1 kg, and the maximum setting value is 3 cm;

[0064] The weight of the cone being grasped is 0.5 kg, and the maximum setting value is 2 cm;

[0065] The weight of the grabbed cone is 1 kg and the maximum setting value is 1 cm.

[0066] Specifically, by detecting the initial distance at the beginning of the grasping stage and the amplitude value at the end of the grasping stage, the amplitude value at the end of the grasping stage corresponding to the initial distance at the beginning of different grasping stages is analyzed. By adjusting the initial distance at the beginning of the grasping stage and then adjusting the amplitude value at the end of the grasping stage, the inertial shaking of the object during grasping is effectively reduced, and the stability and practicality of the automatic grasping cone head device are further improved.

[0067] Please continue reading Figure 4 As shown, the controller obtains the first transfer rate in the transfer phase and the second amplitude value at the end of the transfer phase, and compares the second amplitude value with the maximum set value;

[0068] If the second amplitude value is greater than the maximum set value, the controller determines that the first transfer rate is too large and reduces the first transfer rate of the next transfer stage;

[0069] If the second amplitude value is not greater than the maximum setting value, the controller determines that the first transfer rate is normal and drives the robot arm at the same first transfer rate in the next transfer stage.

[0070] Embodiment 2: Based on Embodiment 1, this embodiment is different from the embodiment 1 in that the controller obtains the first transfer rate of the transfer stage as 0.5 m / s. If the second amplitude value of 3 cm at the end of the transfer stage is greater than the maximum set value of 2 cm, the controller determines that the first transfer rate is too large and drives the robot arm at a transfer rate of 0.3 m / s in the next transfer stage;

[0071] If the second amplitude value of 1 cm at the end of the transfer phase is less than the maximum set value of 2 cm, the controller determines that the first transfer rate is normal and drives the robot arm at a transfer rate of 0.5 m / s in the next transfer phase.

[0072] Please continue reading Figure 4 As shown, at the beginning of the stable phase, if the second amplitude value is greater than the maximum setting value, the controller reduces the first transfer rate;

[0073] If the second amplitude value is not greater than the maximum set value, the controller keeps the first transfer rate unchanged.

[0074] Embodiment 3: Based on Embodiment 2, this embodiment is different from the embodiment 2 in that, at the beginning of the stable phase, the controller obtains the first transfer rate of the transfer phase as 0.5 m / s. If the second amplitude value of 3 cm is greater than the maximum setting value of 2 cm, the controller reduces the first transfer rate to 0.3 m / s.

[0075] If the second amplitude value of 1 cm is less than the maximum setting value of 2 cm, the controller maintains the first transfer rate unchanged.

[0076] Please continue reading Figure 4 As shown, at the end of the stable stage, the controller obtains the third amplitude value and the second transfer rate of the stable stage, and compares the third amplitude value with the maximum set value;

[0077] If the third amplitude value is greater than the maximum set value, the controller determines that the second transfer rate is too large and reduces the first transfer rate of the next transfer stage;

[0078] If the third amplitude value is not greater than the maximum setting value, the controller determines that the second transfer rate is normal and drives the robot arm at the same second transfer rate in the next stable stage.

[0079] Embodiment 4: Based on Embodiment 3, this embodiment is different from the embodiment 3 in that, at the end of the stable stage, the controller obtains the second transfer rate of 0.5 m / s. If the third amplitude value of 3 cm is greater than the maximum set value of 2 cm, the controller determines that the second transfer rate is too large and drives the robot arm at a transfer rate of 0.3 m / s in the next transfer stage.

[0080] If the third amplitude value 1 cm is less than the maximum set value 2 cm at this time, the controller determines that the second transfer rate is normal and drives the robot arm at a transfer rate of 0.5 m / s in the next stable stage.

[0081] Please continue reading Figure 4 As shown, at the end of the stable stage, if the third amplitude value is greater than the maximum setting value, the robotic arm will stop until the third amplitude value is no greater than the maximum setting value and then release the grasped cone.

[0082] Specifically, by detecting the transfer rate and amplitude value and adjusting the transfer rate of the robotic arm, the transfer time is effectively reduced while reducing the vibration amplitude of the grasped object, further improving the stability and practicality of the automatic grasping cone head device.

[0083] Please continue reading Figure 4 As shown, when the robotic arm releases the gripping head, the cone falls onto the limit platform, and the controller obtains the final distance value. If the cone falls into the effective area of ​​the limit platform, the controller releases the gripping head at the same final distance value next time;

[0084] If the cone falls outside the effective area of ​​the limit platform, the controller will reduce the final distance value the next time the gripping head is released.

[0085] See also Figure 3As shown, it is a structural diagram of a limiting platform according to an embodiment of the present invention; wherein the limiting platform 3 includes a fixed portion 31 and a movable portion 32 , and an effective area 33 is an area between two baffles on the fixed portion 31 and the movable portion 32 .

[0086] Example 5: Based on Example 4, this example is different from it in that when the cone is released from the gripping head by the robot arm, it falls onto the limit platform, and the controller obtains a final distance value of 3 cm. If the cone falls into the effective area of ​​the limit platform, the controller releases the gripping head at the same final distance value next time;

[0087] If the cone falls outside the effective area of ​​the limit platform, the controller releases the cone at a final distance value of 2 cm the next time the gripping head is released.

[0088] Specifically, the limiting platform consists of a fixed part and a movable part, and the movable part pushes the cone that falls in the effective area to the fixed part.

[0089] Specifically, by setting a limit platform, the position of the cone can be further adjusted after the robotic arm places the cone. While effectively correcting objects with offset placement positions, the stability and practicality of the automatic cone head grasping device are further improved.

[0090] Specifically, the controller obtains the height between the gripping head and the limit platform measured by the distance sensor and keeps the height always greater than the final distance value.

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

[0092] 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 stable control system for automatically grabbing a cone head, characterized in that: include: A mechanical arm, which is used to grab the cone and transfer the cone to the limiting platform; A controller connected to the robot arm, for obtaining measurement results at different stages of a grasping process and adjusting the transfer rate, initial distance value and final distance value of the robot arm according to the measurement results at the next stage of the same grasping process or the corresponding stage of the next grasping process, including the grasping stage, the transfer stage and the stabilization stage; wherein the measurement result includes the initial distance value, the final distance value, the amplitude value and the transfer rate; a distance sensor, which is connected to the robot arm and the controller, respectively, for measuring the distance between the robot arm and the cone at the beginning of the grasping phase and at the end of the stabilization phase, and generating an initial distance value and a final distance value, respectively; A vibration sensor, which is connected to the robot arm and the controller respectively, and is used to measure the amplitude of the gripping head of the robot arm and generate an amplitude value; A displacement sensor, which is connected to the robot arm and the controller respectively, and is used to measure the displacement of the robot arm grabbing head per unit time to generate a transfer rate; The limiting platform is connected to the mechanical arm and is used to fix the bolt and adjust the position of the cone so that the position of the cone corresponds to the position of the bolt; The controller obtains an initial distance value at the beginning of the grasping phase and a first amplitude value at the end of the grasping phase, and compares the first amplitude value with a maximum set value; If the first amplitude value is greater than the maximum set value, the controller determines that the initial distance value is too large and reduces the initial distance value at the beginning of the next grasping stage; If the first amplitude value is not greater than the maximum set value, the controller determines that the initial distance value is normal and performs grasping with the same initial distance value at the beginning of the next grasping stage; Wherein, the maximum setting value is negatively correlated with the weight of the cone being grasped; The controller obtains a first transfer rate in the transfer phase and a second amplitude value at the end of the transfer phase, and compares the second amplitude value with the maximum set value; If the second amplitude value is greater than the maximum set value, the controller determines that the first transfer rate is too large, reduces the first transfer rate at the beginning of the stable phase, and reduces the first transfer rate in the next transfer phase; If the second amplitude value is not greater than the maximum set value, the controller determines that the first transfer rate is normal, maintains the first transfer rate unchanged at the beginning of the stabilization phase, and drives the robot arm at the same first transfer rate in the next transfer phase; At the end of the stable phase, the controller obtains a third amplitude value and a second transfer rate in the stable phase, and compares the third amplitude value with the maximum set value; If the third amplitude value is greater than the maximum set value, the controller determines that the second transfer rate is too large and reduces the first transfer rate in the next transfer stage; If the third amplitude value is not greater than the maximum set value, the controller determines that the second transfer rate is normal and drives the robot arm at the same second transfer rate in the next stable stage; At the end of the stabilization stage, if the third amplitude value is greater than the maximum set value, the robotic arm stops until the third amplitude value is no greater than the maximum set value and then releases the grasped cone.

2. The stable control system for automatically grabbing a cone head according to claim 1, characterized in that: When the robotic arm releases the grab head, the cone falls onto the limit platform, and the controller acquires the final distance value. If the cone falls into the effective area of ​​the limit platform, the controller releases the grab head with the same final distance value next time; If the cone falls outside the effective area of ​​the limiting platform, the controller reduces the final distance value when the gripping head is released next time.

3. The stable control system for automatically grabbing a cone head according to claim 2, characterized in that: The limiting platform is composed of a fixed part and a movable part, and the movable part pushes the cone dropped in the effective area to the fixed part.

4. The stable control system for automatically grabbing a cone head according to claim 3, characterized in that: The controller obtains the height between the gripping head and the limiting platform measured by the distance sensor and keeps the height always greater than the final distance value.