New Jacobian Matrix and Equations of Motion for a 6 d.o.f Cable-Driven Robot

Abstract

In this paper, we introduce a new method and new motion variables to study kinematics and dynamics of a 6 d.o.f cable-driven robot. Using these new variables and Lagrange equations, we achieve new equations of motion which are different in appearance and several aspects from conventional equations usually used to study 6 d.o.f cable robots. Then, we introduce a new Jacobian matrix which expresses kinematical relations of the robot via a new approach and is basically different from the conventional Jacobian matrix. One of the important characteristics of the new method is computational efficiency in comparison with the conventional method. It is demonstrated that using the new method instead of the conventional one, significantly reduces the computation time required to determine workspace of the robot as well as the time required to solve the equations of motion.

Keywords

parallel robot cable suspended robot workspace equations of motion

1. Introduction

Cable-driven robots or cable robots are a special form of parallel robots in which the rigid links are replaced by cables. These robots have desirable advantages over parallel robots such as large workspace, low inertia properties, high payload-to-weight ratio, transportability, reconfigurability and economical construction. On the other hand, the main disadvantage of cable robots is that cables are only capable of pulling and it can cause instabilities in their motion. Several cable robots have been studied in the past. An early robot is the Robocrane (Albus, J. et al., 1993) developed by NIST for use in shipping ports. Another cable robot is Charlotte (Campbell, P. et al., 1995) developed by McDonnell-Douglas for use on International Space Station. The other cable robots which have been built and tested are: the Texas (Lindemann, R. & Tesar, D., 1989), and the FALCON (Kawamura, S. et al., 1995).

Workspace is as an important issue in cable robots and has been studied by many researchers. Fattah and Agrawal studied the optimal design of Planar Cable Robots (Fattah, A. & Agrawal, S., 2002). Barrette and Gosselin analytically determined the dynamic workspace of a planar cable robot (Barrette, G. & Gosselin, C., 2005). Although it is desirable to obtain workspaces by analytical methods, but because of inherent complexity in cable robots, such methods can be used only for planar robots and simple geometries. On the other hand, numerical methods have fewer limitations and are usually used by researchers. One of the disadvantages of numerical methods is that they need an exhaustive and time-consuming search in the entire taskspace. Alp and Agrawal determined the statically reachable workspace for a 6 d.o.f spatial cable robot which has been built and tested in University of Delaware (Alp, A. & Agrawal, S., 2002). They created a three dimensional grid and searched in this volume. Pusey also used exhaustive search to determine the workspace of a 6 d.o.f cable robot (Pusey, J. et al., 2004).

In this paper, using the concept of kinematic constraints and Lagrange method, a new Jacobian matrix and a new form of equations of motion for a 6 d.o.f cable robot are introduced. The concept used to define the new Jacobian matrix distinguishes it from the conventional Jacobian matrix usually used to study 6 d.o.f cable robots. One of the important characteristics of this method is computational efficiency in workspace determination.

As a result of using this method, we achieve a simple form of equations which are computationally more efficient. Because of straightforwardness of equations of motion in cable robots, few researches have been carried out on this subject. However, it is important for purposes such as real-time control of cable robots (Bostelman, R. et al., 1996) to achieve equations which are as simple as possible.

The organization of this paper is as follows: in Section 2, we study kinematics and dynamics of a 6 d.o.f cable robot using two different sets of motion variables. In Section 3, characteristics of the new method are explained and its efficiency over the conventional one is demonstrated. Finally, conclusions are made in Section 4.

2. Kinematic and Dynamic Analyses

In this study, the well-known NIST Robocrane as a 6 d.o.f cable robot was considered. This robot is an inverted Stewart mechanism in which rigid legs are replaced by cables (Fig. 1). Its suspended movable platform and fixed support are two equilateral triangles often referred to as “lower triangle” and “upper triangle”, respectively. The movable platform is kinematically constrained by maintaining tension in all six cables which terminate in pairs at the vertices of the fixed support. Orientation and position of the moving platform is determined by six winches which separately control each cable.

Fig. 1

–Graphical representation of the Robocrane

As shown in Fig. 1, in order to study kinematics and dynamics of the Robocrane two frames are employed:

The reference frame (XYZ), with its origin in the center of the fixed support (the upper triangle with vertices A,B, and C)

The body frame (xyz), which is similarly attached to the movable platform (the lower triangle with vertices D, E, and F).

