# A Family of Hyperbolic-Type Explicit Force Regulators with Active Velocity Damping for Robot Manipulators.

1. IntroductionThe use of robotic systems has increased during the last four decades. Nowadays, several industrial applications continue to benefit from robotic systems in order to automate repetitive or hazardous maneuvers. It is well known that, in applications involving an automatic process in which the robot is moving freely within its workspace or executes tasks with no interaction with the environment, a control system based on position or motion control represents a viable alternative. However, in applications where the manipulator performs interaction tasks, the manipulator encounters environmental constraints and the interaction forces are not negligible [1-3].

In this situation, the use of motion-control strategies will produce an unsuccessful execution of the task; the adequate implementation of an interaction task requires, in addition to motion/position control strategies, force control and a detailed and accurate modeling of the system and the environment [4-9]. A particular type of interaction control is the impedance control scheme which can regulate environmental forces according to the specified mechanical impedance such as inertial, stiffness, and damping effects. Impedance control belongs to the category of indirect force control, which may not require measurements of contact forces; in addition, the user cannot specify a desired contact force [2, 4, 9-12].

In contrast, force sensing and force control are essential for the successful execution of tasks involving interaction between the manipulator and the environment. The explicit force control strategies are the most suitable option for controlling interaction forces between the robot manipulator and the environment. Such control schemes have a large number of applications in medical and industrial environments, as they are capable of increasing the speed and quality in applications such as deburring, grinding of surfaces, assembly processes, and other operations [3, 10, 13-16].

Some types of force control can be cited, such as [17] where two auxiliary, automatically controlled wings of a monohull ship used to attenuate the roll due to the waves are presented. These wings are variably dipped into the water in order to introduce a force that reduces the oscillations on the ship. Two different compensators for the roll effect have been designed, the first one using classical frequency domain techniques and the second being an adaptive, linear quadratic compensator with a multilayer perceptron neural network. Simulations and experimental tests performed on the ship are presented. In [18], an impedance function is proposed to specify a desired force directly in a robust robot force tracking impedance scheme, which employs a neural network as compensator to cancel out all uncertainties; simulation studies are presented. In [19], the robot dynamics are decomposed into force, position, and redundant joint subspaces; then, using that decomposition in a neural network-based adaptive control scheme for hybrid force/position in Lyapunov sense is proposed. Numerical simulation studies were performed in the model of a two-link, rigid robot manipulator. In [20], an approach based on hybrid force/position with fuzzy PID structure with unspecified robot dynamics in the presence of external disturbances, including experimental results on a PUMA-560 robot, is presented.

Unlike the impedance control schemes, the concept of explicit force control is to consider a desired force rather than the position or velocity references. Then the force error is defined as the difference between a desired force and the actual interaction force, measured with a force sensor mounted on the end-effector, enabling the possibility of ensuring force regulation. The explicit force control selects the directions in which the end-effector position should be controlled and those directions in which the forces controlled by the end-effector are applied on some environment, for a given task. This type of control strategies has two feedback loops for separated, position, and force control and is referred to as hybrid force/position control [1, 21-34].

The original hybrid force/position control concept was proposed in [1]; the basic idea is to divide the robot manipulator space into two orthogonal spaces using of a selection matrix. Position control and force control are applied on two spaces to achieve the capability of compliance control. Explicit force control involves the direct command and measurement of force values in order to control the contact force to a desired value.

Considering that explicit force control is an important topic as research area, it currently represents an open problem of interest for the scientific community and several research efforts have focused on this topic during the last four decades. As a result, different control schemes have been proposed in the literature; for example, we can cite the fundamental works [1, 5, 24, 26, 32]. Progressively this theme has been growing; for instance, [35] describes the design and implementation of a hybrid force/motion scheme to control the interaction force of a robot manipulator, using a PD controller with gain-scheduled linear parameter-varying controller; however, although the reference for this control scheme does not include a stability proof, it presents experimental results on a six-degree-of-freedom manipulator. The paper [36] proposes the design of a robust adaptive neural networkbased hybrid position/force control with PD-type structure for manipulators. It includes a stability analysis in the sense of Lyapunov, but only simulation results with a model of a two-link robot manipulator are presented. In [37], the robustness and stability of disturbance observer based on explicit linear force control systems are analyzed. The validity of the proposals is verified with experimental results on a linear dc motor.

In [38], explicit force regulators for robot manipulators are presented. The control structure includes an on linear term formed by square-root-type functions to drive the force error, with an active velocity damping plus compensation of gravity forces. The stability analysis is performed in Lyapunov sense; in order to obtain asymptotic stability, LaSalle's theorem is used and experimental results on a two-degree-of-freedom robot are presented. In [39], an optimization-based approach for the regulation of excessive or insufficient forces at the end-effector level is introduced. Their approach minimizes the interaction force error at the robot end-effector and considers the linear impedance model and penalty functions in order to handle the constraints on the interaction forces; stability and convergence properties are analyzed taking into account force limits. The proposed scheme is validated via experimental results for a robotic grasping task. The work [40] presents the state of the art on compliant control algorithms applied to both stiff and soft joints based on electric motors for robot manipulators; there is a widely used control structure for all the works presented in this survey, which is the simple PD control.

Recently, in [16] a double active observer control is proposed to control the desired interaction and motion compensation under contact with the heart, relying on robot force control techniques. In [34], a position-based force explicit control strategy based on online trajectory prediction, with proportional-integral-type control structure, is presented. In this work, the experimental results show that the proposed method has a good control effect on the contact force. In [41], the regulation of the clamping force of a robot manipulator gripper is analyzed and discussed, when applied to rescue activities in the ruins after disasters; for this problem, a hybrid force/position control on a cascade PID-scheme and fuzzy sliding mode is presented; the control algorithms were validated with experimental results, whose force errors were acceptable. Force trajectories during isometric force-matching task involving contractions are described in [42]; a PID control with different gains and frequencies is introduced to examine the nature of the contractions in many individuals, which vary substantially. This variability can be explained by discrete PID with varying model parameters to adjust the muscle commands. The position and force control task presented in [43] has been defined considering the manipulator and environment models; asymptotic stability of the control systems is demonstrated, and experimental study of the issue is presented.

