The control strength quantification analysis of outer pendulum rod for double inverted pendulum
Wencong Fu^{1} , Chan Wang^{2} , Peng Xu^{3} , Yuanhong Dan^{4}
^{1, 2, 3}School of Electrical and Electronic Engineering, Chongqing University of Technology, Chongqing, China
^{4}School of Computer Science and Engineering, Chongqing University of Technology, Chongqing, China
^{1}Corresponding author
Vibroengineering PROCEDIA, Vol. 28, 2019, p. 99-104.
https://doi.org/10.21595/vp.2019.21040
Received 19 September 2019; accepted 28 September 2019; published 19 October 2019
JVE Conferences
Due to the complexity of the dynamics characteristics of an inverted pendulum, and the problem that the linearization analyze method cannot satisfy the controlling requirement, a nonlinear dynamics analyze method was proposed. Through decoupling the dynamics model of a double inverted pendulum, the outer pendulum rod motion equation was derived. And then, aiming at the control strength function of outer pendulum rod, the qualitative and quantitative relationship between spatial position of pendulum rod and the control strength of outer rod, and the quantification relationship between dynamics parameters and the control strength of outer rod were separately analyzed. And the simulation verified the correctness of the analysis.
- The structure of rotary double pendulum and its coordinate system
- Nonlinear dynamics analysis method
- simulation verified
Keywords: double inverted pendulum, quantification analysis, control strength of outer rod, dynamics parameter, spatial position of pendulum.
1. Introduction
The inverted pendulum is a classical underactuated mechanical system with nonholonomic constraints. Such kind of non-completely controllable system is important for the dynamics characteristic analysis. In article [1], the method based on Lyapunov stability theorem to conduct the stability control of rotating inverted pendulum was adopted. Jiang built up the mathematical model for rotary inverted pendulum with Lagrange function [2]. The parameter identification for the physical model of two-link and three-link was done through the least square method [3, 4]. The stability control of triple inverted pendulum with cloud control method was realized in [5]. And the stability control of quadruple inverted pendulum with variable universe fuzzy control algorithm was firstly realized in [6]. The controllability of double inverted pendulum and triple inverted pendulum close to equilibrium points with linearization method was analyzed in [4, 8]. But it is not suitable for the area except equilibrium point. Liu applied the Lyapunov exponent formed by state equation to express the motion stability of the system [9]. It is an efficient method to evaluate the quality of closed-loop system after the fact. But with little valueness for designing the controlling system beforehand. The angular acceleration expression of passive joint was derived through dynamics decoupling for a class of rootless underactuated systems in [10]. And simulation and analysis of the controllability of passive joint were carried out. But the quantification relationship between control input and passive joint did not get further discuss. Also, the quantification relationship between physical parameters and system controlling characteristics did not get further study in most relative researches.
The article mainly discussed the control strength quantification analysis of outer pendulum rod for double inverted pendulum. In Section 2, through decoupling the dynamics model, the outer pendulum rod action strength function was derived. In Section 3, the strength analysis, including maximum positive control and maximum negative control, of the outer pendulum rod and the quantification analysis of dynamics parameters and control strength of the outer rod were mainly discussed. Section 4 includes the discussion and analysis of simulation results. Section 5 presents the concluding remarks.
2. Mathematical model and dynamics decoupling
2.1. Mathematical model
The coordinate system was established shown in Fig. 1.
From [11], the mathematical model of the double inverted pendulum can be derived as:
where:
${M}_{23}={M}_{32}={k}_{4}\mathrm{cos}\left({\theta}_{1}-{\theta}_{2}\right),{M}_{31}={k}_{3}\mathrm{cos}{\theta}_{2},\Theta ={\left[\begin{array}{ccc}{\theta}_{0}& {\theta}_{1}& {\theta}_{2}\end{array}\right]}^{T},$
${C}_{21}=-\frac{1}{2}\left({J}_{1}+{m}_{1}{{l}_{1}}^{2}+{m}_{2}{{L}_{1}}^{2}\right){\dot{\theta}}_{0}\mathrm{sin}2{\theta}_{1}-{k}_{4}{\dot{\theta}}_{0}\mathrm{cos}{\theta}_{1}\mathrm{sin}{\theta}_{2}-\frac{1}{2}{m}_{b}{{L}_{1}}^{2}{\dot{\theta}}_{0}\mathrm{sin}2{\theta}_{1},$
${C}_{22}={c}_{1}+{c}_{2},{C}_{23}={k}_{4}{\dot{\theta}}_{2}\mathrm{sin}\left({\theta}_{1}-{\theta}_{2}\right)-{c}_{2},{C}_{33}={c}_{2},$
${C}_{31}=-\frac{1}{2}{k}_{5}{\dot{\theta}}_{0}\mathrm{sin}2{\theta}_{2}-{k}_{4}{\dot{\theta}}_{0}\mathrm{sin}{\theta}_{1}\mathrm{cos}{\theta}_{2},{C}_{32}=-{k}_{4}{\dot{\theta}}_{1}\mathrm{sin}\left({\theta}_{1}-{\theta}_{2}\right)-{c}_{2}.$
The state variables and physical parameters of the rotating secondary inverted pendulum were defined as follows: ${m}_{1}$, ${m}_{2}$, ${m}_{b}$ are the mass of inner rod, outer rod and encoder. ${l}_{1}$, ${l}_{2}$ are the centroid position of inner and outer rod. ${L}_{0}$, ${L}_{1}$ are the length of horizontal rotating rod and inner rod. ${c}_{1}$, ${c}_{2}$ are the rotational friction of cart-inner rod and inner rod-outer rod axis. ${J}_{1}$, ${J}_{2}$ represent the moment of inertia of inner and outer rod. ${\theta}_{0}$, ${\theta}_{1}$, ${\theta}_{2}$ represent the angle of the horizontal rotating rod, and the inner and outer rod. ${\dot{\theta}}_{0}$, ${\dot{\theta}}_{1}$, ${\dot{\theta}}_{2}$ represent the angular speed of the horizontal rotating rod, and the inner and outer rod. And $u$ is the control variable.
Fig. 1. The structure of rotary double pendulum and its coordinate system
2.2. Dynamics decoupling
The meaning of the physical parameters abbreviation in the mathematical model, and the derivation of the outer rod motion equation are shown as follows:
${k}_{4}={m}_{2}{l}_{2}{L}_{1},{k}_{5}={J}_{2}+{m}_{2}{{l}_{2}}^{2},{k}_{6}={m}_{1}{l}_{1}+{m}_{2}{L}_{1}+{m}_{b}{L}_{1},{k}_{7}={m}_{2}{l}_{2},$
${\ddot{\theta}}_{2}=K\left[{K}_{u2}u+{K}_{g2}g+{K}_{v02}{{\dot{\theta}}_{0}}^{2}+{K}_{v12}{{\dot{\theta}}_{0}}^{2}+{K}_{v22}{{\dot{\theta}}_{0}}^{2}+{K}_{e12}{{\dot{\theta}}_{0}}^{2}+{K}_{e22}(\dot{{\theta}_{1}}-\dot{{\theta}_{2}})\right].$
Then, the expressions of the intensity function factor ${K}_{u2}$ in Eq. (2) is shown as follow:
3. Quantitative analysis of spatial position of rod and control strength of the outer rod
$\mathrm{cos}{\theta}_{1}\mathrm{cos}\left({\theta}_{1}-{\theta}_{2}\right)$ is a continuous derivable function. Therefore:
Substituting Eq. (4) into $\mathrm{cos}{\theta}_{1}\mathrm{cos}\left({\theta}_{1}-{\theta}_{2}\right)$:
3.1. Analysis of maximum positive control strength for outer rod
In Eq. (7), the ${K}_{u2}$ is the relative maximum, when the outer rod angle is ${\widehat{\theta}}_{2}$.
Considering that ${K}_{u2}$ is a continuous derivable function, the derivative is zero at the relative maximum value of ${K}_{u2}$. Then, ${\widehat{\theta}}_{2}$ can be obtained in Eq. (8).
Substitute $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}=0$ into Eq. (7): $\mathit{max}\left({K}_{u2}\right)=\frac{1}{2}{k}_{1}{k}_{4}={k}_{2}{k}_{3}$.
For any given ${\theta}_{2}$, if the inner rod angle ${\theta}_{1}=\frac{2n\pi +{\theta}_{2}}{2}$, ${K}_{u2}$ achieves the highest controllability.
Substitute $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}\ne 0$ into Eq. (8): ${\widehat{\theta}}_{2}=n\pi $, $\left(n\in Z\right)$ and:
When $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}>0$, Eq. (10) is the global maximum. Then, ${\theta}_{2}=(2n+1)\pi $, and ${\theta}_{1}=(n+\frac{1}{2})\pi (n\in Z)$. The spatial position of inner and outer rods are shown in Fig. 2.
For the same reason, Eq. (9) is the global maximum when $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}<0$. At this time, the outer rod angle ${\theta}_{2}=2n\pi $ and the inner rod angle ${\theta}_{1}=n\pi $ shown in Fig. 3.
Fig. 2. The angle of both rods on max ${K}_{u2}$ when $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}>0$
Fig. 3. The angle of both rods on max ${K}_{u2}$ when $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}<0$
3.2. Analysis of maximum negative control strength for outer rod
For the same reason, the minimum value $\mathrm{m}\mathrm{i}\mathrm{n}\left({K}_{u2}\right)$ can be obtained in Eq. (11):
In Eq. (12), for any given ${\theta}_{2}$, the outer rod obtains the reverse maximum controllability when ${\theta}_{1}=n\pi +\frac{{\theta}_{2}}{2}$. In Eq. (13), ${\theta}_{2}=2n\pi $, ${\theta}_{1}=\frac{\left(2n+1\right)\pi +{\theta}_{2}}{2}=n\pi +\frac{\pi}{2}(n\in Z)$ shown in Fig. 4. In Eq. (14), ${\theta}_{2}=(2n+1)\pi $, the inner rod angle ${\theta}_{1}=\frac{\left(2n+1\right)\pi +{\theta}_{2}}{2}=n\pi (n\in Z)$ shown in Fig. 5.
Fig. 4. The angle of both rods on min ${K}_{u2}$ when $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}>0$
Fig. 5. The angle of both rods on min ${K}_{u2}$ when $2{k}_{2}{k}_{3}-{k}_{1}{k}_{4}<0$
3.3. Quantification analysis of dynamics parameters and control strength of outer rod
It can be inferred from the Eq. (15) that ${l}_{1}$ has no relationship with the control strength of outer rod ${K}_{u2}$. Besides that, simulations of dynamics parameters including rotating arm length ${L}_{0}$, the inner rod mass ${m}_{1}$, the outer rod length and mass ${l}_{2}$, ${m}_{2}$ are shown in Section 4.
The relationship of inner rod mass ${m}_{1}$ and control strength of outer rod can be simplified as:
$c=\frac{{L}_{0}}{{l}_{2}}\left[2\mathrm{cos}{\theta}_{1}\mathrm{cos}\left({\theta}_{1}-{\theta}_{2}\right)-\frac{4}{3}\mathrm{cos}{\theta}_{2}\right],b=\frac{9}{4}{m}_{2}\left[\frac{1}{3}+\mathrm{sin}{\left({\theta}_{1}-{\theta}_{2}\right)}^{2}\right]+3{m}_{b},$
$a=\frac{16}{9}\left\{{4m}_{2}\left[\frac{1}{3}+\mathrm{sin}{\left({\theta}_{1}-{\theta}_{2}\right)}^{2}\right]+\frac{16}{3}{m}_{b}\right\}\left[2\mathrm{cos}{\theta}_{1}\mathrm{cos}\left({\theta}_{1}-{\theta}_{2}\right)-\frac{4}{3}\mathrm{cos}{\theta}_{2}\right]$
$+\frac{16}{9}\left[{4m}_{2}\mathrm{cos}{\theta}_{1}\mathrm{cos}\left({\theta}_{1}-{\theta}_{2}\right)+{m}_{b}\mathrm{cos}{\theta}_{1}\right].$
It is clear that $b>0$. When $a>0$, $c>0$, ${K}_{u2}\in \left[c,\frac{a}{b}+c\right]$, the $\left|{K}_{u2}\right|$ decrease with ${m}_{1}$. When $a>0$, $c<0$, ${K}_{u2}\u03f5\left[c,\frac{2}{b}+c\right]$, $\left|{K}_{u2}\right|$ increases with ${m}_{1}$, if $\frac{a}{b}+c>0$, $\left|{K}_{u2}\right|$ decreases before ${m}_{1}$ passing zero point. When $a<0$, $c<0$, ${K}_{u2}\u03f5\left[\frac{a}{b}+c,c\right]$, $\left|{K}_{u2}\right|$ decreases with ${m}_{1}$. When $a<0$, $c>0$, $\left|{K}_{u2}\right|$ increases with ${m}_{1}$, if $\frac{a}{b}+c<0$, $\left|{K}_{u2}\right|$ decreases before ${m}_{1}$ passing zero point.
Also, the relationship between ${m}_{1}$ and ${K}_{u2}$ can be simplified as:
The analyzing process is similar to ${m}_{1}$. With different dynamics parameters, three situations such as increasing, decreasing, decreasing first and then increasing exist for the control strength of outer rod. The simulation under different spatial position is given in Section 4.
4. The simulation verification of control strength for outer rod
In order to verify the analysis process and conclusion mentioned above, the equivalent dynamics parameters [11] were put into Eq. (3). Then, calculate the ${K}_{u2}$ within the range of pendulum angles ${\theta}_{1},{\theta}_{2}\in \left[-2\pi ,2\pi \right]$. Finally, the 3D surface graphs were drawn as follow.
Fig. 6 and Fig. 7 show the relationship between ${K}_{u2}$ and rod angles from different perspectives. In these figures, the red area indicates the part in which ${K}_{u2}$ is greater (the deep red shows the maximum of ${K}_{u2}$). And the blue area is the part which ${K}_{u2}$ is smaller. Also, when ${K}_{u2}$ reaches the maximum, the outer rod angles could be $\pm \pi $, and the inner rod angles could be $\pm \frac{\pi}{2}$, $\pm \frac{3\pi}{2}$. And when ${K}_{u2}$ reaches the minimum, the outer rod angles could be $0,\pm 2\pi $, and the inner rod angles could be $\pm \frac{\pi}{2}$, $\pm \frac{3\pi}{2}$. Finally, the rod angles with the maximum and the minimum of ${K}_{u2}$ from Fig. 7 fit the rod angles derived from Eq. (10) and Eq. (13) separately which verified the correctness of analysis about the extremum of ${K}_{u2}$ mentioned above.
The simulation result of control strength of outer rod and dynamics parameters including ${L}_{0}$, ${l}_{2}$, ${m}_{1}$, and ${m}_{2}$, were separately shown in Fig. 8, Fig. 9, Fig. 10 and Fig. 11.
Fig. 6. The perspective view between ${K}_{u2}$ and ${\theta}_{1},{\theta}_{2}$
Fig. 7. The left and right view between ${K}_{u2}$ and ${\theta}_{1},{\theta}_{2}$
Fig. 8. The relationship between ${L}_{0}$ and ${K}_{u2}$
a) Inverted point
b) Hanging point
c) Horizontal point
Fig. 9. The relationship between ${l}_{2}$ and ${K}_{u2}$
a) Inverted point
b) Hanging point
c) Horizontal point
Fig. 10. The relationship between the mass of inner rod ${m}_{1}$ and ${K}_{u2}$
a) Down point, ${K}_{u2}$ increases with ${m}_{1}$
b) Spatial position of rods (80°, 110°), ${K}_{u2}$ decreases with ${m}_{1}$
It can be inferred from those figures that the dynamics parameters are positively or negatively correlated with ${K}_{u2}$. For the parameters ${L}_{0}$, ${l}_{2}$, the influence for ${K}_{u2}$ is much greater than ${m}_{1}$, ${m}_{2}$. And the ${K}_{u2}$ hardly changes with ${m}_{1}$, ${m}_{2}$. Hence, adjusting ${l}_{2}$ could be the main method to satisfy ${K}_{u2}$. However, in the actual system, the improvement of the control action intensity does not mean that the control difficulty is low. And it is also necessary to comprehensively consider that the dynamic and static characteristics such as the servo precision and response speed of the drive mechanism (motor, controller, transmission mechanism).
Fig. 11. The relationship between the mass of inner rod ${m}_{2}$ and ${K}_{u2}$
a) Down point, ${K}_{u2}$ decreases with ${m}_{2}$
b) Spatial position of bars (80°,110°), ${K}_{u2}$ increases with ${m}_{2}$
5. Conclusions
In this article, the control strength quantification analysis of the outer pendulum rod for double inverted pendulum was mainly discussed from two perspectives. One is the qualitative and quantitative relationship between the control strength of the outer rod and the spatial position of the pendulum rod. And the other is the quantification relationship between the control strength of the outer rod and the dynamics parameters (including the length of pendulum rod ${L}_{0}$, ${l}_{1}$, ${l}_{2}$, and the mass of pendulum rod ${m}_{1}$, ${m}_{2}$). Finally, the correctness of the relationship was illustrated by simulation results.
References
- Wen Jie, Shi Yuanhao, Lu Xiaonong Stabilizing a rotary inverted pendulum based on logarithmic Lyapunov function. Journal of Control Science and Engineering, Vol. 2017, 2017, p. 4091302. [Publisher]
- Jiang Xiangju, Liu Erlin Research and realization of the initial and stable pendulum of rotating inverted pendulum. Journal of Process Automation Instrumentation, Vol. 9, 2016, p. 6-9. [CrossRef]
- Zhu Qiuguo, Wu Haoxian, Yi Jiang, Xiong Rong, Wu Jun Push recovery for humanoid robots with passive damped ankles. Proceedings of the IEEE Conference on Robotics and Biomimetics, Zhuhai, China, 2015, p. 1578-1583. [CrossRef]
- Zhu Qiuguo, Wu Haoxian, Wu Jun, Xiong Rong Humanoid robot standing balance control based on three-link dynamics model. Journal of Robot, Vol. 4, 2016, p. 451-457. [CrossRef]
- Zhang Feizhou, Li Yide Realization of intelligent control of inverted pendulum with cloud model. Journal of Control Theory and Applications, Vol. 4, 2000, p. 519-523. [CrossRef]
- Miao Zhihong, Li Hongxing Fuzzy control of robust guaranteed cost of plane motion N-th inverted pendulum. Journal of Huazhong University of Science and Technology (Natural Science Edition), Vol. 3, 2014, p. 62-74. [CrossRef]
- Bo Guizhen, Mei Xiaorong, Wang Shuyi Establishment of mathematical model and controllability of triple inverted pendulum on inclined orbit. Journal of Electric Machines and Control, Vol. 2, 2003, p. 170-173. [CrossRef]
- Dan Yuanhong, Lai Hongxia Modeling and analysis of observability and controllability of annular double inverted pendulum. Journal of Chongqing University of Technology (Natural Science), Vol. 11, 2007, p. 7-16. [CrossRef]
- Liu Yunping, Li Yu, Chen Cheng, Zhang Yonghong Stability of nonholonomic system based on lyapunov index. Journal of Huazhong University of Science and Technology (Natural Science Edition), Vol. 12, 2016, p. 98-101. [CrossRef]
- Li Na, Zhao Tieshi, Jiang Haiyong, Wang Jiazhong Dynamics coupling characteristics of rootless underactuated redundant robots. Journal of Mechanical Engineering, Vol. 9, 2016, p. 49-55. [Publisher]
- Dan Yuanhong, Xu Peng, Zhang Wei, Tan Zhi Improved genetic algorithm for parameters identification of cart-double pendulum. Journal of Vibroengineering, Vol. 21, Issue 6, 2019, p. 1587-1599. [Publisher]