Dynamic simulation of task constrained of a rigid-flexible manipulator

A rigid-flexible manipulator may be assigned tasks in a moving environment where the winds or vibrations affect the position and/or orientation of surface of operation. Consequently, losses of the contact and perhaps degradation of the performance may occur as references are changed. When the environment is moving, knowledge of the angleα between the contact surface and the horizontal is required at every instant. In this paper, different profiles for the time varying angleα are proposed to investigate the effect of this change into the contact force and the joint torques of a rigid-flexible manipulator. The coefficients of the equation of the proposed rotating surface are changing with time to determine the new X and Y coordinates of the moving surface as the surface rotates.


Introduction
In the last two decades, robotic constrained motion applications, where the end-effector of the robot is always in contact with its environment, have received a considerable attention. Typical examples of such applications include grinding, deburring, cutting, polishing, drilling, fastening, etc. To execute these tasks successfully it is necessary to control both motion of the robot and the contact force between the end-effector and the environment. Despite the voluminous research done in the last decade, the study of dynamics and control of the constrained motion of the flexible manipulators remains open for further investigations. Modeling, simulation, and control of manipulators in constrained motion attract many researchers for the last two decades. In 1981, the first attempt in dealing with this problem for rigid manipulators was proposed by applying hybrid position/forcce control scheme ( Raibert, M. & Craig, J., 1981). For rigid-flexible manipulator, the work by (Su, et al. 1990) represented the earliest study in force control of constrained maneuver. In 1994, a dynamic modeling and force/motion control of constrained flexible robot was presented . In their model, the flexible link has an additional degree-offreedom to move axially into the first rigid link. The dynamic hybrid position/force control of a rigid-flexible (Matsuno, F. &Yamamoto, K., 1994) and two-link flexible manipulator  where the elastic deformations were approximated by B-spline functions were Investigated. The inverse force and motion control of constrained three-axis elastic robot based on non-linear inversion and stabilization was presented (Yim, W. & Singh, H., 1995). Using a twotime scale force/position controller, a general systemic model of flexible robot interacting with a rigid environment was addressed (Rocco, P. & Book, W., 1996). The recent work by (Shi, et al, 1999)], A mathematical model of a constrained rigid-flexible manipulator based on Hamilton's principle was derived. A multi variable controller was proposed for the simultaneous motion and force control was also investigated. A parallel force and position control scheme of flexible manipulators using perturbation theory was proposed ( Siciliano, B. & Villani, L., 2000). In 2000, an algorithm employing the computed torque method in the free space and hybrid motion/force controller for rigid manipulators was presented (Bennon, et al., 2000). Experimental results on nonmoving and moving environment were also illustrated. While in 2001, a position and force control scheme for a class of flexible joint robots during constrained motion tasks with model uncertainties based on singular perturbation theory was developed (Hu, Y. & Vukovich, G. 2001). Dynamic modeling and simulation of constrained motion of rigid-flexible manipulator in contact with a compliant surface was addressed (Ata, A. & and Ghazy, S., 2001). While in 2003, they continued their work towards finding an optimal motion trajectory for the constrained motion based on the minimum energy consumption (Ata, et al., 2003). In this study, an extension to the results in the previous work is presented in such away to further study the interaction of the joint motion profile and the angular motion profile of the constraint surface. The constrained surface is assumed to be rotating , therefore, different angular profiles for the surface are proposed to investigate the effect of this change into the constrained force and the joint torques.

Dynamic Modeling
Consider the two-link planar manipulator shown in Figure  1. The first link is rigid and the second link is assumed to be flexible. The end-effector of the robot is in contact with a moving environment during the task. The tip payload consists of mass m 3 with moment of inertia I 3 about its own axis of rotation. The flexible link is assumed to be thin and slender so it can be modeled as an Euler-Bernoulli's beam of length l 2 , uniform mass density ρ 2 , the cross section I 2 . Applying the Virtual Link Coordinate System (VLCS) , consider θ 2 (t) be the angle of a line pointing from the second joint to the tip mass as described in reference (Benati, M. & Morro, A., 1994). The transversal bending deflection w(x,t) at a point xε[0, l 2 ] along the second link is described with respect to the virtual link. Longitudinal deformations are neglected. No damping is assumed and the manipulator moves in the horizontal plane so, the gravity is not considered. The equations of motion can be derived using the extended Hamilton's principle (Ata, et al., 2003). The constrained motion of the rigid-flexible can be described as: is the Coriolis and centripetal terms and can be given by the column vector: τ is the torque due to friction. Frictional force is a highly nonlinear phenomenon that is difficult to model accurately. In the present study, we neglect the effect of this friction force. r τ is the interaction torque due to the contact with the environment and given as: --F x and F y represent the applied forces by the endeffector on the surface in contact including the inertia forces of the end-effector and is modeled with a spring (Su, et al., 1990): The fourth boundary condition is due to the existence of the inertia of the tip mass around its own axis of rotation (Clough, R. & Penzien,J., 1993) in which, ω is the natural frequency of the flexible link, is an assumed function of spatial coordinate, and ) t ( I 3 is the inertia of tip mass which is a time function because we consider tip mass varies linearly with time.

Vibration of the flexible link with time-dependent boundary conditions
For an angular displacement ) t ( θ and an elastic deflection ) t , x ( w , the total displacement ) t , x ( y of a point along the flexible link from the hub can be considered as: By ignoring the first term of (4) since its effect is only obvious at very high speed, and substituting from equation (6) Our objective is to find the rigid and flexible hub torques to move the end-effector through a prescribed trajectory by solving the inverse dynamics problem. Solving equations (1 and 4) for the joints torque subject to the boundary conditions (5a-d) to obtain the rigid and flexible hub torques is a very difficult task. This is simply because one has to calculate the elastic deflection of the arm to obtain the flexible hub torque. Unfortunately, the required flexible torque is also included in the time-dependent boundary condition (8c). An alternative approach to the computation of the link deformation is to use approximations for the flexible torque (Asada , et al. 1990). The sequence of calculations to get 1 τ and 2 τ , can be summarized as follows: i-Assume the joint motion profiles ii-Consider 2 τ as a rigid torque without any elastic effect, substitute into equation (8c).
iii-Solve equation (7)  For the rigid-flexible manipulator under consideration, spatial discretization techniques (e. g., assumed modes, finite element or Galerkin's method) are typically employed to obtain a finite dimensional system of ordinary differential equation suitable for simulation . The assumed modes method, based on modal expansion, consists in finding a particular solution (admissible function) of the Euler-Bernoulli equation to satisfy only the geometric boundary conditions. On the other hand, the finite element method consists in finding a local solution of the equation over a finite element of the flexible link. In this research we are applying the assumed modes method as a technique for the analytical solution. The solution for ) t , x ( y can be obtained using the assumed modes method [Meirovitch, L., 1967& Low, K., 1989 in the form: The subscript n indicates that the continuous system has been approximated by an n-degree-of-freedom system. The three functions The last two nonlinear terms inside the parentheses in equation (6) can be regarded as distributed excitation force with unit density. This effect can be compensated in the time function (Meirovitch, L., 1967) as: where: The convolution integral (14) can be evaluated using Duhamel integral method (Clough, R. & Penzien,J., 1993). The simulation algorithm thus developed is implemented in Matlab and the results will be presented in the next section.

Simulation results and discussion
For the solution of the inverse dynamics problem, three joint motion profiles, namely sine, polynomial, and Gaussian velocity profiles are assumed. In order to investigate the interaction of the two motion profiles on the contact force and the joint torques, four different profiles for the rotation of the constrained surface have been applied to each joint motion profile. These four profiles have in common starting and ending values but they differ in their rates of increase. Accordingly, the angle α of the constrained surface will start from 2π/3 and reach 5π/6 in 5 seconds which is the same time duration as for joint motion. The proposed contact surface is a parabolic shape: y = ax 2 + bx + c. The coefficients of the proposed surface are changing with time to determine the new X and Y coordinates of the contact point of the moving surface as the surface rotates. Figures 2 and 3 represent the position of the stationary and rotating surface respectively in X-Y coordinates. The system parameters used in this study are given in below: l 1 =0.5 m. l 2 =0.75 m, m 1 =0.5 Kg, m 2 = l 2 *ρ 2, m 3 =0.15+(0.15)t/T I 1 =0.0834 Kg.m 2 , I 2 =( l 2 3 *ρ 2 /3), I 3= m 3* K 2 Kg.m 2 I h1 =10*I 1, I h2 =10*I 2 E 2 I 2 =2.4507 Nm 2 Where T is the time duration of motion and K is the radius of gyration for the tip mass. The joint torques and the contact force have been simulated first for the stationary surface in Figs 4, 6, 8 to show that they are greatly different from those resulted in Figs 5(a-d), 7(a-d) and 9(a-d) for the rotating surface with different angular velocity profiles. Simulation plots are presented in groups according to the joint motion profiles. In the Figs 5(a-d), 7(a-d) and 9(a-d), the first word in the Figure's title indicates the angular motion profile of the constrained surface and the second stands for the joint motion profile. It can be observsed from Figs 5, 7 and 9 that the contact force and the joint torques are certainly affected by the changing of the angular motion profiles for the constrained surface. In all three profiles of joint motion, the contact force tends to increase. While for sinusoidal profile of the constrained surface (Figs. 5a, 7a, 9a), the contact force increases considerably creating uncertainty about the stability the system at the end of the time interval. The polynomial, parabolic and Gaussian profiles of the constrained surface give better distributions for the contact force and joints torque. On the other hand, the contact force distributions are influenced by the interaction of the angular velocity profile of the environment and the joint motion profile. This can be observed especially in Figs. 9(a-d) where the distributions of the constrained forces are not as smooth as in Figs. 5(a-d) and 7(a-d) due to the Gaussian joint motion profile. As for the joint torques, all four different angular velocity profiles of the constrained surface produce almost same trend with a little bit different peak values in each particular joint motion profile. In the case of stationary surface, maximum joint torques and contact force result from Gaussian joint motion profile (Fig. 8), followed by sine profile (Fig. 6) and polynomial profile (Fig. 4).

Conclusion
In this paper, the effects of different angular velocity profiles for the constrained surface on the constrained force and the joint torques have been investigated. Simulation results show that system performance can also be affected due to the interaction between the joint motion and the angular motion of the constrained surface.
Therefore, for the better dynamic system performance, it is necessary to choose the motion profiles with judgment for both the surface rotation and the joint motion since there are two motions involved. However, knowledge of the time varying angle α is essential at every instant of surface rotation to obtain correct force measurements and thus joint torques.