Most of the previous works use explicit force control strategies with PD or PID schemes; however, in general, there is a lack of proof on asymptotic stability analysis with different control structures; only a limited number of works have proposed strict Lyapunov functions. Therefore, our main motivation is in the theoretical and practical aspects of the problem. The objective of this paper is to present the design and analysis of a new explicit force control family with a term driven by a large class of saturated-type hyperbolic functions to handle the force error for the problem of force regulation in interaction tasks. This control structure includes also an active velocity damping term with the purpose of obtaining energy dissipation on the contact surface. To ensure global asymptotic stability of the closed-loop system equilibrium point in Cartesian space, we propose a strict Lyapunov function. Additionally, we present in this work another contribution, consisting of the mathematical development of a Cartesian dynamics model property (on the vector of centripetal and Coriolis forces in Cartesian space, see Appendix), which is useful for stability analysis.

The paper includes also an experimental comparison of the performance obtained between 5 explicit force control schemes; they are the classical proportional-derivative (PD), arctangent, square-root controls, and two members of the proposed control family on a two-degree-of-freedom, direct-drive robot manipulator. A force sensor placed at the end-effector of the robot manipulator is used in order to feed back the measure of the force error in the closed-loop, which is given as the difference between a desired and actual force. The Cartesian explicit force control is converted to joint torque signal using the transpose Jacobian introduced by Takegaki and Arimoto [44].

The paper is organized as follows. In Section 2, the joint-space dynamic model of robot manipulators and its relationship with the Cartesian dynamic model are presented; it also describes the most important properties used in the stability analysis of the control schemes. In Section 3, the new family of explicit force regulators is presented, as well as the design of the strict function required to carry out the asymptotic stability analysis in Lyapunov sense. In Section 4, the experimental results on a two-degree-of-freedom, direct-drive robot manipulator including a performance comparison of the control schemes under evaluation are presented. Finally, our conclusions are in Section 5.

2. Dynamic Model of the Robot Manipulator

It is a well-known fact that the dynamic model of a robot manipulator with rigid links is described by a second-order system formed by nonlinear differential equations. This model describes a relationship between the generalized joint torques/forces applied by the actuators and the motion of the robot, which incorporates the position, velocity, and acceleration joints. In joint space, the dynamic model of a robot manipulator with n degrees of freedom is defined by [32]

[mathematical expression not reproducible], (1)

where [mathematical expression not reproducible] denote the joint displacements, velocities, and acceleration values, respectively, [tau] [member of] [R.sup.nx1] stands for the vector of generalized forces/torques applied, M(q) [member of] [R.sup.nxn] is the symmetric positive-definite inertia matrix, C(q, [??]) [member of] [R.sup.nxn] is the matrix of centripetal and Coriolis torques, g(q) [member of] [R.sup.n] is the vector of gravitational torques, and, finally, f([??]) [member of] [R.sup.n] is the friction torque vector. For analysis purposes, only the viscous-friction model is considered in this paper; that is, [mathematical expression not reproducible], where B is a diagonal matrix formed by the viscous-friction coefficients of each joint.

Moreover, the above model (1) can be expressed in terms of coordinates associated with a coordinate system attached to the tool by using a coordinate transformation [6, 25, 45]. For the formulation of the model in Cartesian space, it is assumed that the manipulator performs in a nonsingular configuration.

Let us consider the relationship between the joint velocities [??] and the end-effector Cartesian velocities [??], given by [mathematical expression not reproducible], where J(q) is referred to as the analytical Jacobian matrix; that is, J(q) = [partial derivative]h(q)/ [partial derivative]q [member of] [R.sup.nxn], where h(q) is the direct kinematic. A well-known relationship exists between the applied forces [f.sub.[chi]] on the end-effector and the applied torques [tau] in the joints, which is referred to as the Jacobian Transposed Controller [44]:

[tau] = [J.sup.T] (q) [f.sub.[chi]]. (2)

The Cartesian dynamic model of a robot manipulator is [45]

[mathematical expression not reproducible], (3)

where the term [f.sub.e] represents the external forces applied to the end-effector, such as the forces appearing in an interaction task. The terms [M.sub.[chi]], [C.sub.[chi]], [g.sub.[chi]], and [f.sub.f[chi]] are described as

[mathematical expression not reproducible]. (4)

We use the notation [??](q) to indicate the time derivative of the Jacobian matrix, [??] (q) = (d/di)J(q), and the inverse of transpose Jacobian matrix is denoted by [J.sup.-T](q) = [[[J.sup.-1](q)].sup.T].

Next, some well-known properties that are useful in the analysis and design of our controller scheme are presented.

Property 1. The inertia matrix [M.sub.[chi]] > 0 is symmetric and definite positive (on a workspace without singularity).

[mathematical expression not reproducible]. (5)

Property 2. The matrix [M.sub.[chi]] is upper and lower bounded by

[mathematical expression not reproducible], (6)

where [[lambda].sub.M]{[M.sub.[chi]]} and [[lambda].sub.M]{[M.sub.[chi]]} stand for the maximum and minimum eigenvalues of matrix [M.sub.[chi]], respectively.

Property 3. [mathematical expression not reproducible] is skew symmetric and it satisfies

[mathematical expression not reproducible] (7)

Property 4. The norm of vector [C.sub.[chi]] [??] is bounded, as indicated below:

[mathematical expression not reproducible] (8)