In this section, kinematics and dynamics of the robot will be studied by use of two different sets of motion variables; the first set of variables which has been frequently used to study 6 d.o.f cable robots in previous researches and we call it the “conventional set”, and the second set which can be called the “new set”.

2.1. Analysis by the Conventional Set

Since the robot has six degrees of freedom, at least six independent motion variables are needed. Conventionally, the following set of variables is used in the analysis of 6 d.o.f cable robots;

{X_{C}} = [x y z α β γ]^{T}

(1)

Where, x, y, and z are the Cartesian coordinate of center of mass of the moving platform and α, β, and γ are Euler angles.

Now, using Newton-Euler equations we have: (2)

Where, m and [I] are mass and moment of inertia matrix of the moving platform, respectively. The vector in left side represents external forces and moments exerted to the robot. Equation (2) can be written in the following form;

[M_{C}]_{6 \times 6} {{\ddot{X}}_{C}}_{6 \times 1} + {C}_{6 \times 1} = \frac{1}{r_{0}} ([R_{M}]_{6 \times 6}^{- 1} [J_{C}]_{6 \times 6}^{T}) {τ}_{6 \times 1} - {G}_{6 \times 1} + {L}_{6 \times 1}

(3)

Here, [M_C] is the inertia matrix, [R_M] is the modified transformation matrix, [J_C] is the conventional Jacobian matrix, {C} is the vector of velocity terms, {τ} is the vector of winch torques, {G} is the gravity vector, {L} is the external load vector and r₀ is radius of drum of the winches. It should be noted since the cables are only capable of pulling, each of the elements of {τ} must be non-negative, otherwise it is put zero in the equations of motion.

In equation (3), [R_M] is; (4)

Where, [R]_3×3 is the rotation matrix between the two introduced frames.

As stated, in equation (3), [J_C] is the conventional Jacobian matrix which relates time rate of change in lengths of the cables to the velocity and angular velocity of the moving platform as follows;

{\begin{matrix} {\dot{l}}_{1} \\ {\dot{l}}_{2} \\ {\dot{l}}_{3} \\ {\dot{l}}_{4} \\ {\dot{l}}_{5} \\ {\dot{l}}_{6} \end{matrix}} = {[{S_{1}} {S_{2}} {S_{3}} {S_{4}} {S_{5}} {S_{6}}]}_{6 \times 6}^{T} {\begin{matrix} V_{X} \\ V_{Y} \\ V_{Z} \\ ω_{X} \\ ω_{Y} \\ ω_{Z} \end{matrix}}

(5)

Where;

