Abstract

The R-Min robot is an intrinsically safe parallel manipulator dedicated to pick-and-place operations. The proposed architecture is based on a five-bar mechanism, with additional passive joints in order to obtain a planar seven-bar mechanism with two degrees of underactuation, allowing the robot to reconfigure in case of a collision. A preload bar is added between the base and the end-effector to constrain the additional degrees-of-freedom. This article presents an analysis of the workspace and of the safety performances of the R-Min robot, and it compares them with those of the five-bar mechanism, in order to evaluate the benefits of introducing underactuation in a parallel architecture to obtain intrinsically safer robots. The geometrico-static model of the R-Min robot is formulated as an optimization problem. The direct and inverse kinemato-static models are derived from the geometrico-static model and they allow to express the singularity conditions of the R-Min robot. An analysis of the singularity loci is carried out among the robot’s workspace. A controller based on the dynamic model is proposed and experimentally validated on a prototype of the R-Min robot. Finally, the safety performances of the R-Min robot are evaluated experimentally and they are compared with that of an equivalent five-bar mechanism, using the maximum impact force as a safety criteria in accordance with recent international standards.

1 Introduction

1.1 Context and State-of-the-Art.

The introduction, in the industry, of collaborative robotic cells able to safely share their workspace with humans requires finding solutions to reduce the risk to an acceptable level. Improving the safety of robots can be achieved by sensing or control strategies (reviews can be found in Refs. [1, 2]). However, those strategies are limited by the bandwidth and the response time of the controller, making it hardly suitable to face the high dynamics and unpredictable nature of human displacements. Therefore, strategies based on the mechanical design to obtain intrinsically safe robots are worth being deeply investigated.

A first strategy consists in reducing the mass of the robot links in order to reduce the reflected mass at the impact [35] and thus to mitigate the impact severity. However, when applied to a serial architecture, this strategy is limited by the rigidity of the resulting architecture and the accuracy of the end-effector’s position. Another strategy consists in using intrinsically compliant actuators such as series elastic actuators (SEAs) [6], variable stiffness actuators (VSAs) [7], or the distributed macro-mini (DM2 ) actuation approach [8]. This principle allows to decouple the inertia of the links from that of the motor, thus reducing the reflected mass at the impact. If the use of SEA leads to concepts suffering from poor accuracy, the VSA and DM2 lead to complex and costly actuators. Therefore, other interesting concepts have been proposed based on the use of preloaded compliant mechanisms [913] or clutch mechanisms [14]. Such solutions have been used in multi-link serial architectures, however the experimental evaluation of their safety are often conducted on a single link mechanism.

The use of a parallel architecture to design safe robots has been little investigated in the literature [15], although it allows to reduce the mass of the moving links. In previous works [16], we introduced the R-Min robot, an underactuated parallel robot, whose design is based on the architecture of the five-bar mechanism in which two supplementary passive joints are added. The obtained robot can self-configure in case of a collision with the environment allowing to mitigate the severity of an impact with a human being. However, no experimental proof of the safety performances of this concept has been provided so far.

Assessing the safety of a collaborative robotic application requires the use of safety-related criteria. The automotive industry widely used the head injury criteria [17] to evaluate the severity of a crash accident for human beings. However, it appears that this index is not well suited to analyze the severity of an impact with a robot [18, 19], since the velocity of the robot tip is much lower than that of a car. More recently, bio-mechanical thresholds have been furnished in the standard ISO/TS 15066 [20] for 29 different body parts, based on the experimental analysis of the pain tolerance of 100 healthy subjects [21], following the early works of Ref. [22]. These thresholds define the maximum quasi-static (resp. transient) force and pressure which can be continuously (resp. temporary) applied by the robot on a human body part.

Multiple experimental works investigated the evaluation of the safety performances of new concepts of safe robot. Early works were carried out by the DLR institute in a crash-test center dedicated to car certification. They used a dummy sitting in a car seat and mounted a force sensor at the end of the DLR Light-Weight Robot (LWR) III robot [18]. Such an experimental setup is obviously complex and costly to reproduce. Recently, the consortium of the European project COVR, dedicated to safety-related issues, published protocols to help end-users and system integrators to measure the force and pressure during a constrained [23] or unconstrained impact [24] (an impact is said to be constrained when the impacted human body region is clamped between the robot and the wall or any other rigid and fixed part of the workspace). This protocol involves the use of appropriate force and pressure sensors but also a dedicated mechanical system which imitates the bio-mechanical properties of the human body, including a spring to mimic the stiffness of the impacted human body part and a foam to mimic the nonlinear properties of the skin. The characteristics of the spring (stiffness) and the foam (thickness and hardness) are specified in a former study [25] of the DGUV (Deutsche Gesetzliche Unfallversicherung) institute.

1.2 Contribution Highlights.

The aim of this paper is to demonstrate the interest of introducing underactuation and compliance in the mechanical architecture of a parallel robot in order to improve the safety of the robot. The performances of the R-Min robot are thus compared with those of the five-bar mechanism from which it is inspired. First, the workspace of the R-Min robot is compared with that of the five-bar mechanism. Therefore, the direct and inverse geometrico-static model and kinemato-static model of the R-Min robot are introduced in a forward and unified manner. The geometrico-static model is formulated as an optimization problem minimizing the potential energy of the robot, and it conducts, through a numerical analysis, to the definition of the robot’s workspace. Singularity conditions are derived from the kinemato-static model allowing to determine the singularity loci in the robot’s workspace. Then, the safety performances of the R-Min robot are experimentally compared with those of the five-bar mechanism. Therefore, a prototype of the R-Min robot was designed and manufactured. This prototype can be turned into a five-bar mechanism with equivalent inertia properties allowing a fair comparison. Following recent international standards, a measurement device is used to measure the maximum impact force and evaluate the severity of an impact. A set of experiments is defined in order to analyze the effect of multiple parameters on safety such as the robot’s configuration at the time of impact, the position of the contact on the robot, the velocity of the robot, and the stiffness of the preload bar.

The paper is constructed as follows: Sec. 2 presents the R-Min robot and the manufactured prototype. In Sec. 3, the geometrico-static and kinemato-static models of the R-Min robot are introduced and a singularity analysis is presented. The Cartesian workspace of the R-Min robot is drawn and compared with that of the five-bar mechanism. The effect of the robot’s stiffness on the size of the workspace is analyzed. In Sec. 4, the dynamic model of the robot is presented as well as the associated computed torque controller. The tracking performances of the controller are then evaluated experimentally on a prototype of the R-Min robot. Section 5 presents the experimental setup and the experimental protocol designed to allow the comparison of the safety performances of the R-Min robot with respect to that of the five-bar mechanism based on the measurement of the impact force. The effect of the stiffness of the preload bar on safety is analyzed. Conclusions are drawn in Sec. 6.

2 Presentation of the R-Min Robot

In this section, the kinematic architecture of the robot is introduced. Its behavior when faced with different operating scenarios (in particular during a collision with an operator) is illustrated. The corresponding prototype is introduced for further numerical and experimental analysis.

2.1 Description of the R-Min Kinematic Architecture.

The R-Min robot is an underactuated parallel mechanism designed as a proof of concept for pick-and-place operations in a collaborative cell. Its architecture presented in Fig. 1(a) is inspired from the five-bar parallel mechanism depicted in Fig. 1(b). The traditional five-bar parallel mechanism is composed of two parallel legs made with four links in totality, which are linked through three passive revolute joints at points O12, O22, and P and actuated by two motors located on revolute joints at points Oi1 (i = {1, 2} the index of the leg). The resulting five-bar mechanism has two DoFs (degrees-of-freedom) and is thus fully actuated and able to position its end-effector with a high rigidity.

Fig. 1
Kinematic chains of (a) the R-Min robot and (b) the five-bar mechanism
Fig. 1
Kinematic chains of (a) the R-Min robot and (b) the five-bar mechanism
Close modal

Even if such a parallel architecture allows to reduce the moving masses in comparison with a serial architecture, a five-bar mechanism may still be harmful in case of a collision with a human because of its high stiffness. Therefore, the R-Min robot was designed so as to keep the interesting inertia properties of the five-bar mechanism while adding underactuation in the architecture in order to bring reconfiguration possibilities in case of impact. The resulting design, deeper described below, is composed of an underactuated seven-bar mechanism and a preload system to constrain the robot’s configuration in the normal operating mode (Fig. 1(a)).

The seven-bar parallel mechanism is actuated by two motors located on revolute joints at points Oi1 and composed of passive revolute joints at points Oi2, Oi3, and P (i = {1, 2}). All joint axes are aligned along the y-axis normal to the plane P0:(A,x,z). This mechanism has four DoFs (two more than the five-bar mechanism) making it underactuated with two unconstrained DoFs. At this stage, the resulting chain O12O13PO23O22 would have no rigidity making such robot of little practicability. We therefore introduce a preload system whose kinematic chain is composed of two passive revolute joints at points A and P (axes aligned along the y axis), a passive prismatic joint aligned along AP (thus lying in P0) and a compression spring exerting a force between points A and P. This preload system plays the same role as elastic elements introduced in the design of underactuated hands [26], i.e., it drives the unconstrained DoFs of the robot and kinematically constrains its configuration. This permits to tense the two distal legs O12O13P and O22O23P in order to obtain a robot stiff enough to be controlled, but less stiff than a traditional five-bar mechanism for safety purpose. In addition, since the preload system is located between the two legs, it cannot collide with an operator. This practical solution avoids adding masses on external legs (such as installing a torsion spring on passive joints Oi3 of the seven-bar mechanism), providing a safer design.