for some [k.sub.cx] [member of] [R.sub.+]. As part of the contributions of this article, a brief demonstration of this property is included in the Appendix.

The following decoupled model is considered for modeling the compliant environment [3]:

[f.sub.e] = [K.sub.e] (x - [x.sub.e]), (9)

where [K.sub.e] is a diagonal matrix referred to as the environment's stiffness matrix and the term [x.sub.e] denotes the contact position with the environment, while x represents the actual position of the end-effector.

3. A New Family of Explicit Force Regulator Schemes

In this section, a new family of force control schemes with hyperbolic-type structure for robot manipulators is presented. Consider the following family with large class of explicit force control schemes plus gravity compensation, given by

[mathematical expression not reproducible], (10)

where k [member of] [N.sub.+] is a positive integer, [K.sub.p], [K.sub.v] [member of] [R.sup.nxn] are the proportional and derivative gains, which are positive-definite diagonal matrices, and [??](t) is the force error vector, which is defined as the difference between a desired force [f.sub.d] and the actual force f(i) on the end-effector, measured from the force sensor; [??](t) = [f.sub.d]--f(i). The applied torques on the robot joints are derived from (2); that is, [tau] = [J.sup.T](q)[f.sub.[chi]].

The first term in the proposed control scheme (10) represents a large class of hyperbolic-type regulators to drive the force error; this one is derived from energy shaping of the artificial potential energy [44]. The second term acts as an active velocity damping; the next component includes the Cartesian gravity forces [g.sub.[chi]]; for implementation purposes, partial knowledge of these gravity forces is required, and the last term [f.sub.e] represents the interaction forces.

The closed-loop equation expressed in state variables [mathematical expression not reproducible] is obtained by combining the dynamics model (3) and control law (10):

[mathematical expression not reproducible]. (11)

In order to demonstrate that the state origin is an equilibrium point, it is necessary to consider the Jacobian matrix J(q) with full rank; for example, rank[J(q)] = n; in other words, the Cartesian dynamic model requires a singularity-free workspace. The following assumptions are taken into account:

(a) The Jacobian matrix J(q) is full rank and its spectral norm [parallel]J(q)[parallel] < [k.sub.j] is bounded for all q [member of] [R.sup.n], where [k.sub.j] is a positive constant, [k.sub.j] [member of] [R.sub.+].

(b) According to the environment's stiffness and friction models, the stiffness [K.sub.e] and viscous-friction [B.sub.[chi]] matrices are diagonal and positive-definite matrices, respectively; then [mathematical expression not reproducible].

The first component of the closed-loop equation (11) satisfies [mathematical expression not reproducible], due to the fact that the matrix [K.sub.e] is a diagonal definite positive matrix. For the second component in (11), we use Property 1 of the inertia matrix; then the first term inside the brackets composed of the proportional gain [K.sub.p] and the vector of hyperbolic functions results in the vector [mathematical expression not reproducible], since [K.sub.p] is a positive-definite matrix and each component [mathematical expression not reproducible]. We have also [mathematical expression not reproducible] in the singularity-free workspace. Therefore, the closed-loop system (11) is autonomous differential equation and the state space origin exists and it is a local equilibrium point.

3.1. Control Problem Statement. The problem of explicit force control consists of finding a Cartesian control scheme [f.sub.[chi]] such that the force error vector [??](i) and Cartesian velocity [??](i) converge asymptotically stably to equilibrium point of the closed-loop equation (11) at least for sufficiently small initial conditions [mathematical expression not reproducible]; then the following objective is satisfied:

[mathematical expression not reproducible]. (12)

3.2. Proposition. Consider the closed-loop system (11), under conditions sufficiently small; then the equilibrium point [mathematical expression not reproducible] is locally asymptotically stable and the control objective (12) is achieved.

Proof. To carry out the local stability analysis for the dynamic system (11), we use Lyapunov's direct method through the following strict Lyapunov function (a strict Lyapunov function is a positive-definite function, whose time derivative along the trajectories of closed-loop system yields a negative-definite function), which is composed by the sum of the robot manipulator kinetic and artificial potential energy, and a cross-term between force error [??] and velocity [??]:

[mathematical expression not reproducible] (13)

where [[epsilon].sub.0] is a positive constant number defined in the following interval:

[mathematical expression not reproducible], (14)

where [rho]' is a positive constant, [[lambda].sub.m]{[K.sup.-1.sub.e][K.sub.p]} is the minimum eigenvalue of the product [K.sup.-1.sub.e][K.sub.p], the minimum eigenvalue of the environment's inverse stiffness matrix is [mathematical expression not reproducible] are the maximum eigenvalues of the proportional and derivative gains and viscous-friction matrix, respectively. It is important to note that the constant e0 is only required for analysis purposes and its numerical value is not required for the control scheme.

The artificial potential energy function [U.sub.a]([K.sub.p], [K.sup.- 1.sub.e],[??]) is a continuously differentiable and positive-definite function, given by

[mathematical expression not reproducible] (15)

The candidate Lyapunov function (13) corresponds to the total energy of the closed-loop (11) and can be rewritten as

[mathematical expression not reproducible]. (16)

Now, we will give sufficient conditions to make [mathematical expression not reproducible] a positive-definite function. The first term of the right side of (16) is a definite positive function with respect to [mathematical expression not reproducible], because inertia matrix [M.sub.[chi]] is definite positive. Next, we provide upper and lower bounds on the second and third terms of the Lyapunov function (16).

The artificial energy function (15) has a unique and global minimum at [??] = 0 [member of] [R.sup.n], and it is not a decreasing function; then there exists positive constant [mathematical expression not reproducible]. Therefore, the second and third terms of function (16) satisfy

[mathematical expression not reproducible] (17)

