Hybrid force/position control for a 3-DOF 1T2R parallel robot: Implementation, simulations and experiments

"This is an Author's Accepted Manuscript of an article published in Cazalilla, José, Marina Vallés, Ángel Valera, Vicente Mata, and Miguel Díaz-Rodríguez. 2016. Hybrid Force/Position Control for a 3-DOF 1T2R Parallel Robot: Implementation, Simulations and Experiments. Mechanics Based Design of Structures and Machines 44 (1 2). Informa UK Limited: 16 31. doi:10.1080/15397734.2015.1030679, available online at: https://www.tandfonline.com/doi/full/10.1080/15397734.2015.1030679."[EN] A robot interacting with the environment requires that the end effector \hboxposition is tracked and that the forces of contact are kept below certain reference values. For instance, in a rehabilitation session using a robotic device, the contact forces are limited by the allowed strength of the human limbs and their complex-joints. In these cases, a control scheme which considers both position and force control is essential to avoid damage to either the end effector or the object interacting with the robot. This paper therefore develops a real-time force/position control scheme for a three-DOF parallel robot whose end effector holds a DOF one translation (1T) and two rotations (2R). The implemented hybrid force/position control considers, as a reference, the normal force on the mobile platform, which is measured by means of a load cell installed on the platform. The position control is designed to track the orientations of the robot either in joint or task space using a model-based control scheme with identified parameters. Moreover, the force control is based on a PD action. The control scheme is developed through simulations, before being applied to an actual parallel robot. The findings show that with the implemented controller, the actual robot accomplishes the reference values for the normal force on the mobile platform, while at the same time the platform accurately follows the required angular orientation.The authors wish to thank the Plan Nacional de I+D, Comision Interministerial de Ciencia y Tecnologia (FEDER-CICYT) for the partial funding of this study under the projects DPI2011-28507-C02-01 and DPI2013-44227-R. This work was also partially supported by the Fondo Nacional de Ciencia, Tecnologia e Innovacion (FONACIT-Venezuela).Cazalilla, J.; Vallés Miquel, M.; Valera Fernández, Á.; Mata Amela, V.; Díaz-Rodríguez, M. (2016). Hybrid force/position control for a 3-DOF 1T2R parallel robot: Implementation, simulations and experiments. Mechanics Based Design of Structures and Machines. 44(1-2):16-31. https://doi.org/10.1080/15397734.2015.1030679S1631441-2Åström, K. J., & Murray, R. M. (2008). Feedback Systems. doi:10.1515/9781400828739Bellakehal, S., Andreff, N., Mezouar, Y., & Tadjine, M. (2011). Force/position control of parallel robots using exteroceptive pose measurements. Meccanica, 46(1), 195-205. doi:10.1007/s11012-010-9411-zCao, R., Gao, F., Zhang, Y., Pan, D., & Chen, W. (2014). A New Parameter Design Method of a 6-DOF Parallel Motion Simulator for a Given Workspace. Mechanics Based Design of Structures and Machines, 43(1), 1-18. doi:10.1080/15397734.2014.904234Carretero, J. A., Podhorodeski, R. P., Nahon, M. A., & Gosselin, C. M. (1999). Kinematic Analysis and Optimization of a New Three Degree-of-Freedom Spatial Parallel Manipulator. Journal of Mechanical Design, 122(1), 17-24. doi:10.1115/1.533542Clavel, R. (1988). DELTA, a fast robot with parallel geometry.Proceedings of 18th International Symposium on Industrial Robot, Lausanne, April, 91–100.Díaz-Rodríguez, M., Mata, V., Valera, Á., & Page, Á. (2010). A methodology for dynamic parameters identification of 3-DOF parallel robots in terms of relevant parameters. Mechanism and Machine Theory, 45(9), 1337-1356. doi:10.1016/j.mechmachtheory.2010.04.007Diaz-Rodriguez, M., Valera, A., Mata, V., & Valles, M. (2013). Model-Based Control of a 3-DOF Parallel Robot Based on Identified Relevant Parameters. IEEE/ASME Transactions on Mechatronics, 18(6), 1737-1744. doi:10.1109/tmech.2012.2212716Farhat, N., Mata, V., Page, Á., & Valero, F. (2008). Identification of dynamic parameters of a 3-DOF RPS parallel manipulator. Mechanism and Machine Theory, 43(1), 1-17. doi:10.1016/j.mechmachtheory.2006.12.011Garg, A., Vikram, C. S., Gupta, S., Sutar, M. K., Pathak, P. M., Mehta, N. K., … Gupta, V. K. (2014). Design and Development of In Vivo Robot for Biopsy. Mechanics Based Design of Structures and Machines, 42(3), 278-295. doi:10.1080/15397734.2014.898587Gough, V. E., Whitehall, S. G. (1962). Universal tire test machine.Proceedings of 9th International Technical Congress FISITA, pp. 117–135.García de Jalón, J., & Bayo, E. (1994). Kinematic and Dynamic Simulation of Multibody Systems. Mechanical Engineering Series. doi:10.1007/978-1-4612-2600-0Lee, K.-M., & Arjunan, S. (1991). A three-degrees-of-freedom micromotion in-parallel actuated manipulator. IEEE Transactions on Robotics and Automation, 7(5), 634-641. doi:10.1109/70.97875Li, Y., & Xu, Q. (2007). Design and Development of a Medical Parallel Robot for Cardiopulmonary Resuscitation. IEEE/ASME Transactions on Mechatronics, 12(3), 265-273. doi:10.1109/tmech.2007.897257Merlet, J.-P. (2000). Parallel Robots. Solid Mechanics and Its Applications. doi:10.1007/978-94-010-9587-7Pierrot, F., Nabat, V., Company, O., Krut, S., & Poignet, P. (2009). Optimal Design of a 4-DOF Parallel Manipulator: From Academia to Industry. IEEE Transactions on Robotics, 25(2), 213-224. doi:10.1109/tro.2008.2011412Rosillo, N., Valera, A., Benimeli, F., Mata, V., & Valero, F. (2011). Real‐time solving of dynamic problem in industrial robots. Industrial Robot: An International Journal, 38(2), 119-129. doi:10.1108/01439911111106336Steward, D. A. (1965). A platform with 6 degrees of freedom.Proceedings of the Institution of Mechanical Engineers, Part 1, vol. 15, pp. 371–386.Valera, A., Benimeli, F., Solaz, J., De Rosario, H., Robertsson, A., Nilsson, K., … Mellado, M. (2011). A Car-Seat Example of Automated Anthropomorphic Testing of Fabrics Using Force-Controlled Robot Motions. IEEE Transactions on Automation Science and Engineering, 8(2), 280-291. doi:10.1109/tase.2010.2079931Vallés, M., Díaz-Rodríguez, M., Valera, Á., Mata, V., & Page, Á. (2012). Mechatronic Development and Dynamic Control of a 3-DOF Parallel Manipulator. Mechanics Based Design of Structures and Machines, 40(4), 434-452. doi:10.1080/15397734.2012.687292Volpe, R., & Khosla, P. (1993). A theoretical and experimental investigation of explicit force control strategies for manipulators. IEEE Transactions on Automatic Control, 38(11), 1634-1650. doi:10.1109/9.262033Zarkandi, S. (2011). Kinematics and Singularity Analysis of a Parallel Manipulator with Three Rotational and One Translational DOFs. Mechanics Based Design of Structures and Machines, 39(3), 392-407. doi:10.1080/15397734.2011.559149Zeng, G., & Hemami, A. (1997). An overview of robot force control. Robotica, 15(5), 473-482. doi:10.1017/s026357479700057