In Fig. 2, the configuration of the R-Min robot is illustrated in two different situations: during a pick-and-place trajectory, when no contact occurs (Fig. 2(a)) and when a collision occurs on distal links (Fig. 2(b)). When the robot is subject to gravity effect only (including a payload at the end-effector), points Oi2, Oi3, and P are close to be aligned, thanks to the preload system (Fig. 2(a)). As a result, the configuration of the R-Min robot is close to that of the five-bar mechanism and the position of the end-effector can be precisely determined, making this solution practicable for pick-and-place operations. On the other hand, when loadings likely to appear during an impact with a human are applied on the robot (on a distal link), it encounters large internal reconfigurations (Fig. 2(b)). This behavior should avoid transmitting a large part of the robot’s kinetic energy during impact, since a large part of the collision energy will be dissipated through the reconfiguration of the robot. This behavior makes the R-Min robot a good candidate for safe physical interactions during pick-and-place operations, as it will be confirmed experimentally in what follows.

Fig. 2
Representation of the configuration of the R-Min robot during a pick-and-place trajectory: (a) without contact, the R-Min robot lies in a configuration close to the five-bar mechanism due to the force exerted by the preload bar so that the end-effector is precisely positioned, (b) when a collision occurs on the distal link, the robot self-configures to mitigate the impact force: (a) Configuration without contact and (b) configuration in case of contact
Fig. 2
Representation of the configuration of the R-Min robot during a pick-and-place trajectory: (a) without contact, the R-Min robot lies in a configuration close to the five-bar mechanism due to the force exerted by the preload bar so that the end-effector is precisely positioned, (b) when a collision occurs on the distal link, the robot self-configures to mitigate the impact force: (a) Configuration without contact and (b) configuration in case of contact
Close modal

2.2 Presentation of the R-Min Prototype.

A prototype of the R-Min robot was manufactured based on the kinematic architecture previously defined, and is presented in Fig. 3. The key features of the design of this prototype are described below:

  • All links are made in aluminum hollow tubes of circular cross section, with (a) an external diameter of 30 mm, a thickness of 5 mm for proximal links 11 and 21 (Fig. 1(a)) and (b) an external diameter of 20 mm, a thickness of 2 mm for all other links.

  • Passive joints are made with bronze plain bearings instead of ball bearings, to lighten the mechanism.

  • The compression spring of the preload system is replaced by a set of two traction springs in order to avoid the self-locking effect of the translational guidance.

  • Two direct drive motors SIMOTICS S-1FL6 are used (maximum torque of 23.9 N m when using motor torque control).

The geometric and inertia properties of the R-Min robot are provided in Table 1. Two interchangeable springs of the preload system are indicated. In the following, the robot with the default spring (kt = 111.2 N/m) is referred to as R-Min, while the robot with the stiffer spring (kt = 239.2 N/m) is referred to as R-Min+.

Fig. 3
Prototype of the R-Min robot. This prototype can be turned into an equivalent five-bar mechanism by removing the preload system and locking the two passive joints located at point Oi3 (i = {1, 2}).
Fig. 3
Prototype of the R-Min robot. This prototype can be turned into an equivalent five-bar mechanism by removing the preload system and locking the two passive joints located at point Oi3 (i = {1, 2}).
Close modal
Table 1

Geometric, inertia properties, and design parameters of the prototype of the R-Min robot

LinkLength,Mass,Inertia,aCOM,b
(i; j)i,jmi,jJi,jxi,j
(m)(kg)(kg m2)(m)
(1 and 2;1)0.286.920.03480.0148
(1 and 2;2)0.20.3020.0070.126
(1 and 2;3)0.20.2500.00370.086
(−;4)0.870.540.173−0.429
(−;5)0.810.0040
O11O21=0.25 m
Parameters of the preload bar spring:
Default setting: kt = 111.2 N/m, ℓ0 = 82.7 mm
R-Min+ setting: kt = 239.2 N/m, ℓ0 = 102.5 mm
LinkLength,Mass,Inertia,aCOM,b
(i; j)i,jmi,jJi,jxi,j
(m)(kg)(kg m2)(m)
(1 and 2;1)0.286.920.03480.0148
(1 and 2;2)0.20.3020.0070.126
(1 and 2;3)0.20.2500.00370.086
(−;4)0.870.540.173−0.429
(−;5)0.810.0040
O11O21=0.25 m
Parameters of the preload bar spring:
Default setting: kt = 111.2 N/m, ℓ0 = 82.7 mm
R-Min+ setting: kt = 239.2 N/m, ℓ0 = 102.5 mm
a

Moments of inertia around y are provided at the COM.

b

Center of masses Sij (Fig. 1(a)) are located on the lines OijOij+1. xi,j is the distance from Sij to Oij.

The R-Min prototype can be turned into a five-bar mechanism, by removing the preload system and locking the two passive joints located at Oi3. This solution allows to obtain two robots with comparable dimensions, inertia, and contact geometry, and thus to obtain a fair comparison of the robots performances. The geometric and inertia properties of the obtained five-bar mechanism are provided in Table 2.

Table 2

Geometric, inertia properties, and design parameters of the prototype of the equivalent five-bar mechanism

Length,Mass,Inertia,COM,
Linki,jmi,jJi,jxi,j
(i; j)(m)(kg)(kg m2)(m)
(1 and 2;1)0.286.920.03480.0148
(1 and 2;2)0.400.590.03480.213
O11O21=0.25 m
Length,Mass,Inertia,COM,
Linki,jmi,jJi,jxi,j
(i; j)(m)(kg)(kg m2)(m)
(1 and 2;1)0.286.920.03480.0148
(1 and 2;2)0.400.590.03480.213
O11O21=0.25 m

3 Workspace Analysis of the R-Min Robot

In this section, the computation of the geometrico-static model of the R-Min robot is presented (in a more unified way than in Ref. [27]). The kinemato-static model2 is derived from the geometrico-static model and allows to express the singularity conditions. The workspace of the R-Min robot is computed numerically and compared with that of the five-bar mechanism.

3.1 Geometrico- and Kinemato-Static Models of R-Min Robot

3.1.1 Geometrico-Static Problem.

The R-Min robot being underactuated, its equilibrium configuration is obtained at a minimum of the potential energy U. The robot configuration is parameterized with the joint angles qij (with i = {1, 2} the index of the leg and j = {1, 2, 3} the index of the link) defining the angle between the links (i, j), q4, the direction of the preload system, and ρ its length. In what follows, we will denote as qa=[q11q21]TR2 the vector of the active joint coordinates, qd=[q12q13q22q23]TR4 the vector of the passive joint coordinates (excluding the preload system), and p=[xz]TR2 the end-effector position vector expressed in the frame F0.