On the left-hand side of the inequality (17), to ensure that [mathematical expression not reproducible], which is satisfied by the first term of (14). Hence, the Lyapunov function [mathematical expression not reproducible] given by (13) is a definite positive function in local form.

The total derivative of the candidate Lyapunov function (13) with respect to time is

[mathematical expression not reproducible]. (18)

Substituting the closed-loop equation (11), we also use Property 3; then it yields,

[mathematical expression not reproducible] (19)

where, after cancelling some terms, we obtain

[mathematical expression not reproducible]. (20)

Note that the second term of the right side in (20) corresponds to the gradient of the artificial potential energy [mathematical expression not reproducible]; it is a vector composed of saturated functions with hyperbolic-type structure, for each ith component [mathematical expression not reproducible]; therefore it satisfies

[mathematical expression not reproducible]. (21)

In other words, the second term of function (20) satisfies the following condition:

[mathematical expression not reproducible], (22)

where [[lambda].sub.m]{[K.sub.p]} and [[lambda].sub.m]{[K.sub.p]} stand for the maximum and minimum eigenvalues of matrix [K.sub.p], respectively. Using Property 4, the fourth term from (23) satisfies [mathematical expression not reproducible] [mathematical expression not reproducible]. Next, by [mathematical expression not reproducible]. Next, by taking (22) and Cartesian dynamic model property (2), the expression for [mathematical expression not reproducible] (20) takes the form

[mathematical expression not reproducible] (23)

The time derivative of the Lyapunov function becomes

[mathematical expression not reproducible]. (24)

In order to ensure that matrix Q is positive definite, the number [[epsilon].sub.0] must satisfy the second condition of the left side of (14); then the element [Q.sub.11] > 0; also the third condition of the left side in the expression (14) must be satisfied; then the determinant of matrix Q is positive. Considering that [[epsilon].sub.0] satisfies those considerations, we can conclude that [mathematical expression not reproducible] is a negative-definite function; note that, due to the fact that both conditions [mathematical expression not reproducible] are satisfied, the proposed Lyapunov function is a strict Lyapunov function. Therefore, according to Lyapunov's direct method, we conclude local asymptotic stability of the origin [mathematical expression not reproducible] of the closed-loop equation (11), which means that both state variables [mathematical expression not reproducible] asymptotically converge to zero, as t [right arrow] [infinity].

4. Experimental Results

The experimental results were obtained by using an experimental platform known as "Rotradi" [46], shown in Figure 1. This platform, designed and built at the Robotics Laboratory of Benemerita Universidad Autenoma de Puebla (BUAP) in Mexico, is a two-degree-of-freedom, direct-drive robot. Rotradi consists of two 6061 aluminum links, actuated by brushless, direct-drive servo actuators, in order to drive the joints without a gear reduction. The motors used in Rotradi are DM-1150A and DM-1015B models from Parker Compumotor, for the shoulder and elbow joints, respectively. Since the servomotors are operated in torque mode, they act as a torque source; in this mode, an analog voltage is used as a reference of the torque signal, in proportional scale. The features of the servomotors are shown in Table 1. A motion-control board of Precision MicroDynamics Inc. is included in the robot system; this device is designed for reading the encoders and generating reference voltages. The control algorithms, written in C code, run in real time with a 2.5 ms sample period, on a Pentium computer.

With the purpose of performing force sensing, a six-axis force/torque sensor model ATI FT Gamma SI-130-10 is mounted at the end-effector of the robot manipulator. The sensor is capable of measuring force in the range of [+ or -]130 N and torque within the range of [+ or -]10 Nm. The sensor is connected to a 3.6 GHz Pentium IV computer, in which the signals are processed using a Visual C++ application. The communication between computers (for robot control and force-sensor readings) was enabled by using a communication protocol based on interruption signals, sent via parallel port.

The complete dynamic model for our experimental robot is reported in [46]. However, the gravitational torques vector and the Jacobian matrix are written in an explicit form in order to explain the experiments performed in this paper. The gravitational torques vector is given by

[mathematical expression not reproducible], (25)

while the Jacobian matrix is given as follows:

[mathematical expression not reproducible]. (26)

We present an experimental comparison of five explicit force regulators on the two-degree-of-freedom, direct-drive robot manipulator. The evaluated schemes are the simple proportional-derivative (PD), denoted as [mathematical expression not reproducible], (arctangent) Atan and (square-root) Sqrt control schemes [38], represented as [mathematical expression not reproducible], respectively, and two hyperbolic type members of the proposed control family, denoted by [mathematical expression not reproducible], for exponents k =1 and k = 2, respectively.

The structure of these regulators, evaluated on the two-degree-of-freedom robot manipulator, is given by

[mathematical expression not reproducible] (27)

[mathematical expression not reproducible] (28)

[mathematical expression not reproducible] (29)

[mathematical expression not reproducible] (30)

[mathematical expression not reproducible] (31)

All evaluated control schemes (27)-(31) have the following desired force references [f.sub.d] = [[[f.sub.xd] [f.sub.yd]].sup.T] = [5.0 0.1].sup.T] [N]; and the force error signals are given as [mathematical expression not reproducible], while the gain matrices [K.sub.p] and [K.sub.v] are tuned in order to prevent saturation of the actuators, which is a complicated and time-consuming process where several trials were necessary in order to ensure a small transient state and overshoot and smaller steady-state error. The tuning used for each evaluated force control scheme is presented in Table 2. The hyperbolic structure in (28) and (29) has two arguments: one of them is the force error [??], measured in Newtons; the second one is a constant with unit value (for simplicity, it does not appear in these equations), measured in [Newton.sup.-1], so that the whole argument is dimensionless.