An Integrated Triangulation Laser Scanner for Obstacle Detection of Miniature Mobile Robots in Indoor Environment

n/

Kinematics Analysis of a Novel Five-Degree-of-Freedom Spatial Parallel Micromanipulator

A study of the inverse kinematics for a five-degree-of-freedom (DOF) spatial parallel micromanipulator is presented here below. The objective of this paper is the introduction of a structural and geometrical model of a novel five-degree-of-freedom spatial parallel micromanipulator, analysis of the effective and useful workspace of the micromechanism, presentation of the obtained analytical solutions of the microrobot’s inverse kinematics tasks, and verification of its correctness using selected computer programs and computation environments. The mathematical model presented in this paper describes the behaviour of individual elements for the applied 2-DOF novel piezoelectric actuator, resulting from the position and orientation of the microrobot’s moving platform

Micro motion stages with flexure hinges-design and control

The developments in micro and nano technologies brought the need of high precision micropositioning stages to be used in micro/nano applications such as cell manipulation, surgery, aerospace, micro fluidics, optical systems, micromachining and microassembly etc. Micro motion stages with flexible joints called compliant mechanisms are built to provide the needed accuracy and precision. This thesis aims to build compliant planar micro motion stages using flexure hinges to be used as micropositioning devices in x-y directions by applying new control methods. First 3- RRR planar parallel kinematic structure is selected which is also popular in the literature. Then the mechanism is developed to have a new structure which is a 3-PRR mechanism. The necessary geometric parameters are selected by using Finite Element Analysis (FEA). The displacement, stress and frequency behaviors of the mechanisms are compared and discussed. Modeling of the flexure based mechanisms is also studied for 3-PRR compliant stage by using Kinetostatic modeling method which combines the compliance calculations of flexure hinges with kinematics of the mechanism. Piezoelectric actuators and optical 2d position sensor which uses a laser source are used for actuation and measurement of the stages. After the experimental studies it's seen that the results are not compatible with FEA because of the unpredictable errors caused by manufacturing and assembly. We have succeeded to eliminate those errors by implementing a control methodology based on Sliding Mode Control with Disturbance Observer which is also based on Sliding Mode Control using linear piezoelectric actuator models. Finally, we have extracted experimental models for each actuation direction of the stage and used those models instead of piezoelectric actuator models which lowered our errors in the accuracy of our measurement and ready to be used as a high precision micro positioning stage for our micro system applications