In order to solve the geometrico-static problem, for a given value of the motor angles qa (considered to be blocked), it is necessary to find the configuration qdp=[qdTpT]TR6 which minimizes the robot potential energy (A7), under geometric constraints (1). Indeed, due to the closed-chain nature of the robot, the variables qa, qd, and p are not independent. Four constraint equations grouped in the vector ϕ=[ϕ1Tϕ2T]T can be defined:
ϕi=0=OOi1+i1ui1+i2ui2+i3ui3p
(1)
with i = {1, 2} the index of the leg and uij=[cos(k=1jqik)sin(k=1jqik)]T the direction vector of the link (i, j).
Mathematically speaking, the geometrico-static problem can be formulated as
qdp=argminU(qa,qd,p) subject to ϕ(qa,qd,p)=0
(2)
The total potential energy of the robot U can be expressed as a function of the coordinates qa, qd, and p. For the sake of conciseness, details of the computation are given in Appendix  A. This optimization problem can be reformulated using the augmented Lagrangian function defined as
L=U(qa,qd,p)+ϕT(qa,qd,p)λ
(3)
where λR4 is a vector of Lagrange multipliers. Solutions to (2) can be found by solving the first-order stability conditions [29] qdp,λL=0, which are formulated as follows:
{h(qa,qd,p,λ)=0ϕ(qa,qd,p)=0
(4)
with h(qa,qd,p,λ)=qdpU+qdpϕλ, the gradient of the Lagrangian with respect to qdp.

The system of Eq. (4) is composed of 10 equations, and contains 12 unknowns (qa, qd, p, λ). Therefore, it can be solved by fixing two of the unknowns to a desired value, in order to get either the forward geometrico-static model or the inverse geometrico-static model. Since the solutions to Eq. (4) cannot be obtained analytically, a numerical solver for nonlinear systems of equations must be used. In this work, we used the Matlab implementation of the Levenberg–Marquardt algorithm implemented in the fsolve function.

1 Forward geometrico-static model.

By fixing the value of qa to a given value qa*, it is possible to compute a solution (qd*,p*,λ*)R10 to Eq. (4).

2 Inverse geometrico-static model.

In the same manner, by fixing the value of p to a given value p*, a solution (qa*,qd*,λ*)R10 to Eq. (4) can be found.

3 Second-order stability condition.

The computed configuration (qa*,qd*,p*,λ*) is not necessarily a stable configuration, since it is not necessarily a minimizer of the potential energy U, but could be a maximizer or a saddle point. In order to assess the stability of a configuration satisfying the first-order condition given in Eq. (4), second-order conditions must be checked as detailed in Ref. [29]. These conditions can be formulated using the following two matrices:

  • The Hessian matrix of the Lagrangian function with respect to qdp:
    H(qa*,qd*,p*,λ*)=qdpqdp2L(qa*,qd*,p*,λ*)=Dqdph(qa*,qd*,p*,λ*)
    (5)
  • A matrix ZR6×2 spanning the null space of the transposed gradient of the constraints:
    ZKer(qdpϕT(qa*,qd*,p*,λ*))
    (6)
Then, the configuration (qa*,qd*,p*,λ*) is stable if the projected (or reduced) Hessian Hz = ZTHZ is positive definite, i.e., if Hz0 [29].

3.1.2 Kinemato-Static Modelling of the R-Min Robot.

The kinemato-static model of the robot can be obtained by differentiating the geometrico-static model (4) with respect to time:
{Dqahq˙a+Dphp˙+Dqdhq˙d+Dλhλ˙=0Dqaϕq˙a+Dpϕp˙+Dqdϕq˙d=0
(7)
Equation (7) can be simplified by left-multiplying its first line by matrix ZT defined in (6), noticing that Dλh=qdpϕ. We then obtain
Aq˙a+Pp˙+Dq˙d=0
(8)
with
A=[ZTDqahDqaϕ]R6×2
P=[ZTDphDpϕ]R6×2
and
D=[ZTDqdhDqdϕ]R6×4

The system of Eq. (8) is made of six equations, and contains eight unknowns (q˙a,q˙d,p˙). Therefore, by fixing two of the unknowns to a desired value, Eq. (8) can be solved, in order to get either the forward kinemato-static model (FKSM) or the inverse kinemato-static model (IKSM).

1 Forward kinemato-static model.
It allows to express the end-effector velocity p˙ and the passive joint velocities q˙d as a function of the motor velocities q˙a:
[p˙q˙d]=GPD1Aq˙a
(9)
where GPD=[PD]R6×6. The conditions of degeneracy of the matrix GPD are discussed later.
2 Inverse kinemato-static model.
It allows to express the motor velocities q˙a and the passive joint velocities q˙d as a function of the end-effector velocity p˙:
[q˙aq˙d]=GAD1Pp˙
(10)
where GAD=[AD]R6×6. The conditions of degeneracy of the matrix GAD are discussed in the next paragraph.
3 Singularity analysis.

The system of Eq. (8) is analogous to that of a continuum parallel robot [30], as detailed in Ref. [31]. Based on this paper, several types of singularities may appear for this system of equations, among which the main ones are:

  • Type 1 singularities: appear when matrix GAD is rank deficient, while the matrices A and D are full rank. These are singularities of the IKSM: In them, a motion of the motors do not lead to a motion of the end-effector in some given direction. They define the workspace boundaries.

  • Type 2 singularities: appear when matrix GPD is rank deficient, while the matrices P and D are full rank. These are singularities of the FKSM: For a fixed position of the motors, a small displacement of the end-effector is allowed. As shown in Ref. [31], they define the boundaries of the stable configuration domains and lead to a loss of stiffness of the robot.

  • Type 3 singularities: appear when matrices GAD and GPD are rank deficient at the same time, while the matrices A, P, and D are all full rank. These are a combination of both other types of singularities.

Other types of singularity may be found, as mentioned in Ref. [31], but do not appear in the study of the prototype of the R-Min robot, therefore we do not recall them.

3.2 Robot Workspace Analysis.

In what follows, the algorithm provided in Ref. [27] is used to draw the Cartesian workspace of the R-Min robot. Since there exist multiple solutions to the geometrico-static problem of the R-Min robot (as detailed in Ref. [27]), the following inequalities are added in order to keep only the set of solutions corresponding to the configuration of the robot depicted in Fig. 2(a):
4π/3<q11<π/6
(11)
5π/6<q21<π/3
(12)
y<0
(13)
π/2<qi3<π/2
(14)
0<θ1<π
(15)
π<θ2<0
(16)
with θi being the angle between Oi1Oi2 and Oi2OP. The search of the workspace is performed only in half of the joint space since the robot is symmetric, therefore the additional constraint πq21 < q11 is considered.

The working mode depicted in Fig. 2(a) is suitable for multiple reasons:

  • both distal arms can fold in case of a collision with a human,

  • the preload bar does not present any risk of injury since it lies between both distal arms,

  • it offers a large Cartesian space for the controlled point,

  • the weight of the payload has no (or little) effect on the position of the end-effector, as shown in Ref. [27].

The obtained workspace for the current prototype is represented in Fig. 4. It corresponds to the set of stable solutions to the geometrico-static problem, satisfying inequalities (11)(16). The parameters of the prototype provided in Table 1 have been considered for the computation with the default setting of the preload system.

Fig. 4
Inverse condition numbers of matrices: (a) GPD and (b) GAD plotted in the Cartesian workspace of the R-Min robot
Fig. 4
Inverse condition numbers of matrices: (a) GPD and (b) GAD plotted in the Cartesian workspace of the R-Min robot
Close modal

The values of the inverse condition numbers of the matrices GPD and GAD are, respectively, plotted in Figs. 4(a) and 4(b) allowing to localize the singularity loci3 in the Cartesian workspace. Several observations can be made:

  • Type 2 singularity loci are only present in the top of the workspace, thus allowing to have a large region without issues in terms of stability.

  • The boundaries of the workspace are made of either (a) singularities or (b) the joint limits given in Eqs. (11)(14).

Figure 5 decomposes the boundaries of the workspace of the R-Min robot: curves L1, L4, and L6 correspond to singularities (as it can be seen in Fig. 4), while L2 and L3 correspond to the mechanical limits of both motors (respectively q21 < π/3 and q11 < −π/6), and L5 corresponds to the symmetry of the robot. When considering unlimited motor torques, L1L6 thus represent the boundaries of the workspace for the R-Min robot. When considering the motor torque limitations of our prototype (23.9 N m), a new boundary appears which depends on the stiffness of the preload system. This boundary can significantly reduce the workspace. Thus, the curve L7 (respectively L8) indicates the position for which one motor reaches the maximal value 23.9 N m for the R-Min robot (respectively for R-Min+).

Fig. 5
Decomposition of the workspace boundaries of the R-Min robot
Fig. 5
Decomposition of the workspace boundaries of the R-Min robot
Close modal

The whole workspace of the R-Min robot is drawn in Fig. 6(a). When no limitation of the motor torque is considered, the workspace of the R-Min robot is close to that of the five-bar mechanism corresponding to Table 2 (Fig. 6(b)). However, when considering the maximal torque that can be delivered by each motor (23.9 N m for the prototype), the size of the workspace of the R-Min robot decreases. This workspace is represented for two interchangeable springs in the preload system, with a stiffness kt = 111.2 N/m and a free length ℓ0 = 82.7 mm for the R-Min robot (Fig. 6(c)) and kt = 239.2 N/m, ℓ0 = 102.5 mm for the R-Min+ robot (Fig. 6(d)). Indeed, when increasing the spring stiffness, the size of the workspace decreases because motors cannot deliver enough torque to compensate the wrench applied by the preload system at the end-effector.

Fig. 6
(a and b) Representation of the Cartesian workspace of the R-Min robot for two different values of the spring stiffness in the preload bar considering a maximum motor torque of 23.9 N m, compared with (c) the Cartesian workspace of the five-bar mechanism. The robot parameters given in Table 1 have been considered: (a) R-Min workspace without motor torque limitations, (b) workspace of the five-bar mechanism. R-Min workspace, (c) with motor torque limitations, and (d) R-Min+ workspace with motor torque limitations
Fig. 6
(a and b) Representation of the Cartesian workspace of the R-Min robot for two different values of the spring stiffness in the preload bar considering a maximum motor torque of 23.9 N m, compared with (c) the Cartesian workspace of the five-bar mechanism. The robot parameters given in Table 1 have been considered: (a) R-Min workspace without motor torque limitations, (b) workspace of the five-bar mechanism. R-Min workspace, (c) with motor torque limitations, and (d) R-Min+ workspace with motor torque limitations
Close modal

We may thus conclude that the spring stiffness of the preload system has a considerable impact on the size of the robot workspace: the lower the stiffness, the larger the workspace. In addition, a lower stiffness would intuitively be related to a safer robot as will be discussed later in Sec. 5. However, since the R-Min robot is underactuated, there exist internal oscillations of the passive joints during a trajectory, whose amplitude is related to the robot stiffness. These oscillations are directly related to the positioning accuracy of the end-effector which is evaluated in the following section.

4 Dynamic Modeling and Control of the R-Min Robot

In this section, the dynamic model of the R-Min robot is introduced. Based on this model, a modified version of a computed torque controller is proposed. The tracking performances of the implemented controller are then evaluated experimentally.

4.1 Dynamic Model of the R-Min Robot.

The dynamic model of the R-Min robot is derived from the Lagrange equations. Since the robot has four DoFs, it can be parameterized by four independent coordinates that will be denoted by the vector qg, defined as qg=[qaTquT]TR4, with qa = [q11q21]T and qu = [q12q22]T. The remaining coordinates defining the configuration of the robot are grouped into the vector qc=[q13q23pT]TR4. The dynamic model is thus given by
[τ00]+[qaϕquϕqcϕ]ν=[τqaτquτqc]
(17)
with τqa, τqu, and τqc, the generalized torques associated to the coordinates qa, qu, and qc, obtained using the equations of Lagrange τqk=(d/dt)(L/q˙k)T(L/qk)T with k = {a, u, c}. L = EU is the robot Lagrangian. For the sake of conciseness, the expressions of the potential energy U and the kinetic energy E are detailed in Appendices A and B. τR2 is the vector of the motor input efforts and νR4 is a vector of Lagrange multipliers (which should not be confused with vector λ introduced in the augmented Lagrangian formulation of the optimization problem in Sec. 3.1.1).
This model can also be rewritten under the form below, by removing the Lagrange multipliers ν, using the third line of Eq. (17):
[τ0]=[τqaτqu][qaϕquϕ](qcϕ)1τqc
(18)
where qcϕR4×4 is a square and invertible matrix.
Finally, after some tedious undetailed mathematical simplifications, and by replacing the expressions of the variables in the vector qc and their time derivatives by their expressions as a function of qg, q˙g, and q¨g, the dynamic model can be obtained under the following standard form [33]:
[τ0]=[M11(qg)M12(qg)M21(qg)M22(qg)][q¨aq¨u]+[c1(qg,q˙g)c2(qg,q˙g)]
(19)
where MklR2×2 (k, l = {1, 2}) are submatrices composing the robot inertia matrix, and ckR2 are vectors containing the centrifugal, Coriolis, gravity, and spring effects. It should be noted that friction terms in the joints could also be added in the vectors ck using the methodology presented in Ref. [34].

4.2 Robot Controller.

A modified version of the computed torque controller [33] is applied for the control of the R-Min robot. For computing the motor torques, let us modify the equations of the dynamic model as follows. First, using the bottom of Eq. (19), we get
q¨u=M221M21q¨aM221c2
(20)
Then, introducing this expression of q¨u in the top of Eq. (19), the input torques τ can be obtained as follows:
τ=(M11M12M221M21)q¨a+c1M12M221c2
(21)
In Eq. (21), the terms Mkl and ck depend obviously on qa, qu and their time derivatives. However, the R-Min prototype (presented in Sec. 2) is equipped with only two sensors positioned on both motors, which is not enough to compute the full robot configuration. It was then necessary either to predict the behavior of the robot or to make an assumption on the robot’s configuration. In order to simplify the problem, and because the preload system tense the distal arms, angles q13, q23 and their time derivatives are assumed to be null at any time, allowing to estimate qu and its time derivatives based on the second line of Eq. (7). This hypothesis is of course not true in practice, but this approximation will be compensated when controlling the input efforts τ, thanks to the use of an integral term, as proposed in the following equation, derived from (21):
τ=(M11M12M221M21)(q¨a*+ki(qa*qa)+kp(qa*qa)+kd(q˙a*q˙a))+c1M12M221c2
(22)
with qa*, q˙a*, and q¨a*, the desired position, velocity, and acceleration, respectively, and kd, kp, ki three gains defined by [33]
kd=(1+2ξ)ω
(23)
kp=(1+2ξ)ω2
(24)
ki=ω3
(25)
where, for our prototype, the damping coefficient ξ is fixed at 0.72 and the controller cutoff pulsation ω is experimentally set at 22 rad/s.

4.3 Experimental Evaluation of the Controller Performances.

In this section, the tracking performances of the controller are evaluated experimentally on the prototype of the R-Min robot. A reference trajectory is defined in the Cartesian space. It consists of a linear, horizontal trajectory of 30 cm generated using a quintic polynomial motion law so as to reach a maximal linear velocity of the end-effector of 1.5 m/s (see Fig. 7). From this trajectory, the desired motor positions, velocities, and accelerations, qa*(t), q˙a*(t), and q¨a*(t) (the controller inputs), are computed using the dynamic model. It should be noted that the dynamic model was previously validated experimentally by a proper comparison of simulation and experimental results, whose details are not shown in this article.

Fig. 7
Trajectory used for the evaluation of the controller performances: (a) reference trajectory for the robot end-effector and (b) reference trajectory for the robot end-effector given in the R-Min workspace with initial and median configuration obtained from the inverse geometrico-static model
Fig. 7
Trajectory used for the evaluation of the controller performances: (a) reference trajectory for the robot end-effector and (b) reference trajectory for the robot end-effector given in the R-Min workspace with initial and median configuration obtained from the inverse geometrico-static model
Close modal

The tracking errors on motor coordinates were measured using the motor encoders. Results are presented in Fig. 8(a), showing a maximal error of 3.2 deg. This value is relatively low regarding the simplicity of the used controller and seems low enough to achieve pick-and-place operations. The tracking error at the level of the end-effector was obtained from a camera.4 Results are presented in Fig. 8(b) and show a maximal error of 17 mm along the x direction and 14 mm along the z direction. At the end of the motion, a residual error of 4 mm is probably due to the presence of dry friction in the passive joints and to encoder calibration errors which are not compensated. These errors appear to be reasonable for a pick-and-place application. Figure 8(c) shows the evolution of the passive angles q13 and q23 along the trajectory. A maximal amplitude of 9.3 deg is reached which indicates that the amplitude of these uncontrolled internal motions remains low enough not to represent an additional risk for human operators.

Fig. 8
Evolution of (a) the controller tracking errors, (b) the positioning error at the end-effector, and (c) the passive angles q13 and q23 obtained during the reference trajectory with the R-Min robot (kt = 111.2 N/m)
Fig. 8
Evolution of (a) the controller tracking errors, (b) the positioning error at the end-effector, and (c) the passive angles q13 and q23 obtained during the reference trajectory with the R-Min robot (kt = 111.2 N/m)
Close modal

5 Experimental Analysis of the Safety Performances of the R-Min Robot

In this section, we first introduce the experimental setup that will be used in order to analyze experimentally the safety performances of the R-Min robot and to compare them with those of the five-bar mechanism. Following the recommendations given in the standard ISO 15066 [20], the maximum impact force is chosen as the safety criteria. This impact force is measured using a dedicated impact force measurement device (IFMD), which will be presented below. This IFMD allows to mimic the bio-mechanical properties of different parts of the human body, in case of a constrained impact (i.e., when the human body is clamped between the robot and a wall or the ground). Multiple impact scenarios are conducted in order to evaluate the effects of different parameters on safety such as the configuration of the robot, the location of the impact on the robot (at the end-effector or on middle of the distal arm), the velocity of the end-effector at the time of impact, the impacted human body part, or the stiffness of the preload spring.

5.1 Description of the Experimental Setup

5.1.1 Description of the Compared Robots.

The experimental setup is constituted of two robots: a prototype of R-Min presented in Sec. 2.2 and a five-bar mechanism. The five-bar mechanism is obtained by locking the passive joints at O13 and O23 of the R-Min robot and by removing the preload bar. This permits to obtain two robots with comparable geometric and inertia properties. The R-Min robot is controlled using the strategy given in Sec. 4.2, whereas the five-bar mechanism is controlled using a standard computed torque control [33]. Additionally, in the controller, an impact detection was settled to avoid the application of a continuous force on the impacted body after the collision. Once an impact is detected, the controller generates motor torques that compensate gravity effects only. As mentioned in the previous section, a high-frequency camera allows to measure the instant configuration of the robot and obtain its time derivatives numerically.

5.1.2 Impact Force Measurement Device.

The impact force is measured using a dedicated IFMD which allows to mimic the bio-mechanical properties of different body parts such as the stiffness of the impacted body part and the non-linear properties of the skin, in case of a constrained impact. In accordance with the protocols given in Refs. [24, 23], this system is composed of a translating impactor, a changeable spring, a changeable soft material cover (foam), and a force sensor. The stiffness of the spring and the hardness and thickness of the foam are specified for 29 body parts in a document of the DGUV [25]. These protocols [24, 23] also recommend measuring the pressure during the collision, however, since the current paper focuses on the effect of the robot’s architecture on safety and not on the local geometry of the robot where the contact occurs, the pressure was not measured. The clamping force, which is another important safety criteria [20] when considering a constrained impact, is not analyzed either in our evaluation. Indeed, thanks to the impact detection implemented in the controller and the subsequent reaction applied on motor torques, the clamping force is systematically null.

For the needs of the experiments, we designed our own IFMD (see Figs. 9(a) and 9(b)) following the recommendations given in Refs. [2325]. It is constituted of the following parts:

  • an impactor of mass mp linked to the ground through a prismatic joint,

  • a set of three foams with different Shore A hardness and thickness ℓf (this set was provided by the Pilz company),

  • a set of three springs with different stiffnesses kh,

  • a force sensor Delta IP 68, with a measurement range of 1980 N along the impact direction, a resolution of 0.5 N, and a data acquisition frequency of 7 kHz. The signal is filtered with a fourth-order low-pass butterworth filter with a 3 dB frequency of 1 kHz,

  • a stiff positioning table to position the force sensor with respect to the chassis of the robot.

The foam and the spring were chosen to match the properties of three different body parts: the belly, the leg, and the head, as displayed in Table 3. These three body parts were selected because they represent the range of body stiffnesses given in the standards ISO/TS15066 [20] from 10 to 150 N/mm and use the three possible foams. As shown in Table 3, the stiffnesses of the springs selected within the manufacturer’s catalogue differ from the recommended values in Ref. [20] for multiple reasons related to the mechanical design. However, it is not our objective in this article to assess the safety of the R-Min robot, but only to compare its safety performances with respect to the five-bar mechanism.

Fig. 9
(a) Picture of the designed IFMD mounted on the positioning table and (b) its schematic
Fig. 9
(a) Picture of the designed IFMD mounted on the positioning table and (b) its schematic
Close modal
Table 3

Parameters of the IFMD used in the experiments, kh is the stiffness given by the manufacturer, whereas khrec is the stiffness recommended in the standard [20]

Foam hardnesslfmpkhkhrec
Body partShA(mm)(kg)(N mm−1)(N mm−1)
Belly10211.7211.310
Upper leg30141.644350
Skull and forehead7071.57116150
Foam hardnesslfmpkhkhrec
Body partShA(mm)(kg)(N mm−1)(N mm−1)
Belly10211.7211.310
Upper leg30141.644350
Skull and forehead7071.57116150

5.2 Experimental Protocol.

In the following, we explain how we designed our experiment by detailing the impact scenarios that were selected for testing. We therefore introduce four reference impact configurations (ICs). From these ICs, multiple impact scenarios are defined in order to evaluate the effect of the following parameters on impact forces: the end-effector velocity, the impacted body part, and the stiffness of the R-Min robot.

5.2.1 Definition of Tested IC.

We introduce here four reference impact configurations defined by the configuration of the robot at the time of impact, the direction of the end-effector’s velocity, and the location of the impact on the robot’s arm. These impact configurations are presented in Fig. 10 and can be summarized as follows:

  • Configuration “Co” corresponds to an impact on the distal arm (in the middle of link (2, 2) for the five-bar mechanism, on O23 for R-Min), while the robot is in a centered configuration (Fig. 10(a)).

  • Configuration “Cp” corresponds to an impact on the end-effector P, while the robot is in a centered configuration (Fig. 10(b)).

  • Configuration “So” corresponds to an impact on the distal arm (in the middle of link (2, 2) for the five-bar mechanism, on O23 for R-Min), while the robot is in a side-configuration (Fig. 10(c)).

  • Configuration “Sp” corresponds to an impact on the end-effector P, while the robot is in a side-configuration (Fig. 10(d)).

Fig. 10
Representation of the four reference impact configurations: (a) Co, (b) Cp, (c) So, and (d) Sp. The desired trajectory is represented, the robot is drawn in the initial configuration (gray) and at the time of impact (black). The workspace is drawn for two different cases: (a and b) R-Min and (c and d) R-Min+. The velocity of the end-effector and that of the impact point, as well as the location of the sensor are shown for each of the four reference impact configurations.
Fig. 10
Representation of the four reference impact configurations: (a) Co, (b) Cp, (c) So, and (d) Sp. The desired trajectory is represented, the robot is drawn in the initial configuration (gray) and at the time of impact (black). The workspace is drawn for two different cases: (a and b) R-Min and (c and d) R-Min+. The velocity of the end-effector and that of the impact point, as well as the location of the sensor are shown for each of the four reference impact configurations.
Close modal

We did not consider any impact with the proximal arm (link (i, 1)), since we assume that a proper protective housing could be designed to avoid any contact with the proximal arm of the robot.

In the collision protocols furnished by the COVR consortium [24, 23], it is recommended to position the IFMD such that the foam surface is normal to the direction of the velocity of the contact point attached to the robot vi. However, this protocol is well-adapted for serial robots, when impact occurs on the end of the arm. In our case, due to the parallel architecture of the robot and its bulky nature, the IFMD was positioned normal to the distal arm at the time of impact (see Fig. 10), so that the contact is punctual and takes place on the foam surface and not on its sides.

Table 4 regroups the main parameters defining each four impact configurations, i.e., the end-effector’s coordinates at the time of impact, the orientation of the end-effector’s velocity vector θe, the orientation of the IFMD θc, and the orientation θi of the velocity vector of the contact point. This latter angle is not measured but computed using the geometrico-static model given in Sec. 3.

Table 4

Set of parameters defining the four reference ICs

ICx(tc)z(tc)θeθcθi
(m)(m)(deg)(deg)(deg)
Co0−0.48−37.5−45−38.3
Cp0−0.41−30−54−30
So0.15−0.460−36−7.7
Sp0.15−0.480−360
ICx(tc)z(tc)θeθcθi
(m)(m)(deg)(deg)(deg)
Co0−0.48−37.5−45−38.3
Cp0−0.41−30−54−30
So0.15−0.460−36−7.7
Sp0.15−0.480−360

Note: The orientation of the impact velocity θi is computed from the quasi-static configuration and may vary slightly for the R-Min robot due to internal dynamics of passive joints.

5.2.2 Impact Scenarios.

The design of experiments is based on multiple impact scenarios defined by the selected impacting robot (R-Min, R-Min+, or five-bar mechanism), the impacted body part (belly, leg, or skull head), and the selected impact configuration (as defined in Table 4 and Fig. 10). Impact scenarios have been selected in order to allow the comparison of the R-Min robot with the five-bar mechanism from a safety perspective and to evaluate the effect of the following parameters on impact forces: the configuration of the robot, the location of the impact on the robot’s arm, the impacted body part (belly, leg, or head), the stiffness of the preload bar, and the end-effector’s velocity. Therefore, we propose the following design of experiments:

  • Eight impact scenarios are defined to analyze the effect of the impact configuration on impact forces. Both robots (R-Min and the five-bar mechanism) are tested impacting the IFMD set to mimic the head. The four impact configurations are considered: Co, Cp, So, Sp.

  • Eight additional impact scenarios are defined to analyze the effect of the impacted body part on impact forces. Both robots are tested impacting the IFMD in two additional settings (belly and leg). Two impact configurations are considered: Co, Cp.

  • Two additional impact scenarios are defined to analyze the effect of the stiffness of the spring of the preload bar on impact forces. We therefore consider the R-Min+ version of the R-Min robot which uses a set of springs with a larger stiffness (kt = 231.9 N/m). This robot is thus tested impacting the IFMD in two additional settings (belly and leg). Two impact configurations are considered: So, Sp. Impact configurations Co and Cp could be not tested for R-Min+ because the corresponding robot configurations are not inside the workspace due to the motor torque limitations.

  • The 18 previously defined impact scenarios are realized imposing three different end-effector’s velocities at the time of impact ve(tc)={1,1.5,2} m/s in order to analyze its effect on impact forces.

In order to ensure the repeatability of the obtained measures, each impact scenario was repeated 5 times for a given end-effector’s velocity. Experimental results are obtained with a good reproducibility, indeed we computed the standard deviation of the maximal impact force for each impact scenario and obtained an average standard deviation of 1.7% and a maximum one of 4.0% among all impact scenarios.

5.3 Experimental Results and Analysis.

In this section, we present the experimental results obtained from the previously presented design of experiments. The time profile of the impact force was acquired for each of the 18 impact scenarios and each of the three end-effector’s velocities. These results allow to analyze the effect of various parameters on safety as detailed in the following.

5.3.1 Comparison of R-Min With the Five-Bar Mechanism.

In this section, we present the impact forces obtained using each of the two robots impacting with the IFMD set to mimic the head with an end-effector velocity ve(tc) = 1 m/s. All four impact configurations are considered (Co, Cp, So, Sp).

As can be seen in Fig. 11(a), the maximum impact force obtained with the R-Min robot (56 N) is much lower than that obtained with the five-bar mechanism (226 N), when impact occurs on the distal arm with the robot being in a centered configuration (impact configuration Co). In this case, the maximum impact force is divided by a mean ratio5 of r = 4.0. It should be noted that the impact duration is also significantly lower for the R-Min robot, showing that the mechanical energy transmitted to the human body part through the impact is much lower when using the R-Min robot.

Fig. 11
Representation of the impact force time profile due to an impact between the R-Min robot or the five-bar mechanism and the head, with ve(tc) = 1 m/s. The four impact configurations are considered: (a) Co and Cp and (b) So and Sp.
Fig. 11
Representation of the impact force time profile due to an impact between the R-Min robot or the five-bar mechanism and the head, with ve(tc) = 1 m/s. The four impact configurations are considered: (a) Co and Cp and (b) So and Sp.
Close modal

However, when considering an impact at the level of the end-effector (Cp), the maximum impact forces are very similar for R-Min and the five-bar mechanism (280 N and 272 N, respectively). In this case, the obtained mean ratio is r = 0.94. Similar results are obtained when considering the robot in a side-configuration (So, Sp) as depicted in Fig. 11(b). We then obtain a mean ratio r = 4.6 when impact occurs on the distal arm (So) and r = 1.01 when impact occurs on the end-effector (Sp).

These results show that the underactuated architecture of the R-Min robot allows to significantly reduce the impact force when impact occurs on the middle of the distal arm at O23, whereas the impact force can increase slightly when impact occurs on the end-effector. Indeed, as shown in Fig. 12(a), the robot stiffness kr6 in the direction of impact of the R-Min robot is significantly lower than that of the five-bar mechanism, when considering an impact at point O23 for both centered and sided configurations. Interestingly, in this case, the stiffness of the R-Min robot is not isotropic but is particularly low in the direction of a probable impact (normal to the distal links 22 and 23), in contrast with the five-bar mechanism. Conversely, the R-Min stiffness is rather isotropic at the end-effector but larger than the stiffness of the five-bar mechanism (Fig. 12(b)).

Fig. 12
Representation of the robot stiffness ellipsoid of the R-Min robot and the five-bar mechanism, considering: (a) an impact at the end-effector and (b) an impact at point O23
Fig. 12
Representation of the robot stiffness ellipsoid of the R-Min robot and the five-bar mechanism, considering: (a) an impact at the end-effector and (b) an impact at point O23
Close modal

This behavior of the R-Min robot can be explained by the fact that at the instant before collision, the distal links (i, 2) and (i, 3) are nearly aligned due to the tension applied in the preload bar, making the robot as stiff as the five-bar mechanism at the end-effector, independently of the stiffness of the preload bar. Figure 13(b) shows that the distal links of the R-Min robot remain aligned after an impact at the end-effector, in contrast with an impact at O23 as shown in Fig. 13(a). For both robots, the stiffness at the end-effector mainly relies on the controller stiffness. Indeed, the stiffness of the robot mechanics at the end-effector is infinite when considering rigid links and joints, for both the five-bar mechanism and R-Min (considering aligned distal links in this latter case). The controller stiffness is given by the proportional gain kp defined in Eq. (22), which depends on the inertia of the robot. This explains why the R-Min robot, whose inertia is larger than that of the five-bar mechanism, has a larger stiffness ellipsoid. The introduction of a mechanical stop between links i2 and i3 on both arms, hindering the alignment of these two links, could help reducing the stiffness and the impact force at the end-effector, but, conversely, would increase the stiffness and the impact force at point Oi3. Authors believe a compromise could be found in the definition of this mechanical stop in order to obtain a safe behavior at both locations, but did not investigate this idea in the present article.

Fig. 13
Captures of the R-Min robot 100 ms after the collision, considering impact configurations: (a) Co and (b) Cp, with ve(tc) = 1 m/s
Fig. 13
Captures of the R-Min robot 100 ms after the collision, considering impact configurations: (a) Co and (b) Cp, with ve(tc) = 1 m/s
Close modal

In the following two sections, we check that these results remain true for different impacted body parts and different values of the end-effector velocity.

5.3.2 Effect of the Impacted Body on Safety.

We now investigate the effect of the impacted body part on the impact force. Therefore, three different settings of the IFMD are considered, in order to respectively mimic a constrained impact with the belly, the leg, and the head (see Table 3). Both robots are considered in a centered configuration, impacting on distal arm (Co), with an end-effector velocity ve(tc) = 1 m/s.

The corresponding impact force time profiles are presented in Fig. 14 and show that the maximum impact force is significantly lower for the R-Min robot than for the five-bar mechanism for each of the three body parts. A decreasing stiffness of the IFMD induces a decreasing value of the maximum impact force for both R-Min and the five-bar mechanism. A ratio r = 5.2 is obtained for an impact on the belly, r = 4.2 on the leg and r = 4.0 on the head, showing that the R-Min has a very positive effect on safety in each of these three cases. Considering the impact configuration Cp, a ratio slightly lower than one is obtained in each case, as observed in the previous section.

Fig. 14
Representation of the impact force time profile due to an impact between the R-Min robot (solid lines) or the five-bar mechanism (dashed lines), with different body parts (belly, leg, and head). The impact configuration Co is considered with ve(tc) = 1 m/s.
Fig. 14
Representation of the impact force time profile due to an impact between the R-Min robot (solid lines) or the five-bar mechanism (dashed lines), with different body parts (belly, leg, and head). The impact configuration Co is considered with ve(tc) = 1 m/s.
Close modal

To compare with, the admissible transient impact forces given in the standard ISO/TS 15066 [20] are, respectively, 260 N and 220 N for the leg and the belly. No value is given for the head since it is a critical zone with whom any contact must be avoided. Results depicted in Fig. 14 show that the R-Min allows to obtain a maximum impact force that is significantly lower that the allowable thresholds for the leg and the belly and, thus, would allow operating at higher velocity, whereas the five-bar mechanism is already close to the maximum value, especially for the leg. However, this conclusion is not valid when impact occurs on the end-effector.

5.3.3 Effect of the End-Effector Velocity on Safety.

As mentioned in multiple works [14, 35], there exists a linear relationship between the maximum impact force and the velocity of the impact point at the time of impact vi(tc). In what follows, we show that this linear relation is verified for each of the 18 impact scenarios.

Indeed, a linear regression going through the origin was performed for each impact scenario, considering the three end-effector’s velocities ve(tc)={1,1.5,2} m/s (see Fig. 15). It is recalled that each impact scenario is led five times for each end-effector’s velocity, providing 15 points for the linear regression. We obtain a maximum error on the maximum impact force of 12.0% using the linear regression model, among all impact scenarios, with a mean standard deviation of 3.7%. Once this linear relation has been determined for each scenario, it would be possible to determine, by extrapolation, the end-effector velocity, knowing the maximum admissible impact force defined in the ISO/TS 15066 standard [20].

Fig. 15
Representation of the maximum impact force as a function of the velocity of the impact point considering the R-Min robot impacting with the head in all reference impact configurations. A linear regression is performed for each impact configuration and shows a linear behavior of the impact force with respect to the velocity of the impact point.
Fig. 15
Representation of the maximum impact force as a function of the velocity of the impact point considering the R-Min robot impacting with the head in all reference impact configurations. A linear regression is performed for each impact configuration and shows a linear behavior of the impact force with respect to the velocity of the impact point.
Close modal

5.3.4 Effect of the Stiffness of the Preload Bar on Safety.

It was shown in Sec. 3.2 that the stiffness of the preload bar influences the size of the workspace when considering motor torque limitations (Fig. 6). In this section, we analyze how it affects the safety performances of the R-Min robot. The impact force is measured for two different settings of the preload bar, for R-Minkt = 111.2 N/m and ℓ0 = 82.7 mm (see Fig. 6(c)) for R-Min+kt = 239.2 N/m, ℓ0 = 102.5 mm (see Fig. 6(d)).

Results are presented in Fig. 16 considering impact configurations So and Sp, ve(tc) = 1 m/s, and an impact with the head. These results show that the stiffness of the preload system has a very negligible effect on the impact force, whatever the location of the impact on the robot. When impact occurs on Oi3, a ratio r = 5.4 (resp. r = 4.6) is obtained with R-Min+ (respectively R-Min), showing that the maximum impact force is even decreased when using a stiffer spring in the preload bar.

Fig. 16
Representation of the impact force time profile for two different stiffnesses of the preload bar. Scenarios So and Sp are considered, with ve(tc) = 1 m/s and an impact with the head.
Fig. 16
Representation of the impact force time profile for two different stiffnesses of the preload bar. Scenarios So and Sp are considered, with ve(tc) = 1 m/s and an impact with the head.
Close modal

6 Conclusion

This paper analyzed the safety performances of the R-Min robot, a planar underactuated parallel robot designed for intrinsically safe collaborations with human. After having introduced the mechanical architecture and presented its prototype, the workspace of the R-Min robot was computed numerically based on the geometrico-static, the kinemato-static models, and a singularity analysis. The obtained workspace is very close to that of an equivalent five-bar mechanism. However, the R-Min workspace decreases as the stiffness of the spring in the preload bar increases due to practical motor torque limitations. The dynamic model of the R-Min robot was then introduced as well as the modified computed torque controller. An experimental analysis showed good tracking performances despite the underactuated nature of this robot.

In order to compare the safety performances of the R-Min robot with those of the five-bar mechanism, we setup a dedicated experimental setup, i.e., a five-bar mechanism with geometric and inertia properties equivalent to that of the R-Min robot, and a bio-fidelic IFMD. Following a detailed protocol, experimental results show that the underactuated architecture of the R-Min robot allows to reduce by a ratio of 4–5 the impact force with respect to the five-bar mechanism when impact occurs on the middle of the distal arm. In the meantime, when impact occurs on the end-effector, the impact force is similar to that obtained with the five-bar mechanism. The effect of the stiffness of the preload bar was shown to have a negligible effect on the impact force. We also showed that there exists a linear relation between the impact force and the end-effector velocity for each scenario, allowing to determine, by extrapolation, the maximum end-effector velocity from the allowable impact force defined in the ISO 15066 standard.

The proof of concept R-Min allowed us to obtain encouraging results showing the interest of introducing underactuation in the mechanical architecture of a parallel robot to obtain an intrinsically safer robot. Therefore, further works will investigate strategies to reduce the impact force when impact occurs both on the distal arm or on the end-effector. We will also extend this planar architecture to the spatial case. Simulation tools will be used to optimize the design of such robot with respect to safety criteria. In parallel, we will investigate the use of flexible links in the mechanical design of a parallel robot to obtain a highly underactuated system.

Footnotes

2

Following Ref. [28], we prefer to replace the word kinetostatic by the word kinemato-static. Indeed, the former is an assembly of the words kinetics and statics, and is not related with our present interest in kinematics, i.e., with the study of the motion.

3

In the present work, we compute the condition number of matrices whose components have non-homogeneous units. This is valid as long as we intend to analyze the degeneracy of the corresponding matrices, and not to characterize the physical performance of the robot [32], which is not the case in this paper.

4

A high-frequency camera is used to obtain, a posteriori, the joint and Cartesian coordinates of the robot. The camera used is a Mikrotron MC4082, and images were acquired at a frequency of 500 Hz with a resolution of 1500 dpi. The camera is not used in the control of the robot.

5

The ratio r is the division of the maximum impact force obtained with five-bar mechanism divided by the maximum impact force obtained with the R-Min robot. The ratio values given in this article correspond to the mean value obtained from five repetitions of an impact scenario.

6

Appendix  C details how the robot stiffness is computed.

Conflict of Interest

There are no conflicts of interest.

Data Availability Statement

The datasets generated and supporting the findings of this article are obtainable from the corresponding author upon reasonable request.

Appendix A: Expression of the Potential Energy

The potential energy of the link (i, j) due to the gravity field, denoted as Ui,j, depends on the links masses mij (respectively, m4 and m5 for links (4) and (5)), their center of mass position Sij (respectively, S4 and S5), and their length ℓij. The length ℓSij is equal to OijSij. ℓS4 is the length from P to S4, and ℓS5 is the length from A to S5.

It is then possible to express the potential energy due to the gravity for each link:
Ui,1=gmi1Si1sin(qi1)
(A1)
Ui,2=gmi2(i1sin(qi1)+Si2sin(qi1+qi2))
(A2)
Ui,3=gmi3(i1sin(qi1)+i2sin(qi1+qi2)+Si3sin(qi1+qi2+qi3))
(A3)
U4=gm4z(1S4/ρ)
(A4)
U5=gm5S5sin(q4)=gm5S5z/ρ
(A5)
where the angle q4 = tan −1(z/x) and the length ρ=x2+z2 parameterize the configuration of the preload system.
The potential energy of the robot due to the gravity can then be summarized as
U(qa,qd,p)=i=12j=13Ui,j(qa,qd)+U4(p)+U5(p)
(A6)
The potential energy of the spring included in the preload system can be expressed as follows:
Us=12kt(4ρ0)2
(A7)
where kt and l0 are, respectively, the stiffness and the free length of the spring and ℓ4 is the length of the preload bar from the spring to the end-effector position.
As a result, the total potential energy of the robot U can be expressed as a function of the coordinates qa, qd, and p by
U(qa,qd,p)=U(qa,qd,p)+Us(p)pcf
(A8)
where f is an external force, assumed to be conservative, applied at a contact point pc of the robot.

Appendix B: Expression of the Kinetic Energy

The kinetic energy of the link (i, j) is denoted Ei,j and obtained as follows:
Ei,1=12(Ji1+mi1Si12)q˙i12
(B1)
Ei,2=12((Ji2+mi2Si22)(q˙i1+q˙i2)2+mi2i12q˙i12+2mi2i1Si2q˙i1(q˙i1+q˙i2)cos(qi2))
(B2)
Ei,3=12((Ji3+mi3Si32)(q˙i1+q˙i2+q˙i3)2+mi3i12q˙i12+mi3i22(q˙i1+q˙i2)2+2mi3(i1i2q˙i1(q˙i1+q˙i2)cos(qi2)+Si3(q˙i1+q˙i2+q˙i3)(i1q˙i1cos(qi2+qi3)+i2(q˙i1+q˙i2)cos(qi3))))
(B3)
E4=12((J4+m4S42)q˙42+m4x˙2+m4y˙22S4q˙4(cos(q4)x˙+sin(q4)y˙))
(B4)
E5=12(J5+m5S52)q˙42
(B5)
where Jij (J4, J5, respectively) is the moment of inertia around y of the body (i, j) (4, 5, respectively).
As a result, the total robot kinetic energy E can be expressed as a function of the coordinates qa, qd, and p, and their time derivatives by
E(qa,qd,p,q˙a,q˙d,p˙)=i=12j=13Ei,j(qa,qd,q˙a,q˙d)+E4(p,p˙)+E5(p,p˙)
(B6)

Appendix C: Expression of the Robot Stiffness

Let us recall the static equilibrium equation presented in Eq. (4):
{qdpU(qa,qd,p)+qdpϕ(qa,qd,p)λ=τeϕ(qa,qd,p)=0
(C1)
where τe represents an external force applied on our mechanism, considered constant.
From Eq. (22), in static, we may consider that the controller acts like a spring system of stiffness matrix Kp=(M11M12M221M21)kp, with a potential energy: Ua = (1/2)(qaqv)TKp(qaqv), qv being the motor desired reference. The equilibrium equation can be expressed using this additional spring:
{(qdpU(qa,qd,p)qaU(qa,qd,p)+Kp(qaqv))+(qdpϕ(qa,qd,p)qaϕ(qa,qd,p))λ=(τe0)ϕ(qa,qd,p)=0
(C2)
Differentiating Eq. (C2), considering a small movement of the robot around this equilibrium configuration, due to an effort dτ applied on the mechanism, we obtain
{Hdqt+qtϕdλ=dτqtϕ(qa,qd,p)dqt=0
(C3)
with H being the Hessian of the Lagrangian L=U(qa,qd,p)+Ua(qa,qv)+ϕT(qa,qd,p)λ with respect to variables qt=[qdpqa]T.

The second part of Eq. (C3) signifies that dqt lies in the kernel of ϕ. Let us define ZR8×2, a basis of the kernel of qtϕT, dqt can be written under the form dqt = Zv with vR2.

Left-multiplying the first line of Eq. (C3) by ZT gives
ZTHZv=ZTdτ
(C4)
In the absence of type 2 singularities, the projected Hessian Hr = ZTHZ is invertible. Left-multiplying Eq. (C4) by ZHr1 gives
dqt=ZHr1ZTdτ=Sdτ
(C5)
with S being the softness matrix of the manipulator.
Considering a ponctual effort dfc applied at point pc applied on the mechanism, we have
dτ=JcTdfc
(C6)
dpc=Jcqt
(C7)
with Jc the contact Jacobian matrix.
We finally obtain
dpc=JcSJcTdfc
(C8)
where JSJT is the softness matrix at the point of contact and Kc = (JSJT)−1 is the stiffness matrix. Projecting Eq. (C8) along a direction n, we obtain
dpc=nTJcSJcTndfc=dfckr
(C9)
with kr, the robot stiffness along direction n.

References

1.
Robla-Gómez
,
S.
,
Becerra
,
V. M.
,
Llata
,
J. R.
,
Gonzalez-Sarabia
,
E.
,
Torre-Ferrero
,
C.
, and
Perez-Oria
,
J.
,
2017
, “
Working Together: A Review on Safe Human–Robot Collaboration in Industrial Environments
,”
IEEE Access
,
5
, pp.
26754
26773
.
2.
Vicentini
,
F.
,
2021
, “
Collaborative Robotics: A Survey
,”
ASME J. Mech. Des.
,
143
(
4
), p.
040802
.
3.
Bischoff
,
R.
,
Kurth
,
J.
,
Schreiber
,
G.
,
Koeppe
,
R.
,
Albu-Schäffer
,
A.
,
Beyer
,
A.
,
Eiberger
,
O.
,
Haddadin
,
S.
,
Stemmer
,
A.
,
Grunwald
,
G.
, and
Hirzinger
,
G.
,
2010
, “
The Kuka-Dlr Lightweight Robot Arm—A New Reference Platform for Robotics Research and Manufacturing
,”
ISR 2010 (41st International Symposium on Robotics) and ROBOTIK 2010 (6th German Conference on Robotics)
,
Munich, Germany
,
June 7–9
, pp.
1
8
.
4.
Kim
,
Y.-J.
,
2017
, “
Anthropomorphic Low-Inertia High-Stiffness Manipulator for High-Speed Safe Interaction
,”
IEEE Trans. Rob.
,
33
(
6
), pp.
1358
1374
.
5.
Tsumaki
,
Y.
,
Suzuki
,
Y.
,
Sasaki
,
N.
,
Obara
,
E.
, and
Kanazawa
,
S.
,
2018
, “
A 7-dof Wire-Driven Lightweight Arm With Wide Wrist Motion Range
,”
2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)
,
Madrid, Spain
,
Oct. 1–5
, pp.
1
9
.
6.
Pratt
,
G. A.
, and
Williamson
,
M. M.
,
1995
, “
Series Elastic Actuators
,”
Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots
,
Pittsburgh, PA
,
Aug. 5–9
, Vol. 1, pp.
399
406
.
7.
Bicchi
,
A.
, and
Tonietti
,
G.
,
2004
, “
Fast and “Soft-Arm” Tactics [Robot Arm Design]
,”
IEEE Robot. Autom. Mag.
,
11
(
2
), pp.
22
33
.
8.
Zinn
,
M.
,
Roth
,
B.
,
Khatib
,
O.
, and
Salisbury
,
J. K.
,
2004
, “
A New Actuation Approach for Human Friendly Robot Design
,”
Int. J. Robot. Res.
,
23
(
4–5
), pp.
379
398
.
9.
Park
,
J.-J.
,
Kim
,
B.-S.
,
Song
,
J.-B.
, and
Kim
,
H.-S.
,
2008
, “
Safe Link Mechanism Based on Nonlinear Stiffness for Collision Safety
,”
Mech. Mach. Theory
,
43
(
10
), pp.
1332
1348
.
10.
Hyun
,
D.
,
Yang
,
H. S.
,
Park
,
J.
, and
Shim
,
Y.
,
2010
, “
Variable Stiffness Mechanism for Human-Friendly Robots
,”
Mech. Mach. Theory
,
45
(
6
), pp.
880
897
.
11.
López-Martínez
,
J.
,
Blanco-Claraco
,
J. L.
,
García-Vallejo
,
D.
, and
Giménez-Fernández
,
A.
,
2015
, “
Design and Analysis of a Flexible Linkage for Robot Safe Operation in Collaborative Scenarios
,”
Mech. Mach. Theory
,
92
, pp.
1
16
.
12.
Zhang
,
M.
,
Laliberté
,
T.
, and
Gosselin
,
C.
,
2016
, “
On the Design of Mechanically Safe Robots Based on Spatial Isotropic Force Modules and Torque Limiters
,”
Mech. Mach. Theory
,
105
, pp.
199
212
.
13.
Seriani
,
S.
,
Gallina
,
P.
,
Scalera
,
L.
, and
Lughi
,
V.
,
2018
, “
Development of N-DoF Preloaded Structures for Impact Mitigation in Cobots
,”
ASME J. Mech. Rob.
,
10
(
5
), p.
051009
.
14.
Lauzier
,
N.
, and
Gosselin
,
C.
,
2015
, “
A Comparison of the Effectiveness of Design Approaches for Human-Friendly Robots
,”
ASME J. Mech. Des.
,
137
(
8
), p.
082302
.
15.
Campa
,
F.
,
Diez
,
M.
,
Diaz-Caneja
,
D.
, and
Altuzarra
,
O.
,
2019
, “
A 2 Dof Continuum Parallel Robot for Pick & Place Collaborative Tasks
,”
Adv. Mech. Machine Sci.
, pp.
1979
1988
.
16.
Jeanneau
,
G.
,
Bégoc
,
V.
,
Briot
,
S.
, and
Goldsztejn
,
A.
,
2020
, “
R-min: A Fast Collaborative Underactuated Parallel Robot for Pick-and-Place Operations
,”
IEEE International Conference on Robotics and Automation (ICRA)
,
Paris, France
,
May 31–Aug. 1
, IEEE, pp.
10365
10371
.
17.
Versace
,
J.
,
1971
, “
A Review of the Severity Index
,”
Proceedigns of the 15th Stapp Car Crash Conference
, pp.
771
796
, SAE Technical Paper No. 710881.
18.
Haddadin
,
S.
,
Albu-Schäffer
,
A.
, and
Hirzinger
,
G.
,
2007
, “
Safety Evaluation of Physical Human-Robot Interaction via Crash-Testing
,”
Robotics: Science and Systems
,
Atlanta, GA
,
June 27–30
,
W.
Burgard
,
O.
Brock
, and
C.
Stachniss
, eds., Vol. 3, The MIT Press.
19.
Haddadin
,
S.
,
Albu-Schäffer
,
A.
, and
Hirzinger
,
G.
,
2008
, “
The Role of the Robot Mass and Velocity in Physical Human–Robot Interaction-Part I: Non-Constrained Blunt Impacts
,”
IEEE International Conference on Robotics and Automation
,
Pasadena, CA
,
May 19–23
, IEEE, pp.
1331
1338
.
20.
ISO/TC 299 : ISO/TS15066
,
2016
, “
Robots and Robotic Devices—Collaborative Robots
.”
Tech. Rep. ISO/TS15066, International Organization for Standardization, Tech. Rep.
21.
Melia
,
M.
,
Schmidt
,
M.
,
Geissler
,
B.
,
König
,
J.
,
Krahn
,
U.
,
Ottersbach
,
H. J.
,
Letzel
,
S.
, and
Muttray
,
A.
,
2015
, “
Measuring Mechanical Pain: The Refinement and Standardization of Pressure Pain Threshold Measurements
,”
Behav. Res. Methods
,
47
(
1
), pp.
216
227
.
22.
Yamada
,
Y.
,
Hirasawa
,
Y.
,
Huang
,
S.
, and
Umetani
,
Y.
,
1996
, “
Fail-Safe Human/Robot Contact in the Safety Space
,”
Proceedings 5th IEEE International Workshop on Robot and Human Communication
,
Tsukuba, Japan
,
Nov. 11–14
, pp.
59
64
.
23.
COVR
,
2021
, “
Test Robot Arm for Collision With Fixed Object (Measurement of Pressure Over Time)
,”
Tech. Rep. ROB-LIE-2, COVR Consortium
.
24.
COVR
,
2021
, “
Test Robot Arm for Collision With a Movable Object (Measurement of Pressure Over Time)
,”
Tech. Rep. ROB-LIE-1, COVR Consortium
.
25.
DGUV
,
2017
, “
Kollaboriende Roboter, Planung von Anlagen mit der Funktion ‘Leistungs- und Kraftbegrenzung’
,”
Tech. Rep. FB HM-080, DGUV.
26.
Birglen
,
L.
,
Laliberté
,
T.
, and
Gosselin
,
C. M.
,
2007
,
Underactuated Robotic Hands
,
Springer
.
27.
Jeanneau
,
G.
,
Bégoc
,
V.
, and
Briot
,
S.
,
2020
, “
Geometrico-Static Analysis of a New Collaborative Parallel Robot for Safe Physical Interaction
,”
Proceedings of the ASME 2020 International Design Engineering Technical Conferences and Computers and Information in Engineering Conference
,
virtual online
, p. V010T10A067.
28.
Quennouelle
,
C.
, and
Gosselin
,
C.
,
2011
, “
Kinematostatic Modeling of Compliant Parallel Mechanisms
,”
Meccanica
,
46
(
1
), pp.
155
169
.
29.
Nocedal
,
J.
, and
Wright
,
S.
,
2006
,
Numerical Optimization
,
Springer Science & Business Media
.
30.
Black
,
C.
,
Till
,
J.
, and
Rucker
,
D.
,
2017
, “
Parallel Continuum Robots: Modeling, Analysis, and Actuation-Based Force Sensing
,”
IEEE Trans. Robot.
,
34
(
1
), pp.
29
47
.
31.
Briot
,
S.
, and
Goldsztejn
,
A.
,
2022
, “
Singularity Conditions for Continuum Parallel Robots
,”
IEEE Trans. Robot.
,
38
(
1
), pp.
507
525
.
32.
Merlet
,
J.
,
2006
, “
Jacobian, Manipulability, Condition Number, and Accuracy of Parallel Robots
,”
ASME J. Mech. Des.
,
128
(
1
), pp.
199
206
.
33.
Khalil
,
W.
, and
Dombre
,
E.
,
2002
, “
Chapter 14—Motion Control
,”
Modeling, Identification and Control of Robots
,
W.
Khalil
, and
E.
Dombre
, eds.,
Butterworth-Heinemann
,
Oxford
, pp.
347
376
.
34.
Briot
,
S.
, and
Khalil
,
W.
,
2015
,
Dynamics of Parallel Robots: From Rigid Bodies to Flexible Elements
, 1st ed.,
Springer International Publishing
,
Dordrecht
, pp.
147
149
.
35.
Herbster
,
S.
,
Behrens
,
R.
,
Elkmann
,
N.
,
Siciliano
,
B.
,
Laschi
,
C.
, and
Khatib
,
O.
,
2020
, “
A New Conversion Method to Evaluate the Hazard Potential of Collaborative Robots in Free Collisions
,”
International Symposium on Experimental Robotics
,
Malta
,
B.
Siciliano
,
C.
Laschi
, and
O.
Khatib
, eds., Springer International Publishing, pp.
222
232
.