In order to test the performance of these control structures, an interaction experiment is designed; the experiment consists of placing the robot at an initial position (the force sensor attached to the tool at the end of the robot manipulator is placed at the contact position with the environment through a tangent-hyperbolic position control [47]), and the second link is normal to the plane of the wall. Once positioned, the tool attached to the force sensor is located close to the wall, allowing a slight touch on the surface. For this experiment, it is not necessary to control the end-effector orientation. The initial conditions of the force-regulation experiment are depicted in Figure 1.

Now, the experimental evaluation of the three controllers is described. The force error and the applied torques from PD control [f.sub.[chi]PD] are presented in Figure 2. The force error signals for the PD control corresponding to two components f.sub.x] and [f.sub.y] are depicted in Figure 2(a), which presents convergence properties. It can be noted that each component has a short transient (4.5 sec), and both directions tend asymptotically to small neighborhood of zero; the steady-state force errors at time t = 9 sec have small values, specifically [mathematical expression not reproducible]. Figure 2(b) describes the applied control torques [mathematical expression not reproducible] at the shoulder and elbow joints for the PD scheme. Note that the two torque signals are within the range of operation (see Table 1).

In Figure 3, the results for force error and applied torque of the Atan control are presented. Note that the experimental curves for both force error components [mathematical expression not reproducible] converge to zero; the transitory response has small oscillations; for this control, its transient phase (i = 4.5 sec) is evolved for a shorter time than transient response of the PD control; the steady-state force errors at time t = 9 sec have small values, [mathematical expression not reproducible], and the control algorithm [mathematical expression not reproducible] achieves the force- regulation objective. The torque signals for shoulder and elbow joints avoid saturation of the actuators.

Figure 4 describes the experimental results for the Sqrt control scheme; the transitory response is approximately 4.5 sec; the force error signals reach the steady-state error [mathematical expression not reproducible], and the applied torques [mathematical expression not reproducible] clearly evolve inside the prescribed limits shown in Table 1.

The force error and applied torque signals for the hyperbolic controller [f.sub.[chi]1] with k = 1 are shown in Figure 5. The experimental results for the force errors [??] are depicted in Figure 5(a), which evolve until reaching steady-state errors (t = 9 sec) [[-0.1, 0.15].sup.T] N; the transient state (4.5 sec) is similar to the PD control. However, it is smoother than the transient state of the PD control. The applied torques of the control [[tau].sub.1] = J[(q).sup.T][f.sub.[chi]1] are presented in Figure 5(b); these signals are inside the prescribed limits.

The experimental results for the hyperbolic control scheme for [f.sub.[chi]2] are depicted in Figure 6; the force errors [??] have short transient (approximately 4.5 sec) and a smaller steadystate force error (i = 9 sec) [[0.08, 0.09].sup.T] N than PD, Atan, and Sqrt schemes as can be seen in Figure 6(a).

Observe that the transient phase is brief for all control schemes; the amplitude of the oscillation peaks is lower for the Sqrt, [f.sub.[chi]1], and [f.sub.[chi]2] controls compared to Atan and PD controls; and the steady-state force errors of the control [f.sub.[chi]2] are smaller than PD, Atan, Sqrt, and [f.sub.[chi]1] controls. As a consequence, the novel hyperbolic controllers yield an increased control performance for the explicit force problem of robot manipulators. Steady-state force errors are present due to the presence of static friction at joints and due to the lack of a model for this type of friction in the environment. It is important to note that, despite the presence of nonmodeled friction phenomena, the force errors are acceptably small. The results for the applied torques [[tau].sub.2] = J[(q).sup.T] [f.sub.[chi]2] are shown in Figure 6(b). The profile of these torque signals clearly evolves within the physical limits.

The hyperbolic-type control schemes work as follows: for large errors [[??].sub.i], the hyperbolic function cosh [mathematical expression not reproducible] returns a bounded control output avoiding input saturation in the servo amplifier; when the errors [[??].sub.i] are small, that hyperbolic function is approximately linear; then it works like proportional controller. In contrast, with PD control, [mathematical expression not reproducible] can demand a large amount of torque and it is not saturated. The derivative action of the Atan and Sqrt schemes is bounded, while that for the proposed hyperbolictype control is linear, demanding the effect of damping injection as needed. It is important to emphasize that, in the experiments presented herein, the applied control torques are guaranteed to be within the linear zone of the servo amplifier. Therefore, problems associated with linear control, related to vibration, thermal effects, mechanical noise, and nonmodeled dynamics, are avoided. Linear control is highly demanding in terms of gain tuning, as compared to the scheme proposed herein. In accordance with the analytical results, the proposed family of control schemes provides good performance.

In order to evaluate and compare the performances ofthe controllers in a scalar form, the norm [L.sub.2] of the force error is used; it is an objective numerical measure of the force error [??] [20]; a smaller norm [L.sub.2]{[??]} represents smaller force error and it means the best performance of the evaluated control:

[mathematical expression not reproducible] (32)

where T is the time of the experiment. The norm [L.sub.2] {[??]} measures the root-mean-square "average" of the force error [??]. The performance comparison [L.sub.2]{[??]} of the evaluated control schemes took into account the transitory and steady states; that is, two requirements were considered on five evaluated controllers. The first one consisted of getting the performance of the transient response and the second aimed at achieving steady-state response. Once the performance was evaluated for each controller through the [L.sub.2]{[??]}-norm, then the results are normalized with respect to the largest value and presented in percent scale for the transitory phase in Figure 7(a). The time interval to measure the [L.sub.2]{[??]}-norm in the transitory phase is considered at i [member of] [0,4.5] sec. The best performance for the transient state corresponds to the hyperbolic-type control with exponent k =1, corresponding to the smallest index, 51.22%, with respect to the largest value of the Sqrt control. Note that, for the transitory response shown in Figure 4(a), the Euclidean norm square of the force error [parallel] [??] [parallel][sup.2] for the control [f.sub.[chi]Sqrt] shows a larger area than other evaluated schemes; therefore a poor performance [L.sub.2]{[??]} is obtained for the Sqrt control. The PD control was the second best performance, followed by hyperbolic-type control (exponent k =1) with a good performance.

