A safety mechanism for collaborative robots
By installing a safety mechanism of six-dimensional sensors and elastic components on the bottom of the collaborative robot, real-time detection of external forces and action when exceeding the rated force, the problem of insufficient safety of collaborative robots in the prior art is solved, and a higher level of safety protection is achieved and equipment security.
Patent Information
- Application Number
- CN201911058705.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2019-11-01
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2039-11-01
AI Technical Summary
The existing collaborative robot safety technology solutions have primary functions and cannot fundamentally ensure the safety of humans and robots in the process of collaborative work.
The safety mechanism including six-dimensional sensors, elastic components and thrust cylinders is adopted to flexibly press the support assembly of the robot body to detect external forces in real time and act when exceeding the rated force to avoid the robot from falling and ensure safety.
Effectively combining the robot's movement speed and posture characteristics improves the safety of humans and robots working together, reduces the risk of equipment damage, and achieves a higher level of security protection through flexible connections.
Smart Images

Figure CN112757347B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of robots, and in particular relates to a safety mechanism of a collaborative robot. Background Art
[0002] The realization of Industry 4.0 and the development of intelligence have promoted more and more operators to engineers to manage more robots and create more production capacity. Therefore, it is critical to ensure the safety of people in the process of human-machine collaboration. The main safety technology implementation schemes of existing robots are as follows: (1) Replace the physical fence with a virtual fence and stop automatically when detecting someone approaching; (2) Active safety detection means, such as 3D vision, multi-line laser radar, etc., are used to replace passive sensors; (3) Based on the method of robot joint external torque observer, the torque acting on the joint by the external collision force is observed. The joint friction torque model is solved by the observation value of the robot during normal operation, so that the observation value is only affected by the collision force. When the observation value exceeds the preset threshold, it is considered that the robot has collided and the robot stops running immediately to avoid causing harm to the human body during the human-machine collaboration process. (4) Vision-based collaborative robot safety control method. This method combines visual three-dimensional reconstruction and trajectory planning technology to perform real-time three-dimensional reconstruction of the human-machine collaboration scene in a simulation environment, and combines the robot's own model to perform obstacle avoidance trajectory planning.
[0003] The above existing collaborative robot safety technology implementation solutions have relatively rudimentary safety functions and are still not complete collaborative safety technologies. They cannot fundamentally guarantee the safety of humans and robots working together. Summary of the invention
[0004] In view of the above problems, the purpose of the present invention is to provide a safety mechanism for a collaborative robot to circumvent the functional defects of the current collaborative robot safety technology solutions, avoid incomplete collaborative safety technology, and fundamentally ensure the safety of humans and robots in the process of working together.
[0005] In order to achieve the above object, the present invention adopts the following technical solutions:
[0006] A safety mechanism of a collaborative robot comprises a robot body, a safety mechanism and a platform, wherein a plurality of body support components positioned and connected to the platform are provided at the bottom of the robot body, each body support component corresponds to a safety mechanism arranged on the platform, and the safety mechanism is used to flexibly press the body support components so as to fix the robot body relative to the platform, wherein one body support component is connected to the robot body via a six-dimensional sensor, and the six-dimensional sensor is used to detect the magnitude of external force applied to the robot body in real time, and transmit the data to the robot control system in real time, and the robot control system determines in real time whether the safety mechanism is in action by comparing the magnitude of the external force applied to the robot body with the rated force.
[0007] The safety mechanism includes a pressure block, an elastic component, a thrust assembly and a thrust cylinder, wherein the thrust cylinder is arranged on the platform and the output end is connected to the thrust assembly, the pressure block is connected to the platform through the elastic component, and one end is rotatably connected to the thrust assembly through a hinge shaft, and the thrust cylinder pushes the pressure block to extend and press the main body support assembly.
[0008] The thrust assembly includes a connecting flange and an articulated seat and a positioning boss arranged on the same side of the connecting flange, wherein the articulated seat is located above the positioning boss, the articulated seat is connected to the hinge shaft, and the positioning boss contacts the pressure block plane located above.
[0009] The elastic component includes two springs, and two sides of the pressing block are connected to the platform through the two springs respectively.
[0010] Spring upper fixing pins are arranged on both sides of the pressing block, two spring lower fixing pins are arranged on the platform, and two ends of the spring are respectively connected with the spring upper fixing pin and the spring lower fixing pin.
[0011] A limiting protrusion is provided at the bottom of the pressing block.
[0012] The lower end of the body support assembly is positioned with the platform through arc surface cooperation.
[0013] The main body support assembly includes a cylindrical support body and a hemispherical body arranged at the lower end of the cylindrical support body. The diameter of the hemispherical body is larger than the diameter of the cylindrical support body to form an annular pressing table surface. The platform is provided with a groove for cooperating with the hemispherical body.
[0014] The body support components are four groups, which are respectively connected to the four bottom corners of the robot body.
[0015] The execution end of the robot body is provided with a hand clamping fixture.
[0016] The advantages and beneficial effects of the present invention are:
[0017] 1. The present invention combines the robot's movement speed and movement posture characteristics, and adopts a method of adding multiple groups of safety control and detection components at the bottom of the robot to ensure the safety of humans and robots in the process of working together.
[0018] 2. The present invention adopts a method of elastically connecting the pressure block and the platform to achieve flexible compression of the robot body, so that the six-dimensional sensor can accurately detect the external force.
[0019] 3. The present invention uses the arc surface contact mode between the robot body and the platform to make the robot body easily tip over when subjected to an external force greater than the rated force, thereby ensuring the safety of personnel or equipment. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] Figure 1 It is a front view of the present invention;
[0021] Figure 2 for Figure 1 A top view of
[0022] Figure 3 for Figure 2 BB cross-sectional view;
[0023] Figure 4 for Figure 3 The enlarged image at point I in the middle;
[0024] Figure 5 is an axonometric view of the present invention;
[0025] Figure 6 for Figure 5 Enlarged view of II in the middle;
[0026] Figure 7 It is a structural schematic diagram of the thrust assembly in the present invention;
[0027] Figure 8 It is a schematic diagram of the structure of the briquette in the present invention;
[0028] Fig. 9 It is a schematic structural diagram of the main body support assembly in the present invention.
[0029] In the figure: 1 is a gripping fixture, 2 is a robot body, 3 is a body support assembly, 301 is a cylindrical support body, 302 is a hemispherical body, 4 is a safety mechanism, 401 is a pressure block, 4011 is a hinge ear, 4012 is a limiting protrusion, 402 is a spring, 403 is a hinge shaft, 404 is a thrust assembly, 4041 is a connecting flange, 4042 is a hinge seat, 4043 is a positioning boss, 405 is a thrust cylinder, 406 is a spring upper fixing pin, 407 is a spring lower fixing pin, 5 is a six-dimensional sensor, and 6 is a platform. DETAILED DESCRIPTION
[0030] In order to make the purpose, technical solutions and advantages of the present invention more clear, the present invention is described in detail below with reference to the accompanying drawings and specific embodiments.
[0031] like Figure 1-2 As shown, a safety mechanism of a collaborative robot provided by the present invention comprises a robot body 2, a safety mechanism 4 and a platform 6, wherein a gripping fixture 1 is provided at the execution end of the robot body 2, and a plurality of body support components 3 are provided at the bottom of the robot body 2 and are positioned and connected to the platform 6, and each body support component 3 corresponds to a safety mechanism 4 provided on the platform 6, and the safety mechanism 4 is used to flexibly press the body support component 3, so that the robot body 2 is fixed relative to the platform 6. One of the body support components 3 is connected to the robot body 2 through a six-dimensional sensor 5, and the six-dimensional sensor 5 is used to detect the magnitude of the external force on the robot body 2 in real time, and transmit the data to the robot control system in real time, and the robot control system judges whether the safety mechanism 4 is in action in real time by comparing the magnitude of the external force with the rated force.
[0032] like Figure 3-4 As shown, the safety mechanism 4 includes a pressure block 401, an elastic component, a thrust assembly 404 and a thrust cylinder 405, wherein the thrust cylinder 405 is arranged on the platform 6, and the output end is connected to the thrust assembly 404, the pressure block 401 is connected to the platform 6 through the elastic component, and one end is rotatably connected to the thrust assembly 404 through the hinge shaft 403, and the thrust cylinder 405 pushes the pressure block 401 to extend and press the main body support assembly 3.
[0033] like Figure 5-6 As shown, the elastic component includes two springs 402 , and both sides of the pressing block 401 are connected to the platform 6 via the two springs 402 .
[0034] Furthermore, spring upper fixing pins 406 are provided on both sides of the pressing block 401 , two spring lower fixing pins 407 are provided on the platform 6 , and both ends of the spring 402 are connected to the spring upper fixing pin 406 and the spring lower fixing pin 407 respectively.
[0035] Furthermore, the lower end of the body support assembly 3 and the platform 6 are positioned by arc surface cooperation.
[0036] like Figure 7 As shown, the thrust assembly 404 includes a connecting flange 4041 and an articulated seat 4042 and a positioning boss 4043 arranged on the same side of the connecting flange 4041, wherein the articulated seat 4042 is located above the positioning boss 4043, the articulated seat 4042 is connected to the hinge shaft 403, and the positioning boss 4043 is in contact with the plane of the pressure block 401 located above.
[0037] like Figure 8As shown, one end of the pressing block 401 is stacked above the thrust assembly 404, and the end thereof is provided with a hinge ear 4011, which is rotatably connected to the hinge shaft 403. A limiting protrusion 4013 is provided at the bottom of the pressing block 401, which prevents the pressing block 401 from rotating downward.
[0038] like Fig. 9 As shown, the body support assembly 3 includes a cylindrical support body 301 and a hemispherical body 302 disposed at the lower end of the cylindrical support body 301, and a spherical groove for cooperating with the hemispherical body 302 is disposed on the platform 6. The diameter of the hemispherical body 302 is larger than the diameter of the cylindrical support body 301, and an annular table surface is formed along the circumferential direction. The pressing block 401 of the safety mechanism 4 is pressed tightly on the annular table surface at the upper end of the hemispherical body 302.
[0039] In the embodiment of the present invention, there are four sets of body support components 3, which are respectively connected to the four corners of the bottom of the robot body 2. The robot body 2 is installed on the platform 6 through the four sets of body support components 3, and a gripper fixture 1 is installed at the end of the robot body 2 to realize the functions of robot handling, stacking and assembly.
[0040] When the robot is in normal working state, that is, when the external force on the robot body 2 detected by the six-dimensional sensor 5 does not exceed the set rated force, the thrust cylinder 405 in the four-group safety mechanism assembly 4 is in an extended state. The thrust generated by the thrust cylinder 405 acts on the pressing block 401 through the thrust assembly 404 and the hinge shaft 403. The external force acting on the pressing block 401 fixes the robot body 2 on the platform 6, and the robot completes various actions and functions normally.
[0041] When the robot is in an abnormal working state, that is, when the external force on the robot body 2 detected in real time by the six-dimensional sensor 5 exceeds the set rated force, the robot control system controls the thrust cylinder 405 in the four-group safety mechanism assembly 4 to retract. The force acting on the pressing block 401 through the thrust assembly 404 and the hinge shaft 403 disappears, and the robot topples over when the force exceeds the rated force, thereby avoiding damage to personnel or equipment caused by the rigidity of the robot and ensuring personal safety.
[0042] In summary, the safety mechanism 4 is used to flexibly clamp the body support assembly 3. Under normal collaborative working conditions of the robot, the normal fixation of the robot body 2 support can be completed. Because of its flexibility, the six-dimensional sensor 5 can sense the strain of the system, and then the six-dimensional sensor 5 can obtain the support reaction force output of the installation condition under normal collaborative working conditions of the robot. The working principle of flexible clamping is to ensure that the displacement and posture are relatively controlled under the condition of positioning accuracy, and the strain and stress can be transmitted normally. It not only contains a certain stiffness, but also has a certain damping, which can achieve the beneficial effect of shock absorption. The six-dimensional sensor 5 contains a wireless data transmission module, which can transmit data through the network and remotely monitor the server across regions, which is convenient for multi-robot collaboration and data management, and for deep learning control systems to learn and judge, as well as deep learning control systems to predict faults and manage reliability. The safety mechanism 4 is used to flexibly press the main body support assembly 3. In the case of abnormal collaborative working mode of the robot, it can reduce system damage and the principle of safety self-destruction protection is like a safety pin, which breaks by itself when overloaded, thereby reducing damage to the precision reducer. Because the cost of the pin and the cost of the reducer are not on the same order of magnitude, a higher level of safety protection is provided for the robot transmission system.
[0043] The present invention combines the robot's movement speed and movement posture characteristics, and adopts a method of adding multiple groups of safety control and detection components at the bottom of the robot to ensure the safety of humans and robots in the process of working together.
[0044] The above description is only an embodiment of the present invention and is not intended to limit the protection scope of the present invention. Any modification, equivalent replacement, improvement, expansion, etc. made within the spirit and principle of the present invention are included in the protection scope of the present invention.
Claims
1. A safety mechanism for a collaborative robot, characterized in that: The robot comprises a robot body (2), a safety mechanism (4) and a platform (6), wherein a plurality of body support components (3) are provided at the bottom of the robot body (2) and are positioned and connected to the platform (6), each body support component (3) corresponds to a safety mechanism (4) provided on the platform (6), the safety mechanism (4) is used to flexibly press the body support component (3) so that the robot body (2) is fixed relative to the platform (6), wherein a body support component (3) is connected to the robot body (2) via a six-dimensional sensor (5), the six-dimensional sensor (5) is used to detect the magnitude of the external force applied to the robot body (2) in real time, and transmit the data to the robot control system in real time, and the robot control system determines in real time whether the safety mechanism (4) is in action by comparing the magnitude of the external force applied to the robot body (2) with the rated force; The safety mechanism (4) comprises a pressing block (401), an elastic component, a thrust assembly (404) and a thrust cylinder (405), wherein the thrust cylinder (405) is arranged on the platform (6) and an output end is connected to the thrust assembly (404), the pressing block (401) is connected to the platform (6) via the elastic component, and one end is rotatably connected to the thrust assembly (404) via a hinge shaft (403), and the thrust cylinder (405) pushes the pressing block (401) to extend and press the main body support assembly (3); The lower end of the body support assembly (3) and the platform (6) are positioned by means of arc surface matching.
2. The safety mechanism of the collaborative robot according to claim 1, characterized in that: The thrust assembly (404) comprises a connecting flange (4041) and an articulated seat (4042) and a positioning boss (4043) arranged on the same side of the connecting flange (4041), wherein the articulated seat (4042) is located above the positioning boss (4043), the articulated seat (4042) is connected to the hinge shaft (403), and the positioning boss (4043) is in planar contact with the pressing block (401) located above.
3. The safety mechanism of the collaborative robot according to claim 1, characterized in that: The elastic component comprises two springs (402), and two sides of the pressing block (401) are respectively connected to the platform (6) via the two springs (402).
4. The safety mechanism of the collaborative robot according to claim 3, characterized in that: Spring upper fixing pins (406) are provided on both sides of the pressing block (401), two spring lower fixing pins (407) are provided on the platform (6), and both ends of the spring (402) are respectively connected to the spring upper fixing pin (406) and the spring lower fixing pin (407).
5. The safety mechanism of the collaborative robot according to claim 1, characterized in that: A limiting protrusion (4012) is provided at the bottom of the pressing block (401).
6. The safety mechanism of the collaborative robot according to claim 1, characterized in that: The body support assembly (3) comprises a cylindrical support body (301) and a hemispherical body (302) arranged at the lower end of the cylindrical support body (301); the diameter of the hemispherical body (302) is larger than the diameter of the cylindrical support body (301), forming an annular pressing table surface; the platform (6) is provided with a groove for cooperating with the hemispherical body (302).
7. The safety mechanism of the collaborative robot according to claim 1, characterized in that: The body support components (3) are four groups, which are respectively connected to the four bottom corners of the robot body (2).
8. The safety mechanism of the collaborative robot according to claim 1, characterized in that: A hand gripping fixture (1) is provided at the execution end of the robot body (2).
