Abstract
The output-based control of a redundant robotic manipulator with relevant and adjustable joint stiffness is addressed. The proposed controller is configured as a cascade system that allows the decoupling of the actuators dynamics from the arm dynamics and the consequent reduction of the order of the manipulator dynamic model. Moreover, the proposed controller does not require the knowledge of the whole robot state: only the positions of the actuators and of the joints are necessary. This approach represents a significant simplification with respect to previously proposed state feedback techniques. The problem of controlling simultaneously the position trajectory and the desired stiffness in both the joint and work space is investigated, and the relations between the manipulator redundancy and the selection of both the joint and work space stiffness of the manipulator are discussed. The effectiveness of the proposed approach is verified by simulations of a 3 degrees of freedom planar manipulator.
1. Introduction
Physical human-robot interaction currently represents one of the most challenging issues in robotics. To this end, a new class of robots is under development considering safety and dependability as a primary goal. While early applications of the variable stiffness concept were developed for prosthetic purposes due to the bio-inspired ability of these actuation systems of emulating the behavior of human muscles [1], variable stiffness actuators have been recently introduced in robotics to achieve a suitable tradeoff between accuracy in tasks execution and safety while operating in unstructured environments and in particular in the case of physical interaction/cooperation with humans. In [2], it has been shown how, due to the high reduction ratio of the gearboxes usually adopted in the transmission systems of robotic arms, the kinetic energy of the actuation system is predominant with respect to the one of the arm structure. Moreover, while the inertia of the robot arm can be reduced by adopting lightweight structures and composite materials, it is more difficult to reduce the inertia of the actuators and of the gearboxes because of technological limitations. Due to these considerations, Bicchi and Tonietti [2] proposed to adopt variable stiffness actuation to make the robot more rigid when the system velocities (and then kinetic energy) are low and to make the robot more compliant (or soft) during fast motions (that means high kinetic energy) so that the transmission system may store at least part of the kinetic energy of the actuation system in case unpredictable impacts occur. On the other hand, the kinetic energy of the robotic arm structure can be absorbed during impacts by suitable soft covers mounted on the robot [3], emulating in this way the function and the behavior of the human skin. The research effort in this field is motivated by the potential benefits given by the introduction of robots in human everyday activities, such as assistance to elder or handicapped people, homework activities, and entertainment. It is clear that purposely designed robots are needed to accomplish this kind of tasks.
Although several prototypes of single degree-of-freedom (DOF) joints with relevant and adjustable compliance for robotic manipulators have been designed and developed [4–8] with the aim of verifying the effectiveness of the variable stiffness approach, the implementation of a robotic arm with variable stiffness actuation is still an issue, and only recently, the German Aerospace Center (DLR) has started the development of such a robot. From the mechanical point of view, the main drawbacks of variable stiffness joints are a more complex mechanical design and the necessity of a pair of actuators to adjust simultaneously both the joint position and stiffness. It follows that a more complicated modeling and control approach is necessary, especially when kinematic structures with multiple DOF are considered [9]. In [10], a general approach to the feedback linearization and the simultaneous decoupled control of both the position and stiffness in a serial manipulator actuated by means of variable stiffness joints is proposed, while in [11], a robust controller for the compensation of the model uncertainties in variable stiffness robotic manipulators is presented.
In this paper, the control of robotic manipulators with variable joint stiffness is addressed in the general case of a redundant arm by means of a simplified (with respect to previous ones) output-feedback control approach. The proposed control is configured as a cascade system composed by three independent controllers, one for each part in which the dynamics of the robotic arm with variable stiffness joint can be subdivided. A singular perturbation analysis is then applied to the resulting system to show the separation of the dynamics of the different components, that are the arm, the positioning actuators, and the stiffness actuators, obtaining in this way a reduced order model of the manipulator and then a simplified control structure. The proposed control approach is then validated by means of simulations of a three-link planar manipulator with variable stiffness actuation. In this paper, we refer to a variable stiffness joint as a robotic joint actuated by means of a variable stiffness actuator.
2. System Dynamics
Starting from the general dynamic model of a robot with variable stiffness joints as proposed in [10], a second-order dynamic model is used to describe the stiffness behavior of the joints (or, more in general, of the transmissions), also in view of the nature of the mechanisms used to adjust the joint stiffness [6, 10].
A scheme of the working principle of a variable stiffness joint is shown in Figure 1: the robot link (on the right side) is moved by means of a positioning actuator (on the left side), and these two parts are connected by an elastic element modulated by means of a second actuator, also referred to as the stiffness actuator (in the lower center part). In [10], it has been shown how the conceptual design shown in Figure 1 can be also used to describe the behavior of antagonistic variable stiffness joints, such as the VSA by Bicchi et al. [12], by means of a suitable change of coordinates in the dynamic model of the device. The overall model of a robotic manipulator equipped with this variable stiffness actuators is then composed by the dynamics of an DOF arm driven by positioning actuators through elastic elements and by stiffness actuators that modify the characteristic of the couplings that connect the positioning actuators to the links. It is assumed that each joint has its own positioning and stiffness actuator and that no direct coupling between the actuators of different joints is present. Let be, respectively, the generalized joint positions, the positions of the the positioning actuators, and the vector of the joint stiffness. Under the simplifying modeling assumption used in [13] (viz., the kinetic energy of the actuators are due only to their own spinning), the dynamic model of the system can be written as
where is the inertia matrix of the robotic arm, the vector contains the centrifugal, Coriolis, and gravity forces, is the joint stiffness matrix, is the inertia matrix of the actuators, are the positioning and the stiffness actuators command torques, respectively, is the joint torque contribution due to the effect of an external load; that is,
where is the manipulator Jacobian matrix and is the external wrench. Equation (3) covers a situation where the stiffness actuation modifies the transmission configuration in order to change its compliance, for example, by precompressing elastic elements or by moving some mechanical parts. As shown in [10], the general model (1)–(3) can be used to describe the characteristics of different variable stiffness joint implementations both in the antagonistic case, such as the VSA proposed by Bicchi et al. [12], and in the nonantagonistic case, such as the device proposed by Wolf and Hirzinger [6], by means of a suitable change of coordinates in the dynamic model of the system. In (3), and are used to model the stiffness variation as a function of the device configuration, and they depend on the particular implementation of the robot transmission system; refer to [10] for a detailed description of the general model (1)–(3). Note that and are alternative representations of the joint stiffness. It is important to stress that in this paper, the joint stiffness matrix in (1)-(2) is not constant and that, in general, is a function of time
as expressed by (3), that models the dynamics of the joint stiffness variation. Moreover, we consider , since it has no physical meaning to consider negative stiffness, while if the stiffness drops to zero, an unactuated system would be obtained.
As a nonrestrictive assumption, all the effects due to frictions, dead zones, nonmodeled dynamics, parameters variations, and so forth, not considered in other terms of the system dynamics (1)–(3), are collected in the functions . It is then possible to refer to the nominal system dynamics by considering .
As stated before, the overall system is composed by rigid bodies, and therefore, the state vector of the system can be defined as
while it is assumed that only the state subset information
are directly measurable, typically by means of optical encoders. Note that the joint stiffness is usually reconstructed by means of the knowledge of the elastic elements characteristics and by measuring the actuators and joints positions [9].
In any case, the control objective is the simultaneous and independent regulation of the following set of outputs:
namely, the joint positions (and thus, through the robot direct kinematics, the end-effector pose) and the joint stiffness, acting on the system control inputs
by means of an output-feedback controller based on the knowledge of . As general assumption that takes into account the physical limitations of the system, the state variables are considered bounded; that is, for some properly defined norm .
3. Control Strategy
In the problem considered here, the main control goal is to achieve the tracking of suitable workspace trajectories assigned to the manipulator end-effector while maintaining a desired level of apparent stiffness. As stated previously, this allows to ensure a harmless behavior of the manipulator in case of collision, in particular with humans.
The term apparent stiffness requires a more detailed discussion. Usually, active stiffness control refers to the case in which the manipulator stiffness is modified by means of the control only and has been introduced in [14]. A more general and notable example of active regulation of both static and dynamic parameters of the manipulator is probably the impedance control [15] that has been successfully used for the control of lightweight robots [16] and for safety evaluation of manipulators [17]. On the other hand, passive stiffness control indicates the possibility of changing the mechanical stiffness of the system. Note that in the case of series-elastic actuators [18, 19], the stiffness is fixed by design and cannot be changed anymore without using an active stiffness control approach. In this paper, the discussion is posed in terms of apparent stiffness, because the desired workspace stiffness is achieved by modulating both the mechanical compliance of the joints, that is, the passive stiffness, and the compliance due to the control. This principle is similar to the combined compliance control [20], and it has been already used also in robotic hands control; see [21].
An important point to note is that in case of an unpredictable impact, only the mechanical stiffness of the manipulator is experienced by the environment (or the human) during the very short time interval in which the energy transfer due to the impact occurs [17]. This is due to the limits in both the sensor and the control bandwidth that prevent an immediate reaction of the control system. Another motivation of this fact is the limited stiffness of the robot structure itself (if compared with the time constant of the force transmission along the structure) and to the fact that the impact may occur in any point along the manipulator, while the torque sensors, when available, are located in the joints. This latter effect, as, in general, the energy exchange from the robot to the environment during impacts, can be attenuated by means of suitable soft covers mounted on the robots [3] that allow early transmission of relatively lower forces along the structure together with some storage and dissipation of the energy due to the impact.
Recalling that variable stiffness actuation has been introduced for safety purposes, and that its main role is to absorb at least part of the kinetic energy of the actuation system (i.e., usually predominant with respect to the one of the arm structure because of the high reduction ratio gearboxes used to connect the actuators to the links) during unpredictable impacts, another important point to note is that the selection of suitable values of the joint stiffness depends mainly on the task to be performed (in particular on the required velocities), on both the manipulator and the actuators inertia, that together with the task specifications determines the overall system kinetic energy, and, the most important, on the criteria used to evaluate the robot safety. To this end, the definition of suitable safety criteria for robotic applications represents a key topic. While in early investigations these criteria have been inherited from automotive industries, it has been successively shown that they are not completely suitable for robotic applications because of the very different scenario [17]. Therefore, great attention has been devoted to the definition of adequate principles for the measurements and the quantification of the robot safety [17]. It is not the topic of this paper to deal with the selection of the joint stiffness: it is here assumed that the joint stiffness trajectory is given by a suitable safety planner. An overview of the complete system is depicted in Figure 2.
3.1. Preliminaries
Consider the generic second-order dynamic system
where are the state variables, is the measurable output, is an exogenous measurable signal, is a bounded symmetric positive definite (invertible) matrix, is bounded and Lipschitz in all its arguments, and is a generic function of the time collecting all the disturbances and uncertainties of the system. It is assumed that
Due to the general separation principle introduced in [22] for SISO systems and then extended to MIMO systems in [23], semiglobal stability (i.e., imposing that the domain of attraction of the equilibrium contains a prescribed compact set, [24]) of the desired equilibrium of (10) in nominal conditions () can be achieved by output feedback, since (1) state feedback linearization is clearly possible under the previously defined hypotheses and (2) the system is uniform complete observable. While the verification of the former point is trivial, the latter can be easily proven by dynamic extension, [25]. It is straightforward to show that (10) is a generic form that can be used to represent (1)–(3) (see Property 5 in the appendix). Then, the following theorems hold.
Theorem 1. The system (10) in nominal conditions () and under the effect of the output-based dynamic compensator where is the desired value of , that are positive definite (diagonal) matrices and has a unique steady-state exponentially stable equilibrium point with arbitrary fast error dynamics.
Proof. By defining the state vector composed by the system tracking error plus the compensator estimation error as
then (10)–(16) can be written as
where
The arguments of are omitted for brevity.
At first, the autonomous linear system obtained by neglecting is considered. The eigenvalues of matrix , as can be easily seen by looking at the partitioning in (19), can be freely selected by means of a suitable choice of the parameters , and .
Due to the linearity of the nominal system under the effect of the proposed controller, the origin is the unique exponentially-stable equilibrium point of the autonomous (nominal) system and the rate of convergence can be made arbitrarily fast.
Now, the implications of the previous hypothesis (11) are considered: on this basis and from (20) it is possible to write
The effects of on (18) can be seen as a vanishing perturbation of the nominal system, then the exponential stability of the equilibrium point can be recovered by means of a suitable choice of the controller parameters. In particular, by considering a symmetric positive definite matrix , it is well known that a unique symmetric positive definite matrix exists that satisfies the Lyapunov equation
If and only if the matrix has all negative eigenvalues [26]. The Lyapunov function satisfies the relations
where , , , and . The derivative of along the trajectory of the system satisfies
meaning that the system is exponentially stable if . It is possible to show that this ratio can be maximized by choosing [26].
Theorem 2. The system (18) under the effects of nonvanishing bounded disturbances is ultimate uniformly bounded (UUB), [26].
Proof. Theorem 1 shows that the system (18) has the origin as unique exponentially stable equilibrium point. It is here supposed that . By means of a suitable choice of the control parameters, it possible to ensure that the following condition holds: for some positive constant , where is a positive constant representing a suitable bound of the disturbances. Taking into consideration the same Lyapunov function adopted in Theorem 1, the derivative of along the trajectory of the perturbed system satisfies Then, for all , the trajectory of the system satisfies the relations for some finite time interval , see [26] for additional details on the proof.
Property 1. Due to the structure of and to the partitioning of , the eigenvalues of the dynamic compensator (i.e., of matrix ) depend only on and , while those of the controlled system (i.e., of ) depend on and . This separation property is a consequence of the system linearization obtained by output feedback.
Property 2. Note that (16) represents the internal model of the system, and by assuming constant values of , namely, , the steady-state equilibrium point of the system is
thus resulting that only is affected by the external disturbance.
Generally speaking, by applying a singular perturbation analysis, from Property 1, and by assuming that the eigenvalues of are fast enough with respect to those of , it is possible to assume that the system
is always working in steady-state conditions, and its equilibrium point is
This last relation is a generalization of (29). It follows that
Then, (together with ) provides a filtered estimation of the disturbance. This effect on the system can be seen as a disturbance compensation action (i.e., it compensates for the effects of on the system state), and this compensation action can be annihilated by posing in (13)–(16). Note that from (19), this is a singular condition for the controller.
Property 3. The control system (10)–(16) can be used also as a regulator by neglecting the time derivative of the reference signal and . This property will be exploited for the design of the fast actuators controllers, since, in this case, tracking performance are not necessary, and these controllers are assumed fast enough to work always in steady-state conditions with respect to the slow arm controller.
Property 4. By redefining the control action in (13) as where is an auxiliary input signal, the system dynamics becomes Due to the structure of matrix , it is possible to note that the auxiliary input does not influence the compensator error dynamics , and therefore, the resulting dynamics of the tracking error is showing a steady state tracking error .
3.2. Actuators Control Design
It is important to note that both (2) and (3) are in the form of (10) (see Property 5 in the appendix). This essentially means that both the positioning and the stiffness actuators dynamics can be decoupled from the arm dynamics (1) by exploiting the properties of the controller (12)–(16). Even if this decoupling can be achieved by means of a unique controller, the use of two separated controllers, one for the positioning actuators and one for the stiffness actuators, is chosen to have a more clear view of the overall system structure. Due to the implications of Theorem 1, the possibility of assigning an arbitrary dynamics to the actuators allows to obtain a two time-scale system, where the actuators represent the fast system and the arm the slow one, and then to apply a singular perturbation approach to reduce the order of the resulting system where
and is the vector of the desired positioning actuators configuration, is the vector of the desired joint stiffness, and , summarize the disturbances acting on the positioning and stiffness actuators, respectively. In the case of the actuators controllers, Property 3 has been exploited, since, with respect to the arm dynamics, these controllers are always working in steady-state conditions, then tracking performance are not necessary but just the regulation of the desired position and stiffness. Note that the robotic arm dynamics remains the same as in (1). On the basis of Theorem 1, for both (36) and (37), it is possible to write where the distinction between the positioning and the stiffness actuators has been omitted for brevity. As long as the eigenvalues of can be freely assigned, it is clear how the time scale of (36) and (37) can be made arbitrarily faster than the time scale of (1); therefore, (39) represents the fast manifold dynamics. With some abuse of notation, as (remember that this can be achieved by a suitable choice of the controller parameters) the fast manifold dynamics (39) degenerates, and due to Theorem 1, it is possible to state that the fast manifold has a unique root expressed by (29). From (29)–(37), since the disturbance does not affect the coupling between the actuators and the arm, it is then possible to define the reduced-order model of the robotic manipulator with variable joint stiffness as where the actual actuator configuration and have been substituted with the desired ones and in the arm dynamic equation.
3.3. Trajectory Planning for the Actuators
In this section, the problem of defining the desired trajectories for the actuators given the manipulator trajectories, both in terms of position and stiffness, is addressed. Note that in case the desired manipulator stiffness is defined in the joint space only, the stiffness actuator reference signals are fully defined by , then the more general case of workspace stiffness reference is here addressed.
It is important to note that once the desired joint stiffness has been determined, the torque provided to the joints by the actuators can be regulated by acting on , that is, by a suitable selection of the positioning actuators configuration. To this end, (40) can be rewritten as
where is the vector of the torques provided by the arm virtual actuators obtained from the joined action of the stiffness and the positioning actuators. It follows that
where is the desired torque to be applied on the arm joints by the actuation system and computed by the arm controller that will be defined in the following.
3.3.1. Position Trajectory
Let us define the direct kinematic problem and the manipulator Jacobian as
where is the manipulator end-effector position in an -dimensional task space. Differently from the case of state feedback linearization [10], where and , that is, the joint trajectories must be defined up to the fourth time derivative, while the joint stiffness must be defined up to the second time derivative, in this case, due the reduced order of the arm dynamics (40), the desired manipulator trajectory can be specified as usual for rigid robots both in the task space and in the joint space. In other words, the robot trajectory will be defined in terms of desired positions, velocities, and accelerations, while no particular requirements are necessary for the stiffness desired values. In any case, smooth-enough stiffness profiles are preferable to avoid abrupt oscillations of the actuators and of the arm.
If the manipulator trajectory is defined in the task space, the vectors , , and indicate, respectively, the desired position, velocity, and acceleration of the end effector. It is assumed that both task- and joint-space trajectories are limited and continuous (at least with a piece-wise continuous acceleration profile). Obviously, in case of task space control, singular configurations of the manipulator must be avoided or explicitly considered in the controller. In that case, it is then possible to define the desired joint-space trajectory as where (45) indicates the inverse kinematic function. The solution of the manipulator inverse kinematics can be also obtained by means of a closed-loop inverse kinematic algorithm (CLIK), [27], as specified in the following. In case of manipulator redundancy (), the Jacobian pseudoinverse must be considered. Note that the manipulator redundancy can be exploited by defining secondary tasks [28], for example, to avoid obstacles, to deal with general task constraints, or to optimize the manipulator joint configuration on the basis of the desired task space stiffness, as will be shown in the following.
3.3.2. Stiffness Reference Signals
In the following discussion, the leading superscript will be used to refer to workspace-related variables. In static conditions, the workspace stiffness of the arm can be specified as where the infinitesimal end-effector workspace displacement and the environmental force are considered.
Several works can be found in the literature about the workspace stiffness control of both redundant and nonredundant robots. In particular, in [29], the different components that determine the total workspace stiffness are analyzed, and the orthogonal stiffness decomposition control is introduced, while in [30], the stability properties of the workspace stiffness components and a minimal parametrization of the manipulator stiffness and compliance are reported. Since variable stiffness actuation allows the independent control of the joint compliance, an interesting approach for the regulation of the workspace compliance of redundant robots with compliant actuation can be the combined control approach proposed in [20], where the desired manipulator stiffness in the operational space is achieved by combining a decoupled stiffness joint control together with a workspace stiffness controller.
The relation between the workspace stiffness and the overall joint stiffness can be expressed as where the dependence of the Jacobian from the joint configuration has been omitted for brevity. Note that the overall joint stiffness may be the result of several effects, as specified in the following. For this reason, this quantity has been distinguished from the mechanical joint stiffness . In the right-hand side of (48), since the workspace stiffness must be, in general, symmetric and positive definite and due to the transformation through the manipulator Jacobian, only independent terms are present. At the same time, by considering the case of independent regulation of the joint mechanical stiffness only, matrix is diagonal (), then there are independent terms in the left-hand side of (48). It follows that it is possible to assign arbitrary workspace stiffness by selecting suitable joint mechanical stiffness only if , that means a certain redundancy in the manipulator, at least nonconsidering the trivial case , that is, a single DOF mechanism. If , there exist infinite combinations of joint stiffness that allow to achieve the desired workspace stiffness. Then, this redundancy must be managed by suitable projection of the workspace stiffness on the joint space [29], and it can be exploited maybe to minimize (or maximizing depending on the task) the overall joint stiffness. If , it is not possible to control all the components of the workspace stiffness be means of the joint stiffness only, and suitable couplings between the components of the workspace stiffness must be introduced.
It is now important to remark that the introduction of variable stiffness joints is useful to reduce the energy transferred from the manipulator to the environment (or humans) during unpredictable impacts by decoupling the actuators inertia from the link during fast robot motions (i.e., by reducing the joint stiffness) or, on the other hand, to increase the precision of the manipulator during slow and limited movements by imposing high joint stiffness values to allow adequate external disturbance force/torque rejection. Moreover, variable stiffness actuators are usually designed to have high compliance in rest conditions and to become rigid if necessary under the action of the control system. In this sense, it is then clear that the role of the joint mechanical stiffness, or passive stiffness, is completely different from the active stiffness, that is a control strategy that to allow to rigid robots to show a “compliant’’ behavior with respect to environmental uncertainties, for example, during assembly operations [14].
By introducing the concept of combined compliance control reported in [20] but with different goals, it is possible to split the overall workspace stiffness into two components, one given by the mechanical joint stiffness only, the passive stiffness, that acts at all the frequencies but that shows its major effects at high frequency and then in case of impacts, and in a component due to the control, the active stiffness , that is significant only within the control bandwidth. It is also important to remark that due to the cascade structure of the proposed controller, it is possible to design the arm controller with a purposely defined bandwidth to decouple the passive stiffness from the active stiffness.
The contribution to the workspace stiffness due to the mechanical joint stiffness only, namely, , is given by
It is important to note that (49) maps the joint stiffness to the workspace stiffness no matter what is the number of joints or the dimension of the workspace. This point is important in case of manipulator redundancy to deal with suitable selection of the joint stiffness.
On the basis of these considerations, the workspace stiffness can be partitioned into two different contributions
where is the contribution due to the passive mechanical joint stiffness and is the active stiffness due to the control. Note that since from (49) is symmetric positive definite by definition and must be symmetric and positive definite to avoid instability of the positioning actuators, also is positive definite, thus avoiding system instability: this results in a lower limit of the workspace stiffness given by the effects of the joint mechanical stiffness, since the controller can be used only to increment the overall stiffness. It is important to remark that while in the case of industrial robots the control objective is to make rigid robot softer and then the system compliance is given by the sum of the control compliance and the joint compliance, this last equation shows that the proposed control system is used to the make soft robots (because of the relatively low value of ) stiffer when necessary by means of control (i.e., by acting on ).
From (49) and (50), the induced partitioning of the apparent joint stiffness is
Due to the effect of the joint apparent stiffness, the relation between the infinitesimal joint displacements and the joint torques can be expressed as
Taking into consideration the relation between the workspace displacement and joint displacement, by inverting (52), it is possible to write
where the relation between the workspace stiffness and the joint apparent stiffness has been exploited (see Theorem 3 in the appendix). It is possible to demonstrate that the same relation can be written in the form (Theorem 3 in the appendix) [20]
where is the pseudoinverse Jacobian matrix, weighted by the joint mechanical stiffness . This result is important, because it shows that the relations between workspace and joint displacements are affected only by the mechanical joint stiffness. From the meaning of the pseudoinverse, the inverse kinematic solution obtained from (54) can be considered as providing the manipulator configuration which minimizes the deviation of the joints weighted by the joint stiffness; that is, it minimizes the potential energy stored in the joint compliance, ensuring the minimum energy transfer due to the inertia of the actuators during unexpected collisions. It follows that the desired workspace stiffness has no effect on the inverse kinematics solution of the manipulator. This fact suggests that the regulation of the manipulator configuration must be performed on the basis of the inverse kinematic solution obtained by means of both to stabilize the manipulator dynamics in the Jacobian null space and to achieve minimum energy transfer from the actuators to the arm.
3.4. Arm Control Design
Several robust controllers for robotic arms have been presented in the literature; see for example, [31–33] for some well-known examples. Anyway, in case of robots with variable joint stiffness, the application suggests a particular implementation of the controller.
First of all, aiming to clarify the role of the passive and the active stiffness, the static relation between the environmental force and the deviation of the end effector in the workspace is considered and for small-enough displacements, From (43) and (51), it follows that
By substituting (57) into (41)-(42), it follows that that means that the robotic arm behaves as a joints-position controlled system with the desired apparent stiffness.
Looking at the right hand side of (57), the first term represents the passive stiffness, since the positioning actuators are commanded just on the basis of the manipulator joint desired position trajectory, and then, no feedback from the actual joint positions is present, while the second term represents the active stiffness, since it implies the joint positions feedback on the positioning actuators. It is important to remark that while the passive stiffness acts at high frequency since it does not require the intervention of any controller, the active stiffness acts within the arm controller bandwidth. Moreover, if the manipulator configuration is obtained by the inverse kinematic solution by using (54), the minimum value for the potential energy stored in the joints as a consequence of the end-effector displacement is achieved.
With the aim of controlling the workspace motion of the manipulator, a specialized version of the controller (12)–(16) that in particular exploits Property 4 is now applied to the arm reduced model (41)–(43) (see Property 6 in the appendix). The torque of the virtual actuators can be then computed as where is the matrix that projects the joint space control action in the null space of the manipulator Jacobian, is the joint space damping, and represent the desired workspace damping and mass of the manipulator, respectively, and are positive definite (diagonal) matrices. In particular, and are provided by a closed-loop inverse kinematic solver that exploits (54), while and are the external force measurement and estimation, respectively. On the basis of Property 4, the external force estimation is used as the auxiliary input appearing in (34) in the arm controller. Note that on the basis of (54), the static term in the joint space control ensures the minimum norm of the joint space control effort.
It is initially assumed that the force applied by the end effector to the environment is measurable (i.e., by means of a 6-axis force/torque sensor), then it is possible to impose . Note that by recalling the boundedness of the arm trajectory and the limited value of the state variables and in particular of both the joint velocity and of the controller state , the condition (11) is ensured by the general properties of the robotic arm dynamics [34, 35].
By recalling Property 2, and with a suitable choice of large-enough values of , the dynamic compensator represented by (62)–(64) can be configured as a third fast system together with the actuators controllers previously defined. Due to the controller structure, the arm response would be slower in two-order than the actuation control system. This fact does not represent a limitation, since (1) the fast control systems are very simple, and then, very fast implementations are possible with current technologies and computational capabilities of modern digital systems, (2) robots with variable stiffness actuation are conceived for the interaction with humans and to operate in a human-like environment, then smoother and bandwidth-limited motions are required with respect to industrial robots, (3) fast high-gain controllers are used in the actuators, while a slow low-gain controller is more suitable for the arm control also for safety reasons. It is then possible to assume that where is the effect of the model and parameter uncertainties. Then, by denoting , the reduced-order nominal arm dynamics (41) under the effect of the controller (59)-(60) can be written as
In case a direct measure of the force applied by the end effector to the environment is not available, () by assuming the perfect knowledge of the arm dynamics, that is, , and by considering the external force as a disturbance, Property 2 implies that in steady state conditions, A suitable estimation of the external force can be then assumed as
This equation defines a virtual force sensor that provides an indirect measure of the external force. Hence, the reduced-order nominal arm dynamics can be written as
The last term in (69) represents the perturbation on the system dynamics due to the use of the force estimation instead of a direct measure. Apart from this spurious term, the robotic manipulator is now configured as an impedance controlled system.
Once the torque is determined by means of (59), the reference trajectory for the positioning actuators can be computed through (43).
An important remark is that while the workspace stiffness is obtained by combining the mechanical stiffness of the robot transmission together with the control action, only the active part of the desired stiffness implies the feedback of the manipulator joint positions. This is a key feature for safety reasons [2], because no reaction from the controller is needed to achieve the desired compliant behavior at joint level, since the compliance is a structural characteristic of the robot itself.
Note that also the arm controller provides a filtered estimation of the disturbance acting on the joints through (64). These information, also called residuals in the robotic community [36], can be used for fault evaluation and collision detection/reaction [37], and they have recently been successfully used for safe interaction of lightweight robots with human operators [17]. The possibility of exploiting the properties of robots with variable stiffness actuation together with the safety-oriented control techniques related to the use of the residuals justifies the proposed implementation of the controller.
3.5. Remarks
With respect to the control approaches for the system (1)–(3) proposed in [10, 11], the control scheme presented in this paper presents a number of remarkable advantages (i)The complexity of the controller is significantly reduced since neither static nor dynamic inversion of the system is needed. (ii)Redundancy of the manipulator is considered. (iii)The computation of the Lie derivative of the system dynamics up to the fourth order is avoided. (iv)An output-feedback control law has been defined instead of state-feedback controllers. (v)The arm trajectory must now be defined only up to the second order derivative, as in the rigid robot case, while previously, it was necessary to define the position trajectory up to the fourth order and the stiffness trajectory to the second order derivative. (vi)Since the arm control is based on the two signals and , that are generated online and that act as exogenous reference for the actuators fast system, online compensation of disturbances is permitted. (vii)The joint stiffness is controlled by a specific control system that directly compensates for the effects of disturbances, external forces and couplings due to both positioning actuators and arm dynamics. (viii)The proposed control strategy exploits the mechanical compliance of the transmission to achieve the desired workspace behavior (passive compliance). (ix)In case of perfect knowledge of the arm dynamics, the system is able to estimate and regulate the workspace interaction force without a direct measurement of the force itself. (x)The manipulator residuals are directly provided by the controller, allowing a simple integration with fault and collision detection/reaction techniques. (xi)The extension of the proposed approach to the case of robotic manipulator where the stiffness can be adjusted only for some joints is straightforward, since by applying the proposed positioning and stiffness actuators controller where necessary, the overall robot dynamics is reduced to the rigid case.
4. Simulation of a Three-Link Planar Manipulator
The proposed controller has been validated by means of simulations of a planar three-link robotic arm with variable joint stiffness. Only the Cartesian coordinates and of the workspace end-effector position are considered (not the orientation), and this allows to analyze the effects of the manipulator redundancy in a quite simple manner. The extension of the proposed control approach to the case in which gravity compensation is needed is straightforward. The well-known dynamic model of the three-link planar arm is omitted for brevity; see [35], and only the dynamics of stiffness variation is specified
This stiffness dynamic model [10] is typical of a variable stiffness actuator with antagonistic elastic elements characterized by quadratic force-deformation relation proposed by Migliore et al. in [5]. The parameters of the three-link planar manipulator used in simulation are reported in Table 1, and all the links of the manipulator are considered identical for simplicity. In the simulation scheme, the trajectories are generated using proper filters to compute the position trajectory in the workspace together with its derivatives up to the second order. In this manner, the conditions given by Theorem 1 for the stability of the system are implicitly met. It is assumed that the joint stiffness reference values are provided by a suitable safety controller on the basis of some requirements given by the particular application and contest. Moreover, the matrices that characterize the arm impedance controller have been considered diagonal to simplify the analysis of the simulation results. The controller parameters adopted in the simulations are summarized in Tables 2 and 3. Three case studies have been considered: in the first case, whose results are reported in Figure 3, the manipulator end-effector is driven along several point-to-point trajectories. During this simulation, friction in the actuators is considered together with parameter uncertainties in the arm dynamics. External forces are applied along the and directions at time [s] and [s], respectively. From these plots, it is possible to note that as expected on the basis of Property 2, the end-effector position error is mainly affected by the external force, that is considered measurable during this test, and exactly related to the desired workspace stiffness. It is important to note that the joint mechanical stiffness is not significantly affected by the remaining parts of the system, then the independent regulation of the actuation stiffness is achieved. The joint stiffness tracking error is not reported, since it is very limited and not meaningful. In Figure 3, also the joint reference trajectory computed by the inverse kinematic solver is reported (upper left plot): this information is useful for the regulation of the null-space behavior of the system. Finally, also the positioning actuators trajectories are reported.
(a)
(b)
In Figure 4, the results of the case study no. 2 are reported. During this test, a different set of point-to-point trajectories have been evaluated together with an higher values of the desired workspace stiffness and larger (measurable) external forces. The same limitations on the maximum workspace velocity considered in the previous case are assumed during this test. Also, in this simulation, the external forces are applied along and at time [s] and [s], respectively. As in the previous case, the end-effector position error is determined by the external force and by the desired workspace stiffness, while the commanded joint stiffness is the same of the case no. 1, hence showing the independent control of the workspace and of the joints stiffness.
(a)
(b)
For the simulation of case no. 3, whose results are reported in Figure 5, the same condition of case no. 2 are considered, but the perfect knowledge of the arm parameters is assumed, and the external force has been considered nonmeasurable: from the comparison with Figure 4, it is possible to note that the proposed virtual force sensor is able to correctly estimate the external force; however, the response of the system in case no. 3 shows larger oscillations during transients with respect to case no. 2, but the response in static conditions is identical to those obtained considering direct measure of the external force, that is, in case no. 2.
(a)
(b)
5. Conclusions
In this paper, the problem of output-based regulation of robotic manipulators with variable stiffness actuation has been discussed. A control scheme has been proposed whose main features are the simultaneous and decoupled workspace stiffness-position control with limited error, disturbance compensation and estimation-control of the environment interaction force. Moreover, the case of manipulator redundancy has been explicitly addressed and some nice features and implications related to the control of the both the joint mechanical stiffness and workspace stiffness have been highlighted. The control objective is achieved by means of a multilevel controller that decouples the dynamics of both the positioning and the stiffness actuators from the arm dynamics. This result is obtained by applying a singular perturbation analysis to both the actuators and the arm dynamics, configuring in this way a multilevel control structure that presents fast controllers for the actuators and a slow controller for the arm. Moreover, the proposed controller presents several advantages with respect to previous approaches for this class of devices, as the rigid-robot-like trajectory specification, the reduced complexity and the availability of the system residuals for collision detection/reaction purposes to cite some of them. The extension of the proposed analysis to an hybrid case, in which both rigid and elastic joints are present, with constant or variable stiffness, can be easily achieved. Also, the case of joints with different stiffness variation models can be easily considered. The proposed control approach is validated by means of simulation of a three-link planar manipulator, and the experimental validation of the proposed approach will be considered in the future.
Appendix
Property 5. The general second-order dynamic system (10) can be used in place of each of (1)–(3) by posing: (i)In case of (1) (ii)In case of (2), (iii)In case of (3),
Property 6. The general second-order dynamic system (10) can be used in place of (41)–(43) by posing
Theorem 3. Let , , and be diagonal positive definite, and symmetric positive definite matrices, respectively. The following definitions are given: where the properties of symmetry and positive definition of the matrices , , and should hold. Note that (A.5)–(A.7) correspond to (49)–(51). Then,
Proof. Let consider (A.9) first. By applying the matrix inversion lemma [38] to (A.7)
It follows that
By applying the matrix inversion lemma also to (A.6), it results
By noticing that (A.11) and (A.12) are equivalent, it follows that the relation (A.8) is satisfied.
Now (A.9) is considered. From (A.10) and (A.8),
By introducing (A.6)
where (A.5) has been finally used.
Acknowledgments
This research has been partially supported by the EC Seventh Framework Programme (FP7) under Grant agreement no. 216239 as part of the IP DEXMART (DEXterous and autonomous dual-arm/hand robotic manipulation with sMART sensory-motor skills: a bridge from natural to artificial cognition) and by the Italian MIUR with the PRIN2007CCRNFA-004/PRIN2008-ZRLPWS projects.