Design and Optimization of the Thigh for an Exoskeleton based on Parallel Mechanism

Similar documents
EXPLOITING MOTION SYMMETRY IN CONTROL OF EXOSKELETON LIMBS

Resolution of spherical parallel Manipulator (SPM) forward kinematic model (FKM) near the singularities

SIMULATION ENVIRONMENT PROPOSAL, ANALYSIS AND CONTROL OF A STEWART PLATFORM MANIPULATOR

Serially-Linked Parallel Leg Design for Biped Robots

ÉCOLE POLYTECHNIQUE DE MONTRÉAL

An Efficient Method for Solving the Direct Kinematics of Parallel Manipulators Following a Trajectory

FREE SINGULARITY PATH PLANNING OF HYBRID PARALLEL ROBOT

A New Algorithm for Measuring and Optimizing the Manipulability Index

Modeling of Humanoid Systems Using Deductive Approach

Jacobian: Velocities and Static Forces 1/4

Motion Control of Wearable Walking Support System with Accelerometer Considering Swing Phase Support

Development of an optomechanical measurement system for dynamic stability analysis

A New Algorithm for Measuring and Optimizing the Manipulability Index

Singularity Management Of 2DOF Planar Manipulator Using Coupled Kinematics

Open Research Online The Open University s repository of research publications and other research outputs

Jacobians. 6.1 Linearized Kinematics. Y: = k2( e6)

DOUBLE CIRCULAR-TRIANGULAR SIX-DEGREES-OF- FREEDOM PARALLEL ROBOT

EEE 187: Robotics Summary 2

10/11/07 1. Motion Control (wheeled robots) Representing Robot Position ( ) ( ) [ ] T

Rigid Dynamics Solution Methodology for 3-PSU Parallel Kinematic Manipulators

CMPUT 412 Motion Control Wheeled robots. Csaba Szepesvári University of Alberta

1724. Mobile manipulators collision-free trajectory planning with regard to end-effector vibrations elimination

Research Subject. Dynamics Computation and Behavior Capture of Human Figures (Nakamura Group)

VIBRATION ISOLATION USING A MULTI-AXIS ROBOTIC PLATFORM G.

MTRX4700 Experimental Robotics

Singularity Loci of Planar Parallel Manipulators with Revolute Joints

Stewart Gough platforms with linear singularity surface

Design, Manufacturing and Kinematic Analysis of a Kind of 3-DOF Translational Parallel Manipulator

Jacobian: Velocities and Static Forces 1/4

which is shown in Fig We can also show that the plain old Puma cannot reach the point we specified

Geometric Approach For Inverse Kinematics Solution: 3-PSU Parallel Kinematic Manipulator

Introduction to Robotics

Workspace Optimization of 3-Legged UPU and UPS Parallel Platforms With Joint Constraints

Table of Contents. Chapter 1. Modeling and Identification of Serial Robots... 1 Wisama KHALIL and Etienne DOMBRE

Motion Control (wheeled robots)

Robotics. SAAST Robotics Robot Arms

Kinematics of the Stewart Platform (Reality Check 1: page 67)

WORKSPACE AGILITY FOR ROBOTIC ARM Karna Patel

Kinematics. CS 448D: Character Animation Prof. Vladlen Koltun Stanford University

The Collision-free Workspace of the Tripteron Parallel Robot Based on a Geometrical Approach

COLLISION-FREE TRAJECTORY PLANNING FOR MANIPULATORS USING GENERALIZED PATTERN SEARCH

PPGEE Robot Dynamics I

CALCULATING TRANSFORMATIONS OF KINEMATIC CHAINS USING HOMOGENEOUS COORDINATES

Finding Reachable Workspace of a Robotic Manipulator by Edge Detection Algorithm

THE KINEMATIC DESIGN OF A 3-DOF HYBRID MANIPULATOR

Extension of Usable Workspace of Rotational Axes in Robot Planning

x Condition Number Condition Number 0.5

Some algebraic geometry problems arising in the field of mechanism theory. J-P. Merlet INRIA, BP Sophia Antipolis Cedex France

Rotating Table with Parallel Kinematic Featuring a Planar Joint

10/25/2018. Robotics and automation. Dr. Ibrahim Al-Naimi. Chapter two. Introduction To Robot Manipulators

The Mathematical Model and Computer Simulation of a Quadruped Robot

Dynamics modeling of structure-varying kinematic chains for free-flying robots

θ x Week Date Lecture (M: 2:05p-3:50, 50-N202) 1 23-Jul Introduction + Representing Position & Orientation & State 2 30-Jul

Chapter 2 Intelligent Behaviour Modelling and Control for Mobile Manipulators

Kinematics of Closed Chains

A general approach for optimal kinematic design of 6-DOF parallel manipulators

Design of a Three-Axis Rotary Platform

Robotics I. March 27, 2018

Cecilia Laschi The BioRobotics Institute Scuola Superiore Sant Anna, Pisa

Theory of Robotics and Mechatronics

UNIVERSITY OF OSLO. Faculty of Mathematics and Natural Sciences

An Improved Dynamic Modeling of a 3-RPS Parallel Manipulator using the concept of DeNOC Matrices

A sliding walk method for humanoid robots using ZMP feedback control

Dynamic Analysis of Manipulator Arm for 6-legged Robot

3/12/2009 Advanced Topics in Robotics and Mechanism Synthesis Term Projects

NMT EE 589 & UNM ME 482/582 ROBOT ENGINEERING. Dr. Stephen Bruder NMT EE 589 & UNM ME 482/582

Serial Manipulator Statics. Robotics. Serial Manipulator Statics. Vladimír Smutný

KINEMATIC AND DYNAMIC SIMULATION OF A 3DOF PARALLEL ROBOT

Workspaces of planar parallel manipulators

ME 115(b): Final Exam, Spring

Novel 6-DOF parallel manipulator with large workspace Daniel Glozman and Moshe Shoham

Inverse Kinematics of 6 DOF Serial Manipulator. Robotics. Inverse Kinematics of 6 DOF Serial Manipulator

INSTITUTE OF AERONAUTICAL ENGINEERING

Constraint-Based Task Programming with CAD Semantics: From Intuitive Specification to Real-Time Control

Symmetrical Observability of Kinematic Parameters in Symmetrical Parallel Mechanisms

SCREW-BASED RELATIVE JACOBIAN FOR MANIPULATORS COOPERATING IN A TASK

mme.modares.ac.ir Dynamic Modeling and Sliding Mode Control of a Three DOF Parallel Robot with 3[P2(US)] Structure .[1] .[5,4]

KINEMATIC IDENTIFICATION OF PARALLEL MECHANISMS BY A DIVIDE AND CONQUER STRATEGY

METR 4202: Advanced Control & Robotics

Using Algebraic Geometry to Study the Motions of a Robotic Arm

The International Journal of Robotics Research

Singularity Handling on Puma in Operational Space Formulation

Dynamics Analysis for a 3-PRS Spatial Parallel Manipulator-Wearable Haptic Thimble

The closed-loop kinematics modeling and numerical calculation of the parallel hexapod robot in space

Centre for Autonomous Systems

Triangulation: A new algorithm for Inverse Kinematics

1498. End-effector vibrations reduction in trajectory tracking for mobile manipulator

Open Access The Kinematics Analysis and Configuration Optimize of Quadruped Robot. Jinrong Zhang *, Chenxi Wang and Jianhua Zhang

Geometric Modeling of Parallel Robot and Simulation of 3-RRR Manipulator in Virtual Environment

MCE/EEC 647/747: Robot Dynamics and Control. Lecture 3: Forward and Inverse Kinematics

Force-Moment Capabilities of Redundantly-Actuated Planar-Parallel Architectures

1. Introduction 1 2. Mathematical Representation of Robots

Lecture «Robot Dynamics»: Kinematic Control

Kinematics and dynamics analysis of micro-robot for surgical applications

Kinematics, Kinematics Chains CS 685

Inverse Kinematics. Given a desired position (p) & orientation (R) of the end-effector

Constraint and velocity analysis of mechanisms

Industrial Robots : Manipulators, Kinematics, Dynamics

Chapter 2 Kinematics of Mechanisms

DYNAMIC ANALYSIS AND OPTIMIZATION OF A KINEMATICALLY-REDUNDANT PLANAR PARALLEL MANIPULATOR

Transcription:

