This paper was converted on www.awesomepapers.org from LaTeX by an anonymous user.
Want to know more? Visit the Converter page.

Stability analysis of admittance control
using asymmetric stiffness matrix

Toshiaki Tsuji1 and Yasuhiro Kato1 1Toshiaki Tsuji and Yasuhiro Kato are with the Graduate School of Science and Engineering, Saitama University, 255 Shimo-okubo, Saitama, 338-8570 E-mail: [email protected]
Abstract

In contact-rich tasks, setting the stiffness of the control system is a critical factor in its performance. Although the setting range can be extended by making the stiffness matrix asymmetric, its stability has not been proven. This study focuses on the stability of compliance control in a robot arm that deals with an asymmetric stiffness matrix. It discusses the convergence stability of the admittance control. The paper explains how to derive an asymmetric stiffness matrix and how to incorporate it into the admittance model. The authors also present simulation and experimental results that demonstrate the effectiveness of their proposed method.

I Introduction

In-demand automation tasks often involve contact-rich tasks with varying mechanical constraints between the robot and the environment, making control program implementation complex. Studies on contact-rich tasks using the peg-in-hole benchmark have expanded automation technology, particularly for precision assembly. Compliance mechanisms, such as active and passive compliance, help robots to perform assembly tasks despite positional errors. Impedance and admittance control are common methods for active compliance [1, 2]. Contact-model-based [3, 4] and contact-model-free [5, 6] approaches are used for compliance control, with the latter often using machine learning methods such as learning from demonstration and learning from the environment with reinforcement learning.

Variable impedance control (VIC), a control strategy that adjusts a robot’s mechanical impedance for safe, versatile, and efficient interaction, has been actively studied [7]. VIC has shown promising results in various applications, such as manipulation, locomotion, haptic feedback, and rehabilitation. However, it faces several challenges, such as the design of robust and efficient actuators and sensors, as well as the development of effective control strategies for complex and dynamic tasks [8].

Methods that use passive compliance obtain the desired stiffness of the hand by using a device that combines passive mechanical elements such as springs. The remote center compliance (RCC) device is one of the most popular examples, which utilizes the inter-axis interference to induce motion against external force [9]. Instead of VIC, variable RCC (VRCC), which can set stiffness in a variable manner, has been studied to deal with complicated tasks [10, 11].

RCC has the advantage of not being limited by control bandwidth because it is composed of mechanical elements. On the other hand, when compliance is reproduced by control, even ranges that cannot be reproduced mechanically can be artificially reproduced with a single parameter setting. In other words, the compliance control has a wider range over which motion can be induced. However, how to set the parameters under an assurance of stability is an important issue.

A passivity-based approach is the most popular candidate to ensure the stability of VIC [12]. It has also been extended to the time-varying admittance controller [13]. Kronander and Billard proposed stability conditions for the VIC scheme that works for different levels of stiffness and damping, using a modified Lyapunov function [14]. Later, Sun et al. expanded on this idea and proposed new constraints that ensure both exponential stability and boundedness of the robot’s position, velocity, and acceleration [15]. Spyrakos-Papastavridis et al. proposed a Passivity-Preservation Control (PPC) that enables the implementation of stable VIC and provided joint and Cartesian space versions of the PPC controller permit the intuitive definition of interaction tasks [16]. In the study of parameter design for variable admittance control, Kim and Yang performed a stability analysis based on the root locus [17]. The root locus has also been used in the parameter design for drill admittance control [18].

While many stability analyses of compliance control have been conducted, only passivity-based analysis has been pursued in multi-degree-of-freedom systems because the problem becomes complex due to the consideration of interference in other axes [19]. Previous studies on compliance control, such as [20] and [21], have indicated that introducing an asymmetric stiffness matrix can increase the robot’s capability and extend the range of motion induction. However, the main challenge is that the asymmetric part fails to satisfy passivity, making it impossible to ensure stability. In this study, we derived parameters for the stability limit of the asymmetric stiffness matrix based on the eigenvalues of the system matrix. We then demonstrate that stability can be guaranteed by setting the parameters using the root locus method.

The contributions of this paper can be summarized as follows.

  1. 1.

    Spiral oscillations can be excited when the stiffness matrix is asymmetric. We have clarified the condition for such excitation. We also showed that the condition for the absence of spiral oscillation is equivalent to the condition that the eigenvalues of the stiffness matrix are real numbers.

  2. 2.

    We have demonstrated that it is difficult to satisfy the passivity when the above conditions are not satisfied and therefore identified the conditions under which vibration converges using the root locus method.

II Basic Principle

This study discusses the stability of compliance control in a robot arm that deals with an asymmetric stiffness matrix. It is limited to admittance control and discusses the convergence stability of a planar admittance model, assuming the inner position control loop is stable. The feedback control system is shown in Fig. 1. It is an admittance control system with a minor feedback loop for position control. The type of position control is not specified, but a control system using a disturbance observer (DOB) is adopted in the experimental setup. The admittance model is based on the following equation:

