Geometric Adaptive Control of Quadrotor UAVs Transporting a CableSuspended Rigid Body


 Dortha Rogers
 2 years ago
 Views:
Transcription
1 Geometric Adaptive Control of Quadrotor UAVs Transporting a CableSuspended Rigid Body Taeyoung Lee Abstract This paper is focused on tracking control for a rigid body payload that is connected to an arbitrary number of quadrotor unmanned aerial vehicles via rigid links. An intrinsic form of the equations of motion is derived on the nonlinear configuration manifold and a geometric adaptive controller is constructed such that the payload asymptotically follows a given desired trajectory for its position and attitude in the presence of uncertainties. The unique feature is that the coupled dynamics between the rigid body payload links and quadrotors are explicitly incorporated into control system design and stability analysis. These are developed in a coordinatefree fashion to avoid singularities and complexities that are associated with local parameterizations. The desirable features of the proposed control system are illustrated by a numerical example. I. INTRODUCTION Aerial transport of payloads by towed cables is common in emergency response industrial operations and military missions. Examples of aerial transportation range from search and rescue missions where individuals are lifted from dangerous situations to the delivery of heavy equipment to the top of a tall building that is difficult to reach by other means. Transportation of a cablesuspended load has been studied traditionally for humanoperated helicopters. Recently small unmanned aerial vehicles or quadrotors are also considered for load transportation and deployments This is to utilize the high thrusttoweight ratio of quadrotors or multirotor aerial vehicles in autonomous aerial load transportation. However these are based on simplified dynamics models. For example the effects of the payload are considered as additional force and torque exerted to quadrotors instead of considering the dynamic coupling between the payload and the quadrotor and a precomputed trajectory that minimizes swing motion of the payload is followed instead of actively controlling the motion of payload and cable 4. As such these may not be suitable for agile load transportation where the motion of cable and payload should be actively suppressed online. Recently geometric nonlinear control systems are developed for the complete dynamic model of multiple quadrotors transporting a common payload cooperatively 6. It is also generalized for a quadrotor with a payload connected by flexible cable that is modeled as a seriallyconnected links to incorporate the effects of deforming cables 7. However in these results it is assumed that the payload is modeled Taeyoung Lee Mechanical and Aerospace Engineering George Washington University Washington DC 5 This research has been supported in part by NSF under the grant CMMI 43 (transferred from 955) CMMI3358 and CNS by a point mass. Such assumption is quite restrictive for practical cases where the size of the payload is comparable to the quadrotors and the length of cables. Also the effects of modeling errors or unknown disturbances are not considered in the control system design and therefore it is impractical to implement those results in experimental settings. The objective of this paper is to construct a control system for an arbitrary number of quadrotors connected to a rigid body payload via rigid links with explicit consideration on uncertainties. This is challenging in the sense that dynamically coupled quadrotors should cooperate safely to transport a rigid body. This is in contrast to the existing results on formation control of decoupled multiagent systems. In this paper a coordinatefree form of the equations of motion is derived according to Lagrange mechanics on a nonlinear manifold and a geometric adaptive control system is designed such that the rigid body payload asymptotically follows a given desired trajectory of both the payload position and attitude. The unique property of the proposed control system is that the nontrivial coupling effects between the dynamics of payload cable and multiple quadrotors are explicitly incorporated into control system design without any simplifying assumption. Compared with the preliminary work in 8 this paper adopts nonlinear adaptive controls and finitetime stability such that the tracking errors asymptotically converge to zero in the presence of uncertainties. Another distinct feature is that the equations of motion and the control systems are developed directly on the nonlinear configuration manifold intrinsically. Therefore singularities of local parameterization are completely avoided to generate agile maneuvers of the payload in a uniform way. In short the proposed control system is particularly useful for rapid and safe payload transportation in complex terrain where the position and attitude of the payload should be controlled concurrently in a fast manner to avoid collision with obstacles. Most of the existing control systems of aerial load transportation suffer from limited agility as they are based on reactive assumptions that ignore important dynamic characteristics of aerial load transportation. The proposed control system explicitly integrates the comprehensive dynamic characteristics to achieve extreme maneuverability in aerial load transportation. To the author s best knowledge adaptive tracking controls of a cablesuspended rigid body have not been studied as mathematically rigorously as presented in this paper. This paper is organized as follows. A dynamic model is presented and the problem is formulated at Section II. Control systems are constructed at Sections III and IV which are
2 e 3 e e m i J i R i SO(3) ρ i q i S x R 3 m J R SO(3) Fig.. Dynamics model: n quadrotors are connect to a rigid body m via massless links l i. The configuration manifold is R 3 SO(3) (S SO(3)) n. followed by a numerical example at Section V. II. PROBLEM FORMULATION Consider n quadrotor UAVs that are connected to a payload that is modeled as a rigid body via massless links (see Figure ). Throughout this paper the variables related to the payload is denoted by the subscript and the variables for the ith quadrotor are denoted by the subscript i which is assumed to be an element of I = { n} if not specified. We choose an inertial reference frame { e e e 3 } and bodyfixed frames { b j b j b j3 } for j n as follows. For the inertial frame the third axis e 3 points downward along the gravity and the other axes are chosen to form an orthonormal frame. The origin of the jth bodyfixed frame is located at the center of mass of the payload for j = and at the mass center the quadrotor for j n. The third bodyfixed axis b i3 is normal to the plane defined by the centers of rotors and it points downward. The location of the mass center of the payload is denoted by x R 3 and its attitude is given by R SO(3) where the special orthogonal group is defined by SO(3) = {R R 3 3 R T R = I detr = }. Let ρ i R 3 be the point on the payload where the ith link is attached and it is represented with respect to the zeroth bodyfixed frame. The other end of the link is attached to the mass center of the ith quadrotor. The direction of the link from the mass center of the ith quadrotor toward the payload is defined by the unitvector q i S where S = {q R 3 q = } and the length of the ith link is denoted by l i R. Let x i R 3 be the location of the mass center of the i th quadrotor with respect to the inertial frame. As the link is assumed to be rigid we have x i = x + R ρ i l i q i. The attitude of the ith quadrotor is defined by R i SO(3) which represents the linear transformation of the representation of a vector from the ith bodyfixed frame to the inertial frame. In summary the configuration of the presented system is described by the position x and the attitude R of the payload the direction q i of the links and the attitudes R i of the quadrotors. The corresponding configuration manifold of this system is R 3 SO(3) (S SO(3)) n. l i The mass and the inertia matrix of the payload are denoted by m R and J R 3 3 respectively. The dynamic model of each quadrotor is identical to 9. The mass and the inertia matrix of the ith quadrotor are denoted by m i R and J i R 3 3 respectively. The ith quadrotor can generates a thrust f i R i e 3 R 3 with respect to the inertial frame where f i R is the total thrust magnitude and e 3 = T R 3. It also generates a moment M i R 3 with respect to its bodyfixed frame. The control input of this system corresponds to {f i M i } i n. Disturbances are modeled as follows. Let x R R 3 be arbitrary but fixed disturbance force and moment acting on the mass center of the payload respectively. The disturbance force and moment exerted on the ith quadrotor are denoted by xi Ri R 3 respectively. The disturbance forces are represented with respect to the inertial frame and the disturbance moments are represented with respect to the corresponding bodyfixed frame. Throughout this paper the norm of a matrix A is denoted by A and its maximum eigenvalue and minimum eigenvalues are denoted by λ M A and λ m A respectively. The standard dot product is denoted by x y = x T y for any x y R 3. A. Equations of Motion The kinematic equations for the payload quadrotors and links are given by q i = ω i q i = ˆω i q i () Ṙ = R ˆΩ Ṙ i = R i ˆΩi () where ω i R 3 is the angular velocity of the ith link satisfying q i ω i = and Ω and Ω i R 3 are the angular velocities of the payload and the ith quadrotor expressed with respect to its bodyfixed frame respectively. The hat map ˆ : R 3 so(3) is defined by the condition that ˆxy = x y for all x y R 3 and the inverse of the hat map is denoted by the vee map : so(3) R 3 where so(3) denotes the set of 3 3 skewsymmetric matrices i.e. so(3) = {S R 3 3 S T = S} and it corresponds to the Lie algebra of SO(3). Several properties of the hat map are summarized as follows : ˆxy = x y = y x = ŷx (3) traˆx = trˆx(a A T ) = x T (A A T ) (4) ˆxA + A T ˆx = ({tra I 3 3 A} x) (5) RˆxR T = (Rx) (6) for any x y R 3 A R 3 3 and R SO(3). We derive equations of motion according to Lagrangian mechanics. The velocity of the ith quadrotor is given by ẋ i = ẋ + Ṙρ i l i q i. The kinetic energy of the system is composed of the translational kinetic energy and the rotational kinetic energy of the payload and quadrotors: T = m ẋ + Ω J Ω
3 + m i ẋ + Ṙρ i l i q i + Ω i J i Ω i. (7) The gravitational potential energy is given by U = m ge 3 x m i ge 3 (x + R ρ i l i q i ) (8) where the unitvector e 3 points downward along the gravitational acceleration as shown at Fig.. The corresponding Lagrangian of the system is L = T U. Coordinatefree form of Lagrangian mechanics on the twosphere S and the special orthogonal group SO(3) for various multibody systems has been studied in. The key idea is representing the infinitesimal variation of q i S in terms of the exponential map: δq i = d dɛ exp(ɛˆξ i )q i = ξ i q i (9) ɛ= for a vector ξ i R 3 with ξ i q i =. Similarly the variation of R i is given by δr i = d dɛ R i exp(ɛˆη i )q i = R iˆη i () ɛ= for η i R 3. By using these expressions the equations of motion can be obtained from Hamilton s variational principle as follows (see Appendix A for more detailed derivations). M q (ẍ ge 3 ) m i q i qi T R ˆρ i Ω = x + + u i + x i m i l i ω i q i m i q i qi T R ˆΩ ρ i () + (J m i ˆρ i R T q i qi T R ˆρ i ) Ω m i ˆρ i R T q i qi T (ẍ ge 3 ) + ˆΩ J Ω = R ˆρ i R T (u i + x i m i l i ω i q i m i q i qi T R ˆΩ ρ i ) ω i = l i ˆq i (ẍ ge 3 R ˆρ i Ω + R ˆΩ ρ i ) () ˆq i (u i + x m i l i ) i (3) J i Ωi + Ω i J i Ω i = M i + Ri (4) where M q = m y I + n m iq i q T i R 3 3 which is symmetric positivedefinite for any q i. The vector u i R 3 represents the control force at the ith quadrotor i.e. u i = f i R i e 3. The vectors u i and u i R 3 denote the orthogonal projection of u i along q i and the orthogonal projection of u i to the plane normal to q i respectively i.e. u i = q iq T i u i (5) u i = ˆq i u i = (I q i q T i )u i. (6) Therefore u i = u i +u i. Throughout this paper the subscripts and of a vector denote the component of the vector that is parallel to q i and the other component of the vector that is perpendicular to q i. Similarly the disturbance force at the ith quadrotor is decomposed as B. Tracking Problem x i = q i q T i xi (7) x i = ˆq i xi = (I q i q T i ) xi. (8) Define a fixed matrix P R 6 3n as I3 3 I P = 3 3. (9) ˆρ ˆρ n Recall that ρ i describe the point on the payload where the ith link is attached. Assume the links are attached to the payload such that rankp 6. () This is to guarantee that there exist enough degrees of freedom in control inputs for both the translational motion and the rotational maneuver of the payload. The assumption () requires that the number of quadrotor is at least three i.e. n 3 since when n = the above matrix P has a nonempty null space spanned by (ρ ρ ) T (ρ ρ ) T T. This follows from the fact that it is impossible to generate any moment to the payload along the direction of ρ ρ when n =. It is also assumed that the bounds of the disturbance forces and moments are available i.e. for a known positive constant B δ R we have max{ x R T x T x n T Ri } < B δ. () Suppose that the desired trajectories for the position and the attitude of the payload are given as smooth functions of time namely x d (t) R 3 and R d (t) SO(3). From the attitude kinematics equation we have Ṙ d (t) = R d (t)ˆω d (t) where Ω d (t) R 3 corresponds to the desired angular velocity of the payload. It is assumed that the velocity and the acceleration of the desired trajectories are bounded by known constants. We wish to design a control input of each quadrotor {f i M i } i n such that the tracking errors asymptotically converge to zero along the solution of the controlled dynamics. III. CONTROL SYSTEM DESIGN FOR SIMPLIFIED DYNAMIC MODEL In this section we consider a simplified dynamic model where the attitude dynamics of each quadrotor is ignored and we design a control input by assuming that the thrust at each quadrotor namely u i can be arbitrarily chosen. It corresponds to the case where every quadrotor is replaced by a fully actuated aerial vehicle that can generates a thrust along any direction arbitrarily. The effects of the attitude dynamics of quadrotors will be incorporated in the next section.
4 In the simplified dynamic model given by ()(3) the dynamics of the payload are affected by the parallel components u i of the thrusts and the dynamics of the links are directly affected by the normal components u i of the thrusts. This structure motivates the following control system design procedure: first the parallel components u i are chosen such that the payload follows the desired position and attitude trajectory while yielding the desired direction of each link namely q id S ; next the normal components u i are designed such that the actual direction of the links q i follows the desired direction q id. A. Design of Parallel Components Let a i R 3 be the acceleration of the point on the payload where the ith link is attached that is measured relative to the gravitational acceleration: a i = ẍ ge 3 + R ˆΩ ρ i R ˆρ i Ω. () The parallel component of the control input is chosen as u i = µ i + m i l i ω i q i + m i q i q T i a i (3) where µ i R 3 is a virtual control input that is designed later with a constraint that µ i is parallel to q i. Note that the expression of u i is guaranteed to be parallel to q i due to the projection operator q i qi T at the last term of the righthand side of the above expression. The motivation for the proposed parallel components becomes clear if (3) is substituted into ()() and rearranged to obtain m (ẍ ge 3 ) = x + (µ i + x i ) (4) J Ω + ˆΩ J Ω = R + ˆρ i R T (µ i + x i ). (5) Therefore considering a freebody diagram of the payload the virtual control input µ i corresponds to the force exerted to the payload by the ilink or the tension of the ith link in the absence of disturbances. Next we determine the virtual control input µ i. Any control scheme developed for the translational and rotational dynamics of a rigid body can be applied to (4) and (5). Here we consider an adaptive control scheme to handle the effects of the disturbances. As in 3 define position attitude and angular velocity tracking error vectors e x e R e Ω R 3 for the payload as e x = x x d e R = (RT d R R T R d ) e Ω = Ω R T R d Ω d. The desired resultant control force F d R 3 and moment M d R 3 acting on the payload are given in term of these error variables as F d = m ( k x e x kẋ ė x + ẍ d ge 3 ) x x i (6) M d = k R e R k Ω e Ω + (R T R d Ω d ) J R T R d Ω d + J R T R d Ωd R ˆρ i R xi (7) for positive constants k x kẋ k R k Ω R. Here the estimates of x xi R are denoted by x xi R R 3 and the orthogonal projection of xi along q i is denoted by x i = q i qi T xi R 3. Adaptive control laws to update the estimates of disturbances are introduced later at Section IIIC. These are the ideal resultant force and moment to achieve the control objectives. One may try to choose the virtual control input µ i by making the expressions in the righthand sides of (4) and (5) namely i µ i and i ˆρ ir T µ i become identical to F d and M d respectively. But this is not valid in general as each µ i is constrained to be parallel to q i. Instead we choose the desired value of µ i without any constraint such that µ id = F d ˆρ i R T µ id = M d (8) or equivalently using the matrix P defined at (9) R T µ d R T P. = F d. M d R T µ nd From the assumption stated at () there exists at least one solution to the above matrix equation for any F d M d. Here we find the minimumnorm solution given by µ d. µ nd = diagr R P T (PP T ) R T F d M d. (9) The virtual control input µ i is selected as the projection of its desired value µ id along q i µ i = (µ id q i )q i = q i q T i µ id (3) and the desired direction of each link namely q id S is defined as q id = µ i d µ id. (3) It is straightforward to verify that when q i = q id the resultant force and moment acting on the payload become identical to their desired values. Here the extra degrees of freedom in control inputs are used to minimize the magnitude of the desired tension at (9) but they can be applied to other tasks such as controlling the relative configuration of links 6. This is referred to future investigation. B. Design of Normal Components Substituting () into (3) and using (8) the equation of motion for the ilink is given by ω i = l i ˆq i a i m i l i ˆq i (u i + x i ). (3)
5 Here the normal component of the control input u i is chosen such that q i q id as t. Control systems for the unitvectors on the twosphere have been studied in 4 5. In this paper we adopt the control system developed in terms of the angular velocity in 5 and we augment it with an adaptive control term to handle the disturbance x i. For the given desired direction of each link its desired angular velocity is obtained from the kinematics equation as ω id = q id q id. Define the direction and the angular velocity tracking error vectors for the ith link namely e qi e ωi R 3 as e qi = q id q i e ωi = ω i + ˆq i ω id. For positive constants k q k ω R the normal component of the control input is chosen as u i = m i l iˆq i { k q e qi k ω e ωi (q i ω id ) q i ˆq i ω d } m iˆq i a i x i (33) where x i R 3 corresponds to the component of the estimate xi that is projected onto the plane normal to q i i.e. xi = ˆq i xi. Note that the expression of u i is perpendicular to q i by definition. Substituting (33) into (3) and rearranging by the facts that the matrix ˆq i corresponds to the orthogonal projection to the plane normal to q i and ˆq i 3 = ˆq i we obtain ω i = k q e qi k ω e ωi (q i ω id ) q i ˆq i ω d m i l i ˆq i xi (34) where the estimation error is defined as x i = x i x i R 3. In short the control force for the simplified dynamic model is given by C. Design of Adaptive Law u i = u i + u i. (35) The above control inputs require estimates of the uncertainties. They are updated according to the following adaptive laws x = h x (ė x + c x e x ) m (36) R = h R (e Ω + c R e R ) (37) xi = h xi q i q T i { m (ė x + c x e x ) R ˆρ i (e Ω + c R e R )} + h x i m i l i ˆq i (e ωi + c q e qi ) (38) for positive constants c x c R c q R and adaptive gains h x h R h xi R. Note that the adaptive law for xi is composed of two parts: the first part that is parallel to q i determined by the tracking errors of the payload and the second part that is normal to q i defined by the dynamics of the link. The resulting stability properties are summarized as follows. Proposition. Consider the simplified dynamic model defined by ()(3). For given tracking commands x d R d a control input is designed as (35)(38). Then there exist the values of controller gains and controller parameters such that the following properties are satisfied. (i) The zero equilibrium of tracking errors (e x ė x e R e Ω e qi e ωi ) and the estimation errors ( x R xi ) is stable in the sense of Lyapunov. (ii) The tracking errors asymptotically coverage to zero. (iii) The estimation errors are uniformly bounded. Proof. See Appendix B At (3) the negative sign appeared to make the tension at each cable positive when q i = q id. Assuming that the tracking errors e x ė x e R e Ω and the variables ẍ d Ω d Ω d obtained from the desired trajectories are sufficiently small this guarantees that quadrotors remain above the payload. If desired the negative sign at (3) can be eliminated to place quadrotors below the payload resulting in a tracking control of an inverted rigid body multilink pendulum that can be considered as a generalization of a flying spherical inverted spherical pendulum illustrated in 6. The proposed control system guarantees stability in the sense of Lyapunov and asymptotic convergence of tracking errors variables but as the convergence of estimation error is not guaranteed asymptotic stability is not achieved. However in the absence of the disturbances we can achieve stronger exponential stability by eliminating the adaptive parts of the proposed control system via setting x = R = xi = and h x h R h xi = 8. IV. CONTROL SYSTEM DESIGN FOR FULL DYNAMIC MODEL The control system designed at the previous section is based on a simplifying assumption that each quadrotor can generate a thrust along any arbitrary direction instantaneously. However the dynamics of quadrotor is underactuated since the direction of the total thrust is always parallel to its third bodyfixed axis while the magnitude of the total thrust can be arbitrarily changed. This can be directly observed from the expression of the total thrust u i = f i R i e 3 where f i is the total thrust magnitude and R i e 3 corresponds to the direction of the third bodyfixed axis. Whereas the rotational attitude dynamics is fully actuated by the control moment M i. Based on these observations the attitude of each quadrotor is controlled such that the third bodyfixed axis becomes parallel to the direction of the ideal control force u i designed in the previous section within a finite time. More explicitly the desired attitude of each quadrotor is constructed as follows. The desired direction of the third bodyfixed axis of the ith quadrotor namely b 3i S is given by b 3i = u i u i. (39) This provides twodimensional constraint on the threedimensional desired attitude of each quadrotor and there
6 remains one degree of freedom. To resolve it the desired direction of the first bodyfixed axis b i (t) S is introduced as a smooth function of time. Due to the fact that the first bodyfixed axis is normal to the third bodyfixed axis it is impossible to follow an arbitrary command b i (t) exactly. Instead its projection onto the plane normal to b 3i is followed and the desired direction of the second bodyfixed axis is chosen to constitute an orthonormal frame 9. This corresponds to controlling the additional one dimensional yawing angle of each quadrotor. From these the desired attitude of the ith quadrotor is given by R ic = (ˆb 3i ) b i (ˆb 3i ) b i ˆb3i b i b ˆb 3i b i 3 i which is guaranteed to be an element of SO(3). The desired angular velocity is obtained from the attitude kinematics equation Ω ic = (Ri T c Ṙ ic ) R 3. In the prior work described in 8 the attitude of each quadrotor is controlled such that the equilibrium R i = R ic becomes exponentially stable and the stability of the combined full dynamic model is achieved via singular perturbation theory 6. However we can not follow such approach in this paper as the presented adaptive control system guarantees asymptotical convergence of the tracking error variables due to the disturbances. Here we design the attitude controller of each quadrotor such that R i becomes equal to R ic within a finite time via finitetime stability theory Define the tracking error vectors e Ri e Ωi R 3 for the attitude and the angular velocity of the ith quadrotor as e Ri = (RT i c R i R T i R ic ) e Ωi = Ω i R T i R ic Ω ic. The timederivative of e Ri can be written as 9 ė Ri = (tr R T i R ic I R T i R ic )e Ωi E(R i R ic )e Ωi. (4) For < r < define S : R R 3 R 3 as S(r y) = y r sgn(y ) y r sgn(y ) y 3 r sgn(y 3 ) T where y = y y y 3 T R 3 and sgn( ) denotes the sign function. For positive constants k R l R the terminal sliding surface s i R 3 is designed as s i = e Ωi + k R e Ri + l R S(r e Ri ). (4) We can show that when confined to the surface of s i the tracking errors become zero in a finite time. To reach the sliding surface for positive constants k s l s the control moment is designed as M i = k s s i l s S(r s i ) + Ω i J i Ω i (k R J i + l s rj i diag j e Rij r )E(R i R ci )e Ωi J i (ˆΩ i R T i R ic Ω ic R T i R ic Ωic ). (4) The thrust magnitude is chosen as the length of u i projected on to R i e 3 f i = u i R i e 3 (43) which yields that the thrust of each quadrotor becomes equal to its desired value u i when R i = R ic. t = t = 3.3 t = 6.6 (a) 3D perspective (b) Top view (c) Side view t = 3.3 t = 6.6 t = t = Fig.. Snapshots of controlled maneuver (red:desired trajectory blue:actual trajectory). A short animation illustrating this maneuver is available at w6c. Stability of the corresponding controlled systems for the full dynamic model can be shown by using the fact that the full dynamic model becomes exactly same as the simplified dynamic model within a finite time. Proposition. Consider the full dynamic model defined by ()(4). For given tracking commands x d R d and the desired direction of the first bodyfixed axis b i control inputs for quadrotors are designed as (4) and (43). Then there exists controller parameters such that the tracking error variables (e x ė x e R e Ω e qi e ωi ) asymptotically converge to zero and the estimation errors are uniformly bounded. Proof. See Appendix C. This implies that the payload asymptotically follows any arbitrary desired trajectory both in translations and rotations in the presence of uncertainties. In contrast to the existing results in aerial transportation of a cable suspended load it does not rely on any simplifying assumption that ignores the coupling between payload cable and quadrotors. Also the presented global formulation on the nonlinear configuration manifold avoids singularities and complexities that are inherently associated with local coordinates. As such the presented control system is particularly useful for agile load transportation involving combined translational and rotational maneuvers of the payload in the presence of uncertainties.
7 V. NUMERICAL EXAMPLE We consider a numerical example where three quadrotors (n = 3) transport a rectangular box along a figureeight curve which is a special case of Lissajous figure shaped like the symbol. More explicitly the mass of the payload is m =.5 kg and its length width and height are. m.8 m and. m respectively. Throughout this section all of the units are in kg m and s if not specified. Mass properties of three quadrotors are identical and they are given by m i =.755 J i = diag The length of cable is l i = m and they are attached to the following points of the payload. ρ =.5. T ρ =.5.4. T ρ 3 =.5.4. T. In other words the first link is attached to the center of the top front edge and the remaining two links are attached to the vertices of the top rear edge (see Figure ). The desired trajectory of the payload is chosen as x d (t) =. sin(.πt) 4. cos(.πt).5 T. The desired attitude of the payload is chosen such that its first axis is tangent to the desired path and the third axis is parallel to the direction of gravity it is given by R d (t) = ẋd ẋ d Initial conditions are chosen as ê 3ẋ d ê 3ẋ d e 3. x () = 4.8 T v () = 3 q i () = e 3 ω i () = 3 R i () = I 3 3 Ω i () = 3. The uncertainties are specified as x = 3.5 T R =.5..5 T xi =.5..3 T Ri =..3.7 T. The corresponding simulation results are presented at Figures and 3. Figure illustrates the desired trajectory that is shaped like a figureeight curve around two obstacles represented by cones and the actual maneuver of the payload and quadrotors. Figure 3 shows tracking errors for the position and the attitude of the payload tracking errors for the link directions and the attitude of quadrotors as well as tension and control inputs. These illustrate excellent tracking performances of the proposed control system. VI. CONCLUSIONS This paper presents a geometric control system for an arbitrary number of quadrotors that transport a cablesuspended rigid body. It is guaranteed that the payload asymptotically follows a desired position trajectory and a desired attitude trajectory concurrently in the presence of uncertainties. The main contribution is developing a geometric nonlinear adaptive control system that incorporate the nontrivial coupling between the payload links and quadrotors in an intrinsic fashion t (sec) (a) Position of payload (x :blue x d :red) t (sec) (c) Link direction error Ψ qi = q i q id t (sec) (e) Tension at links t (sec) (b) Attitude tracking error of payload Ψ = R R d t (sec) (d) Attitude tracking error of quadrotors Ψ i = R i R id fi Mi t (sec) (f) Control input for quadrotors f i M i Fig. 3. Simulation results for tracking errors and control inputs. (for figures (c)(f): i = :blue i = :green i = 3:red) Rigorous stability proof of a nonlinear control system for such comprehensive dynamic model of cooperative aerial load transportation has been unprecedented. Future works include motion planning and control of the formation of the quadrotors relative to the payload to avoid collisions with obstacles places near the desired trajectory of the payload. A. Lagrangian Mechanics APPENDIX a) Derivatives of Lagrangian: Here we develop the equations of motion for the Lagrangian given by (7) and (8). The derivatives of the Lagrangian are given by Dẋ L = m T ẋ + m i (R ˆΩ ρ i l i q i ) (44) D qi L = m i (li q i l i ẋ l i R ˆΩ ρ i ) (45) D Ω L = J Ω + m i ˆρ i R T (ẋ l i q i ) (46)
8 D Ωi L = J i Ω i (47) D x L = m T ge 3 (48) D qi L = m i l i ge 3 (49) where J = J n m i ˆρ i. The variation of a rotation matrix is represented by δr j = R j ˆη j for η j R 3. Using this the derivative of the Lagrangian with respect to R j can be written as D R L δr = m i R ˆη ˆΩ ρ i (ẋ i l i q i ) + m i ge 3 R ˆη ρ i = m i { ˆΩ ρ i R T (ẋ l i q i ) + g ˆρ i R T e 3 } η d R L η (5) where d R L (R 3 ) R 3 is referred to as lefttrivialized derivatives. Substituting δr j = R j ˆη j into the attitude kinematic equations () and rearranging the variation of the angular velocity can be written as δω j = η j + Ω j η j. For the variation model of q i given at (9) we have δq i = ξ i q i and ξ i = ξ i q i + ξ i q i. b) Lagranged Alembert Principle: Let G = t f t L dt be the action integral. Using the above equations the infinitesimal variation of the action integral can be written as tf δg = Dẋ L δẋ + D x L δx t + D Ω L ( η + Ω η ) + d R L η + D qi L ( ξ i q i + ξ i q i ) + D qi L (ξ i q i ) + D Ωi L ( η i + Ω i η i ) dt. The total control thrust at the ith quadrotor with respect to the inertial frame is denoted by u i = f i R i e 3 R 3 and the total control moment at the ith quadrotor is defined as M i R 3. There exist the disturbances x R for the payload and the disturbances xi Ri for the ith quadrotor. The corresponding virtual work can be written as tf δw = (u i + xi ) {δx + R ˆη ρ i l i ξ i q i } + t (M i + Ri ) η i + x δx + R η dt. According to Lagranged Alembert principle we have δg = δw for any variation of trajectories with fixed end points. By using the integration by parts and rearranging we obtain the following EulerLagrange equations: d dt D ẋ L D x L = x + (u i + xi ) d dt D Ω L + Ω D Ω L d R L = R + We have µ id = q id qi T d µ id from (3). Using this the error term ˆρ i R T (u i + xi ) can be written in terms of e qi as Y x = n (qi T m d µ id ){(qi T q id )q i q id } ˆq i d dt D q i L ˆq i D qi L = l iˆq i (u i + xi ) d dt D Ω i L + Ω i D Ωi L = M i + Ri. Substituting (44)(5) into these and rearranging by the fact that q i = ˆq i ω i ω i q i and ˆq i q i = ˆq i ω i = ω i the equations of motion can be rewritten as m T ẍ + m i ( R ˆρ i Ω + l iˆq i ω i ) + +m i l i ω i q i = m T ge 3 + x + J Ω + m i R ˆΩ ρ i (u i + xi ) (5) m i ˆρ i R T (ẍ + l iˆq i ω i + l i ω i q i ) + ˆΩ J Ω = R + ˆρ i R T (u i + xi + m i ge 3 ) (5) m i l i ω i m iˆq i ẍ + m iˆq i R ˆρ i Ω m iˆq i R ˆΩ ρ i = ˆq i (u i + xi + m i ge 3 ) (53) J i Ωi + Ω i J i Ω i = M i + Ri (54) where m T = m + n m i R 3 and J = J n m i ˆρ i R3 3. Next we substitute (53) into (5) and (5) to eliminate the dependency of ω i in the expressions for ẍ and Ω. Using the fact that I + ˆq i = q i q T i for any q i S and ˆΩ ˆρ i Ω = ˆρ i ˆΩ ρ i for any Ω ρ i R 3 we obtain () and () after rearrangements and simplifications. It is straightforward to see that (53) is equivalent to (3). B. Proof of Proposition c) Error Dynamics: From () and (3) the dynamics of the position tracking error is given by m ë x = m (ge 3 ẍ d ) + x + q i qi T µ id + x i. From (8) and (6) this can be rearranged as ë x = ge 3 ẍ d + m F d + Y x + m ( x + = k x e x kẋ ė x + m ( x + x i ) x i ) + Y x (55) where x i = x i x i R 3 corresponds to the parallel component of the estimation error. The last term Y x R 3 represents the error caused by the difference between q i and q id and it is given by Y x = n (q i qi T I)µ id. m
9 = n (qi T m d µ id )ˆq i e qi. Using (9) an upper bound of Y x can be obtained as Y x n µ id e qi m γ( F d + M d ) e qi where γ =. From (6) and (7) this can be m λmpp T further bounded by Y x {β(k x e x + kẋ ė x ) + γ(k R e R + k Ω e Ω ) + B} e qi (56) where β = m γ and the constant B is determined by the given desired trajectories of the payload and (6) which defines the domain D of the error variables that the presented stability proof is considered. Throughout the remaining parts of the proof any bound that can be obtained from x d R d or (6) is denoted by B for simplicity. In short the position tracking error dynamics of the payload can be written as (55) where the error term is bounded by (56). Similarly we find the attitude tracking error dynamics for the payload as follows. Using () (7) and (3) the timederivative of J e Ω can be written as J ė Ω = (J e Ω + d) e Ω k R e R k Ω e Ω + R + ˆρ i R T x i + Y R (57) where d = (J trj I)R T R d Ω d R 3 3 that is bounded and R R 3 denotes the estimation error given by R = R ˆ R. The error term in the attitude dynamics of the payload namely Y R R 3 is given by Y R = ˆρ i R T (q i qi T I)µ id = ˆρ i R T (qi T d µ id )ˆq i e qi. Similar with (56) an upper bound of Y R can be obtained as Y R {δ i (k x e x + kẋ ė x ) + σ i (k R e R + k Ω e Ω ) + B} e qi (58) ˆρ i where δ i = m σ λmpp T i = δi m R. Next from (34) the timederivative of the angular velocity error projected on to the plane normal to q i is given as ˆq i ė ωi = ω + (q ω d ) q + ˆq ω d = k q e qi k ω e ωi m i l i ˆq i xi. (59) In summary the error dynamics of the simplified dynamic model are given by (55) (57) and (59). d) Stability Proof: Define an attitude configuration error function Ψ R for the payload as Ψ R = tr I R T d R which is positivedefinite about R = R d and Ψ R = e R e Ω 9 3. We also introduce a configuration error function Ψ qi for each link that is positivedefinite about q i = q id as Ψ qi = q i q id. For positive constants e xmax ψ R ψ qi B δ R consider the following open domain containing the zero equilibrium of tracking error variables: D = {(e x ė x e R e Ω e qi e ωi x R xi ) (R 3 ) 4 (R 3 R 3 ) n (R 3 ) R 3n e x < e xmax Ψ R < ψ R < Ψ qi < ψ qi < x < B δ R < B δ xi < B δ }. (6) In this domain we have e R = Ψ R ( Ψ R ) ψr ( ψ R ) α < and e qi = Ψ qi ( Ψ qi ) ψqi ( ψ qi ) α i <. It is assumed that ψ qi is sufficiently small such that nα i β <. We can show that the configuration error functions are quadratic with respect to the error vectors in the sense that e R Ψ R e R ψ R e q i Ψ qi e qi ψ qi where the upper bounds are satisfied only in the domain D. Define V = ė x + k x e x + c x e x ė x + e Ω J Ω + k R Ψ R + c R e R J e Ω + e ω i + k q Ψ qi + c q e qi e ωi where c x c R c q are positive constants. This is composed of tracking error variables only and we define another function for the estimation errors of the adaptive laws as V a = h x x + h R R + h xi xi. The Lyapunov function for the complete simplified dynamic model is chosen as V = V + V a. Let z x = e x ė x T z R = e R e Ω T z qi = e qi e ωi T R. The first part of the Lyapunov function V satisfies zx T P x z x + zr T P R z R + zq T i P qi z qi V z T x P x z x + z T R P R z R + zq T i P qi z qi
10 where the matrices P x P R P qi P x P R P qi R are given by P x = kx c x c x P R = kr c R λ c R λ λ kq c q c q P qi = P x = P R = P qi = kx c x c x kr ψ R c R λ kq ψ qi c R λ λ c q c q where λ = λ m J and λ = λ M J. If the constants c x c R c q are sufficiently small all of the above matrices are positivedefinite. As the second part of the Lyapunov function V a is already given as a quadratic form it is straightforward to see that the complete Lyapunov function V is positivedefinite and decrescent. The timederivative of the Lyapunov function along the error dynamics (55) (57) and (59) is given by V = (kẋ c x ) ė x c x k x e x c x kẋ e x ė x + (c x e x + ė x ) Y x k Ω e Ω + c R ė R J e Ω c R k R e R + c R e R ((J e Ω + d) e Ω k Ω e Ω ) + (e Ω + c R e R ) Y R + (k ω c q ) e ωi c q k q e qi c q k ω e qi e ωi + m (ė x + c x e x ) ( x + + (e Ω + c R e R ) ( R + x i ) ˆρ i R T x i ) ( n ) ˆq i (e ωi + c q e qi ) m i l xi i R R h R x x h x h xi ( x i xi + x i xi ) (6) where the last term has been obtained using the facts that x i xi = x i xi =. Substituting the adaptive laws given by (36) (37) and (38) into (6) the expressions at the last four lines of (6) that are dependent of estimation errors vanish. An upper bound of the remaining expressions of V can be obtained as follows. Since e R ė R e Ω and d B V (kẋ c x ) ė x c x k x e x c x kẋ e x ė x + (c x e x + ė x ) Y x (k Ω c R λ) e Ω c R k R e R + c R (k Ω + B) e R e Ω + (e Ω + c R e R ) Y R + (k ω c q ) e ωi c q k q e qi c q k ω e qi e ωi. (6) From (56) an upper bound of the fourth term of the righthand side is given by (c x e x + ė x ) Y x α i β(c x k x e x + c x kẋ e x ė x + kẋ ė x ) + {c x B e x + (βk x e xmax + B) ė x } e qi + α i γ(c x e x + ė x )(k R e R + k Ω e Ω ). (63) Similarly using (58) (c R e R + e Ω ) Y R α i σ i (c R k R e R + c R k Ω e R e Ω + k Ω e Ω ) + {c R B e R + (α σ i k R + B) e Ω } e qi + α i δ i (c R e R + e Ω )(k x e x + kẋ ė x ). (64) Substituting these into (6) and rearranging V zi T W i z i (65) where z i = z x z R z qi T R 3 and the matrix W i R 3 3 is defined as λ m W xi W xr i W xq i W i = W xr i λ m W Ri W Rq i (66) W xq i W Rq i λ m W qi where the submatrices are given by W xi = c x k x ( nα i β) cxkẋ ( + nα i β) n cxkẋ ( + nα i β) kẋ ( nα i β) c x W Ri = c R k R ( nα i σ i ) c R (k Ω + B + nα i σ i ) n c R (k Ω + B + nα i σ i ) k Ω ( nα i σ i ) c R λ c W qi = q k q cqkω cqkω k ω c q γcx k W xri = α R + δ i c R k x γc x k Ω + δ i k x i γk R + δ i c R kẋ γk Ω + δ i kẋ W xqi = c x B βk x e xmax + B W xri = c R B α σ i k R + B If the constants c x c R c q that are independent of the control input are sufficiently small the matrices W xi W Ri W qi are positivedefinite. Also if the error in the direction of the link is sufficiently small relative to the desired trajectory we can choose the controller gains such that the matrix W i is positivedefinite which follows that the zero equilibrium of tracking errors is stable in the sense of Lyapunov and all of the tracking error variables z i and the estimation error variables are uniformly bounded i.e. e x ė x e R e Ω e qi e ωi x R xi L. These also imply that e x ė x e R e Ω e qi e ωi L from (65) and that ė x ë x ė R ė Ω ė qi ė ωi L. According to Barbalat s lemma all of the tracking error variables e x ė x e R e Ω e qi e ωi and their timederivatives asymptotically converge to zero..
11 C. Proof of Proposition We first show that the attitude of the ith quadrotor becomes exactly equal to its desired value within a finite time i.e. R i (t) = R ic (t) for any t T for some T >. This is achieved by finitetime stability theory 7. This proof is composed of two parts: (i) s i (t) = for any t > T s for some T s < ; (ii) when the state is confined to the surface defined by s i = we have e Ri (t) = e Ωi (t) = for any t > T R for some T R <. From now on we drop the subscript i for simplicity as the subsequent development is identical for all quadrotors. From 9 the error dynamics for e Ω is given by Jė Ω = Ω Ω + M + R + J(ˆΩR T R c Ω c R T R c Ωc ). Substituting (4) s Jė Ω = k s s l s S(r s) + R B δ s (k R J + l s rjdiag j e Rj r )E(R R c )e Ω. (67) Let a Lyapunov function be W = s Js. From (4) and (4) its timederivative is given by Ẇ = s {Jė Ω + (k R J + l s rjdiag j e Rj r )E(R R c )e Ω }. Substituting (67) and (4) and using () it reduces to Ẇ = s { k s s l s S(r s) + R s s B δ} k s s l s n j= k s s l s s r+ s j r+ + B δ s B δ s where the last inequality is obtained from the fact that x α n x i α for any x = x... x n T and < α < 9 Lemma. Therefore Ẇ ɛ W ɛ W (r+)/ where ɛ = ks λ M J and ɛ = l s ( λ M J )(r+)/. This implies that s(t) = for any t T s where the settling time T s satisfies T s ɛ ( r) ln ɛ W() ( r)/ + ɛ ɛ according to 8 Remark. Next consider the second part of the proof when s =. Let a configuration error function for the attitude of a quadrotor be Ψ R = tr I R T c R. Consider a domain give by D R = {(R Ω) SO(3) R 3 Ψ R < ψ R < }. It has been shown that the following inequality is satisfied in the domain e R Ψ R e R. (68) ψ R Therefore it is positivedefinite about e R =. The timederivative of Ψ R is given by Ψ R = e R e Ω. Therefore when s = we have Ψ R = k R e R l R Substituting (68) we obtain n j= e Rj r+ k R e R l R e R r+ Ψ R ɛ 3 Ψ R ɛ 4 Ψ (r+)/ R where ɛ 3 = k R l ψ R and ɛ 4 = R ( ψ R. This implies that ) (r+)/ e R (t) = e Ω (t) = for any t T R where the settling time T R satisfies T R ɛ 3 ( r) ln ɛ 3Ψ R () ( r)/ + ɛ 4 ɛ 4. In summary whenever t T max{t s T R } it is guaranteed that R i (t) = R ic (t) for the ith quadrotor. Next we consider the reduced system which corresponds to the dynamics of the payload and the rotational dynamics of the links when R i = R ic. From (43) and (39) the control force of quadrotors when R i = R ic is given by f i R i e 3 = (u i R ci e 3 )R ci e 3 = (u i u i u i ) u i u i = u i. Therefore the reduced system is given by the controlled dynamics of the simplified model. If the controller gains k R l R k s l s are selected large such that T is sufficiently small the solution stays inside of the domain D given at (6) during t < T. After t T the controlled system corresponds to the controlled system of the simplified dynamic model and from Proposition the tracking errors asymptotically coverage to zero and the estimation error are uniformly bounded. REFERENCES L. Cicolani G. Kanning and R. Synnestvedt Simulation of the dynamics of helicopter slung load systems Journal of the American Helicopter Society vol. 4 no. 4 pp M. Bernard Generic slung load transportation system using small size helicopters in Proceedings of the International Conference on Robotics and Automation 9 pp I. Palunko P. Cruz and R. Fierro Agile load transportation IEEE Robotics and Automation Magazine vol. 9 no. 3 pp N. Michael J. Fink and V. Kumar Cooperative manipulation and transportation with aerial robots Autonomous Robots vol. 3 pp I. Maza K. Kondak M. Bernard and A. Ollero MultiUAV cooperation and control for load transportation and deployment Journal of Intelligent and Robotic Systems vol. 57 pp T. Lee K. Sreenath and V. Kumar Geometric control of cooperating multiple quadrotor UAVs with a suspended load in Proceedings of the IEEE Conference on Decision and Control Florence Italy Dec. 3 pp F. Goodarzi D. Lee and T. Lee Geometric stabilization of a quadrotor UAV with a payload connected by flexible cable in Proceedings of the American Control Conference June 4 pp T. Lee Geometric control of multiple quadrotor UAVs transporting a cablesuspended rigid body in Proceedings of the IEEE Conference on Decision and Control 4 accepted. 9 T. Lee M. Leok and N. McClamroch Geometric tracking control of a quadrotor aerial vehicle on SE(3) in Proceedings of the IEEE Conference on Decision and Control Atlanta GA Dec. pp (Acceptance Rate: 6%).
12 M. Shuster Survey of attitude representations Journal of the Astronautical Sciences vol. 4 pp T. Lee Computational geometric mechanics and control of rigid bodies Ph.D. dissertation University of Michigan 8. T. Lee M. Leok and N. McClamroch Lagrangian mechanics and variational integrators on twospheres International Journal for Numerical Methods in Engineering vol. 79 no. 9 pp F. Goodarzi D. Lee and T. Lee Geometric nonlinear PID control of a quadrotor UAV on SE(3) in Proceedings of the European Control Conference Zurich July 3 pp F. Bullo and A. Lewis Geometric control of mechanical systems ser. Texts in Applied Mathematics. New York: SpringerVerlag 5 vol. 49 modeling analysis and design for simple mechanical control systems. 5 T. Wu Spacecraft relative attitude formation tracking on SO(3) based on lineofsight measurements Master s thesis The George Washington University. 6 H. Khalil Nonlinear Systems nd Edition Ed. Prentice Hall S. Bhat and D. Bernstein Finitetime stability of continuous autonomous systems SIAM Journal of Control and Optimization vol. 38 no. 3 pp S. Yu X. Yu B. Shirinzadeh and Z. Man Continuous finitetime control for robotic manipulators with terminal slideing mode Automatica vol. 4 pp S. Wu G. Radice Y. Gao and Z. Sun Quaternionbased finite time control for spacecraft attitude tracking Acta Astronautica vol. 69 pp P. Ioannou and J. Sung Robust Adaptive Control. Prentice Hall 995.
Dynamics. Basilio Bona. DAUINPolitecnico di Torino. Basilio Bona (DAUINPolitecnico di Torino) Dynamics 2009 1 / 30
Dynamics Basilio Bona DAUINPolitecnico di Torino 2009 Basilio Bona (DAUINPolitecnico di Torino) Dynamics 2009 1 / 30 Dynamics  Introduction In order to determine the dynamics of a manipulator, it is
More informationDynamics and Control of an Elastic Dumbbell Spacecraft in a Central Gravitational Field
Dynamics Control of an Elastic Dumbbell Spacecraft in a Central Gravitational Field Amit K. Sanyal, Jinglai Shen, N. Harris McClamroch 1 Department of Aerospace Engineering University of Michigan Ann Arbor,
More informationPrecise Modelling of a Gantry Crane System Including Friction, 3D Angular Swing and Hoisting Cable Flexibility
Precise Modelling of a Gantry Crane System Including Friction, 3D Angular Swing and Hoisting Cable Flexibility Renuka V. S. & Abraham T Mathew Electrical Engineering Department, NIT Calicut Email : renuka_mee@nitc.ac.in,
More informationDynamic Analysis. Mass Matrices and External Forces
4 Dynamic Analysis. Mass Matrices and External Forces The formulation of the inertia and external forces appearing at any of the elements of a multibody system, in terms of the dependent coordinates that
More informationCONTRIBUTIONS TO THE AUTOMATIC CONTROL OF AERIAL VEHICLES
1 / 23 CONTRIBUTIONS TO THE AUTOMATIC CONTROL OF AERIAL VEHICLES MINH DUC HUA 1 1 INRIA Sophia Antipolis, AROBAS team I3SCNRS Sophia Antipolis, CONDOR team Project ANR SCUAV Supervisors: Pascal MORIN,
More information2. Dynamics, Control and Trajectory Following
2. Dynamics, Control and Trajectory Following This module Flying vehicles: how do they work? Quick refresher on aircraft dynamics with reference to the magical flying space potato How I learned to stop
More informationState of Stress at Point
State of Stress at Point Einstein Notation The basic idea of Einstein notation is that a covector and a vector can form a scalar: This is typically written as an explicit sum: According to this convention,
More informationPhysics 9e/Cutnell. correlated to the. College Board AP Physics 1 Course Objectives
Physics 9e/Cutnell correlated to the College Board AP Physics 1 Course Objectives Big Idea 1: Objects and systems have properties such as mass and charge. Systems may have internal structure. Enduring
More informationVELOCITY, ACCELERATION, FORCE
VELOCITY, ACCELERATION, FORCE velocity Velocity v is a vector, with units of meters per second ( m s ). Velocity indicates the rate of change of the object s position ( r ); i.e., velocity tells you how
More informationSolving Simultaneous Equations and Matrices
Solving Simultaneous Equations and Matrices The following represents a systematic investigation for the steps used to solve two simultaneous linear equations in two unknowns. The motivation for considering
More informationKyuJung Kim Mechanical Engineering Department, California State Polytechnic University, Pomona, U.S.A.
MECHANICS: STATICS AND DYNAMICS KyuJung Kim Mechanical Engineering Department, California State Polytechnic University, Pomona, U.S.A. Keywords: mechanics, statics, dynamics, equilibrium, kinematics,
More informationMechanics lecture 7 Moment of a force, torque, equilibrium of a body
G.1 EE1.el3 (EEE1023): Electronics III Mechanics lecture 7 Moment of a force, torque, equilibrium of a body Dr Philip Jackson http://www.ee.surrey.ac.uk/teaching/courses/ee1.el3/ G.2 Moments, torque and
More informationChapter 11 Equilibrium
11.1 The First Condition of Equilibrium The first condition of equilibrium deals with the forces that cause possible translations of a body. The simplest way to define the translational equilibrium of
More informationOnboard electronics of UAVs
AARMS Vol. 5, No. 2 (2006) 237 243 TECHNOLOGY Onboard electronics of UAVs ANTAL TURÓCZI, IMRE MAKKAY Department of Electronic Warfare, Miklós Zrínyi National Defence University, Budapest, Hungary Recent
More informationLecture L222D Rigid Body Dynamics: Work and Energy
J. Peraire, S. Widnall 6.07 Dynamics Fall 008 Version.0 Lecture L  D Rigid Body Dynamics: Work and Energy In this lecture, we will revisit the principle of work and energy introduced in lecture L3 for
More informationDesignSimulationOptimization Package for a Generic 6DOF Manipulator with a Spherical Wrist
DesignSimulationOptimization Package for a Generic 6DOF Manipulator with a Spherical Wrist MHER GRIGORIAN, TAREK SOBH Department of Computer Science and Engineering, U. of Bridgeport, USA ABSTRACT Robot
More informationRotation: Moment of Inertia and Torque
Rotation: Moment of Inertia and Torque Every time we push a door open or tighten a bolt using a wrench, we apply a force that results in a rotational motion about a fixed axis. Through experience we learn
More informationExample 4.1 (nonlinear pendulum dynamics with friction) Figure 4.1: Pendulum. asin. k, a, and b. We study stability of the origin x
Lecture 4. LaSalle s Invariance Principle We begin with a motivating eample. Eample 4.1 (nonlinear pendulum dynamics with friction) Figure 4.1: Pendulum Dynamics of a pendulum with friction can be written
More informationOperational Space Control for A Scara Robot
Operational Space Control for A Scara Robot Francisco Franco Obando D., Pablo Eduardo Caicedo R., Oscar Andrés Vivas A. Universidad del Cauca, {fobando, pacaicedo, avivas }@unicauca.edu.co Abstract This
More informationSpacecraft Dynamics and Control. An Introduction
Brochure More information from http://www.researchandmarkets.com/reports/2328050/ Spacecraft Dynamics and Control. An Introduction Description: Provides the basics of spacecraft orbital dynamics plus attitude
More informationDynamics and Control of an Elastic Dumbbell Spacecraft in a Central Gravitational Field
Dynamics and Control of an Elastic Dumbbell Spacecraft in a Central Gravitational Field Amit K. Sanyal Jinglai Shen N. Harris McClamroch Department of Aerospace Engineering University of Michigan Conference
More informationQuadcopters. Presented by: Andrew Depriest
Quadcopters Presented by: Andrew Depriest What is a quadcopter? Helicopter  uses rotors for lift and propulsion Quadcopter (aka quadrotor)  uses 4 rotors Parrot AR.Drone 2.0 History 1907  BreguetRichet
More informationAttitude Control and Dynamics of Solar Sails
Attitude Control and Dynamics of Solar Sails Benjamin L. Diedrich A thesis submitted in partial fulfillment of the requirements for the degree of Master of Science in Aeronautics & Astronautics University
More informationPID, LQR and LQRPID on a Quadcopter Platform
PID, LQR and LQRPID on a Quadcopter Platform Lucas M. Argentim unielargentim@fei.edu.br Willian C. Rezende uniewrezende@fei.edu.br Paulo E. Santos psantos@fei.edu.br Renato A. Aguiar preaguiar@fei.edu.br
More informationStability Of Structures: Basic Concepts
23 Stability Of Structures: Basic Concepts ASEN 3112 Lecture 23 Slide 1 Objective This Lecture (1) presents basic concepts & terminology on structural stability (2) describes conceptual procedures for
More informationAMIT K. SANYAL. 20012004 Ph.D. in Aerospace Engineering, University of Michigan, Ann Arbor, MI. Date of completion:
AMIT K. SANYAL Office Home 305 Holmes Hall 3029 Lowrey Avenue Mechanical Engineering Apartment # N2211 University of Hawaii at Manoa Honolulu, HI 96822 Honolulu, HI 96822 4806038938 8089562142 aksanyal@hawaii.edu
More informationForce/position control of a robotic system for transcranial magnetic stimulation
Force/position control of a robotic system for transcranial magnetic stimulation W.N. Wan Zakaria School of Mechanical and System Engineering Newcastle University Abstract To develop a force control scheme
More informationNewton s Laws of Motion
Section 3.2 Newton s Laws of Motion Objectives Analyze relationships between forces and motion Calculate the effects of forces on objects Identify force pairs between objects New Vocabulary Newton s first
More information(Most of the material presented in this chapter is taken from Thornton and Marion, Chap. 7)
Chapter 4. Lagrangian Dynamics (Most of the material presented in this chapter is taken from Thornton and Marion, Chap. 7 4.1 Important Notes on Notation In this chapter, unless otherwise stated, the following
More informationLecture L3  Vectors, Matrices and Coordinate Transformations
S. Widnall 16.07 Dynamics Fall 2009 Lecture notes based on J. Peraire Version 2.0 Lecture L3  Vectors, Matrices and Coordinate Transformations By using vectors and defining appropriate operations between
More informationLecture L19  Vibration, Normal Modes, Natural Frequencies, Instability
S. Widnall 16.07 Dynamics Fall 2009 Version 1.0 Lecture L19  Vibration, Normal Modes, Natural Frequencies, Instability Vibration, Instability An important class of problems in dynamics concerns the free
More informationMotion Control of 3 DegreeofFreedom DirectDrive Robot. Rutchanee Gullayanon
Motion Control of 3 DegreeofFreedom DirectDrive Robot A Thesis Presented to The Academic Faculty by Rutchanee Gullayanon In Partial Fulfillment of the Requirements for the Degree Master of Engineering
More informationWorldwide, space agencies are increasingly exploiting multibody dynamical structures for their most
Coupled OrbitAttitude Dynamics in the ThreeBody Problem: a Family of OrbitAttitude Periodic Solutions Davide Guzzetti and Kathleen C. Howell Purdue University, Armstrong Hall of Engineering, 71 W. Stadium
More informationAdequate Theory of Oscillator: A Prelude to Verification of Classical Mechanics Part 2
International Letters of Chemistry, Physics and Astronomy Online: 213919 ISSN: 22993843, Vol. 3, pp 11 doi:1.1852/www.scipress.com/ilcpa.3.1 212 SciPress Ltd., Switzerland Adequate Theory of Oscillator:
More informationACTUATOR DESIGN FOR ARC WELDING ROBOT
ACTUATOR DESIGN FOR ARC WELDING ROBOT 1 Anurag Verma, 2 M. M. Gor* 1 G.H Patel College of Engineering & Technology, V.V.Nagar388120, Gujarat, India 2 Parul Institute of Engineering & Technology, Limda391760,
More informationChapter 18 Static Equilibrium
Chapter 8 Static Equilibrium 8. Introduction Static Equilibrium... 8. Lever Law... Example 8. Lever Law... 4 8.3 Generalized Lever Law... 5 8.4 Worked Examples... 7 Example 8. Suspended Rod... 7 Example
More informationKINEMATICS OF PARTICLES RELATIVE MOTION WITH RESPECT TO TRANSLATING AXES
KINEMTICS OF PRTICLES RELTIVE MOTION WITH RESPECT TO TRNSLTING XES In the previous articles, we have described particle motion using coordinates with respect to fixed reference axes. The displacements,
More informationChapter 4 Dynamics: Newton s Laws of Motion. Copyright 2009 Pearson Education, Inc.
Chapter 4 Dynamics: Newton s Laws of Motion Force Units of Chapter 4 Newton s First Law of Motion Mass Newton s Second Law of Motion Newton s Third Law of Motion Weight the Force of Gravity; and the Normal
More informationDiscrete mechanics, optimal control and formation flying spacecraft
Discrete mechanics, optimal control and formation flying spacecraft Oliver Junge Center for Mathematics Munich University of Technology joint work with Jerrold E. Marsden and Sina OberBlöbaum partially
More informationTHEORETICAL MECHANICS
PROF. DR. ING. VASILE SZOLGA THEORETICAL MECHANICS LECTURE NOTES AND SAMPLE PROBLEMS PART ONE STATICS OF THE PARTICLE, OF THE RIGID BODY AND OF THE SYSTEMS OF BODIES KINEMATICS OF THE PARTICLE 2010 0 Contents
More informationOptimal Reconfiguration of Formation Flying Satellites
Proceedings of the th IEEE Conference on Decision and Control, and the European Control Conference 5 Seville, Spain, December 5, 5 MoA.6 Optimal Reconfiguration of Formation Flying Satellites Oliver Junge
More informationPrincipal Rotation Representations of Proper NxN Orthogonal Matrices
Principal Rotation Representations of Proper NxN Orthogonal Matrices Hanspeter Schaub Panagiotis siotras John L. Junkins Abstract hree and four parameter representations of x orthogonal matrices are extended
More informationChapter 24 Physical Pendulum
Chapter 4 Physical Pendulum 4.1 Introduction... 1 4.1.1 Simple Pendulum: Torque Approach... 1 4. Physical Pendulum... 4.3 Worked Examples... 4 Example 4.1 Oscillating Rod... 4 Example 4.3 Torsional Oscillator...
More informationEngineering Mechanics I. Phongsaen PITAKWATCHARA
2103213 Engineering Mechanics I Phongsaen.P@chula.ac.th May 13, 2011 Contents Preface xiv 1 Introduction to Statics 1 1.1 Basic Concepts............................ 2 1.2 Scalars and Vectors..........................
More informationINSTRUCTOR WORKBOOK Quanser Robotics Package for Education for MATLAB /Simulink Users
INSTRUCTOR WORKBOOK for MATLAB /Simulink Users Developed by: Amir Haddadi, Ph.D., Quanser Peter Martin, M.A.SC., Quanser Quanser educational solutions are powered by: CAPTIVATE. MOTIVATE. GRADUATE. PREFACE
More informationChapter 4. Forces and Newton s Laws of Motion. continued
Chapter 4 Forces and Newton s Laws of Motion continued 4.9 Static and Kinetic Frictional Forces When an object is in contact with a surface forces can act on the objects. The component of this force acting
More informationManipulator Kinematics. Prof. Matthew Spenko MMAE 540: Introduction to Robotics Illinois Institute of Technology
Manipulator Kinematics Prof. Matthew Spenko MMAE 540: Introduction to Robotics Illinois Institute of Technology Manipulator Kinematics Forward and Inverse Kinematics 2D Manipulator Forward Kinematics Forward
More informationLecture L5  Other Coordinate Systems
S. Widnall, J. Peraire 16.07 Dynamics Fall 008 Version.0 Lecture L5  Other Coordinate Systems In this lecture, we will look at some other common systems of coordinates. We will present polar coordinates
More informationMechanical Design of a 6DOF Aerial Manipulator for assembling bar structures using UAVs
Mechanical Design of a 6DOF Aerial Manipulator for assembling bar structures using UAVs R. Cano*. C. Pérez* F. Pruaño* A. Ollero** G. Heredia** *Centre for Advanced Aerospace Technologies, Seville, Spain
More informationMidterm Solutions. mvr = ω f (I wheel + I bullet ) = ω f 2 MR2 + mr 2 ) ω f = v R. 1 + M 2m
Midterm Solutions I) A bullet of mass m moving at horizontal velocity v strikes and sticks to the rim of a wheel a solid disc) of mass M, radius R, anchored at its center but free to rotate i) Which of
More informationMetrics on SO(3) and Inverse Kinematics
Mathematical Foundations of Computer Graphics and Vision Metrics on SO(3) and Inverse Kinematics Luca Ballan Institute of Visual Computing Optimization on Manifolds Descent approach d is a ascent direction
More informationModeling Mechanical Systems
chp3 1 Modeling Mechanical Systems Dr. Nhut Ho ME584 chp3 2 Agenda Idealized Modeling Elements Modeling Method and Examples Lagrange s Equation Case study: Feasibility Study of a Mobile Robot Design Matlab
More informationwww.mathsbox.org.uk Displacement (x) Velocity (v) Acceleration (a) x = f(t) differentiate v = dx Acceleration Velocity (v) Displacement x
Mechanics 2 : Revision Notes 1. Kinematics and variable acceleration Displacement (x) Velocity (v) Acceleration (a) x = f(t) differentiate v = dx differentiate a = dv = d2 x dt dt dt 2 Acceleration Velocity
More information11.1. Objectives. Component Form of a Vector. Component Form of a Vector. Component Form of a Vector. Vectors and the Geometry of Space
11 Vectors and the Geometry of Space 11.1 Vectors in the Plane Copyright Cengage Learning. All rights reserved. Copyright Cengage Learning. All rights reserved. 2 Objectives! Write the component form of
More informationGeometric Constraints
Simulation in Computer Graphics Geometric Constraints Matthias Teschner Computer Science Department University of Freiburg Outline introduction penalty method Lagrange multipliers local constraints University
More informationHomework 4. problems: 5.61, 5.67, 6.63, 13.21
Homework 4 problems: 5.6, 5.67, 6.6,. Problem 5.6 An object of mass M is held in place by an applied force F. and a pulley system as shown in the figure. he pulleys are massless and frictionless. Find
More informationOrbital Mechanics. Angular Momentum
Orbital Mechanics The objects that orbit earth have only a few forces acting on them, the largest being the gravitational pull from the earth. The trajectories that satellites or rockets follow are largely
More informationOn Motion of Robot EndEffector using the Curvature Theory of Timelike Ruled Surfaces with Timelike Directrix
Malaysian Journal of Mathematical Sciences 8(2): 89204 (204) MALAYSIAN JOURNAL OF MATHEMATICAL SCIENCES Journal homepage: http://einspem.upm.edu.my/journal On Motion of Robot EndEffector using the Curvature
More informationLecture 07: Work and Kinetic Energy. Physics 2210 Fall Semester 2014
Lecture 07: Work and Kinetic Energy Physics 2210 Fall Semester 2014 Announcements Schedule next few weeks: 9/08 Unit 3 9/10 Unit 4 9/15 Unit 5 (guest lecturer) 9/17 Unit 6 (guest lecturer) 9/22 Unit 7,
More information3D Tranformations. CS 4620 Lecture 6. Cornell CS4620 Fall 2013 Lecture 6. 2013 Steve Marschner (with previous instructors James/Bala)
3D Tranformations CS 4620 Lecture 6 1 Translation 2 Translation 2 Translation 2 Translation 2 Scaling 3 Scaling 3 Scaling 3 Scaling 3 Rotation about z axis 4 Rotation about z axis 4 Rotation about x axis
More informationTHREE DIMENSIONAL GEOMETRY
Chapter 8 THREE DIMENSIONAL GEOMETRY 8.1 Introduction In this chapter we present a vector algebra approach to three dimensional geometry. The aim is to present standard properties of lines and planes,
More informationLet s first see how precession works in quantitative detail. The system is illustrated below: ...
lecture 20 Topics: Precession of tops Nutation Vectors in the body frame The free symmetric top in the body frame Euler s equations The free symmetric top ala Euler s The tennis racket theorem As you know,
More information8.2 Elastic Strain Energy
Section 8. 8. Elastic Strain Energy The strain energy stored in an elastic material upon deformation is calculated below for a number of different geometries and loading conditions. These expressions for
More informationIdentification of Energy Distribution for Crash Deformational Processes of Road Vehicles
Acta Polytechnica Hungarica Vol. 4, No., 007 Identification of Energy Distribution for Crash Deformational Processes of Road Vehicles István Harmati, Péter Várlaki Department of Chassis and Lightweight
More informationCHAPTER 1 INTRODUCTION
CHAPTER 1 INTRODUCTION 1.1 Background of the Research Agile and precise maneuverability of helicopters makes them useful for many critical tasks ranging from rescue and law enforcement task to inspection
More information5. Forces and MotionI. Force is an interaction that causes the acceleration of a body. A vector quantity.
5. Forces and MotionI 1 Force is an interaction that causes the acceleration of a body. A vector quantity. Newton's First Law: Consider a body on which no net force acts. If the body is at rest, it will
More informationA Python Project for Lagrangian Mechanics
The 3rd International Symposium on Engineering, Energy and Environments 1720 November 2013, Pullman King Power Hotel, Bangkok A Python Project for Lagrangian Mechanics Peter Slaets 1, Pauwel Goethals
More informationRotation Rate of a Trajectory of an Algebraic Vector Field Around an Algebraic Curve
QUALITATIVE THEORY OF DYAMICAL SYSTEMS 2, 61 66 (2001) ARTICLE O. 11 Rotation Rate of a Trajectory of an Algebraic Vector Field Around an Algebraic Curve Alexei Grigoriev Department of Mathematics, The
More informationChapter 10 Rotational Motion. Copyright 2009 Pearson Education, Inc.
Chapter 10 Rotational Motion Angular Quantities Units of Chapter 10 Vector Nature of Angular Quantities Constant Angular Acceleration Torque Rotational Dynamics; Torque and Rotational Inertia Solving Problems
More informationElasticity Theory Basics
G22.3033002: Topics in Computer Graphics: Lecture #7 Geometric Modeling New York University Elasticity Theory Basics Lecture #7: 20 October 2003 Lecturer: Denis Zorin Scribe: Adrian Secord, Yotam Gingold
More informationCS3220 Lecture Notes: QR factorization and orthogonal transformations
CS3220 Lecture Notes: QR factorization and orthogonal transformations Steve Marschner Cornell University 11 March 2009 In this lecture I ll talk about orthogonal matrices and their properties, discuss
More informationHumanlike Arm Motion Generation for Humanoid Robots Using Motion Capture Database
Humanlike Arm Motion Generation for Humanoid Robots Using Motion Capture Database Seungsu Kim, ChangHwan Kim and Jong Hyeon Park School of Mechanical Engineering Hanyang University, Seoul, 133791, Korea.
More informationDYNAMICS OF A TETRAHEDRAL CONSTELLATION OF SATELLITESGYROSTATS
7 th EUROMECH Solid Mechanics Conference J. Ambrosio et.al. (eds.) Lisbon, Portugal, 7 11 September 2009 DYNAMICS OF A TETRAHEDRAL CONSTELLATION OF SATELLITESGYROSTATS Alexander A. Burov 1, Anna D. Guerman
More informationCross product and determinants (Sect. 12.4) Two main ways to introduce the cross product
Cross product and determinants (Sect. 12.4) Two main ways to introduce the cross product Geometrical definition Properties Expression in components. Definition in components Properties Geometrical expression.
More informationPhysics: Principles and Applications, 6e Giancoli Chapter 4 Dynamics: Newton's Laws of Motion
Physics: Principles and Applications, 6e Giancoli Chapter 4 Dynamics: Newton's Laws of Motion Conceptual Questions 1) Which of Newton's laws best explains why motorists should buckleup? A) the first law
More information1 Scalars, Vectors and Tensors
DEPARTMENT OF PHYSICS INDIAN INSTITUTE OF TECHNOLOGY, MADRAS PH350 Classical Physics Handout 1 8.8.2009 1 Scalars, Vectors and Tensors In physics, we are interested in obtaining laws (in the form of mathematical
More informationDiscrete Convolution and the Discrete Fourier Transform
Discrete Convolution and the Discrete Fourier Transform Discrete Convolution First of all we need to introduce what we might call the wraparound convention Because the complex numbers w j e i πj N have
More informationAPPLIED MATHEMATICS ADVANCED LEVEL
APPLIED MATHEMATICS ADVANCED LEVEL INTRODUCTION This syllabus serves to examine candidates knowledge and skills in introductory mathematical and statistical methods, and their applications. For applications
More informationA PAIR OF MEASURES OF ROTATIONAL ERROR FOR AXISYMMETRIC ROBOT ENDEFFECTORS
A PAIR OF MEASURES OF ROTATIONAL ERROR FOR AXISYMMETRIC ROBOT ENDEFFECTORS Sébastien Briot, Ilian A. Bonev Department of Automated Manufacturing Engineering École de technologie supérieure (ÉTS), Montreal,
More information11. Rotation Translational Motion: Rotational Motion:
11. Rotation Translational Motion: Motion of the center of mass of an object from one position to another. All the motion discussed so far belongs to this category, except uniform circular motion. Rotational
More information3 Orthogonal Vectors and Matrices
3 Orthogonal Vectors and Matrices The linear algebra portion of this course focuses on three matrix factorizations: QR factorization, singular valued decomposition (SVD), and LU factorization The first
More informationIMPORTANT NOTE ABOUT WEBASSIGN:
Week 8 homework IMPORTANT NOTE ABOUT WEBASSIGN: In the WebAssign versions of these problems, various details have been changed, so that the answers will come out differently. The method to find the solution
More informationEssential Mathematics for Computer Graphics fast
John Vince Essential Mathematics for Computer Graphics fast Springer Contents 1. MATHEMATICS 1 Is mathematics difficult? 3 Who should read this book? 4 Aims and objectives of this book 4 Assumptions made
More informationWHICH LINEARFRACTIONAL TRANSFORMATIONS INDUCE ROTATIONS OF THE SPHERE?
WHICH LINEARFRACTIONAL TRANSFORMATIONS INDUCE ROTATIONS OF THE SPHERE? JOEL H. SHAPIRO Abstract. These notes supplement the discussion of linear fractional mappings presented in a beginning graduate course
More informationChapter 3.8 & 6 Solutions
Chapter 3.8 & 6 Solutions P3.37. Prepare: We are asked to find period, speed and acceleration. Period and frequency are inverses according to Equation 3.26. To find speed we need to know the distance traveled
More informationHW Set VI page 1 of 9 PHYSICS 1401 (1) homework solutions
HW Set VI page 1 of 9 1030 A 10 g bullet moving directly upward at 1000 m/s strikes and passes through the center of mass of a 5.0 kg block initially at rest (Fig. 1033 ). The bullet emerges from the
More informationLab 5: Conservation of Energy
Lab 5: Conservation of Energy Equipment SWS, 1meter stick, 2meter stick, heavy duty bench clamp, 90cm rod, 40cm rod, 2 double clamps, brass spring, 100g mass, 500g mass with 5cm cardboard square
More informationChapter 7. Lyapunov Exponents. 7.1 Maps
Chapter 7 Lyapunov Exponents Lyapunov exponents tell us the rate of divergence of nearby trajectories a key component of chaotic dynamics. For one dimensional maps the exponent is simply the average
More informationα = u v. In other words, Orthogonal Projection
Orthogonal Projection Given any nonzero vector v, it is possible to decompose an arbitrary vector u into a component that points in the direction of v and one that points in a direction orthogonal to v
More informationVibrations can have an adverse effect on the accuracy of the end effector of a
EGR 315 Design Project  1  Executive Summary Vibrations can have an adverse effect on the accuracy of the end effector of a multiplelink robot. The ability of the machine to move to precise points scattered
More informationRecall that two vectors in are perpendicular or orthogonal provided that their dot
Orthogonal Complements and Projections Recall that two vectors in are perpendicular or orthogonal provided that their dot product vanishes That is, if and only if Example 1 The vectors in are orthogonal
More information2D Geometric Transformations. COMP 770 Fall 2011
2D Geometric Transformations COMP 770 Fall 2011 1 A little quick math background Notation for sets, functions, mappings Linear transformations Matrices Matrixvector multiplication Matrixmatrix multiplication
More informationChapter 2. Derivation of the Equations of Open Channel Flow. 2.1 General Considerations
Chapter 2. Derivation of the Equations of Open Channel Flow 2.1 General Considerations Of interest is water flowing in a channel with a free surface, which is usually referred to as open channel flow.
More informationBead moving along a thin, rigid, wire.
Bead moving along a thin, rigid, wire. odolfo. osales, Department of Mathematics, Massachusetts Inst. of Technology, Cambridge, Massachusetts, MA 02139 October 17, 2004 Abstract An equation describing
More informationA Control Scheme for Industrial Robots Using Artificial Neural Networks
A Control Scheme for Industrial Robots Using Artificial Neural Networks M. Dinary, AbouHashema M. ElSayed, Abdel Badie Sharkawy, and G. Abouelmagd unknown dynamical plant is investigated. A layered neural
More informationPath Tracking for a Miniature Robot
Path Tracking for a Miniature Robot By Martin Lundgren Excerpt from Master s thesis 003 Supervisor: Thomas Hellström Department of Computing Science Umeå University Sweden 1 Path Tracking Path tracking
More informationNonlinear analysis and formfinding in GSA Training Course
Nonlinear analysis and formfinding in GSA Training Course Nonlinear analysis and formfinding in GSA 1 of 47 Oasys Ltd Nonlinear analysis and formfinding in GSA 2 of 47 Using the GSA GsRelax Solver
More informationPower Electronics. Prof. K. Gopakumar. Centre for Electronics Design and Technology. Indian Institute of Science, Bangalore.
Power Electronics Prof. K. Gopakumar Centre for Electronics Design and Technology Indian Institute of Science, Bangalore Lecture  1 Electric Drive Today, we will start with the topic on industrial drive
More informationOrthogonal Projections
Orthogonal Projections and Reflections (with exercises) by D. Klain Version.. Corrections and comments are welcome! Orthogonal Projections Let X,..., X k be a family of linearly independent (column) vectors
More information1996 IFAC World Congress San Francisco, July 1996
1996 IFAC World Congress San Francisco, July 1996 TRAJECTORY GENERATION FOR A TOWED CABLE SYSTEM USING DIFFERENTIAL FLATNESS Richard M. Murray Mechanical Engineering, California Institute of Technology
More information