Design and Optimization of the Thigh for an Exoskeleton based on Parallel Mechanism Konstantin Kondak, Bhaskar Dasgupta, Günter Hommel Technische Universität Berlin, Institut für Technische Informatik und Mikroelektronik Einsteinufer 17, Sekr.: EN10, D-10587 Berlin, Germany {kondak, dasgupta, hommel}@cs.tu-berlin.de Keywords: exoskeleton, design and simulation of CLAWAR, biped robots, medical rehabilitation and helping disabled people. Abstract A full parallel mechanism is suggested as a base construction for an exoskeleton to implement complex movement of body parts of the human relativ to each other. The optimal design of such a structure for a thigh is presented. The positions of the connection points of the linear actuators to the moving platform were chosen as design parameters. The calculation of these design parameters was perform numericaly. The results show that the designed parallel mechanism allows arbitrary motion of the thigh in a workspace of the mechanism which is large enough not only for walking but also for more complex movements like sitting down on a chair and standing up. 1 Introduction This paper deals with the design and optimization of the legs for an exoskeleton. The goal is to design a mechanical structure for a leg which can support a disabled person in walking as well as performing complicated movements like sitting down and standing up. In spite of the number of interesting applications for an exoskeleton like support for disabled people, rehabilitation, force amplication in space or underwater suits, only few research groups and research projects have worked on this topic recently. One of the reasons is the complexity of the mechanical construction. For real application, the structure which is attached to the parts of the human body should provide enough degrees of freedom and free space for the movement of body parts. Natural walking and performing movements like sitting down and standing up require the mobility of leg structures which is comparable with the mobility of a human leg. This requirement is important not only for comfort but also for stability. The hip joint (see Fig. 1) and the movement abilities of the thigh play a crucial role here. This joint is composed of three rotation axes each of which is indispensable for walking. The realization of the two axes X and Y in traditional way with serial kinematicchains usually composed of rotary actuators is complicated but possible. The problem lies in the third axis Z which goes through the thigh and cannot be implemented in this way. The solution proposed in this paper is to use a fully parallel mechanism for implementation of the hip joint. The scheme of the suggested construction is shown in Fig. 2. The base of the parallel mechanism is xed on the hip part of the trunk and the moving platform on the thigh close to the

Z X Y Figure 1: Hip joint and the required rotation axis for the thigh front view right side view hip part of the trunk base thigh linear actuators knee platform lower leg Figure 2: Scheme of the mechanical construction for the leg (thigh) of the exoskeleton knee. If the base and platform are connected with six actuated kinematic chains, the platform and, therefore, the thigh have six degrees of freedom with respect to the base or the hip. In this paper, the design and optimization study of the suggested construction is presented. The design process was carried out as follows. The needed workspace was calculated from measurements on the human body. The connection points of the actuators to the base (hip) were determinated in a way which would enable a disabled person to walk and to sit down on the chair (section 2). The connection points to the platform (knee) were calculated in an optimization process (section 3). The goal of the optimization was avoidance of architecture singularities [1] in the workspace of the parallel platform which automatically yields the enhancement of such important criteria of the construction as the reduction of forces in actuators and better performance in terms of achievable velocities and accelerations. After the determination of all connection points, the viability of the resulting structure is proved (section 4). For the solution of the optimization problem, the numerical approach was used. The formulation of the cost function and advanced symbolic calculation before the optimization process allowed the fast and stable computation of the actuator connection points on the platform.

In this work, the results of the referenced papers were used, in particular the results of [2]. In contrast to [2], rather than the parameters of the given shape of the platform, this shape itself (considering practical constraints) was calculated in the optimization process. The contribution of the paper is the introduction of the parallel mechanism as a basic structure for exoskeletons, the determination of an optimal design for this application and demonstration of the practical viability of the suggested construction. 2 Problem Formulation The workspace of the parallel mechanism was determined by measurements on human bodies in order to allow walking, sitting down and standing up. Fig. 3 shows the scheme of the kinematic structure and the workspace of the thigh. The reference point C of the platform coordinate frame sagittal plane A2 A1 Z A6 X O Y A5 Z A3 A4 B1 C X Y B6 B5 frontal plane Figure 3: Scheme of the parallel mechanism F 0 =(C;X 0 ;Y 0 ;Z 0 ) should be able to move on the sphere surface with the center in hip joint O which is also the reference point of the base coordinate frame F =(O;X;Y;Z). The area of motion is given by sweeping with the radius vector OC between the angles of 60 f in sagittal and 30 f in frontal plane of the human. The rotational part of the workspace was set to 10 f around axes X 0 and Y 0 andto30 f around axis Z 0. The design goal is to determine proper connection points for the actuators. It can be shown that the place of the connection points is crucial for the performance of the structure [3, 2]. In case of the exoskeleton, maximal actuator forces for dened loads and maximal achievable velocities as well as accelerations in the predened workspace are most interesting characteristics. The minimization of forces in actuators allows to reduce the size and weight of the construction, maximization of the allowed velocities and accelerations at the end-effector lets more freedom in design of stabilization control for walking. In general, all of the connection points, 6 Λ 3 = 18 parameters, have to be determined in the design process.

In this study the connection points of the base were set by combining results from other studies with requirements of the application area. The results presented in [2] show that parallel robots with triangular base and platform show better performance than the three other presented shapes. The triangular base with equal sides was selected as a starting point and modied in order to let the space at the back of the human free from mechanical parts which would allow the human to sit down as well as to stand on parallel legs. The resulting shape of the base is shown in Fig. 4. A3, A4 left side left side 0.08 B3 0.06 0.04 front side B4 0.04 b3 front side 0.02 0.02 A1, A2 b4 B1, B2-0.05-0.025 0.0250.050.075 0.1-0.02 0.02 0.04-0.02-0.02 b6-0.04 B5-0.04 A5, A6 B6 BASE PLATFORM Figure 4: Shapes of the base and platform for thigh structure Because of the application requirements, it was imposed that the connection points of the platform lie on a circle. Two points of the platform, B 4 and B 5, were xed to provide enough free space in the back of the leg. The places of the points B 1 ;B 2 ;B 3 ;B 6 on the circle or the angles β 1 ;β 2 ;β 3 ;β 6 (see g. 4) have to be found in an optimization process and are our design parameters. Let X =[x;y;z;α;β;γ] T denote the position and orientation of the mobile frame F 0 in frame F and Q =[q 1 ;q 2 ;:::q 6 ] T the joint coordinates (actuator lengths). It is known (see e.g. [3]) that the relation between joint velocities Q and twist Ẋ of the frame F 0 is linear and given by the Jacobian matrix J of the parallel mechanism: Q = JẊ (1) The Jacobian matrix is constructed from unit vectors along the linear actuators n i = A i B i = ka i B i k and vectors B i C expressed in the base frame F: 0 n T 1 ; (n 1 1 B 1 C) T n T 2 J = B ; (n 2 B 2 C) T C (2) @. A n T 6 ; (n 6 B 6 C) T The investigationof the performance of parallel mechanism is based on a property study of the Jacobian matrix J. Indeed, eq. (1) shows that if the matrix J is singular in some points or subspaces of the workspace there will be some directions in which the platform can move without changing the actuators lengths or in which no movement is possible. The transpose of the Jacobian matrix J

is the force transformation matrix H that maps linearly the actuator forces to the forces and torques exerted on the end-effector (see e.g. [3]). This means that in case of a singular or ill-conditioned matrix J or H, the actuators will be not able to hold an arbitrary load or the forces in actuators will be immense. The goal of the optimization is, therefore, to choose design parameters in a way, that the Jacobian matrix J is as far as possible from the singularities. This distance to the singularity of a matrix can be measured with a scalar cost function κ = κ(j) which can be dened in different ways. It has to be noted that the matrix J depends not only on design parameter but also on pose X of the moving platform. The problem for computation of design parameters yielding enhanced performance of the thigh structure can be formulated as the minimization of κ(j), subject to constraints employed to prevent the crossing of actuators. 3 Solution of the Optimization Problem In this work the cost function was dened as follows: 0 j 11 =α 1 j 16 =α 1 B κ(j) = det@.. j 61 =α 6 j 66 =α 6 where the α i are the lengths of the row vectors of the matrix J: q α i = ji1 2 + j2 i2 + + j2 i6 1 C A (3) It can easily be shown (see e.g. [4]) that the absolute value of the function κ(j) in (3) is equal to the volume of the parallelepiped built from the unit row vectors of the Jacobian matrix J. In case of singularity at least one dimension of this parallelepiped vanishes and the volume shrinks to 0. In case of mutual orthogonality of the row vectors the cost function κ(j) takes its smallest value 1. The closed form of the expression (3) was computed using the symbolical computation software MATHEMATICA. fl In other papers the condition number of the Jacobian matrix cond(j)=kjkfl J 1 fl fl is used as a cost function. The cost function (3) is smoother than the condition number and yields better stability of the algorithm. The optimization toolbox in Matlab has been used for the numerical optimization. As in [5] the optimization of the design parameters was performed for a representative pose X of the platform. After that, several congurations in the workspace were proved to be non singular. 4 Result For the start solution, the following values of the design parameters can be taken: β 1 = β 2 = 0, β 3 = π=2, β 6 = 3π=2. The corresponding shape of the platform is shown in Fig. 4. The obtained