Design, Development and Implementation of the Position Estimator Algorithm for Harmonic Motion on the XY Flexural Mechanism for High Precision Positioning

This article presents a novel concept of the position estimator algorithm for voice coil actuators used in precision scanning applications. Here, a voice coil motor was used as an actuator and a sensor using the position estimator algorithm, which was derived from an electro-mechanical model of a voice coil motor. According to the proposed algorithm, the position of coil relative to the fixed magnet position depends on the current drawn, voltage across coil and motor constant of the voice coil motor. This eliminates the use of a sensor that is an integral part of all feedback control systems. Proposed position estimator was experimentally validated for the voice coil actuator in integration with electro-mechanical modeling of the flexural mechanism. The experimental setup consisted of the flexural mechanism, voice coil actuator, current and voltage monitoring circuitry and its interfacing with PC via a dSPACE DS1104 R&D microcontroller board. Theoretical and experimental results revealed successful implementation of the proposed novel algorithm in the feedback control system with positioning resolution of less than ±5 microns at the scanning speed of more than 5 mm/s. Further, proportional-integral-derivative (PID) control strategy was implemented along with developed algorithm to minimize the error. The position determined by the position estimator algorithm has an accuracy of 99.4% for single direction motion with the experimentally observed position at those instantaneous states

Design synthesis & prototype implementation of parallel orientation manipulators for optomechatronic applications