𝑭ext=𝑴𝒙¨+𝑫𝒙˙+𝑲𝒙\displaystyle\mbox{\boldmath$F$}_{ext}=\mbox{\boldmath$M$}\ddot{\mbox{\boldmath$x$}}+\mbox{\boldmath$D$}\dot{\mbox{\boldmath$x$}}+\mbox{\boldmath$K$}\mbox{\boldmath$x$} (1)

This admittance model takes force 𝑭ext\mbox{\boldmath$F$}_{ext} as input and outputs the position 𝒙x and velocity 𝒙˙\dot{\mbox{\boldmath$x$}} obtained through numerical integration based on the acceleration 𝒙¨\ddot{\mbox{\boldmath$x$}} obtained from equation (1). While symmetric matrices are typically used for the stiffness matrix 𝑲K and damping matrix 𝑫D of the admittance model, this study considers the use of an asymmetric matrix for the stiffness matrix 𝑲K. For simplicity, the damping matrix 𝑫D is assumed to be a diagonal matrix.

When an external force occurs, the direction in which the robot end effector is induced, and the convergence point are determined only by the stiffness matrix 𝑲K of the admittance model. Therefore, it is desirable to expand the selection range of the stiffness matrix 𝑲K when designing the relationship between external forces and robot operation. On the other hand, since the damping matrix 𝑫D does not affect the convergence point of the end effector, the priority of expanding the selection range is not high. Additionally, applying viscous force only in the direction in which velocity is generated increases the dissipation of energy and is reasonable for enhancing stability. Therefore, it is necessary to consider how to give the diagonal elements of the damping matrix 𝑫D when the non-diagonal elements of the stiffness matrix 𝑲K are given arbitrarily.

When the stiffness matrix 𝑲K is asymmetric, it is known that the effect of the stiffness matrix can be expressed as a superposition of the symmetric part 𝑲s\mbox{\boldmath$K$}_{s}, which creates a force field that converges at the equilibrium point [1], and the asymmetric part 𝑲a\mbox{\boldmath$K$}_{a}, which creates a force that rotates around the equilibrium point. An example of this is shown in Fig. 2. If the stiffness control is reproduced by a virtual spring, the symmetric part can be treated as generating an elliptical virtual potential energy field generated by strain. Similarly, virtual kinetic energy can be derived from the mass and velocity of the admittance model. Therefore, in the symmetric matrix, a control system design based on passivity can be achieved by deriving an energy function. However, when this is extended to an asymmetric matrix, the curl field generated by the asymmetric part is not a conservative force, and it may excite oscillations. Oscillations excited by the curl field are referred to as spiral oscillations. Since energy may increase due to spiral oscillation, passivity may not be satisfied.

This is demonstrated by the energy function. It is obtained as the integral of the product of velocity and force, which is power.

V\displaystyle V\!\! =\displaystyle= 𝒙˙T𝑭ext𝑑t\displaystyle\int\dot{\mbox{\boldmath$x$}}^{T}\mbox{\boldmath$F$}_{ext}dt (2)

By substituting 𝑲=𝑲s+𝑲a\mbox{\boldmath$K$}=\mbox{\boldmath$K$}_{s}+\mbox{\boldmath$K$}_{a} and (1) into (2),

V\displaystyle V\!\! =\displaystyle= 𝒙˙T𝑴𝒙¨+𝒙˙T𝑫𝒙˙+𝒙˙T𝑲s𝒙+𝒙˙T𝑲a𝒙\displaystyle\int\dot{\mbox{\boldmath$x$}}^{T}\mbox{\boldmath$M$}\ddot{\mbox{\boldmath$x$}}+\dot{\mbox{\boldmath$x$}}^{T}\mbox{\boldmath$D$}\dot{\mbox{\boldmath$x$}}+\dot{\mbox{\boldmath$x$}}^{T}\mbox{\boldmath$K$}_{s}\mbox{\boldmath$x$}+\dot{\mbox{\boldmath$x$}}^{T}\mbox{\boldmath$K$}_{a}\mbox{\boldmath$x$} (3)
=\displaystyle= 12𝒙˙T𝑴𝒙˙+12𝒙T𝑲s𝒙+𝒙˙T𝑫𝒙˙𝑑t+𝒙˙T𝑲a𝒙𝑑t\displaystyle\!\!\!\!\frac{1}{2}\dot{\mbox{\boldmath$x$}}^{T}\!\!\mbox{\boldmath$M$}\dot{\mbox{\boldmath$x$}}+\frac{1}{2}\mbox{\boldmath$x$}^{T}\!\!\mbox{\boldmath$K$}_{s}\mbox{\boldmath$x$}+\!\!\int\!\!\dot{\mbox{\boldmath$x$}}^{T}\!\!\mbox{\boldmath$D$}\dot{\mbox{\boldmath$x$}}dt+\!\!\int\!\!\dot{\mbox{\boldmath$x$}}^{T}\!\!\mbox{\boldmath$K$}_{a}\mbox{\boldmath$x$}dt (4)

