CN112847430A - Intrinsic safety design method for cooperative robot - Google Patents

Intrinsic safety design method for cooperative robot Download PDF

Info

Publication number
CN112847430A
CN112847430A CN201911169657.XA CN201911169657A CN112847430A CN 112847430 A CN112847430 A CN 112847430A CN 201911169657 A CN201911169657 A CN 201911169657A CN 112847430 A CN112847430 A CN 112847430A
Authority
CN
China
Prior art keywords
robot
safety
performance
human
cooperative
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201911169657.XA
Other languages
Chinese (zh)
Other versions
CN112847430B (en
Inventor
王洪光
于海斌
潘新安
胡明伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenyang Institute of Automation of CAS
Original Assignee
Shenyang Institute of Automation of CAS
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shenyang Institute of Automation of CAS filed Critical Shenyang Institute of Automation of CAS
Priority to CN201911169657.XA priority Critical patent/CN112847430B/en
Publication of CN112847430A publication Critical patent/CN112847430A/en
Application granted granted Critical
Publication of CN112847430B publication Critical patent/CN112847430B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/007Means or methods for designing or fabricating manipulators

Abstract

The invention relates to the field of cooperative robots, in particular to an intrinsic safety design method of a cooperative robot, which comprises the following steps: step one, analyzing the working performance of the cooperative robot; secondly, designing the upper layer of the cooperative robot; thirdly, performing risk analysis on the cooperative robot, and determining a safety risk type and a safety evaluation index; performing correlation analysis of the working performance and the safety performance of the robot, and determining indexes which have coupling influence on the working performance and the safety performance of the cooperative robot; establishing a human-computer interaction impact model, drawing a safety table based on human body biomechanics restriction index danger level, and determining a coupling index parameter range according to the safety table; and step six, according to the coupling index parameter range obtained in the step five, performing safety design on the basis of the optimized cooperative robot in the step two. The invention can balance the safety performance index and the working performance index of the mutually coupled cooperative robot, and simultaneously maximize the safety performance index and the working performance index.

Description

Intrinsic safety design method for cooperative robot
Technical Field
The invention relates to the field of cooperative robots, in particular to an intrinsic safety design method of a cooperative robot.
Background
The cooperative robot is a robot capable of directly interacting with a person in a designated cooperative area, and has the characteristics of man-machine fusion, safety, easiness in use, sensitivity, accuracy, flexibility, universality and the like. The cooperative robot breaks through the limit of man-machine separation, shares a working space with people, is suitable for man-machine cooperation tasks in non-structural environments, and improves the automation level of medium and small enterprises.
Different from a traditional industrial robot which seeks working performance maximization and works in a closed structure environment, the cooperative robot needs to seek the maximization of the working performance under the constraint of safety, namely the safety of physical man-machine interaction, and how to simultaneously achieve the working performance and the safety performance maximization of the cooperative robot is a difficult point of the design of the conventional cooperative robot.
Disclosure of Invention
The invention aims to provide an intrinsic safety design method for a cooperative robot, which can balance the safety performance index and the working performance index of the cooperative robot coupled with each other, maximize the safety performance index and the working performance index of the cooperative robot at the same time and provide a basis for the mechanical design and the control system design of the cooperative robot.
The purpose of the invention is realized by the following technical scheme:
a collaborative robot intrinsic safety design method comprises the following steps:
the method comprises the following steps: analyzing the working performance of the cooperative robot, and determining a working performance index parameter value of the robot according to the working task of the robot;
step two: the cooperative robot is designed in an upper layer, and the robot is optimized according to the working performance index parameter value determined in the step one;
step three: performing risk analysis on the cooperative robot, and determining a safety risk type and a safety evaluation index;
step four: performing correlation analysis of the working performance and the safety performance of the robot, and determining indexes which have coupling influence on the working performance and the safety performance of the cooperative robot;
step five: establishing a human-computer interaction impact model, drawing a safety table based on human body biomechanics restriction index danger level according to the human-computer interaction impact model, and determining an index parameter range with coupling influence in the fourth step according to the safety table;
step six: and according to the coupling index parameter range obtained in the fifth step, safety design is carried out on the basis of the optimized cooperative robot in the second step, and safety evaluation is carried out through safety evaluation indexes in the third step after the design is finished.
In the first step, the robot is divided into a low-load robot, a medium-load robot and a high-load robot according to the operation type of the robot.
And in the second step, the configuration optimization is firstly carried out on the cooperative robot, and then the precision optimization is carried out on the cooperative robot.
In step three, the safety risk type analysis comprises an impact type, a personnel stress type and a injured part of the personnel.
The safety performance evaluation indexes in the third step are as follows:
Figure BDA0002288359470000021
in the formula (1), N is a safety performance parameter of the designed robot, and N isCIs a human body biomechanical limiting parameter.
And in the fourth step, determining optimized parameters of the robot speed and the effective quality by constructing a coupling matrix diagram of the working performance and the safety performance of the cooperative robot.
And step five, obtaining the relation between the relative speed of the robot and the effective mass of the robot by establishing a human-computer interaction impact model:
Figure BDA0002288359470000022
in the above formula (9), vrelIs the relative speed, F, of the robot before collision with a personlimM is a biomechanical limit index of the human bodyRIs the effective mass of the robot, mHIs the effective mass of the human impact site, k is the hooke coefficient, where Flim、k、mHAnd obtaining the numerical value according to the safety risk type determined in the third step, drawing a safety table based on the human body biomechanical limit index danger level according to the formula (9), and selecting the range of the effective quality and speed performance parameters of the robot according to the safety table as a combination point of the effective quality and speed performance of the robot on the boundary of the design interval.
The human-computer interaction impact model establishment process comprises the following steps:
the transfer energy generated during the human-computer interaction impact is as follows:
Figure BDA0002288359470000023
Figure BDA0002288359470000024
in the above formulas (2) and (3), μ is the effective mass of both at the time of a human-machine collision, vrelIs the relative speed of the robot before collision with a person, CRIs the elastic recovery coefficient. m isRIs the effective mass of the robot, mHIs the effective mass of the human impact site.
Assuming inelastic contact between the robot and the person at impact, i.e. CRWhen the energy is equal to 0, the transfer energy generated during the man-machine interaction impact is as follows:
Figure BDA0002288359470000031
assuming that the collision part of the human body is an undamped linear spring, the elastic potential energy stored by the linear spring is as follows:
Figure BDA0002288359470000032
in the above formula (5), Δ x is the amount of compression by contact, k is the hooke's coefficient, and F is the impact force by contact.
Assuming that the transfer energy generated by the collision is all stored in the linear spring in the form of elastic potential energy, then:
ΔW=E (6);
namely, it is
Figure BDA0002288359470000033
The relationship between the relative speed and the impact force in the human-computer interaction process is as follows:
Figure BDA0002288359470000034
the relation between the relative speed and the effective mass of the robot is obtained by substituting the formula (3) for the formula (8)
Figure BDA0002288359470000035
The invention has the advantages and positive effects that:
1. the invention can balance the safety performance and the working performance of the mutually coupled cooperative robots, maximize the safety performance and the working performance of the cooperative robots at the same time, provide basis for the mechanical design, the control system design and the like of the cooperative robots, provide an important theoretical basis for the intrinsic safety design of the cooperative robots, and can be popularized to the safety design of robot systems such as service robots, exoskeleton robots and the like.
2. The invention has carried out the intrinsic safety design to the cooperative robot SHIR5, the robot is applied to the robot cooperative task such as 3C assembly, detection successfully, has realized the maximization of working property and security performance, has verified the validity of this method.
Drawings
Figure 1 is a flow chart of the method of the present invention,
FIG. 2 is a safety chart of risk level based on biomechanical restriction indicators of human body,
figure 3 is a diagram of the configuration and dimensional parameters of a cooperative robot according to embodiment 1 of the present invention,
figure 4 is a diagram of a robot working performance and safety performance coupling matrix,
fig. 5 is a safety chart based on the human hand safety index risk level according to embodiment 1 of the present invention.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings.
As shown in fig. 1, the present invention comprises the steps of:
the method comprises the following steps: and analyzing the working performance of the cooperative robot, and determining the working performance index parameter value of the robot according to the working task of the robot.
According to the robot operation type, the robot is divided into a low-load robot, a medium-load robot and a high-load robot, wherein:
(1) the low-load robot mainly performs the work of circuit board assembly, visual inspection and the like, and the requirements on the working performance of the low-load robot are low load and high speed (the load is 0.5 Kg-20 Kg, and the tail end speed of the robot is more than 10 m/s);
(2) the medium-load robot mainly engages in the work of toy assembly, part transportation and the like, and the working performance requirements are medium load and medium speed (the load is 20 Kg-60 Kg, and the tail end speed of the robot is more than 5 m/s);
(3) the high-load robot is mainly used for automobile assembly, spot welding, stacking and the like, and the high-load robot has high load and low speed (the load is more than 60Kg, and the tail end speed of the robot is less than 5m/s) on the working performance.
According to the operation business engaged in by the cooperative robot, specific parameter values of the working performance index of the robot are determined, wherein the specific parameter values comprise load, robot tail end speed, robot freedom degree, working space, robot precision and the like.
Step two: and (4) cooperating the upper layer design of the robot, and optimizing the robot according to the working performance index parameter value determined in the step one.
And 2.1, carrying out configuration optimization on the cooperative robot, wherein the working performance indexes of the cooperative robot comprise the freedom degree and the working space of the robot.
In the step 2.1, according to a reference document ' Humingwei, Kinghonang, Panxinan ', and the like ', a cooperative robot motion performance analysis and simulation [ J ] is reported by an intelligent system, 2017,12(1):75-81.
And 2.2, performing precision optimization on the cooperative robot on the basis of the step 2.1, wherein the working performance indexes of the cooperative robot comprise robot pose repeatability and pose accuracy (robot precision).
Step 2.2 above can be optimized using MATLAB numerical analysis software according to the reference "HU M W, WANG H G, PAN X A, et al.
Step three: and carrying out risk analysis on the cooperative robot, and determining a safety risk type and a safety evaluation index.
And 3.1, risk analysis, and safety risk confirmation according to different operation conditions of the robot.
Risks generated in the physical human-computer interaction process mainly include various collision conditions, including unconstrained impact, partially constrained impact, secondary impact caused by the impact and the like, and the reasons for causing personal injuries include static force, static pinch point force, static contact pressure, dynamic impact force, impact pinch point force, impact contact pressure, energy transfer and the like, and the parts of the personal which are easy to be injured are different according to different operation tasks.
Step 3.2, determining a human body biomechanical limit index causing human body injury according to the safety risk type confirmed in the step 3.1, and determining a safety performance evaluation index, wherein the safety performance evaluation index formula is as follows:
Figure BDA0002288359470000051
in the formula (1), N is a safety performance parameter of the designed robot, and N isCIs a human body biomechanical limiting parameter. The above formula (1) can be obtained according to the reference "Ikuta K, Ishi i H, Nokata M.safe Evaluation Method of Design and Control for Human-carbon Robots [ J]The International Journal of Robotics Research,2003,22(5): 281-.
And fourthly, carrying out correlation analysis on the working performance and the safety performance of the robot, and determining indexes with coupling influence on the working performance and the safety performance of the cooperative robot.
Obviously, the working performance indexes of all robots cannot be improved on the premise of ensuring the safety of human-computer interaction. In fact, the safety design of the cooperative robot is that the safety of the robot is balanced with the working performance indexes, and the performance indexes are independent or coupled.
As shown in fig. 4, in this step, the optimized parameters are determined as the robot speed and the effective quality by constructing a coupling matrix diagram of the working performance and the safety performance of the cooperative robot.
The working performance index parameters of the cooperative robot mainly comprise dexterity (degree of freedom and working space), agility (terminal speed), precision (repeatability and accuracy of terminal pose of the robot), load (rated load), flexibility (force perception) and lightness (self weight of a mechanical arm), and in order to ensure the working performance of the robot, the indexes are improved or maximized as much as possible.
The safety performance indexes for measuring the safety of the robot mainly comprise static force, static pinch point force, static contact pressure, impact force, impact pinch point force, impact contact pressure and dead weight impact force, and the safety of the robot can be ensured only by reducing or minimizing the safety performance indexes as much as possible.
And strong coupling exists between certain working performance indexes and safety performance indexes, and how to balance the indexes is an important task for carrying out safety design on the robot.
As shown in fig. 4, the present invention constructs a robot performance and safety performance coupling matrix diagram according to the analysis of the cooperative robot performance and safety performance, wherein "+" represents that two design indicators are positively correlated, such as weight reduction (self weight of mechanical arm) and robot safety design limiting criterion are positively coupled, i.e. the smaller the robot quality is, both the work performance and the safety performance are better, "-" represents that two design indicators are negatively correlated, such as robot agility (robot end speed) and load are reversely coupled with the robot safety design limiting criterion, which means that the increase of the robot speed and load improves the work performance of the robot but sacrifices the safety performance, and blank represents that there is no correlation between two design parameters. The analysis of whether or not there is coupling between the various performance parameters described above is well known in the art.
According to the method shown in fig. 4, the design parameters of coupling and decoupling of the working performance and the safety performance of the robot can be obtained through correlation analysis, for the decoupling design parameters, the decoupling design parameters are optimized to ensure the improvement of the working performance of the robot, such as the maximization of the robot precision, the maximization of the robot dexterity and the like, and for the coupling design parameters, optimization calculation is performed through an optimization algorithm, and since the rated load of the robot is usually a set value during design, the parameters of the effective mass (light weight) and the terminal speed (agility) of the robot are selected to be optimized according to the method shown in fig. 4.
And fifthly, establishing a human-computer interaction impact model, drawing a safety table based on human body biomechanics limit index danger level according to the human-computer interaction impact model, and determining an index parameter range with coupling influence on the working performance and the safety performance of the cooperative robot according to the safety table.
The specific process is as follows:
the transfer energy generated during the human-computer interaction impact is as follows:
Figure BDA0002288359470000061
Figure BDA0002288359470000062
in the above formulas (2) and (3), μ is the effective mass of both at the time of a human-machine collision, vrelIs the relative speed of the robot before collision with a person, CRIs the elastic recovery coefficient. m isRIs the effective mass of the robot, mHIs effective for human impact partAnd (4) quality.
Assuming inelastic contact between the robot and the person at impact, i.e. CRWhen the energy is equal to 0, the transfer energy generated during the man-machine interaction impact is as follows:
Figure BDA0002288359470000063
assuming that the collision part of the human body is an undamped linear spring, the elastic potential energy stored by the linear spring is as follows:
Figure BDA0002288359470000071
in the above formula (5), Δ x is the amount of compression by contact, k is the contact stiffness, and F is the impact force by contact.
Assuming that the transfer energy generated by the collision is all stored in the linear spring in the form of elastic potential energy, then:
ΔW=E (6);
namely, it is
Figure BDA0002288359470000072
The relationship between the relative speed and the impact force in the human-computer interaction process is as follows:
Figure BDA0002288359470000073
the relation between the relative speed and the effective mass of the robot is obtained by substituting the formula (3) for the formula (8)
Figure BDA0002288359470000074
In the above formula (9), mRIs the effective mass of the robot, mHIs the effective mass of the human impact part, mu is the effective mass of the human impact part and the human impact part when the human is collided, vrelIs the relative speed of the robot before collision with the human, k is the hooke coefficient, FlimIs a biomechanical limit index of human bodies.
Determining the maximum limiting force F of the impact part of the operator not being injured during the collision according to the safety risk type determined in the step threelimAnd the effective mass and the elastic coefficient of the impact part of the operator, and a safety table based on the human body biomechanical limit index danger level is drawn according to the formula (9), the drawn safety table is shown in figure 2, and the effective mass and speed performance parameter range of the robot is selected according to the figure 2 to be the combination point of the effective mass and speed performance of the robot on the boundary of the design interval, so that the working performance and the safety performance of the robot can be maximized.
The above formulae (3) to (9) are obtained according to the reference "Intrasicality Safer Robots" and FIG. 2 can be drawn by MATLAB numerical analysis software.
And step six, according to the effective mass and speed performance parameter range of the robot obtained in the step five, carrying out safety design on the basis of the optimized cooperative robot in the step two, selecting a corresponding driving and transmission mode during design so that the effective mass and speed performance parameters of the robot meet the requirements in the step five, and additionally, following a series of existing safety design requirements during design, such as minimizing the mass and inertia of the robot, eliminating all pinch points, maximizing the clamping radius and the like, wherein the existing safety design requirements can refer to a document of 'Intra chair Safer Robots'.
After the cooperative robot is designed, the robot is required to be subjected to safety evaluation by establishing an impact model and according to the formula (1) confirmed in the step three. Specific evaluation procedures can be found in the references "Sangg-DuckLee, Byeong-SangKim, Jae-BokSong. human-robot compatibility model with effective mass and design for a specific tester [ J ]. Advanced robots, 2013, 27 (3): 189-: 357, 366 ", etc., may be implemented based on the numerical analysis software MATLAB.
The following example is provided to specifically describe the specific process of the present invention.
Example 1:
the specific flow of this embodiment is as follows:
the method comprises the following steps: and analyzing the working performance of the cooperative robot.
According to the requirement that the cooperative robots share the working space with people, the robot working tasks are selected, the working tasks (the load is 0.5 Kg-20 Kg, and the tail end speed of the robot is more than 10m/s) such as 3C assembly, detection, sorting and the like are mainly executed, and specific parameter values of relevant performance indexes of the robots, including the degree of freedom, the working space, the precision and the like of the robots, are determined according to the working tasks engaged by the cooperative robots. In the embodiment, the degree of freedom of the robot is 7, the working space is 900mm, the precision is +/-0.1 mm (repeatability and accuracy of pose of the end pose of the robot), and the load is 5 Kg.
Step two: and (4) collaborating the upper layer design of the robot, and optimizing the robot according to the index parameter value determined in the step one.
And 2.1, carrying out configuration optimization synthesis on the cooperative robot according to the performance parameters of the robot, such as the degree of freedom, the working space and the like, wherein the optimized robot parameters are shown in figure 3.
2.2, on the basis of the configuration optimization and integration of the robot, performing precision optimization on the cooperative robot according to performance parameters such as pose repeatability, pose accuracy and the like of the robot, wherein the random motion precision of each joint after optimization in the embodiment is as follows:
Δθ′1=Δθ′2=4.8×10-5rad
Δθ′3=Δθ′4=6.4×10-5rad
Δθ′5=Δθ′6=Δθ′7=1.2×10-4rad。
and thirdly, performing risk analysis on the cooperative robot, and determining a safety risk type and a safety evaluation index parameter.
Step 3.1, analyzing the collision situation generated by the cooperative robot in the physical human-computer interaction process in the embodiment, determining the most dangerous collision situation in the human-computer interaction process as constraint collision, and determining that the main reason for causing personnel injury is dynamic impact force, and the probability of hand injury is the largest in the human-computer interaction process.
Step 3.2, according to the safety risk analysis in the step 3.1, determining that the biomechanical limit index of the human body is Flim280N, k 75N/mm and m is the effective mass of the impact partH0.6 Kg. Wherein the biomechanical limit index of the human body is Flim280N is obtained from a reference "ISO/TS 15066Robots and viral devices-colorful Robots", with a hooke coefficient of 75N/mm and an effective mass of mH0.6Kg is a basic parameter for intrinsic safety design of cooperative robots, and can be obtained according to references of "investment of intellectual Properties of the Human Body", Physics of the Human Body ", and the like, and a safety evaluation index is obtained according to the above formula (1).
And fourthly, carrying out correlation analysis on the working performance and the safety performance of the robot, and determining design parameters with coupling influence on the working performance and the safety performance of the cooperative robot as the speed and the effective quality of the robot by constructing a coupling matrix diagram of the working performance and the safety performance of the robot.
And fifthly, establishing a human-computer interaction impact model, drawing a danger level safety table based on the human body biomechanical restriction index according to the human-computer interaction impact model, and selecting effective quality and speed performance parameters of the robot according to the danger level safety table of the human body biomechanical restriction index so as to maximize the working performance and safety performance of the robot.
Confirming the effective mass and the elastic coefficient of the part impacted by the operator during collision and the maximum limiting force F of the part which is not injured according to the third steplimAnd according to the relation between the relative speed and the effective mass of the robot, namely the above equation (9), a danger level safety table based on the human hand mechanics restriction index is drawn as shown in fig. 5, and the effective mass and speed performance parameter range of the robot is determined according to fig. 5.
And step six, according to the range of the effective quality and speed performance parameters of the robot obtained in the step five, performing safety design on the basis of the optimized cooperative robot in the step two, selecting corresponding driving and transmission modes to enable the effective quality and speed performance parameters of the robot to meet the range requirements in the step five, additionally, following a series of existing safety design requirements during design, and after the cooperative robot is designed, performing safety evaluation on the robot by establishing a collision model and according to the formula (1) confirmed in the step three.

Claims (8)

1. A collaborative robot intrinsic safety design method is characterized in that: the method comprises the following steps:
the method comprises the following steps: analyzing the working performance of the cooperative robot, and determining a working performance index parameter value of the robot according to the working task of the robot;
step two: the cooperative robot is designed in an upper layer, and the robot is optimized according to the working performance index parameter value determined in the step one;
step three: performing risk analysis on the cooperative robot, and determining a safety risk type and a safety evaluation index;
step four: performing correlation analysis of the working performance and the safety performance of the robot, and determining indexes which have coupling influence on the working performance and the safety performance of the cooperative robot;
step five: establishing a human-computer interaction impact model, drawing a safety table based on human body biomechanics restriction index danger level according to the human-computer interaction impact model, and determining an index parameter range with coupling influence in the fourth step according to the safety table;
step six: and according to the coupling index parameter range obtained in the fifth step, safety design is carried out on the basis of the optimized cooperative robot in the second step, and safety evaluation is carried out through safety evaluation indexes in the third step after the design is finished.
2. The collaborative robot intrinsic safety design method of claim 1, wherein: in the first step, the robot is divided into a low-load robot, a medium-load robot and a high-load robot according to the operation type of the robot.
3. The collaborative robot intrinsic safety design method of claim 1, wherein: and in the second step, the configuration optimization is firstly carried out on the cooperative robot, and then the precision optimization is carried out on the cooperative robot.
4. The collaborative robot intrinsic safety design method of claim 1, wherein: in step three, the safety risk type analysis comprises an impact type, a personnel stress type and a injured part of the personnel.
5. The collaborative robot intrinsic safety design method of claim 1, wherein: the safety performance evaluation indexes in the third step are as follows:
Figure FDA0002288359460000011
in the formula (1), N is a safety performance parameter of the designed robot, and N isCIs a human body biomechanical limiting parameter.
6. The collaborative robot intrinsic safety design method of claim 1, wherein: and in the fourth step, determining optimized parameters of the robot speed and the effective quality by constructing a coupling matrix diagram of the working performance and the safety performance of the cooperative robot.
7. The collaborative robot intrinsic safety design method of claim 6, wherein: and step five, obtaining the relation between the relative speed of the robot and the effective mass of the robot by establishing a human-computer interaction impact model:
Figure FDA0002288359460000021
in the above formula (9), vrelIs the relative speed, F, of the robot before collision with a personlimM is a biomechanical limit index of the human bodyRIs the effective mass of the robot, mHIs the effective mass of the human impact site, k is the hooke coefficient, where Flim、k、mHAnd obtaining the numerical value according to the safety risk type determined in the third step, drawing a safety table based on the human body biomechanical limit index danger level according to the formula (9), and selecting the range of the effective quality and speed performance parameters of the robot according to the safety table as a combination point of the effective quality and speed performance of the robot on the boundary of the design interval.
8. The collaborative robot intrinsic safety design method of claim 7, wherein: the human-computer interaction impact model establishment process comprises the following steps:
the transfer energy generated during the human-computer interaction impact is as follows:
Figure FDA0002288359460000022
Figure FDA0002288359460000023
in the above formulas (2) and (3), μ is the effective mass of both at the time of a human-machine collision, vrelIs the relative speed of the robot before collision with a person, CRIs the elastic recovery coefficient. m isRIs the effective mass of the robot, mHIs the effective mass of the human impact site.
Assuming inelastic contact between the robot and the person at impact, i.e. CRWhen the energy is equal to 0, the transfer energy generated during the man-machine interaction impact is as follows:
Figure FDA0002288359460000024
assuming that the collision part of the human body is an undamped linear spring, the elastic potential energy stored by the linear spring is as follows:
Figure FDA0002288359460000025
in the above formula (5), Δ x is the amount of compression by contact, k is the hooke's coefficient, and F is the impact force by contact.
Assuming that the transfer energy generated by the collision is all stored in the linear spring in the form of elastic potential energy, then:
ΔW=E (6);
namely, it is
Figure FDA0002288359460000031
The relationship between the relative speed and the impact force in the human-computer interaction process is as follows:
Figure FDA0002288359460000032
the relation between the relative speed and the effective mass of the robot is obtained by substituting the formula (3) for the formula (8)
Figure FDA0002288359460000033
CN201911169657.XA 2019-11-26 2019-11-26 Intrinsic safety design method for cooperative robot Active CN112847430B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911169657.XA CN112847430B (en) 2019-11-26 2019-11-26 Intrinsic safety design method for cooperative robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911169657.XA CN112847430B (en) 2019-11-26 2019-11-26 Intrinsic safety design method for cooperative robot

Publications (2)

Publication Number Publication Date
CN112847430A true CN112847430A (en) 2021-05-28
CN112847430B CN112847430B (en) 2022-03-29

Family

ID=75984598

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911169657.XA Active CN112847430B (en) 2019-11-26 2019-11-26 Intrinsic safety design method for cooperative robot

Country Status (1)

Country Link
CN (1) CN112847430B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114415618A (en) * 2021-11-08 2022-04-29 中国民航大学 Method and device for evaluating motion agility of manned robot
CN114418269A (en) * 2021-11-30 2022-04-29 哈尔滨工业大学 Industrial robot safety evaluation index construction method
CN116372932A (en) * 2023-04-24 2023-07-04 深圳墨影科技有限公司 Modular design system applied to robot or robot system

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015114089A1 (en) * 2014-01-30 2015-08-06 Kuka Systems Gmbh Safety device and safety process
CN106794581A (en) * 2014-09-02 2017-05-31 约翰霍普金斯大学 For the system and method for flexible man-machine collaboration
CN108230676A (en) * 2018-01-23 2018-06-29 同济大学 A kind of intersection pedestrian's street crossing methods of risk assessment based on track data
CN108582070A (en) * 2018-04-17 2018-09-28 上海达野智能科技有限公司 robot collision detecting system and method, storage medium, operating system
CN108942915A (en) * 2017-05-22 2018-12-07 广明光电股份有限公司 Method for programming speed of cooperative robot
CN109822579A (en) * 2019-04-10 2019-05-31 江苏艾萨克机器人股份有限公司 Cooperation robot security's control method of view-based access control model

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015114089A1 (en) * 2014-01-30 2015-08-06 Kuka Systems Gmbh Safety device and safety process
CN106794581A (en) * 2014-09-02 2017-05-31 约翰霍普金斯大学 For the system and method for flexible man-machine collaboration
CN108942915A (en) * 2017-05-22 2018-12-07 广明光电股份有限公司 Method for programming speed of cooperative robot
CN108230676A (en) * 2018-01-23 2018-06-29 同济大学 A kind of intersection pedestrian's street crossing methods of risk assessment based on track data
CN108582070A (en) * 2018-04-17 2018-09-28 上海达野智能科技有限公司 robot collision detecting system and method, storage medium, operating system
CN109822579A (en) * 2019-04-10 2019-05-31 江苏艾萨克机器人股份有限公司 Cooperation robot security's control method of view-based access control model

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
KOJI IKUTA等: "Safety Evaluation Method of Design and Control for Human-Care Robots", 《THE INTERNATIONAL JOURNAL OF ROBOTICS RESEARCH》 *
肖聚亮等: "一种轻型模块化协作机器人碰撞检测算法", 《天津大学学报(自然科学与工程技术版)》 *
胡明伟等: "一种协作型机器人运动性能分析与仿真", 《智能系统学报》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114415618A (en) * 2021-11-08 2022-04-29 中国民航大学 Method and device for evaluating motion agility of manned robot
CN114415618B (en) * 2021-11-08 2023-09-29 中国民航大学 Method and device for evaluating movement agility of manned robot
CN114418269A (en) * 2021-11-30 2022-04-29 哈尔滨工业大学 Industrial robot safety evaluation index construction method
CN116372932A (en) * 2023-04-24 2023-07-04 深圳墨影科技有限公司 Modular design system applied to robot or robot system
CN116372932B (en) * 2023-04-24 2023-11-17 深圳墨影科技有限公司 Modular design system applied to robot or robot system

Also Published As

Publication number Publication date
CN112847430B (en) 2022-03-29

Similar Documents

Publication Publication Date Title
CN112847430B (en) Intrinsic safety design method for cooperative robot
CN108772838B (en) Mechanical arm safe collision strategy based on external force observer
Oberer et al. Robot-dummy crash tests for robot safety assessment
KR101850185B1 (en) Method and means for designing and/or operating a robot
CN106182087B (en) Position of collision cognitive method based on six-dimension force sensor
CN203541876U (en) Three-degree-of-freedom anti-collision force sensor
CN106872180B (en) A method of for determining occupant's head damage in vehicle frontal collision
CN107703748A (en) A kind of heavy-load robot static rigidity discrimination method based on biasing plate design
CN109910057B (en) Collision test method and system for rehabilitation robot
Bortot et al. Human motion behavior while interacting with an industrial robot
Wang et al. Classification, personalised safety framework and strategy for human-robot collaboration
CN110497405A (en) For controling the force feedback man-machine collaboration anticollision detection method and module of integral control system
KR102289375B1 (en) Real-time safety evaluation method of robot based on the big data of collision physical force using graphic information
CN106003032A (en) Robot astronaut capable of stably climbing in space station cabin
CN208179600U (en) Mobile robot
US9073207B2 (en) Method for improving sensitivity of robot
Iwata et al. A physical interference adapting hardware system using MIA arm and humanoid surface covers
CN109113001B (en) Anti-collision guardrail
Wang et al. Safety strategy in the smart manufacturing system: A human robot collaboration case study
Wu et al. Optimal Control Method for Side Impact Safety of Vehicle Frame Structure.
CN107538486A (en) A kind of joint power control platform device, method and relevant apparatus
CN116330344A (en) Cooperative robot collision detection method based on supervised learning support vector machine
Laffranchi et al. Improving safety of human-robot interaction through energy regulation control and passive compliant design
Ikuta et al. Safety evaluation method of human-care robot control
CN201993189U (en) Integrated five dimensional micro force/moment sensor

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant