Force-Impedance Control: a new control strategy of robotic manipulators

Transcription

1 Force-Impedance Control: a new control strategy of robotic manipulators Fernando Almeida, António Lopes, Paulo Abreu IDMEC - Pólo FEUP, Faculdade de Engenharia da Universidade do Porto, Rua dos Bragas, 499 Porto code, Portugal {fga, aml, pabreu} fe.up.pt Abstract. A novel control strategy of robotic manipulators is presented in this paper: the force-impedance controller. This controller enables two kinds of behaviour: force limited impedance control and position limited force control. The type of behaviour only depends on the chosen manipulator trajectories. Free space error dynamics and post-contact manipulator dynamics may be independently chosen if a new impedance control architecture is used. Simulation results of a force-impedance controlled parallel manipulator, eecuting tasks that involve end-effector contact with uncertain environments of unknown stiffness, are presented.. Introduction Position control strategies have been successfully used on robotic tasks involving a null or week interaction between the manipulator and its environment. Good eamples are provided by spray painting, welding and palletising tasks [], [], [3]. On the other hand, although the set of tasks requiring a strong interaction between the manipulator and the environment is very large [], [4], [5], the use of robots on assembly, polishing, grinding and deburring tasks, as well as on the field of medical surgery [6], is still low due to control difficulties. The two main approaches to the control of the interaction of the manipulator and its environment are [4], [7]: Hybrid Force-Position Control [8], [9]; Impedance Control [], [4], []. Hybrid control is motivated by the task analysis made by Mason []: on each direction of the task space, the environment imposes a force or a position constraint. These natural constraints are originated by the task geometry. Only the unconstrained variables may be controlled, their reference values being artificial constraints imposed by the task eecution strategy. Hybrid control enables the tracking of position and force references, the task space being decomposed into force and position controlled directions. As the decomposition is based on an ideal model of the environment, the ever present modelling errors always lead to unwanted movements along the force controlled directions and

2 unwanted forces along position controlled directions. This problem is more acute during the transition between free space and interactive movements, necessitating the use of some kind of controller switching strategy based on contact force information. Unfortunately, the switching process may induce an unstable manipulator behaviour [], [3], [4], [5]. The impedance control objective is to control neither force nor position but their dynamic relation, the desired impedance, along each direction on the task space. Impedance controllers possess some inherent robustness to environment modelling errors [6], [7], [7]. Nevertheless, as contact forces cannot be directly imposed, they may grow in an uncontrolled manner due to modelling errors of the environment impedance. Controllers combining the hybrid and the impedance control approaches have been developed, their main objective being a robust behaviour under environment modelling errors [8]. The Hybrid Impedance Controller proposed by Anderson and Spong [9] uses an inner control loop for manipulator dynamics linearization and decoupling. Impedance control substitutes for the position control used on hybrid controllers position subspace. This way, a desired manipulator dynamic behaviour is imposed. Chiaverini and Sciavicco [6] combine a PD position control loop in parallel with a PI force control loop. The controller achieves the typical robustness of an impedance controller and the ability to follow position and force references of an hybrid controller. Position and force references must be specified for each task space direction. Control action is obtained as the sum of the two parallel loops control actions. Conflicting situations, as an unepected contact, are naturally solved as force control always rules over position control, due to the integral control action. Unfortunately this may lead to an undesirable manipulator drift, along the contact surface, in the presence of environment modelling errors. Neither of the above controllers enable the definition, over a force controlled direction, of a free space trajectory up to the contact surface without the use of some sort of force measure based switching strategy. The novel force-impedance controller presented in this paper behaves itself as an impedance (position) controller up to contact set up. Afterwards, impedance or force control is achieved. This behavioural change is performed without the use of any supervising switching strategy. Section presents a new impedance controller structure that enables a definition of different free space error dynamics and post-contact impedance. The novel forceimpedance controller is developed in section 3. Simulation results of an eperimental parallel manipulator under force-impedance control are presented in section 4. Conclusions are drawn in section 5.

3 . Impedance Control The control objective of an impedance controller is to impose, along each direction of the task space, a desired dynamic relation between the manipulator end-effector position and the force of interaction with the environment, the desired impedance. Usually, the desired impedance is chosen linear and of second order, as in a massspring-damper system. Higher order impedances have a less well known behaviour and require additional state variables. In order to fulfil the task requirements, the user chooses a desired end-effector impedance that may be epressed by equation, M B K = f () d d d d d d e where M d, B d and K d are constant, diagonal and positive definite matrices representing the desired inertia, damping, and stiffness system matrices. Vectors and represent the actual and the desired end-effector positions, and f e represents the generalised force the environment eerts upon the end effector. If the manipulator is able to follow an acceleration reference given by [ ] = M f B K r d d e d d d d it will behave as described by equation. So, r is the reference for an inner loop acceleration tracking controller, that linearizes and decouples the manipulator nonlinear dynamics. () f e B d Controlled System r K d M d G aa s s B d Fig.. Block diagram of an impedance controller Fig. shows a block diagram of an impedance controller. The transfer function matri G aa (s) represents the non-ideal behaviour of the inner loop acceleration controller, such as finite bandwidth and incomplete decoupling. At low frequency, up to a maimum meaningful value, the acceleration controller must ensure that G aa (s)

4 may be taken as the identity matri, I. Hence, and without loss of generality, the force-impedance controller will be presented for a single dof system. Under these conditions, and taking all values from Fig. as scalar quantities, the end-effector position on the Laplace domain, X(s), is given by where X s = X s G s F s (3) d f e G f = (4) M s B s K d d d represents the desired manipulator admittance. The initial error between and decays to zero, in free space, according to a characteristic equation equal to the desired impedance. The desired manipulator dynamics, epressed by equation, may also be implemented using a new, and more general, structure presented in Fig.. represents the position changes, relative to the free space trajectory, due to the contact force f e. In this case, G f = (5) M s B s K f f f This new structure enables the independent definition of free space error dynamics, and post-contact, G f (s), manipulator dynamics. In free space, the error between and decays to zero with a dynamic behaviour given by the following characteristic equation: M s B s K = (6) This etra degree of freedom may be used to improve free space error dynamics, without compromising the desired impedance under contact. Using the conventional structure presented in Fig., a similar behaviour could only be obtained by switching controller gains (impedance). With the new control structure, the need for a supervising switching strategy is avoided. From equations 5 and 6 it is easily concluded that the impedance controller is stable as long as parameters M, B, K, M f, B f and K f are chosen strictly positive. However, it should not be forgotten that the inner acceleration loop finite bandwidth (G aa (s) I) may lead to instability if the desired manipulator dynamics are chosen too fast.

5 B K M B f e M f B f K f Fig.. New impedance controller structure: free space error dynamics and manipulator impedance may be independently defined 3. The new Force-Impedance Controller The force-impedance controller presented on this paper combines the robustness properties of an impedance controller with the ability to follow position and force references of an hybrid controller. The proposed controller has two cascaded control loops (see Fig. 4): an impedance controller, as the one presented on the previous section, is implemented as a inner loop controller. An integral force controller is used as an eternal loop controller. This force controller acts by modifying the position reference, given by, in order to limit the contact force to a specified maimum value. For each task space direction the user must specify a, possible time variant, force reference, in addition to the desired position trajectory, impedance, and free space dynamics. The force reference has the meaning of a limiting value to the force the end-effector may apply to the environment.

6 The static force-displacement relation imposed by the force-impedance controller is presented in Fig. 3. Positive force values are obtained with a pushing environment and the negative values with a pulling one. The contact force saturation behaviour is obtained by the use of limited integrators on the force control loop. While the manipulator is not interacting with the environment the controller ensures reference position tracking with the specified free space error dynamics. After contact is set up the controller behaviour may be interpreted in two different ways: as a force limited impedance controller; as a position limited force controller. If contact conditions are planed in such a way that the force reference (limit) is not attained, the manipulator is impedance controlled. If environment modelling errors result in ecessive force, the contact force is limited to the reference value. If contact conditions are planed in order to ensure that the force reference is attainable, the manipulator is force controlled. When environment modelling errors result in ecessive displacement, manipulator position is limited to its reference value. This kind of manipulator behaviour ensures a high degree of robustness to environment uncertainty. f e f d α f d K d Fig. 3. Static force-displacement relation imposed by the force-impedance controller Fig. 4 shows the force-impedance controller under a contact situation with a purely elastic environment. Its contact surface is positioned at e and presents a stiffness K e. In order to allow a choice of integrator gain, K F, that is not dependent on the desired manipulator stiffness, K f, the force error is divided by it. When the force control loop is in action the end-effector position, on the Laplace domain, is described by the net equation, where = X s X s G s U G s F s (7) d f e K F U = [ Fd Fe ] s K f (8)