Eq. (4) shows that the virtual energy of the admittance model is defined as a function divided into four terms: kinetic energy, stiffness energy, energy loss due to friction, and energy imparted by the asymmetric part. The first and second terms represent kinetic and potential energy, respectively. The third term represents energy dissipated by viscosity, while the fourth term represents energy imposed by the curl field. Since the first and second terms are the energy of conservative forces, if the third term is smaller than the fourth term, the energy function does not increase. However, the above equation depends on velocity, and when the velocity decreases, the dissipative term becomes smaller. Therefore, if there are periods during vibration where the velocity becomes small, passivity may not hold.

Refer to caption
Figure 1: Admittance Control
Refer to caption
Figure 2: Force field generated by asymmetric stiffness matrix

III Stability analysis using root locus

The fundamental principle of admittance control described in the previous section shows that it is generally difficult to establish passivity when the stiffness matrix is made asymmetric. Therefore, the stability will be analyzed based on the concept of root locus below. First, the admittance parameters are defined in the x-y plane as follows:

𝑲=𝑲s+𝑲a=[kxks+kakskaky],𝑫=[d00d]\mbox{\boldmath$K$}=\mbox{\boldmath$K$}_{s}+\mbox{\boldmath$K$}_{a}=\begin{bmatrix}k_{x}&k_{s}+k_{a}\\ k_{s}-k_{a}&k_{y}\end{bmatrix},\mbox{\boldmath$D$}=\begin{bmatrix}d&0\\ 0&d\end{bmatrix} (5)

we define the state vector 𝒙x as [xx,xy,x˙x,x˙y][x_{x},x_{y},\dot{x}_{x},\dot{x}_{y}], then its state equation can be obtained as follows:

𝒙˙\displaystyle\dot{\mbox{\boldmath$x$}} =\displaystyle= 𝑨A𝒙x
[x¨xx¨yx˙xx˙y]\displaystyle\begin{bmatrix}\ddot{x}_{x}\\ \ddot{x}_{y}\\ \dot{x}_{x}\\ \dot{x}_{y}\end{bmatrix} =\displaystyle= [dm0kxmkskam0dmks+kamkym10000100][x˙xx˙yxxxy]\displaystyle\begin{bmatrix}-\frac{d}{m}&0&-\frac{k_{x}}{m}&\frac{-k_{s}-k_{a}}{m}\\ 0&-\frac{d}{m}&\frac{-k_{s}+k_{a}}{m}&-\frac{k_{y}}{m}\\ 1&0&0&0\\ 0&1&0&0\end{bmatrix}\begin{bmatrix}\dot{x}_{x}\\ \dot{x}_{y}\\ x_{x}\\ x_{y}\end{bmatrix} (6)

Here, kx,ky,ks,ka,d,m𝑹k_{x},k_{y},k_{s},k_{a},d,m\in\mbox{\boldmath$R$}. dd and mm are the damper and mass of the admittance model. kxk_{x} and kyk_{y} represent the diagonal elements of the stiffness matrix in the x and y directions, respectively, and ksk_{s} and kak_{a} represent the symmetric and asymmetric components of the non-diagonal terms, respectively. Moreover, we define parameters as follows: dm=dm,kxm=kxm,kym=kym,ksm=ksm,kam=kamd_{m}=\frac{d}{m},k_{xm}=\frac{k_{x}}{m},k_{ym}=\frac{k_{y}}{m},k_{sm}=\frac{k_{s}}{m},k_{am}=\frac{k_{a}}{m}, then we can write 𝑨A, the system matrix of the state equation, as follows:

𝑨A =\displaystyle= [dm0kxmksmkam0dmksm+kamkym10000100]\displaystyle\begin{bmatrix}-d_{m}&0&-k_{xm}&-k_{sm}-k_{am}\\ 0&-d_{m}&-k_{sm}+k_{am}&-k_{ym}\\ 1&0&0&0\\ 0&1&0&0\end{bmatrix} (7)

The eigenvalues of the system matrix 𝑨A are obtained as follows:

λ=dm±dm22(kxm+kym±4kam2+4ksm2+(kxmkym)2)2\!\!\lambda\!=\!\!\frac{\!\!-d_{m}\!\!\pm\!\!\sqrt{\!d_{m}^{2}\!\!-\!\!2(k_{xm}\!\!+\!\!k_{ym}\!\!\pm\!\!\sqrt{\!\!-4k_{am}^{2}\!\!+\!\!4k_{sm}^{2}\!\!+\!\!(k_{xm}\!\!-\!\!k_{ym})^{2}\!})}}{2} (8)

The poles of the transfer function of this admittance model have the same values as the eigenvalues of the system matrix 𝑨A. Therefore, the root locus can be obtained by sweeping a parameter of matrix 𝑨A from 0 to infinity. When the non-diagonal element kamk_{am} of the stiffness matrix is zero, i.e., when the stiffness matrix is symmetric, the root locus for varying the damping ratio dmd_{m} from 0 to infinity is shown in Fig. 3. For a symmetric matrix, the roots of the natural vibrations, which depend on the stiffness matrix, appear on the imaginary axis, and as the viscous damping ratio dmd_{m} increases, the roots move in the negative real axis direction. At the same time, the imaginary part of the root decreases. The damping ratio dmd_{m} where the imaginary part of the two conjugate eigenvalues shrinks to zero is called the critical damping ratio. The contents of the square root of (8) are then zero, hence the critical damping ratio is derived by the following equation.

dm=2(kxm+kym±4kam2+4ksm2+(kxmkym)2)\displaystyle d_{m}\!\!=\!\sqrt{2\left(k_{xm}\!+\!k_{ym}\!\!\pm\!\!\sqrt{\!-4k_{am}^{2}\!\!+\!4k_{sm}^{2}\!\!+\!(k_{xm}\!\!-\!k_{ym})^{2}}\right)} (9)

When the value is equal to the critical damping ratio, the roots coincide on the real axis. When the viscous damping ratio dmd_{m} increases beyond this value, the roots separate and move to the left and right along the real axis.

Fig. 3(a) shows the result when kxm=kym=100k_{xm}=k_{ym}=100 and ksm=0k_{sm}=0, and the stiffness matrix is diagonal. On the other hand, Fig. 3(b) shows the result when kxm=kym=100k_{xm}=k_{ym}=100 and ksm=40k_{sm}=40. In other words, the stiffness matrix is not diagonal and its eigenvalues are 140 and 60. Fig. 3(c) shows the result for the case of a diagonal stiffness matrix with the same eigenvalues as in Fig. 3(b), with kxm=140,kym=60,ksm=0k_{xm}=140,k_{ym}=60,k_{sm}=0. The initial position of the root locus changes depending on the eigenvalues of the stiffness matrix, as shown in the comparison of Figs. 3(a), (b), and (c).

In Fig. 3(a), since the two eigenvalues coincide, the root locus starts from the points ±kxmj\pm\sqrt{k_{xm}}j on the imaginary axis, while in Fig. 3(b), the root locus is split into two upper and lower branches due to the different eigenvalues. Figs. 3(b) and (c) also show that the root locus coincides when the eigenvalues are the same. Eq. (1) deals with a generalized stiffness matrix in two dimensions, but to simplify the derivation of the equation, ksmk_{sm} is set to 0, and stability analysis is performed below. For the case where ksmk_{sm} is not 0, the same root locus can be obtained by deriving its eigenvalues and substituting them into the diagonal elements.

Refer to caption
Figure 3: The root locus of a system with a symmetric stiffness matrix

The root locus of the asymmetric matrix is shown in Fig. 4, where four roots appear symmetrically across the imaginary axis when dmd_{m} is 0. As dmd_{m} is gradually increased from 0, the four roots move negatively along the real axis while the imaginary axis component decreases. As dmd_{m} is further increased, two of the four roots change their orientation toward the positive direction of the real axis, and the other two roots move in opposite directions, one positive and one negative. In this case, the imaginary axis component remains slightly. This means that in the case of an asymmetric matrix, oscillations are excited due to the presence of the curl field. However, there is a condition for the parameter that excites the oscillation. To ensure that all eigenvalues λ\lambda are real, it is necessary for the contents of the square root in the second term of the numerator in (8) to be positive, that is,

dm22(kxm+kym±4kam2+4ksm2+(kxmkym)2)>0.d_{m}^{2}\!-2\!\left(\!k_{xm}\!+\!k_{ym}\!\pm\!\!\sqrt{\!-4k_{am}^{2}\!+4k_{sm}^{2}\!+\!\left(k_{xm}\!-\!k_{ym}\right)^{2}}\right)\!\!>\!0. (10)

And it is necessary to have a real value of dmd_{m} in (10). To ensure this, the square root term in (10) must be positive. The condition is expressed by the following inequality.

4kam2+4ksm2+(kxmkym)2>0-4k_{am}^{2}+4k_{sm}^{2}+(k_{xm}-k_{ym})^{2}>0 (11)

Consequently, condition for the asymmetric element kamk_{am} is determined as follows:

|kam|<ksm2+1/4(kxmkym)2|k_{am}|<\sqrt{k_{sm}^{2}+1/4(k_{xm}-k_{ym})^{2}} (12)

If the above inequality is satisfied, the oscillation will no longer occur when dmd_{m} is greater than the critical damping. The eigenvalues of the stiffness matrix 𝑲K are derived by the following equation:

λK=12(kxm+kym±4kam2+4ksm2+(kxmkym)2)\lambda_{K}=\frac{1}{2}\left(k_{xm}+k_{ym}\pm\sqrt{-4k_{am}^{2}+4k_{sm}^{2}+\left(k_{xm}-k_{ym}\right)^{2}}\right) (13)

The condition for the stiffness matrix to obtain critical damping is equivalent to the matrix having real eigenvalues, as shown by the fact that the condition for (13) to have real solutions is the same as that for (12).

Refer to caption
Figure 4: The root locus of a system with an asymmetric stiffness matrix