solution was: β 1 = β 3 = 60:17 f and β 2 = β 6 = 299:5 f. Fig. 5 shows the corresponding optimal shape of the platform and Fig. 6, the isometric projection of the whole mechanism. Signicantly B4 0.04 B1, B3 0.02-0.03-0.02-0.01 0.010.02-0.02 B5-0.04 B2, B6 Figure 5: Optimal shape of the moving platform the determined solution is minimal for a quite large neighbourhood in the design parameter space, so changing the values of start solutions leads to the same solution of the optimization problem. An interesting point is also that despite quite high perturbations in the given base shape apart from equilateral triangle, the optimization procedure tends to form the triangle in the platform even though innite varieties of shapes are possible. In [2] the triangle shape of the base and the platform were chosen intuitively and proved to be the best one among others three shapes. The results here support the strong assumption that the triangle shape is the best among all possible coplanar shapes for parallel mechanisms with six parallel legs (in the literature called general robot) without leg crossing. In the case where leg crossing was allowed, the calculated solution was: β 1 = 91:68 f, β 2 = 88:18 f, β 3 = 43:48 f, β 6 = 29:33 f and the value of the cost function was improved to approximately 39%. The compound joints at the base and at the platform have to be split so that a practical implementation of the structure becomes possible. It is possible to include more design parameters in the optimization procedure than presented in this paper. For example, one can allow the points B 1, B 2, B 3 and B 6 to lie not only on the circle but in the entire plane or even in the 3D space. However, such dimension extension of the optimization problem is not expected to bring much enhancement of the cost function due to relative small value ranges of additional design variables which are given by construction constraints. Having computed the design parameters, the viability of the resulting structure has to be proven. The specialty of using parallel mechanism to construct an exoskeleton is that a relatively large working space is required. For the viability proof, maximal and minimal lengths of the actuators must be computed. For this computation, the inverse kinematic equations are used and the leg lengths variation constraints are veried. Fig. 7 shows the length of all six actuators for sitting down from a standing posture.

A2 A1 A3 A4 A6 A5 B1 B3 B2 B6 B5 B4 Figure 6: Isometric projection of the hole mechnism 5 Conclusion A fully parallel mechanism was suggested as a basic construction for an exoskeleton to implement complex movements occurring e.g. in hip joint. An optimal design for the thigh of the exoskeleton was presented. The goal of the optimization was avoidance of architectural singularities in the dened workspace which automatically results in the reduction of the actuator forces as well as increase of the possible velocities and accelerations at the end-effector. The viability of the suggested design was demonstrated. The further work of the authors in this area is concentrated on the dynamical simulation of the proposed mechanical structure and on the development of its control. The entire exercise can be repeated for other parts of the exoskeleton, using suitably designed parallel mechanism elements, to achieve motions required at other joints. References [1] O. Ma, J. Angeles. Architecture Singularities of Platform Manipulators. Robotics and Automation, 1991. Proceedings., 1991 IEEE International Conference on, 1991. Page(s): 1542-1547 vol.2 [2] O. Ma, J. Angeles. Optimum Architecture Design of Platform Manipulators. Advanced Robotics, 1991. Robots in Unstructured Environments, 91 ICAR., Fifth International Conference on, 1991. Page(s): 1130-1135 vol.2 [3] J.P. Merlet. Parallel Robots. Vol. 24 Solid Mechanics and its Applicatons. Kluwer Academic Publishers 2000.

Length (m) 0.46 0.44 0.42 0.4 0.38 0.36 0.34 actuators 1,2 actuator 4 actuator 3 actuators 5,6 0.32-0.75-0.5-0.25 0 0.25 0.5 0.75 1 Angle in sagittal plane (rad) Figure 7: Changing the lengths of the actuators during the sitting down or standing up [4] G.H. Golub, J.M. Ortega. Scientic Computing and Differential Equations: An Introduction to Numerical Methods. Academic Press, 1991. ISBN 0-12-289255-0. [5] T.A. Dwarakanath, B. Dasgupta, T.S. Mruthyunjaya. Design and development of a Stewart platform based force-torque sensor. Mechatronics 11, 2001, Pages:793-809