This thesis documents a research endeavor undertaken to develop high-performing designs for parallel orientation manipulators (POM) capable of delivering the speed and the accuracy requirements of a typical optomechatronic application. In the course of the research, the state of the art was reviewed, and the areas in the existing design methodologies that can be potentially improved were identified, which included actuator design, dimensional synthesis of POMs, control system design, and kinematic calibration. The gaps in the current art of designing each of these POM system components were addressed individually. The outcomes of the corresponding development activities include a novel design of a highly integrated voice coil actuator (VCA) possessing the speed, the size, and the accuracy requirements of small-scale parallel robotics. Furthermore, a method for synthesizing the geometric dimensions of a POM was developed by adopting response surface methodology (RSM) as the optimization tool. It was also experimentally shown how conveniently RSM can be utilized to develop an empirical quantification of the actual kinematic structure of a POM prototype. In addition, a motion controller was formulated by adopting the active disturbance rejection control (ADRC) technology. The classic formulation of the ADRC algorithm was modified to develop a resource-optimized implementation on control hardware based on field programmable gate arrays (FPGA). The practicality and the effectiveness of the synthesized designs were ultimately demonstrated by performance benchmarking experiments conducted on POM prototypes constructed from these components. In specific terms, it was experimentally shown that the moving platforms of the prototyped manipulators can achieve highspeed motions that can exceed 2000 degrees/s in angular velocity, and 5×105 degrees/s2 in angular acceleration

Dynamic analysis, design and control of an industrial parallel robot

An investigation into the applicability of the bond-graph methodology, using the so-called Model Transformation Tools software, has been undertaken to model parallel robots. This software is a novel, non-commercial, program developed at the University of Glasgow, and in addition to the standard bond graph, it contains a powerful tool called the Hierarchical Bond Graph for dealing with very large-scale dynamical systems. It is the first time this tool has been applied for the modelling of parallel manipulators. A General Method for modelling parallel robots using the Hierarchical Bond-Graph concept has been developed. The method is based on related work on the modelling of closed chain robots using the Lagrange method. Introduction of a new design concept to be known as the Multi-cell Parallel Planar Manipulator. The methodology allows for an increase in the workspace of the manipulator by increasing the number of cells without affecting the number of DOF. It can also be shown to enhance the manoeuvrability of the system. Application of the multi-cell approach to a specific 2-DOF planar parallel manipulator and recognition of the need for a general model led to the development of a general dynamic model for the multi-cell manipulator using the Lagrange method. The reason for using the Lagrange formulation is that the necessary generalisation cannot be formalised using the Bond Graph technique due to the dependency of a bond graph on the specified structure of the system being modelled. Static balancing of the new general manipulator was addressed and a new method for balancing has been introduced. The method reduces the number of parameters to be adjusted to only one

Sliding-Mode control for high-precision motion control systems

In many of today's mechanical systems, high precision motion has become a necessity. As performance requirements become more stringent, classical industrial controllers such as PID can no longer provide satisfactory results. Although many control approaches have been proposed in the literature, control problems related to plant parameter uncertainties, disturbances and high-order dynamics remain as big challenges for control engineers. Theory of Sliding Mode Control provides a systematic approach to controller design while allowing stability in the presence of parametric uncertainties and external disturbances. In this thesis a brief study of the concepts behind Sliding Mode Control will be shown. Description of Sliding Mode Control in discrete-time systems and the continuous Sliding Mode Control will be shown. The description will be supported with the design and robustness analysis of Sliding Mode Control for discrete-time systems. In this thesis a simplified methodology based on discrete-time Sliding Mode Control will be presented. The main issues that this thesis aims to solve are friction and internal nonlinearities. The thesis can be outlined as follows: -Implementation of discrete-time Sliding Mode Control to systems with nonlinearities and friction. Systems include; piezoelectric actuators that are known to suffer from nonlinear hysteresis behavior and ball-screw drives that suffer from high friction. Finally, the controller will be implemented on a 6-dof Stewart platform which is a system of higher complexity. -It will also be shown that performance can be enhanced with the aid of disturbance compensation based on a nominal plant disturbance observer