Next, we will derive the conditions for the admittance parameters that ensure stability. If the viscous damping coefficient dmd_{m} is increased to a certain value or more, all the roots will move toward the left half of the complex plane, making it possible to stabilize the control system. From (8), in the case of an asymmetric matrix,

kxm+kym±(4kam2+(kxmkym)2<0\displaystyle k_{xm}+k_{ym}\pm\sqrt{(-4k_{am}^{2}+(k_{xm}-k_{ym})^{2}}<0 (14)

The above condition results in the occurrence of positive eigenvalues and unstable poles. However, if 4kam2+(kxmkym)2>0-4k_{am}^{2}+(k_{xm}-k_{ym})^{2}>0, there are no solutions that satisfy (14) for kxm>0,kym>0k_{xm}>0,k_{ym}>0. Therefore, the condition for unstable poles to occur within the range of 4kam2+(kxmkym)20-4k_{am}^{2}+(k_{xm}-k_{ym})^{2}\leq 0 needs to be investigated. To simplify the (8), α,β𝑹\alpha,\beta\in\mbox{\boldmath$R$} are defined as follows:

α=dm22(kxm+kym),β=16kam24(kxmkym)2.\displaystyle\alpha=\!d_{m}^{2}\!-\!2(k_{xm}\!+\!k_{ym}),\beta=\!\!\sqrt{16k_{am}^{2}\!-\!4(k_{xm}\!-\!k_{ym})^{2}}. (15)

Then, the eigenvalues are expressed as follows:

λ=12(dm±α±βj)\displaystyle\lambda=\frac{1}{2}(-d_{m}\pm\sqrt{\alpha\pm\beta j}) (16)

Let the real part and imaginary part of α±βj\sqrt{\alpha\pm\beta j} be aa and bb, respectively, then

(a+bj)(a+bj)=a2b2+2abj=α+βj\displaystyle(a+bj)(a+bj)=a^{2}-b^{2}+2abj=\alpha+\beta j (17)

Consequently, α=a2b2\alpha=a^{2}-b^{2}, and β=2ab\beta=2ab are obtained. By the following equation: α+α2+β2=2a2\alpha+\sqrt{\alpha^{2}+\beta^{2}}=2a^{2}, real part aa is expressed as below:

a=±α+α2+β22\displaystyle a=\pm\sqrt{\frac{\alpha+\sqrt{\alpha^{2}+\beta^{2}}}{2}} (18)

In order to avoid unstable poles, it is necessary for all eigenvalues to be negative, so we only consider the case where a=α+α2+β22a=\sqrt{\frac{\alpha+\sqrt{\alpha^{2}+\beta^{2}}}{2}}.

dm+α+α2+β22<0\displaystyle-d_{m}+\sqrt{\frac{\alpha+\sqrt{\alpha^{2}+\beta^{2}}}{2}}<0 (19)

The condition that satisfies the (10) is derived below. First, consider the typical case where the equation is simplified, which is kxm=kymk_{xm}=k_{ym}. Substituting α=dm24kxm\alpha=d_{m}^{2}-4k_{xm}, β=4kam\beta=4k_{am} into (19) and the following equation is obtained:

dm>kam2kxm\displaystyle d_{m}>\sqrt{\frac{k_{am}^{2}}{k_{xm}}} (20)

If the value of kamk_{am} is greater than kxmk_{xm}, then the lower limit of dmd_{m} also increases. These parameters are determined by the mass ratio, and to convert them into actual admittance parameters, we substitute kxm=kx/m,kam=ka/mk_{xm}=k_{x}/m,k_{am}=k_{a}/m, and dm=d/md_{m}=d/m into the above equation, yielding the following equation:

d>ka2mkx\displaystyle d>\sqrt{\frac{k_{a}^{2}m}{k_{x}}} (21)

The next is to consider the case where kym>kxm>0k_{ym}>k_{xm}>0 to further generalize (20) and (21). The condition is still given by (15), but now we substitute the more generalized (10). It is difficult to algebraically derive the condition for all eigenvalues to be negative. However, if (20) is satisfied, then all eigenvalues will be negative.

The proof is shown below. If (19) is satisfied and without changing the values of the other parameters, let us increase the value of kymk_{ym} from kxmk_{xm}. If aa in (18) does not increase during this process, (15) will always be satisfied. When differentiating (18) with respect to α\alpha and β\beta, we obtain the following expressions:

aα\displaystyle\frac{\partial a}{\partial\alpha} =\displaystyle= 1+aα2+β222α+α2+β2\displaystyle\frac{1+\frac{a}{\sqrt{\alpha^{2}+\beta^{2}}}}{2\sqrt{2}\sqrt{\alpha+\sqrt{\alpha^{2}+\beta^{2}}}} (22)
aβ\displaystyle\frac{\partial a}{\partial\beta} =\displaystyle= β22α2+β2α+α2+β2\displaystyle\frac{\beta}{2\sqrt{2}\sqrt{\alpha^{2}+\beta^{2}}\sqrt{\alpha+\sqrt{\alpha^{2}+\beta^{2}}}} (23)

when β>0\beta>0 and kym>kxmk_{ym}>k_{xm}, both partial derivatives are positive. As (15) shows, increasing kymk_{ym} always results in a decrease in both α\alpha and β\beta, so the value of aa in (18) must always decrease. Therefore, if (20) is satisfied, then for all kym>kxm>0k_{ym}>k_{xm}>0, all eigenvalues are always negative. Replacing kxmk_{xm} and kymk_{ym} in (20) as follows:

dm>kam2kym\displaystyle d_{m}>\sqrt{\frac{k_{am}^{2}}{k_{ym}}} (24)

By performing the same equation expansion as above, stability can also be demonstrated for the case where kxm>kym>0k_{xm}>k_{ym}>0.

IV Simulation study of convergence

IV-A Comparison of time response

A simulation study on the convergence of the proposed method’s root locus was conducted to examine its relationship with stability. An external force of Fext=(0.0,10.0)TF_{ext}=(0.0,10.0)^{T} was step-inputted to the admittance model on a 2D plane at equilibrium. The damping coefficient dmd_{m} was derived as follows and a comparative study was conducted while changing the value of the damping ratio ζ\zeta.

dm=ζ2(kxm+kym±4kam2+4ksm2+(kxmkym)2)d_{m}\!=\zeta\sqrt{2\!\left(\!k_{xm}\!+\!k_{ym}\!\pm\!\!\sqrt{\!\!-4k_{am}^{2}\!+\!4k_{sm}^{2}\!+\!\left(k_{xm}\!\!-\!k_{ym}\right)^{2}}\right)} (25)

Fig. 5(a) illustrates the simulation results conducted under the same conditions as those in Fig. 4(b). The convergence of the system is determined by the satisfaction of (21). As the damping ratio dmd_{m} increases, the magnitude of oscillation decreases. Additionally, the system’s time constant decreases beyond a certain value of dmd_{m}. However, oscillation persists even when ζ\zeta exceeds 1, and the system did not attain critical damping. Fig. 5(b) shows the results of the same conditions as Fig. 4(b). As the viscosity ratio dmd_{m} increases, the oscillation becomes smaller, and the time constant becomes lower. Critical damping occurs at ζ=1\zeta=1, and no oscillation occurs at higher viscosity ratios. The difference between the two conditions is whether (12) is satisfied or not. Fig. 5(a) has eigenvalues with imaginary components, while Fig. 5(b) does not. The results support the theory that the presence of imaginary components in the eigenvalues of the stiffness matrix determines whether the asymmetric matrix causes spiral oscillations. Since the stiffness matrix in Fig. 5(b) only has positive real eigenvalues, oscillations can be avoided by setting an appropriate viscosity ratio dmd_{m}. Fig. 5(c) compares the paths when ζ=1\zeta=1. It shows that the asymmetric matrix with eigenvalues with imaginary components generated a spiral path, while the matrix with eigenvalues without imaginary components did not cause spiral oscillation.

Refer to caption
Figure 5: Time response of asymmetric matrix

IV-B Simulation-based validation of passivity

The proposed stability analysis method, which utilizes root locus, provides proof of convergence for a particular parameter range. The stability of compliance control is often shown not only by nominal stability, which does not consider contact with the target, but also by combined stability with contact with the target. Therefore, in this simulation, we reproduced a situation in which the object is fixed to a rigid wall. To illustrate this, we compare the time responses of two simulations in Figs. 6 and 7, with the parameters listed in Table I. The parameters of the admittance model are presented in Table I. A damping value of d=0.34d=0.34, which is slightly above the threshold value (d=0.316d=0.316) derived in (21), caused the system to start oscillating at the mechanical natural frequency and gradually decrease its amplitude, as depicted in Fig. 4. By setting the damping value to d=0.30d=0.30, slightly below the threshold value (d=0.316d=0.316), the amplitude of the system gradually increased, as shown in Fig. 7. This result demonstrates the validity of (21). Fig. 6 shows stable convergence, and the sum of kinetic energy proportional to the mass and potential energy proportional to the stiffness of the admittance model gradually decreased. However, between 0 and 1 second, there were several time periods when the sum of the outputs was slightly above 0. The increase in energy occurred during periods of low velocity during oscillation. This means that if the loss due to viscous resistance is smaller than the increase in energy due to the curl field, the energy may increase locally even when the amplitude is monotonically decreasing. The system does not satisfy local passivity when the velocity is small. However, the energy only increases in certain phases during oscillation, and final convergence is guaranteed if (21) is satisfied.

TABLE I: Parameters in simulation
mass mm 0.1 [kg] stiffness kxk_{x} 100.0 [N/m]
sampling tst_{s} 1 [ms] kyk_{y} 100.0 [N/m]
time ksk_{s} 0.0 [N/m]
kak_{a} 10.0 [N/m]
Refer to caption
Figure 6: Time response when damping is higher than the threshold (d=0.34)
Refer to caption
Figure 7: Time response when damping is lower than the threshold (d=0.30)

To confirm the validity of the design value of the minimum damper derived in (20), a simulation evaluation was performed: 5 seconds tests were conducted using the same parameters as in Table I. We repeated the test with ksk_{s} and kak_{a} changed in the range of -80 to 80. The response was recorded when dd was varied in increments of 0.1 for each condition, and stability was considered to be maintained when the average kinetic energy for 0.1 seconds was less than 0.2 J at the end of the test. The minimum value of dd at which this was the case was plotted.

Fig. 8(a) shows the design value derived from (20), and (b) shows the result derived from the above simulation. In all conditions, the control system was confirmed to be stable at a damper below the design value. When ksk_{s} is 0, the design value and the simulation results almost coincide, while the larger the absolute value of ksk_{s}, the smaller the damper dd becomes. Eq. (11) shows that the imaginary component of the eigenvalue λ\lambda decreases with increasing absolute value of ksk_{s}. Since the imaginary component of λ\lambda is the cause of spiral oscillation, this simulation result confirms the contents of (11). In addition, the region where stability is ensured even when dd is zero and the region represented by (12) are almost identical. This confirms the validity of (12) as an expression for the parameter region where spiral oscillation does not occur. Fig. 8(c) represents the result when only kxk_{x} is changed to 80. As shown in (24), this result confirms that when either stiffness is low, it is desirable to set the parameters according to the higher stiffness value.

The conditions in (12) and (24) only concern the parameter settings for the asymmetric part. Note that other conditions that must be satisfied by the symmetrical part, as indicated in previous studies, must be taken into account. For example, Fig. 8(b) does not show the results for ksmk_{sm} of 1000, but when ksmk_{sm} exceeds 1000, one of the eigenvalues of the symmetric part becomes negative and stability is not satisfied. In sum, it is necessary to design the asymmetric part in addition to the design of the symmetric part in the conventional methods.

Refer to caption
Figure 8: Minimum damper parameter in simulation

V Experiment

In this experiment, the robot’s performance was evaluated based on the admittance parameter. The robot was made to move vertically towards a metallic board and follow the surface in the y-axis using the displacement caused by the admittance control. Symmetric and asymmetric stiffness matrices were chosen, and damping parameters were set to d=18d=18 which was higher than the threshold (d=17.889d=17.889). The results shown in Fig. 9 revealed that after contacting the board at t=27t=27 seconds, the robot moved towards the negative direction in the y-axis. There was no noticeable movement in the x-axis due to the design of the non-diagonal element of the stiffness matrix. In the case of the symmetric matrix, the difference between the desired displacement ydy_{d} and the actual displacement yy was 8 mm. Due to the setting of kzy=400k_{zy}=400, there was slight displacement in the z-axis, which led to a lower contact force fzf_{z}. However, in the case of the asymmetric (triangular) matrix, the difference between the desired displacement ydy_{d} and the actual displacement yy was 6 mm, which is shorter than that of the symmetric matrix. Additionally, the contact force fzf_{z} was maintained higher because the displacement mainly occurred in the y-axis.

Refer to caption
Figure 9: Comparison of experimental results

VI Conclusion

This paper discusses the stability of admittance control of a robot arm handling an asymmetric stiffness matrix. Although the introduction of asymmetric elements does not guarantee passivity, it is possible to derive a range of parameters for which stability is guaranteed from the eigenvalues of the system matrix. In addition, the introduction of asymmetric elements may excite helical oscillations, so that critical damping may not be obtained for any given damping parameter, depending on the setting of the stiffness matrix. In this study, we focused on the fact that the spiral oscillation is caused by the imaginary component of the system matrix and clarified the condition of the asymmetric matrix for which critical damping can be obtained. From the simulation and experimental results, it is confirmed that the asymmetric matrix setting method is effective to obtain critical damping. The analysis was performed on a 2-dimensional plane, but future work should extend the theory to a wider range of conditions. The theory can be generalized to systems with three or more degrees of freedom and by utilizing the concept of energy tanks, conduct stability analysis similar to a passive system. The theory may also be extended to variable stiffness control.

References

  • [1] N. Hogan, “Impedance control: An approach to manipulation: Part III— Applications,” J. Dyn. Syst., Meas., Control, vol. 107, pp. 121–128, 1985.
  • [2] W. S. Newman: “Stability and performance limits of interaction controllers,” Journal of Dynamic Systems, Measurement, and Control, vol. 114, no. 4, pp. 563–570, 2012.
  • [3] T. Tang, H. Lin, Y. Zhao, W. Chen, and M. Tomizuka: “Autonomous alignment of peg and hole by force/torque measurement for robotic assembly,” in Proc. 2016 IEEE Int. Conf. on Automation Science and Engineering (CASE), pp. 162–167, 2016.
  • [4] H. Unten, S. Sakaino and T. Tsuji: “Peg-in-Hole Using Transient Information of Force Response,” in IEEE/ASME Trans. Mechatronics, vol. 28, no. 3, pp. 1674–1682, 2023.
  • [5] S. Gubbi, S. Kolathaya, and B. Amrutur: “Imitation learning for high precision peg-in-hole tasks,” in Proc. of 6th International Conference on Control, Automation and Robotics (ICCAR), pp. 368–372, 2020.
  • [6] J. Luo, E. Solowjow, C. Wen, J. A. Ojea, A. M. Agogino, A. Tamar, and P. Abbeel: “Reinforcement learning on variable impedance controller for high-precision robotic assembly,” in Proc. of International Conference on Robotics and Automation (ICRA), pp. 3080–3087, 2019.
  • [7] R. Ikeura and H. Inooka: “Variable impedance control of a robot for cooperation with a human,” in Proc. 1995 IEEE Int. Conf. on Robotics and Automation, pp. 3097–3102 vol. 3, 1995.
  • [8] F. J. Abu-Dakka and M. Saveriano: “Variable impedance control and learning—a review.” Frontiers in Robotics and AI, vol. 7, 590681, 2020.
  • [9] D. E. Whitney: “Quasi-static assembly of compliantly supported rigid parts,” Journal of Dynamic Systems Measurement and Control-transactions of the Asme, vol. 104, pp. 65–77, 1982.
  • [10] F. Zhao and P. S. Y. Wu: “VRCC : a variable remote center compliance device,” Mechatronics, vol. 8, no. 6, pp. 657–672, 1998.
  • [11] S. Lee: “Development of a new variable remote center compliance (VRCC) with modified elastomer shear pad (ESP) for robot assembly,” IEEE Trans. on Automation Science and Engineering, vol. 2, pp. 193–197, 2005.
  • [12] F. Ferraguti, C. Secchi, and C. Fantuzzi: “A tank-based approach to impedance control with variable stiffness,” in Proc. IEEE Int. Conf on robotics and automation pp. 4948–4953, 2013
  • [13] F. Ferraguti, N. Preda, A. Manurung, M. Bonfe, O. Lambercy, R. Gassert, R. Muradore, P. Fiorini, and C. Secchi: “An energy tank-based interactive control architecture for autonomous and teleoperated robotic surgery,” IEEE Trans. on Robotics, vol. 31, no. 5, pp. 1073–1088, 2015.
  • [14] K. Kronander and A. Billard: “Learning compliant manipulation through kinesthetic and tactile human-robot interaction,” IEEE Transactions on Haptics, vol. 7, no. 3, pp. 367–380, 2014.
  • [15] T. Sun, L. Peng, L. Cheng, Z. G. Hou and Y. Pan: “Stability-Guaranteed Variable Impedance Control of Robots Based on Approximate Dynamic Inversion,” in IEEE Transactions on Systems, Man, and Cybernetics: Systems, vol. 51, no. 7, pp. 4193–4200, 2021, doi: 10.1109/TSMC.2019.2930582.
  • [16] E. Spyrakos-Papastavridis, P. R. N. Childs, and J. S. Dai: “Passivity Preservation for Variable Impedance Control of Compliant Robots,” in IEEE/ASME Trans. on Mechatronics, vol. 25, no. 5, pp. 2342–2353, 2020, doi: 10.1109/TMECH.2019.2961478.
  • [17] H. Kim, W. Yang: “Variable Admittance Control Based on Human–Robot Collaboration Observer Using Frequency Analysis for Sensitive and Safe Interaction,” Sensors, vol. 21, no. 5, 1899, 2021.
  • [18] Y. Aydin, D. Sirintuna, C. Basdogan: “Towards collaborative drilling with a cobot using admittance controller,” Trans. Institute of Measurement and Control. vol. 43, no. 8, pp. 1760–1773, 2021.
  • [19] C. Ott, A. Dietrich, and A. Albu-Schäffer: “Prioritized multi-task compliance control of redundant manipulators,” Automatica, vol. 53, pp. 416–423, 2015.
  • [20] M. Oikawa, T. Kusakabe, K. Kutsuzawa, S. Sakaino, and T. Tsuji: “Reinforcement learning for robotic assembly using non-diagonal stiffness matrix,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 2737–2744, 2021.
  • [21] S. Kozlovsky, E. Newman, and M. Zacksenhouse, “Reinforcement Learning of Impedance Policies for Peg-in-Hole Tasks: Role of Asymmetric Matrices,” IEEE Robotics and Automation Letters, vol. 7, no. 4, pp. 10898–10905, 2022.
  • [22] K. Ohnishi, M. Shibata, and T. Murakami: “Motion control for advanced mechatronics,” IEEE/ASME Trans. on Mechatronics, vol. 1, no. 1, pp. 56–67, 1996.
  • [23] S. W. Doebling, L. D. Peterson, and K. F. Alvin. “Experimental determination of local structural stiffness by disassembly of measured flexibility matrices.” J. Vib. Acoust., vol. 120, no. 4, pp. 949–957, 1998.
  • [24] E. Masehian and S. Ghandi: “Assembly sequence and path planning for monotone and nonmonotone assemblies with rigid and flexible parts,” Robotics and Computer-Integrated Manufacturing, vol. 72, 2021, 102180.
  • [25] J. E. Colgate and N. Hogan: “Robust control of dynamically interacting systems,” Int. J. Control, vol. 48, no. 1, pp. 65–88, 1988