{\begin{cases} {S_{1}} = {\begin{matrix} {\vec{u}}_{A / D} \\ ({\vec{r}}_{D / G} \times {\vec{u}}_{A / D}) \end{matrix}}, {S_{2}} = {\begin{matrix} {\vec{u}}_{B / D} \\ ({\vec{r}}_{D / G} \times {\vec{u}}_{B / D}) \end{matrix}} \\ {S_{3}} = {\begin{matrix} {\vec{u}}_{B / E} \\ ({\vec{r}}_{E / G} \times {\vec{u}}_{B / E}) \end{matrix}}, {S_{4}} = {\begin{matrix} {\vec{u}}_{C / E} \\ ({\vec{r}}_{E / G} \times {\vec{u}}_{C / E}) \end{matrix}} \\ {S_{5}} = {\begin{matrix} {\vec{u}}_{C / F} \\ ({\vec{r}}_{F / G} \times {\vec{u}}_{C / F}) \end{matrix}}, {S_{6}} = {\begin{matrix} {\vec{u}}_{A / F} \\ ({\vec{r}}_{F / G} \times {\vec{u}}_{A / F}) \end{matrix}} \end{cases}

(6)

In equations (6), vectors r and u are the position and unit vectors (in the directions of the specified points), respectively.

2.2 Analysis by the New Set

Here, we introduce {X_N} as follows;

{X_{N}} = [x_{D} y_{D} z_{D} x_{E} y_{E} z_{E} x_{F} y_{F} z_{F}]^{T}

(7)

Unlike the conventional set, the new set consists of nine variables. As it is observed, the elements of {X_N} are the Cartesian coordinates of vertices of the moving platform written in the reference frame. Here, Lagrange method is used to derive the equations of motion. Therefore, we can consider the variables in question as generalized coordinates. It is clear that these generalized coordinates are not independent. In other words, since the robot has six degrees of freedom, three constraint equations are also needed. These equations are;

{\begin{cases} (x_{D} - x_{E})^{2} + (y_{D} - y_{E})^{2} + (z_{D} - z_{E})^{2} = (2 a)^{2} \\ (x_{E} - x_{F})^{2} + (y_{E} - y_{F})^{2} + (z_{E} - z_{F})^{2} = (2 a)^{2} \\ (x_{D} - x_{F})^{2} + (y_{D} - y_{F})^{2} + (z_{D} - z_{F})^{2} = (2 a)^{2} \end{cases}

(8)

Where, a is half of the side of the lower triangle. Equations (8) imply that the distances between vertices of the lower triangle remain constant.

In derivation of the kinetic energy in terms of the discussed generalized coordinates, it is convenient to use point masses instead of distributed mass. Otherwise, we encounter complicated terms in the rotational part of the kinetic energy.

The moments and products of inertia of the moving platform are;

{\begin{cases} I_{x x} = I_{y y} = m \frac{a^{2}}{6} \\ I_{z z} = 2 I_{x x} \\ I_{x y} = I_{z x} = I_{y z} = 0 \end{cases}

(9)

It should be noted that the thickness of the lower triangle in calculation of the moments of inertia is ignored.

As it is shown in Fig. 2, four point masses are positioned in the moving platform; three identical masses (m₂) at the vertices and a single point mass (m₁) at the center of mass of the lower triangle. Now, we can determine m₁ and m₂ so that the masses and mass moments of inertia of these systems are identical;

{\begin{cases} m_{1} + 3 m_{2} = m \\ 2 m_{2} a^{2} = I_{x x} \end{cases}

(10)

Equations (10) lead to;

m_{1} = 9 m_{2} = \frac{3}{4} m

(11)

Fig. 2

– The moving platform with the point masses

It should be noted that it is not necessary to check equality of the other moments of inertia (I_yy and I_zz) because these equations and the second equation in equations (10) are dependent. It is clear that the products of inertia of these systems (I_xy, I_zx, and I_zy) are identical regardless of values of the unknowns, as a result of this arrangement of the point masses.

Now, the kinetic and potential energies of the robot are easily expressed in terms of the generalized coordinates. Then, the equations of motion can be derived;

\frac{d}{d t} (\frac{\partial T}{\partial {\dot{q}}_{i}}) - \frac{\partial T}{\partial q_{i}} + \frac{\partial V}{\partial q_{i}} = Q_{i} + \sum_{j = 1}^{3} λ_{j} a_{j i} i = 1, 2, \dots, 9

(12)

It leads to;

[M_{N}]_{9 \times 9} {{\ddot{X}}_{N}}_{9 \times 1} = \frac{1}{r_{0}} ([P]_{9 \times 6}^{T}) {τ}_{6 \times 1} - {G}_{9 \times 1} + {Q}_{9 \times 1} + [a]_{9 \times 3}^{T} {λ}_{3 \times 1}

(13)

Here, [M_N] is the new inertia matrix;

[M_{N}]_{9 \times 9} = \frac{1}{12} m [\begin{matrix} 2 & 0 & 0 & 1 & 0 & 0 & 1 & 0 & 0 \\ 0 & 2 & 0 & 0 & 1 & 0 & 0 & 1 & 0 \\ 0 & 0 & 2 & 0 & 0 & 1 & 0 & 0 & 1 \\ 1 & 0 & 0 & 2 & 0 & 0 & 1 & 0 & 0 \\ 0 & 1 & 0 & 0 & 2 & 0 & 0 & 1 & 0 \\ 0 & 0 & 1 & 0 & 0 & 2 & 0 & 0 & 1 \\ 1 & 0 & 0 & 1 & 0 & 0 & 2 & 0 & 0 \\ 0 & 1 & 0 & 0 & 1 & 0 & 0 & 2 & 0 \\ 0 & 0 & 1 & 0 & 0 & 1 & 0 & 0 & 2 \end{matrix}]

(14)

In equation (13), we also have;

{G}_{9 \times 1} = \frac{1}{3} m g [0 0 1 0 0 1 0 0 1]^{T}

(15)

[a]_{3 \times 9} = [\begin{matrix} 0 0 0 & [u_{E / F}^{x} u_{E / F}^{y} u_{E / F}^{z}] & - [u_{E / F}^{x} u_{E / F}^{y} u_{E / F}^{z}] \\ - [u_{D / F}^{x} u_{D / F}^{y} u_{D / F}^{z}] & 0 0 0 & [u_{D / F}^{x} u_{D / F}^{y} u_{D / F}^{z}] \\ [u_{D / E}^{x} u_{D / E}^{y} u_{D / E}^{z}] & - [u_{D / E}^{x} u_{D / E}^{y} u_{D / E}^{z}] & 0 0 0 \end{matrix}]

(16)

{λ}_{3 \times 1} = [λ_{2} λ_{2} λ_{3}]^{T}

(17)

Where, [a] is the Jacobian constraint matrix, {λ} is Lagrange multiplier vector.

In addition, [P] in equation (13) is the matrix which relates the vertex velocities to the joint velocities as follows;

{\dot{l}}_{6 \times 1} = [P]_{6 \times 9} {{\dot{X}}_{N}}_{9 \times 1}

(18)

If we write equation (13) in the following form; (19)

Then, we can define the new Jacobian matrix as; (20)

Therefore we have; (21)

Or; (22)

Where, elements of the new Jacobian matrix are components of unit vectors in specified directions. The previous equation completely expresses all of the kinematical relations of the system. Because of using Lagrange multipliers, the three last elements in the left side of equation (22) are zero. In other words, it is like that three additional degrees of freedom are given to the robot by replacing the sides of the lower triangle with hydraulic pistons, and then they are locked (i.e. i₇ = i₈ = i₉ = 0).

In equation (19), {Q} is the generalized force vector which is obtained by calculation of virtual work done by external loads (except the gravity force). In the case where we also have external moments, Because of difficulty in expressing virtual rotation of the moving platform in terms of the generalized coordinates, we replaced each of three external moment components (in xyz frame) with forces in point masses so that the sum of them vanishes but they produce the moment in the corresponding direction (see Fig. 3).

Fig. 3

–Replacement of the external moments by forces

Now, {Q} can be obtained from the following equation;

{Q}_{9 \times 1} = [W]_{9 \times 6} {L}_{6 \times 1}

(23)

Where, {L} is the external load vector;

{L}_{6 \times 1} = {[F_{X} F_{Y} F_{Z} M_{x} M_{y} M_{z}]}^{T}

(24)

And, [W] is the matrix with rows which specify contribution of the external loads to each generalized force as follows;

[W]_{9 \times 6} = [\begin{matrix} \frac{1}{3} & 0 & 0 & \frac{R_{13}}{2 a} & \frac{R_{13}}{2 \sqrt{3} a} & - \frac{R_{11}}{2 a} \\ 0 & \frac{1}{3} & 0 & \frac{R_{23}}{2 a} & \frac{R_{23}}{2 \sqrt{3} a} & - \frac{R_{21}}{2 a} \\ 0 & 0 & \frac{1}{3} & \frac{R_{33}}{2 a} & \frac{R_{33}}{2 \sqrt{3} a} & - \frac{R_{31}}{2 a} \\ \frac{1}{3} & 0 & 0 & 0 & - \frac{R_{31}}{2 a} & 0 \\ 0 & \frac{1}{3} & 0 & 0 & - \frac{R_{23}}{\sqrt{3} a} & 0 \\ 0 & 0 & \frac{1}{3} & 0 & - \frac{R_{33}}{\sqrt{3} a} & 0 \\ \frac{1}{3} & 0 & 0 & - \frac{R_{13}}{2 a} & \frac{R_{13}}{2 \sqrt{3} a} & \frac{R_{11}}{2 a} \\ 0 & \frac{1}{3} & 0 & - \frac{R_{23}}{2 a} & \frac{R_{23}}{2 \sqrt{3} a} & \frac{R_{21}}{2 a} \\ 0 & 0 & \frac{1}{3} & - \frac{R_{33}}{2 a} & \frac{R_{33}}{2 \sqrt{3} a} & \frac{R_{31}}{2 a} \end{matrix}]

(25)

Where, R_ij's (elements of the rotation matrix) can be easily obtained in terms of the new variables without any angular parameter regarding the fact that the columns of [R] are the basic unit vectors of the body frame (i, j, and k), written in the reference frame.

3. Characteristics of the New Method

3.1 Definition of Jacobian Matrix Using the Concept of Constraint

In definition of the new Jacobian matrix, we inserted the velocity constraints in equation (22) to achieve a complete expression of the system kinematics. Although the robot has six degrees of freedom, we considered it as a 9 d.o.f system with three inactive degrees of freedom. In other words, the added degrees of freedom are three “virtual degrees of freedom” which appeared in kinematical relations as a result of using constraints. This new approach employed to define Jacobian matrix has not been used before and distinguishes this research from previous studies.

3.2 Efficiency in Workspace Determination

The workspace of a cable robot is characterized by the set of points where the center of the moving platform can be positioned while all cables are in tension and their lengths are less than a maximum limit. Therefore, in order to determine the workspace of cable robots, the equations of motion are also needed. Because of complexity in determining the workspace of cable robots by analytical methods, numerical methods are extensively used by researchers. The main disadvantage of numerical methods is their exhaustive and time-consuming search in the entire taskspace.

Checking the cable tensions in each point by use of equations of motion is an important part of the exhaustive search. Here, either the conventional or the new equations of motion can be used;

{T}_{6 \times 1} = [J_{C}]_{6 \times 6}^{- T} [R_{M}]_{6 \times 6} {G}_{6 \times 1}

(26)

Equation (26) is derived from the conventional equations of motion and yields the cable tensions for the static case when the gravity is the only external force exerted to the robot. However, if we use the new form of equations of motion, we have; (27)

For comparison, two programs were created in MATLAB to determine the static constant-orientation workspace of the Robocrane for a special orientation by both methods. To do that, a three dimensional grid of points was considered and the condition of falling into workspace in each point was investigated. Assumptions of the analysis are specified in Table 1.

Table 1-

Assumptions considered in the analysis of workspace determination

Orientation of the moving platform	α _r = β _r = γ _r = 0
Maximum length of the cables	L_m =5 m
Distance between the grid points in x and y directions	Δx = Δy = 4 cm
Distance between the grid points in z direction	Δz = 8 cm

The workspaces obtained by these programs are identical as shown in Fig. 4.

Fig. 4-

Workspace of the robot (for 4aL=β=γ=0 orientation)

The difference between these programs is in the time it takes to obtain the workspace as indicated in Table 2;

Table 2-

Comparison between efficiency of the two methods in workspace determination

Computation time for the conventional method	23.6 minutes
Computation time for the new method	8.55 minutes

As it is observed, the computation time in the new method is about 36% of the computation time in the conventional one. Such computational efficiency is more considerable when workspaces for several orientations (e.g. for workspace optimization) are to be obtained.

3.3 Efficiency in Solving Equations of Motion

Here, we assumed that it is desired to obtain the required motor torques for a movement of the lower triangle in a special path within a specified time (t_f). Therefore, two programs were created in MATLAB and then, the motor torques (as functions of time) and the required time for computation in each program were obtained and compared. Assumptions of the analysis are specified in Table 3.

Table 3-
Assumptions considered in the analysis of solving equations of motion

Path polynomial $\begin{array}{l} {X (t)}_{j \times 1} = {a_{0}}_{j \times 1} + t {a_{1}}_{j \times 1} + t^{2} {a_{2}}_{j \times 1} \\ + t^{3} {a_{3}}_{j \times 1} + t^{4} {a_{4}}_{j \times 1} + t^{5} {a_{5}}_{j \times 1} \\ {\begin{cases} j = 6 & for the conventional Set \\ j = 9 & for the new Set \end{cases} \end{array}$

Initial position $\begin{array}{l} {X_{i}} = [x_{i} y_{i} z_{i} α_{i} β_{i} γ_{i}]^{T} \\ {X_{i}} = {[1 m .4 m - 4.5 m - {11.46}^{0} - {5.72}^{0} - {2.86}^{0}]}^{T} \end{array}$

Final position $\begin{array}{l} {X_{f}} = [x_{f} y_{f} z_{f} α_{f} β_{f} γ_{f}]^{T} \\ {X_{f}} = {[1 m .4 m - 5 m {11.46}^{0} {5.72}^{0} - {5.72}^{0}]}^{T} \end{array}$

External loads (SI units) $\begin{array}{l} {L} = [F_{X} F_{Y} F_{Z} M_{X} M_{Y} M_{Z}]^{T} \\ {L} = {[100 100 - 500 - 90 40 60]}^{T} \end{array}$

Step time 0.001 Sec

Movement time (t_f) 0.5 Sec

According to the assumptions in Table 3, each motion variable follows a fifth order polynomial from its initial value to final value. The velocities and accelerations in the start and end points of the path are zero. The path unknowns (vectors a_i‘s) in each program are determined so that the initial and final conditions are satisfied. In the program written for the new method, the initial and final position vectors are obtained from the corresponding position vectors specified in Table 3.

The winch torques obtained by these programs are identical as shown in Fig. 5.

Fig. 5

–The winch torques as functions of time

Comparison between these programs reveals that the computation time in the new method is about 54% of that in the conventional one (see Table 4) and the difference can be more considerable when the movement time (t_f) is longer. Absence of trigonometric functions, and simple algebraic terms in equations derived by the new method, lead to such computational efficiency in comparison with the conventional method. This reduction of computation time is valuable for purposes like real-time control of cable robots.

Table 4-

Comparison between efficiency of the two methods in solving equations of motion

Computation time for the conventional method	4.09 sec
Computation time for the new method	2.24 sec

4. Conclusions

In this study, NIST Robocrane as a well-known 6 d.o.f cable robot was considered and the Cartesian coordinates of vertices of its moving platform were used as new motion variables to obtain equations of motion. Then, the Jacobian matrix associated with these new variables was introduced. Because of using Lagrange multipliers, three virtual degrees of freedom appeared in this matrix. The approach used to define the new Jacobian matrix distinguishes it from the conventional one. Finally, using programs created in MATLAB, it was demonstrated that the new method is computationally more efficient than the conventional one in workspace determination as well as in solving equations of motion.

References

Albus

Bostelman

& Dagalakis

(1993). The NIST Robocrane, Journal of Robotic Systems, pp. 709–724

Alp

& Agrawal

(2002). Cable suspended robots: design, planning, and control, Proceedings of IEEE International Conference on Robotics and Automation, pp. 4275–4280, May 2002, Washington

Barrette

& Gosselin

(2005). Determination of the Dynamic Workspace of Cable-Driven Planar Parallel Mechanisms, Transactions of the ASME, Vol. 127, pp. 242–248

Bostelman

Jacoff

Dagalakis

& Albus

(1996). RCS-Based RoboCrane Integration, Proceedings of the International Conference on Intelligent Systems A Semiotic Perspective, pp. 20–23, October 1996, Gaithersburg

Campbell

Swaim

& Thompson

(1995). Charlotte Robot Technology for Space and Terrestrial Applications, 25^th International Conference on Environmental Systems, SAE Article 951520, San Diego

Fattah

& Agrawal

(2002). Design of Cable-Suspended Planar Parallel Robots for an Optimal Workspace, Proceedings of the WORKSHOP on Fundamental Issues and Future Research Directions for Parallel Mechanisms and Manipulators, October 2002, Quebec

Kawamura

Choe

Tanaka

& Pandian

(1995). Development of an ultra high speed robot FALCON using wire drive system, Proceedings of the 1993 IEEE/ICRA International Conference on Robotics and Automation, pp. 215–220, May 1995, Nagoya

Lindemann

& Tesar

(1989). Construction and Demonstration of a 9-String 6-DOF Force Reflecting Joystick for Telerobotics, NASA International Conference on Space Telerobotics, pp. 55–63

Pusey

Fattah

& Agrawal

(2004). Design and workspace analysis of a 6–6 cable-suspended parallel robot, Mechanism and Machine Theory, Vol. 39, pp. 761–778

Path polynomial	$\begin{array}{l} {X (t)}_{j \times 1} = {a_{0}}_{j \times 1} + t {a_{1}}_{j \times 1} + t^{2} {a_{2}}_{j \times 1} \\ + t^{3} {a_{3}}_{j \times 1} + t^{4} {a_{4}}_{j \times 1} + t^{5} {a_{5}}_{j \times 1} \\ {\begin{cases} j = 6 & for the conventional Set \\ j = 9 & for the new Set \end{cases} \end{array}$
Initial position	$\begin{array}{l} {X_{i}} = [x_{i} y_{i} z_{i} α_{i} β_{i} γ_{i}]^{T} \\ {X_{i}} = {[1 m .4 m - 4.5 m - {11.46}^{0} - {5.72}^{0} - {2.86}^{0}]}^{T} \end{array}$
Final position	$\begin{array}{l} {X_{f}} = [x_{f} y_{f} z_{f} α_{f} β_{f} γ_{f}]^{T} \\ {X_{f}} = {[1 m .4 m - 5 m {11.46}^{0} {5.72}^{0} - {5.72}^{0}]}^{T} \end{array}$
External loads (SI units)	$\begin{array}{l} {L} = [F_{X} F_{Y} F_{Z} M_{X} M_{Y} M_{Z}]^{T} \\ {L} = {[100 100 - 500 - 90 40 60]}^{T} \end{array}$
Step time	0.001 Sec
Movement time (t_f)	0.5 Sec