Method for controlling vibration of flexible mechanical arm based on cooperative tracking
12017357 ยท 2024-06-25
Assignee
Inventors
Cpc classification
B25J9/1682
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1615
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1664
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1605
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A method for controlling vibration of flexible mechanical arms based on cooperative tracking is disclosed, including: building a dynamic model of the flexible mechanical arm, according to a dynamic characteristic, constructing a flexible mechanical arm group made up of a plurality of flexible mechanical arms, assigning one of the plurality of flexible mechanical arms as a leader and the rest ones as followers which are required to track the leader's motion trajectory so as to realize cooperative work; designing cooperative control-based boundary controllers in combination with a Lyapunov method to realize cooperative work and suppress vibration of the flexible mechanical arms; and constructing a Lyapunov function using Lyapunov direct method to validate stability of the flexible mechanical arms under the control.
Claims
1. A method for controlling vibration of a plurality of flexible mechanical arms based on cooperative tracking, the method comprising: kinematic each of establishing a dynamic model equation for each of the plurality of flexible mechanical arms, according to characteristics of the flexible mechanical arms including kinetic energy, potential energy, and virtual work done by non-conservative force acting on the flexible mechanical arm; assigning one of the plurality of flexible mechanical arms as a leader and the rest ones as followers which need to track the leader's motion trajectory; designing cooperative tracking-based boundary controllers based on the plurality of flexible mechanical arms; constructing a Lyapunov function for each of the plurality of flexible mechanical arms based on the dynamic model equation and the boundary controllers; and validating stability of each of the plurality of flexible mechanical arms, according to the Lyapunov function, wherein the dynamic model equation is obtained by substituting the kinetic energy, the potential energy, and the virtual work into Hamilton's principle, and the kinematic model equation is as follows:
2. The method of claim 1, wherein assigning one of the plurality of flexible mechanical arms as the leader and the rest ones as the followers, and designing the boundary controller includes: defining an auxiliary variable as follows:
3. The method of claim 2, wherein the Lyapunov function for each of the flexible mechanical arms is constructed as follows: V.sub.i=V.sub.1i+V.sub.2i+V.sub.3i, where
4. The method of claim 1, wherein validating stability of the flexible mechanical arm, according to the Lyapunov function, includes: proving, by validating a positive definiteness of the Lyapunov function, the flexible mechanical arm is stable in a Lyapunov theory; and proving, by validating a negative definiteness of the first derivative of the Lyapunov function, the flexible mechanical arm is asymptotically stable.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
DETAILED DESCRIPTION OF THE EMBODIMENTS
(4) In order to make the object, technical solutions, and advantages of embodiments in the present disclosure clearer, the technical solutions of the embodiments will be described more clearly and completely according to accompanying drawings in the embodiments in the present disclosure. Apparently, the described embodiments are part of the embodiments of the present disclosure, rather than all of the embodiments. Based on the embodiments of the present disclosure, all other embodiments obtained by those ordinary technicians without creative work shall be within the scope of the present disclosure.
Embodiments
(5) Referring to
(6) At S101, a dynamic model of the flexible mechanical arm is built according to a dynamic characteristic of the flexible mechanical arm.
(7) As shown in
(8) Kinetic energy of the flexible mechanical arm may be represented as:
(9)
(10) where E.sub.ki represents kinetic energy of an i.sup.th flexible mechanical arm, ? represents a uniform mass per unit length of the flexible mechanical arm, y.sub.i(x,t) represents an elastic deformation of the i.sup.th flexible mechanical arm at time t and location x in the XOY coordinate system and is abbreviated as y.sub.i, and {dot over (y)}.sub.i(x,t) is the first derivative of y.sub.i(x,t) with respect to time and is abbreviated as {dot over (y)}.sub.i, {dot over (y)}.sub.i(l,t) represents a value of y.sub.i(x,t) at x=l, m represents a tip mass of the flexible mechanical arm, l represents a length of the flexible mechanical arm, r represents a radius of a rigid hub, I.sub.h represents a hub inertia, ?.sub.i represents an attitude angle, and {dot over (?)}.sub.i is the first derivative of ?.sub.i with respect to time.
(11) Potential energy of the flexible mechanical arm is represented as:
(12)
(13) where w.sub.i(x,t) represents a vibration offset of the i.sup.th flexible mechanical arm in the xoy coordinate system and is abbreviated as w.sub.i, w.sub.i(x,t) and w.sub.i(x,t) represent the first and second derivative of w.sub.i(x,t) with respect to x and are abbreviated as w.sub.i and w.sub.i respectively, T represents a tension, and EI represents a bending stiffness.
(14) And virtual work done by non-conservative forces acting on the flexible mechanical arm is represented as:
(15)
(16) where ? represents a variational symbol, ? represents a viscous damping coefficient, u.sub.1i and u.sub.2i represent controllers located at the tip and the fixed end of the flexible mechanical arm respectively, and y.sub.i(l,t) represents a value of y.sub.i(l,t) at x=l.
(17) By substituting the kinetic energy, the potential energy, and the virtual work into Hamilton's principle, a dynamic model equation for the flexible mechanical arm is obtained as follows:
(18)
(19) where {dot over (w)}.sub.i(x,t) and {umlaut over (w)}.sub.i(x,t) represent the first and second derivative of w.sub.i(x,t) with respect to time and are abbreviated as {dot over (w)}.sub.i and {umlaut over (w)}.sub.i respectively, w.sub.i(x,t) and w.sub.i(x,t) represent the third and fourth derivative of w.sub.i(x,t) with respect to x and are abbreviated as w.sub.i and w.sub.i respectively, {umlaut over (?)}.sub.i represents the second derivative of the attitude angle ?.sub.i with respect to time, w.sub.i(0,t) represents a value of w.sub.i(x,t) at x=0, w.sub.i(0,t) represents a value of w.sub.i(x,t) at x=0, w.sub.i(l,t) represents a value of w.sub.i(x,t) at x=l, and ?t|[0,?).
(20) A boundary condition is presented as follows:
(21)
(22) where {dot over (w)}.sub.i(l,t) represents a value of {dot over (w)}.sub.i(x,t) at x=l, {umlaut over (w)}.sub.i(l,t) represents a value of {umlaut over (w)}.sub.i(x,t) at x=l, w(l,t) represents a value of w.sub.i(x,t) at x=l, w.sub.i(l,t) represents a value of w.sub.i(x,t) at x=l, u.sub.1i represents a controller at the tip position of the flexible mechanical arm, w.sub.i(0,t) represents a value of w.sub.i(x,t) at x=0, and w.sub.i(0,t) represents a value of w.sub.i(x,t) at x=0.
(23) At S102, based on the flexible mechanical arm, a flexible mechanical arm group is made up of a plurality of flexible mechanical arms, one of which is assigned as a leader, and the rest ones are followers. Then the boundary controllers are constructed based on cooperative tracking.
(24) As shown in
(25) In order to reduce or eliminate vibration of the flexible mechanical arm and to achieve cooperative tracking of the plurality of flexible mechanical arms, a kind of cooperative tracking-based boundary controller is constructed. Details are as follows
(26) An auxiliary variable is defined as:
(27)
(28) where A=[?.sub.ij]?R.sup.k?k is a non-negative matrix and is defined that if there is information communication between two flexible mechanical arms, then ?.sub.ij>0, otherwise ?.sub.ij=0; B=diag(b.sub.10, b.sub.20, . . . , b.sub.k0) is a non-negative diagonal matrix and is defined that if there is information communication between the leader and the follower, then b.sub.i0>0, otherwise, b.sub.i0=0; and v is a positive constant, ?.sub.0 represents an attitude angle of the flexible mechanical arm as the leader, and ?.sub.i and ?.sub.j represent attitude angles of the i.sup.th and j.sup.th flexible mechanical arms respectively.
(29) A generalized tracking error, a second tracking error, and a virtual control amount are respectively defined as:
(30)
(31) where {dot over (?)}.sub.ri i is the first derivative of ?.sub.ri with respect to time.
(32) A variables is defined as follows:
(33)
(34) y.sub.ei(x,t) is abbreviated as y.sub.ei.
(35) Boundary controllers are constructed as follows:
(36)
(37) where {dot over (y)}.sub.ei(x,t) represents the first derivative of y.sub.ei (x,t) with respect to time, and {dot over (y)}.sub.ei(l,t) represents a value of {dot over (y)}.sub.ei(x,t) at x=l.
(38) S.sub.1i, and S.sub.2i are proposed as follows:
(39)
(40) where {dot over (y)}.sub.i(l,t) represents a value of {dot over (y)}.sub.i(x,t) at x=l, y.sub.ei(l,t) represents a value of y.sub.ei(x,t) at x=l, and ?, ?, k.sub.m, k.sub.p1, k.sub.p3 and k.sub.d are gain parameters of the boundary controller and all are greater than 0.
(41) Most of the existing researches on vibration control of the flexible mechanical arm focus on a single flexible mechanical arm system, and many of them adopt PID control, robust control, and so on. In this embodiment, the auxiliary variable represents information communication relationship among the flexible mechanical arms, and then two boundary controllers located at the fixed end and the tip respectively are constructed, so that not only vibration suppression effect can be achieved, but also the effect of cooperative tracking of these multiple flexible mechanical arms are achieved. All of the above signals can be obtained by sensors or calculations.
(42) At S103, A Lyapunov function for the flexible mechanical arm is constructed based on the flexible mechanical arm and the boundary controllers.
(43) The Lyapunov function is constructed as:
(44)
where V.sub.1i, V.sub.2i and V.sub.3i are as follows respectively:
(45)
(46) At S104, stability of the flexible mechanical arm is validated according to the Lyapunov function. In this step, A Lyapunov direct method is used to validate the stability of the flexible mechanical arm.
(47) In this embodiment, if the flexible mechanical arm meets a preset requirement, that is, the stability of the flexible arms in Lyapunov theory can be drawn from the fact that the Lyapunov function is validated positive definite.
(48) By validating the Lyapunov function with the first derivative negative definite, it is obtained that the flexible mechanical arm is asymptotically stable.
(49) In this embodiment, the positive definiteness of the Lyapunov function is validated as follows.
(50) According to an inequality ab??(a.sup.2+b.sup.2), it may be obtained that:
(51)
(52) According to the equation (16), it may be determined that the Lyapunov function is positive definite, i.e.
(53)
The positive definiteness of the Lyapunov function is validated.
(54) The negative definiteness of the first derivative of the Lyapunov function is validated as follows.
(55) The derivative of V.sub.i(t) with respect to time is taken as:
(56)
(57) Calculating the derivative of V.sub.1i, V.sub.2i and V.sub.3i in (16) with respect to time and then adding them together, it can be obtained that:
(58)
(59) where ? and ? are positive constants.
(60) Appropriate parameters should be selected as follows:
(61)
(62) It is obtained that {dot over (V)}.sub.i?0, i.e., {dot over (V)}.sub.i is semi-negative definiteness.
(63) From (21), it can be obtained that:
(64)
(65) When ? meets the following conditions:
(66)
(67) Multiplying both sides of (25) by e.sub.?t, it can be obtained that:
(68)
(69) Thus, it holds that
(70)
(71) According to the above analysis, the stability of the flexible mechanical arm based on cooperative tracking is validated.
(72) It should be noted that, referring to
(73) Appropriate gain parameters are selected to validate the positive definiteness of the Lyapunov function and the negative definiteness of the first derivative of the Lyapunov function.
(74) In this embodiment, the numerical simulations of the flexible arms can be conducted on MATLAB and then the corresponding simulation results can be obtained. According to the simulation results, it can be judged whether the control effect of the flexible mechanical arm under control can meet expectations. If it is, the operation can be ended. If not, the gain parameters of the boundary controller should be corrected and the numerical simulation should be performed again.
(75) In summary, the present embodiment provides a method for controlling vibration of a flexible mechanical arm based on cooperative tracking, including: building a dynamic model of the flexible mechanical arm; constructing a flexible mechanical arm group made up of a plurality of flexible mechanical arms, assigning one of the plurality of flexible mechanical arms as a leader and the rest ones as followers; determining information communication relationship, and designing cooperative tracking-based boundary controllers located at a fixed end and a tip position of the flexible mechanical arm respectively; and validating stability of the flexible mechanical arm under control. The disclosure can realize the control of the flexible mechanical arms more stably and accurately, and can also realize the cooperative tracking of the flexible mechanical arm.
(76) The above-mentioned embodiments are preferred embodiments of the present disclosure, but embodiments of the present disclosure are not limited to the above-mentioned embodiments. Any other changes, modifications, substitutions, combinations, and simplifications which do not depart from the spirit and principles of the present disclosure are intended to be equivalent permutations and are included within the scope of the present disclosure.