The comparative results of performance indexes for the steady state are shown in Figure 7(b). The smaller [L.sub.2]{[??]} shows that the k = 2 hyperbolic-type control with 50.46% is the one with the best performance, because the steadyforce errors presented less error than the rest of the evaluated control algorithms; the Sqrt control obtained the largest performance index and therefore a poor performance.

The total performance index for each evaluated control scheme would be the average of the sum of indexes of the transitory and steady states; then [mathematical expression not reproducible], which correspond to PD, Atan, Sqrt, k =1, and k = 2 hyperbolictype controls, respectively. Therefore, the best performance corresponds to the hyperbolic-type control scheme [f.sub.[chi]2].

5. Conclusion

In this paper, a new family of explicit force control schemes is presented. The proposed control family includes a large class of saturated-type hyperbolic function terms; the hyperbolic structure depends on k as a power function. It includes also an active velocity damping term plus gravity compensation. Our proposal of force regulators is supported by a stability analysis in Lyapunov sense using a strict Lyapunov function. The asymptotic stability of the closed-loop system equilibrium point in Cartesian space is guaranteed. The mathematical development of Property 4 for the Cartesian dynamics model has been completed; this property is very useful for the stability analysis.

In order to show the performance of the controllers, experimental results have been obtained. An experimental comparison of the performances obtained with the classical proportional-derivative (PD), Atan, and Sqrt controls and two members of the proposed control family on a two-degree-of-freedom, direct-drive robot manipulator is presented. A force sensor (a force/torque sensor ATI FT Gamma SI-130-10) is mounted at the end-effector of the robot manipulator with the purpose of measuring the contact force in order to feed back the force error in the closedloop. The experimental evidence shows that the controller in transitory state with the best performance is the hyperbolic structure with k =1, followed by the hyperbolic controller with k = 2, while in steady state the best performance corresponds to the hyperbolic control with exponent k = 2. The performance of the proposed control is improved compared with traditional PD control scheme and it is a good candidate for industrial applications. The effectiveness of the proposed control scheme can be concluded.

https://doi.org/10.1155/2018/9324623

Appendix

The Cartesian dynamic model has some useful properties for stability analysis of robot controllers. Among these properties, Property 4 is widely cited in the literature of Cartesian robot control; however, we did not find in the literature the proof that the norm of vector [C.sub.[chi]][??] is bounded. Therefore, the mathematical development for Property 4 is presented in this section. For the validity of the Cartesian dynamic model, it is assumed that the Jacobian matrix is full rank.

Proof of Property 4. First, it is necessary to prove that [mathematical expression not reproducible], is true. Since [mathematical expression not reproducible]. Also,

[mathematical expression not reproducible]. (A.1)

For the next step, consider that [mathematical expression not reproducible]; hence,

[mathematical expression not reproducible]. (A.2)

Therefore, [mathematical expression not reproducible].

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding this paper.

Acknowledgments

This work is partially supported by BUAP, Mexico (Project VIEP-00110).

References

[1] M. H. Raibert and J. J. Craig, "Hybrid position/force control of manipulators," Journal of Dynamic Systems, Measurement, and Control, vol. 103, no. 2, pp. 126-133, 1981.

[2] N. Hogan, "Impedance control--An approach to manipulation. I--Theory. II--Implementation. III--Applications," ASME Transactions Journal of Dynamic Systems and Measurement Control B, vol. 107, pp. 1-24, mar 1985.

[3] B. Siciliano and K. Oussama, Handbook of Robotics, Springer, 2nd edition, 2016.

[4] H. Kazerooni, T. B. Sheridan, and P. K. Houpt, "Robust Compliant Motion for Manipulators, Part I: The Fundamental Concepts of Compliant Motion," IEEE Journal on Robotics and Automation, vol. 2, no. 2, pp. 83-92, 1986.

[5] D. E. Whitney, "Historical Perspective and State of the Art in Robot Force Control," International Journal of Robotics Research, vol. 6, no. 1, pp. 3-14, 1987.

[6] O. Khatib, "A unified approach for motion and force control of robot manipulators: the operational space formulation," IEEE Transactions on Robotics and Automation, vol. 3, no. 1, pp. 4353, 1987.

[7] R. Carelli and R. Kelly, "An adaptive impedance/force controller for robot manipulators," Institute of Electrical and Electronics Engineers Transactions on Automatic Control, vol. 36, no. 8, pp. 967-971, 1991.

[8] S. P. Patarinski and R. G. Botev, "Robot force control: A review," Mechatronics, vol. 3, no. 4, pp. 377-398, 1993.

[9] M. Mendoza-Gutierrez, F. Reyes, I. Bonilla-Gutierrez, and E. Gonzelez-Galvan, "Proportional-derivative impedance control of robot manipulators for interaction tasks," Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, vol. 225, no. 3, pp. 315-329, 2011.

[10] B. Siciliano and L. Villani, Robot Force Control, Kluwer Academic Publishers, Boston, MA, USA, 1999.

[11] I. Bonilla-Guti, F. Reyes, M. Mendoza-Guti, and E. J. Gonz, "A Dynamic-compensation Approach to Impedance Control of Robot Manipulators," Journal of Intelligent Robotic Systems, vol. 63, pp. 51-73, 2011.

[12] M. Mendoza, I. Bonilla, F. Reyes, and E. Gonzalez-Galvan, "A Lyapunov-based design tool of impedance controllers for robot manipulators," Kybernetika, vol. 48, no. 6, pp. 1136-1155, 2012.