7 and G = K (9) M s B s K Force Controller Impedance Controller f d α K F s K F s K f u G e K e f e G f Fig. 4. Block diagram of the novel force-impedance controller interacting with an elastic environment of stiffness K e Substituting equations 5, 8 and 9 in equation 7 the following relation results: X s PX PF PE s = X d Fd X e () Q Q Q X X X where, = ( )( ) P s K s M s B s K M s B s K X f f f f = ( ) P s K K M s B s K F F f f f = ( ) ( ) P s K K K M s B s K sk K M s B s K E F e f f f e f = ( )( ) K f Kes( M s Bs K ) KK F Ke( M f s B f s K f ) Q s K s M s B s K M s B s K X f f f f () () (3) (4) If the desired manipulator free space error dynamics is made equal to the desired impedance, then M = M f = M d, B = B f = B d, and K = K f = K d. Under this assumption the force-impedance controller can be simplified (see Fig. 5) and the manipulator position may be epressed as

8 ( d d d ) M s B s K s X = s M s B s K K s K K X s d d d d e F e K F s M s B s K K s K K F s d d d d e F e K F Ke ske s M s B s K K s K K X s e d d d e F e (5) If the Routh stability criteria is applied to equation 5, a maimum value of the force control loop integral gain, K F, is obtained as K F ( ) B K K < M K d d e d e Bd < (6) M So, K F may be chosen in a manner that is independent of the environment stiffness K e, increasing the controller robustness to environment modelling uncertainty. A similar stability analysis for the case when different free space error dynamics and post-contact impedance are desired is still under study. d Impedance Controller B d f d α Force Controller K F s K F s K f Controlled System r K d M d Gaa s s e K e f e B d Fig. 5. Force-impedance controller: same free space error dynamics and post-contact impedance 4. Force-Impedance Controller Simulation Results A simulation of the force-impedance controller, when applied to the control of a 6 dof parallel manipulator, was performed. An eperimental set-up is under construction: the Robotic Controlled Impedance Device (RCID). This is a fully parallel minimanipulator with a Merlet platform architecture [], []. The RCID is coupled to an industrial manipulator: the latter one performs the large amplitude movements

9 while the RCID is only used for the fine and high bandwidth movements needed for force-impedance control. The simulation program was developed on ACSL (Advanced Continuous Simulation Language) [] and implements a discrete time version of the controller. Fully dynamic models of the manipulator, actuators, and transducers were included. The simulation also takes into account position, acceleration, and force measurement noises, as well as input and output quantization. The inner loop acceleration controller uses a khz sampling frequency and achieves a closed loop bandwidth of 4 rad/s. The force-impedance controller runs with a 5 Hz sampling frequency and includes a velocity observer having acceleration and position as input variables. The two simulation cases that are presented net were chosen in order to enable an easy performance evaluation of the force-impedance controller. The first case shows the force-impedance controller working as a force limited impedance controller. The task includes an approach to a contact surface, followed by a contact phase and, in the end, a pull back movement. During the contact phase, the end-effector must follow the surface e, presented in Fig. 6(a), and the contact force must be limited to f d = N. The desired trajectory was planed without taking into account a mm hump on the contact surface and requires the end-effector to move with a speed of 5 mm s. Simulation results, with impedance matrices M d = diag([ ]) (Kg; Kg m), B d = diag([ ]) (N s m ; N m s rad ), and K d = diag([ ]) (N m ; N m rad ), force controller gain K F = 4 s on all dof, and force environment stiffness K e = 6 N m, are presented in Fig. 6(b), position tracking error norm, and Fig. 6(c), contact force. The manipulator tracks up to the contact surface. After impact, impedance is regulated. When the unepected hump is attained, the contact force grows up quickly and is limited to its reference value. After the hump, and to the end of the contact phase, the controller returns to impedance control. Position tracking is regained when the end-effector goes back into free space. In the second case the force-impedance controller is used as a position limited force controller, tracking a reference force profile. After a free space approach to the contact surface, the end-effector must track a desired contact force profile and, in the end, do a pull back movement. The desired trajectory (Fig. 6(d)) was planned on the basis of an uncertain model of the environment, and requires the end-effector to move with speed of mm s. Simulation results, using the same set of parameters as on the previous case, are presented in Fig. 6(e), position tracking error norm, and Fig. 6(f), reference force profile and actual contact force. During the approach phase, the manipulator follows the desired position trajectory up to the contact surface. After impact, a short period of impedance control is observed. When the desired force becomes attainable, force control starts. The desired force profile is followed up to the beginning of the pull out movement. During the pull out phase the controller returns to impedance control, enabling the manipulator to follow the desired free space position trajectory.

10 Environment / Reference Position (z ais) (mm) Environment / Reference Position (z ais) (mm) Position ( ais) (mm) Position ( ais) (mm) (a) (d).5.5 Position error (mm).5 Position error (mm) Position ( ais) (mm) (b) Position ( ais) (mm) (e) 4 4 Contact force / Reference force (N) Contact force / Reference force (N) Position ( ais) (mm) Position ( ais) (mm) (c) Fig. 6. Simulation results: (a), (b), and (c) - force limited impedance control case; (d), (e), and (f) - position limited force control case. (References are represented by dashed lines) (f)