[13] S. Chiaverini, B. Siciliano, and L. Villani, "A survey of robot interaction control schemes with experimental comparison," IEEE/ASME Transactions on Mechatronics, vol. 4, no. 3, pp. 273-285, 1999.

[14] A. Deneve, S. Moughamir, L. Afilal, and J. Zaytoon, "Control system design of a 3-DOF upper limbs rehabilitation robot," Computer Methods and Programs in Biomedicine, vol. 89, no. 2, pp. 202-214, 2008.

[15] H. Mehdi and O. Boubaker, "Stiffness and Impedance Control Using Lyapunov Theory for Robot-Aided Rehabilitation," International Journal of Social Robotics, vol. 4, no. 1, pp. 107-119,2012.

[16] R. Cortesao and M. Dominici, "Robot Force Control on a Beating Heart," IEEE/ASME Transactions on Mechatronics, vol. 22, no. 4, pp. 1736-1743, 2017.

[17] L. Fortuna and G. Muscato, "A roll stabilization system for a monohull ship: modeling, identification, and adaptive control," IEEE Transactions on Control Systems Technology, vol. 4, no. 1, pp. 18-28, 1996.

[18] S. Jung and T. C. Hsia, "Robust neural force control scheme under uncertainties in robot dynamics and unknown environment," IEEE Transactions on Industrial Electronics, vol. 47, no. 2, pp. 403-412, 2000.

[19] N. Kumar, V. Panwar, N. Sukavanam, S. P. Sharma, and J.-H. Borm, "Neural network based hybrid force/position control for robot manipulators," International Journal of Precision Engineering and Manufacturing, vol. 12, no. 3, pp. 419-426, 2011.

[20] H. Chaudhary, V. Panwar, R. Prasad, and N. Sukavanam, "Adaptive neuro fuzzy based hybrid force/position control for an industrial robot manipulator," Journal of Intelligent Manufacturing, vol. 27, no. 6, pp. 1299-1308, 2016.

[21] T. Yoshikawa, T. Sugie, and M. Tanaka, "Dynamic Hybrid Position/Force Control of Robot Manipulators--Controller Design and Experiment," IEEE Journal on Robotics and Automation, vol. 4, no. 6, pp. 699-705, 1988.

[22] R. Lozano and B. Brogliato, "Adaptive hybrid force-position control for redundant manipulators," Institute ofElectrical and Electronics Engineers Transactions on Automatic Control, vol. 37, no. 10, pp. 1501-1505, 1992.

[23] D. Jeon and M. Tomizuka, "Learning Hybrid Force and Position Control of Robot Manipulators," IEEE Transactions on Robotics and Automation, vol. 9, no. 4, pp. 423-431, 1993.

[24] R. Volpe and P. Khosla, "A theoretical and experimental investigation of explicit force control strategies for manipulators," Institute ofElectrical and Electronics Engineers Transactions on Automatic Control, vol. 38, no. 11, pp. 1634-1650, 1993.

[25] S. Chiaverini and L. Sciavicco, "Parallel approach to force/position control of robotic manipulators," IEEE Transactions on Robotics and Automation, vol. 9, no. 4, pp. 361-373, 1993.

[26] S. K. Singh and D. O. Popa, "An Analysis of Some Fundamental Problems in Adaptive Control of Force and Impedance Behavior: Theory and Experiments," IEEE Transactions on Robotics and Automation, vol. 11, no. 6, pp. 912-921, 1995.

[27] G. Ferretti, G. Magnani, and P. Rocco, "Toward the implementation of hybrid position/force control in industrial robots," IEEE Transactions on Robotics andAutomation, vol. 13, no. 6, pp. 838-845, 1997.

[28] G. Zeng and A. Hemami, "An overview of robot force control," Robotica, vol. 15, no. 5, pp. 473-482, 1997.

[29] C. Natale, Interaction Control of Robot Manipulators: Six-degrees-of- freedom Tasks, Springer Tracts in Advanced Robotics, Springer, 2003.

[30] Q. H. Xia, S. Y. Lim, M. H. Ang Jr., and T. M. Lim, "Parallel force and motion control using adaptive observer-controller," in Proceedings of the 2008 IEEE International Conference on Systems, Man and Cybernetics, SMC 2008, pp. 3143-3149, Singapore, October 2008.

[31] Y. Karayiannidis and Z. Doulgeri, "Robot force/position tracking on a surface of unknown orientation," in European Robotics Symposium 2008, vol. 44 of Springer Tracts Adv. Robot., pp. 253-262, Springer, Berlin, 2008.

[32] B. Siciliano, L. Sciavicco, L. Villani, and G. Oriolo, Robotics: Modelling, Planning and Control, Springer Publishing Company, Incorporated, 2010.

[33] S. A. M. Dehghan, M. Danesh, and F. Sheikholeslam, "Adaptive hybrid force/position control of robot manipulators using an adaptive force estimator in the presence of parametric uncertainty," Advanced Robotics, vol. 29, no. 4, pp. 209-223, 2015.

[34] X. Sheng, L. Xu, and Z. Wang, "A position-based explicit force control strategy based on online trajectory prediction," International Journal of Robotics and Automation, vol. 32, no. 1, pp. 93-100, 2017.

[35] S. M. Hashemi, U. Gurcuoglu, and H. Werner, "Interaction control of an industrial manipulator using LPV techniques," Mechatronics, vol. 23, no. 6, pp. 689-699, 2013.

[36] H. P. Singh and N. Sukavanam, "Stability analysis of robust adaptive hybrid position/force controller for robot manipulators using neural network with uncertainties," Neural Computing and Applications, vol. 22, no. 7-8, pp. 1745-1755, 2013.

[37] E. Sariyildiz and K. Ohnishi, "On the explicit robust force control via disturbance observer," IEEE Transactions on Industrial Electronics, vol. 62, no. 3, pp. 1581-1589, 2015.