11 5. Conclusions The novel force-impedance controller presented on this paper enables the follow up of position and force trajectories, nevertheless achieving the robustness properties inherent to impedance controllers. If the new impedance control structure is used, different free space error dynamics and post-contact dynamics may be used, without the need of a switching strategy. Force limited impedance control and position limited force control may be implemented with the proposed force-impedance controller. The type of behaviour is only dependent on the chosen trajectories and does not necessitates any other decision mechanism. The simulation of a force-impedance controlled parallel mini-manipulator, the RCID, shows that good position, impedance, and force tracking is obtained The robust behaviour of the proposed controller is also enhanced by the fact that its parameters may be fully defined without the knowledge of the environment stiffness. This research was supported by Ministério da Ciência e Tecnologia - FCT, under the project nº PBIC/C/TPR/55/95. References. Hogan, N.: Impedance Control: an Approach to Manipulation: Part I-III. ASME Journal of Dynamic Systems, Measurement, and Control, Vol. 7 (985) -4. Hogan, N.: Stable Eecution of Contact Tasks Using Impedance Control. Proc. IEEE International Conference on Robotics and Automation (987) Mills, J. K., Goldenberg, A. A.: Force and Position Control of Manipulators During Constrained Motion Tasks. IEEE Transactions on Robotics and Automation, Vol. 5, N. (989) Kazerooni, H., Sheridan, T. B., Houpt, P. K.: Robust Compliant Motion for Manipulators: Part I-II. IEEE Journal of Robotics and Automation, Vol., N. (986) De Schutter, J., Van Brussel, H.: Compliant Robot Motion: Part I-II. The International Journal of Robotics Research, Vol. 7, N. 4 (988) Ho, S. C., Hibberd, R. D., Cobb, J., Davies, B. L.: Force Control for Robotic Surgery. Proc. of the International Conference on Advanced Robotics (995) Seraji, H., Colbaugh, R.: Force Tracking in Impedance Control. The International Journal of Robotics Research, Vol. 6, N. (997) Raibert, M., Craig, J.: Hybrid Position/Force Control of Manipulators. ASME Journal of Dynamic Systems, Measurement, and Control, Vol. (98) Khatib, O.: A Unified Approach for Motion and Force Control of Robot Manipulators: the Operational Space Formulation. IEEE Journal of Robotics and Automation, Vol. 3, N. (987) Kazerooni, H.: On the Robot Compliant Motion Control. ASME Journal of Dynamic Systems, Measurement, and Control, Vol. (989) 46-45

12 . Mason, M.: Compliance and Force Control for Computer Controlled Manipulators. IEEE Transactions on Systems, Man and Cybernetics, Vol., N.6 (98) Whitney, D. E.: Historical Perspective and State of the Art in Robot Force Control. Proc. of the IEEE International Conference on Robotics and Automation (985) Paul, R. P.: Problems and Research Issues Associated with the Hybrid Control of Force and Displacement. Proc. of the IEEE International Conference on Robotics and Automation (987) Eppinger, S. D., Seering, W. P.: Understanding Banwidth Limitations in Robot Force Control. Proc. of the IEEE Int. Conference on Robotics and Automation (987) Lu, Z., Goldenberg, A. A.: Implementation of Robust Impedance and Force Control. Journal of Intelligent and Robotic Systems, Vol. 6 (99) Chiaverini, S., Sciavicco, L.: The Parallel Approach to Force/Position Control of Robotic Manipulators. IEEE Transactions on Robotics and Automation, Vol. 9, N. 4 (993) Lu, Z., Goldenberg, A. A.: Robust Impedance Control and Force Regulation: Theory and Eperiments. The International Journal of Robotics Research, Vol. 4, N. 3 (995) De Schutter, J., Bruyninck, H., Zhu, W.-H., Spong, M. W.: Force Control: a bird s eye view. IEEE CSS/RAS International Workshop on Control Problems in Robotics and Automation: Future Directions (997) 9. Anderson, R. J., Spong, M. W.: Hybrid Impedance Control of Robotic Manipulators. IEEE Journal of Robotics and Automation, Vol. 4, N. 5 (988) Merlet, J.-P., Gosselin, C.: Nouvelle Architecture pour un Manipulateur Parallele a Si Degres de Liberte. Mech. And Machine Theory, Vol. 6, N. (99) Lopes, A. M., Almeida, F. G.: Manipulability Optimization of a Parallel Structure Robotic Manipulator. Proc. of the nd Portuguese Conference on Automatic Control (996) MGA Software: ACSL Reference Manual, Edition. (995)