[38] C. A. Chavez-Olivares, F. Reyes-Cortes, and E. J. Gonzalez-Galvan, "On Explicit Force Regulation with Active Velocity Damping for Robot Manipulators," Automatika, vol. 56, no. 4, pp. 478-490, 2015.

[39] R. D. J. Portillo-Velez, A. Rodriguez-Angeles, and C. A. Cruz-Villar, "An optimization-based impedance approach for robot force regulation with prescribed force limits," Mathematical Problems in Engineering, vol. 2015, Article ID 918301,13 pages, 2015.

[40] A. Calanca, R. Muradore, and P. Fiorini, "A review of algorithms for compliant control of stiff and fixed-compliance robots," IEEE/ASME Transactions on Mechatronics, vol. 21, no. 2, pp. 613-624, 2016.

[41] Q. Wu, X. Wang, B. Chen, H. Wu, and Z. Shao, "Development and hybrid force/position control of a compliant rescue manipulator," Mechatronics, vol. 46, pp. 143-153, 2017.

[42] J. L. Dideriksen, D. F. Feeney, A. M. Almuklass, and R. M. Enoka, "Control of force during rapid visuomotor force-matching tasks can be described by discrete time PID control algorithms," Experimental Brain Research, vol. 235, no. 8, pp. 2561-2573, 2017.

[43] P. Gierlak and M. Szuster, "Adaptive position/force control for robot manipulator in contact with a flexible environment," Robotics and Autonomous Systems, vol. 95, pp. 80-101, 2017.

[44] M. Takegaki and S. Arimoto, "New feedback method for dynamic control of manipulators," Journal of Dynamic Systems, Measurement and Control, vol. 103, no. 2, pp. 119-125, 1981.

[45] C. Ott, Cartesian Impedance Control of Redundant and Flexible Joint Robots, Springer, 2008.

[46] C. A. Chavez-Olivares, F. Reyes-Cortes, E. J. Gonzelez-Galven, M. O. Mendoza-Gutieerrez, and I. Bonilla-Gutieerrez, "Experimental evaluation of parameter identification schemes on a direct-drive robot," Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, vol. 226, no. 10, pp. 1419-1431, 2012.

[47] R. Kelly, V. Santibanez, and F. Reyes, "On saturated-proportional derivative feedback with adaptive gravity compensation of robot manipulators," International Journal of Adaptive Control and Signal Processing, vol. 10, no. 4-5, pp. 465-479, 1996.

Fernando Reyes-Cortes (iD), (1) Cesar Chavez-Olivares (iD), (2) and Emilio J. Gonzalez-Galvan (iD), (3)

(1) Facultad de Ciencias de la Electronica, Benemerita Universidad Autonoma dePuebla, 72570 Puebla, PUE, Mexico

(2) Departamento deIngenieroa Robotica, Universidad Autonoma de Aguascalientes, Campus Sur, Av. Prolongacion Mahatma Gandhi No. 6601, 20340 Aguascalientes, AGS, Mexico

(3) Facultad de Ingenierea, Universidad Autonoma de San Luis Potosi, Av. Manuel Nava 8, Zona Universitaria, 78290 San Luis Potose, SLP, Mexico

Correspondence should be addressed to Fernando Reyes-Cortes; fernando.reyes@correo.buap.mx

Received 28 December 2017; Accepted 1 March 2018; Published 16 April 2018

Academic Editor: L. Fortuna

Caption: Figure 1: Experimental robot "Rotradi."

Caption: Figure 2: Experimental results for the PD control [mathematical expression not reproducible].

Caption: Figure 3: Experimental results for the [mathematical expression not reproducible].

Caption: Figure 4: Experimental results for the Sqrt control [mathematical expression not reproducible].

Caption: Figure 5: Experimental results of the hyperbolic control [mathematical expression not reproducible].

Caption: Figure 6: Experimental results for the hyperbolic control [mathematical expression not reproducible].

Table 1: Robot arm servo actuators. Joint Model Max. torque [Nm] Resolution [cpr] (1) Shoulder DM-1150A 150 1,024,000 (2) Elbow DM-1015B 15 1,024,000 Table 2: Gain matrices [K.sub.p] and [K.sub.v] for the force regulators. Regulator [K.sub.p] Proportional diag(16.0,5.0) dimensionless Hyperbolic, k = 1 diag(65.0,5.0)N Hyperbolic, k = 2 diag(55.0,5.0)N Atan diag(30.0,5.0) N Sqrt diag(39.0,5.0) N Regulator [K.sub.v] Proportional diag(450.0,150.0) N-sec/m Hyperbolic, k = 1 diag(650.0,150.0) N-sec/m Hyperbolic, k = 2 diag(700.0,150.0) N-sec/m Atan diag(400.0,150.0) N Sqrt diag(400.0,150.0) N Figure 7: Performance indices [L.sub.2] of evaluated control schemes. (a) Normalized [L.sub.2]-norm of the transitory state PD 55.55 k = 1 51.22 k = 2 63.57 Atan 90.38 Sqrt 100 (b) Normalized [L.sub.2]-norm of the steady state PD 87.12 k = 1 93.7 k = 2 50.46 Atan 74.39 Sqrt 100 Note: Table made from bar graph.

Printer friendly Cite/link Email Feedback | |

Title Annotation: | Research Article |
---|---|

Author: | Reyes-Cortes, Fernando; Chavez-Olivares, Cesar; Gonzalez-Galvan, Emilio J. |

Publication: | Journal of Robotics |

Date: | Jan 1, 2018 |

Words: | 7791 |

Previous Article: | Ring Fusion of Fisheye Images Based on Corner Detection Algorithm for Around View Monitoring System of Intelligent Driving. |

Next Article: | Modeling and Kinematics Simulation of a Mecanum Wheel Platform in RecurDyn. |

Topics: |