Abstract
This paper investigates the nonlinear control of a three-link planar robot, which includes a passive first link, a passive second link, and an active last link (subsequently referred to as the PPA robot). Notably, only the angle between the last link and the vertical axis is actuated. First, this paper presents and strictly proves a property of the PPA robot, unaffected by its mechanical parameters. This property reveals that the two passive links of the PPA robot maintain static positions when the active last link remains fixed under a constant control input. Different from previous studies, the proof for the PPA robot demonstrates new challenges and distinctions originated from actuator configuration. Second, leveraging this property, this paper studies the energy-based control corresponding to the PPA robot’s upright equilibrium point (UEP), where all links extend upward. Under the derived energy-based controller, this paper conducts a global motion analysis of the closed-loop system to show that if the control gains satisfy certain requirements, then all initial states, apart from those in a set of Lebesgue measure zero, converge to an invariant set in which the last link extends upward and the robot’s total mechanical energy coincides with its value at the UEP. Finally, this paper provides numerical simulation to validate the developed theoretical results and to demonstrate the effectiveness of applying the derived controller along with an LQR controller to the swing-up and stabilizing task of the PPA robot.
Similar content being viewed by others
Data Availability
The data that support the findings of this study are available on request from the corresponding author.
Abbreviations
- COM:
-
Center of mass
- PPA robot:
-
Three-link planar robot with active last link
- UEP:
-
Upright equilibrium point
- \(\theta _i\) :
-
Angle measured in the counterclockwise direction from the vertical to link i
- \(\varvec{\theta }\) :
-
Generalized coordinate vector \([\theta _1,\theta _2,\theta _3]^{\textrm{T}}\)
- \(\varOmega _\textrm{s}\) :
-
Equilibrium set
- \({\mathbb {R}}\) :
-
Field of real numbers
- \(\mathbb {R^{+}}\) :
-
Field of positive real numbers
- \({\mathbb {S}}\) :
-
Circle (a 1-sphere)
- \(\textrm{diag}\{a_1,a_2,\ldots ,a_n\}\) :
-
Diagonal matrix with entries \(a_1,a_2,\ldots ,a_n\) from the upper left corner
- \(\varvec{0}_{n\times m}\) :
-
Zero matrix of size \(n\times m\)
- \(\varvec{A}=[a_{ij}]\) :
-
Matrix \(\varvec{A}\) with the element of the ith row and the jth column being \(a_{ij}\)
- \(|\varvec{A}|\) :
-
Determinant of the square matrix \(\varvec{A}\)
- \(a\equiv b\) :
-
Equivalence between two sides at all time
- \(\varvec{B}\) :
-
Weight matrix of input
- \(\varvec{C}\) :
-
Coriolis and centrifugal matrix
- E :
-
Total mechanical energy of the PPA robot
- \(E_\textrm{r}\) :
-
Total mechanical energy of the PPA robot at the UEP
- \(\varvec{G}\) :
-
Vector of gravity terms
- g :
-
Gravitational acceleration
- \(\varvec{I}\) :
-
Identity matrix
- \(\varvec{J}\) :
-
Jacobian matrix
- \(J_i\) :
-
Moment of inertial of link i around its center of mass
- \(k_D\), \(k_P\), \(k_V\) :
-
Control gains of the energy-based controller
- \(l_i\) :
-
Length of link i
- \(l_{ci}\) :
-
Distance measured from joint i to the center of mass of link i
- \(\varvec{M}\) :
-
Inertial matrix
- \(m_i\) :
-
Mass of link i
- P :
-
Potential energy of the PPA robot
- \(u_3\) :
-
Single control input driving link 3
- V :
-
Lyapunov function
- W :
-
Invariant set
- \(W_\textrm{r}\) :
-
Invariant set when \(\theta _3=0\)
- \(\varvec{x}\) :
-
State vector \([\theta _1,\theta _2,\theta _3,{\dot{\theta }}_1,{\dot{\theta }}_2,{\dot{\theta }}_3]^{\textrm{T}}\)
References
Åström, K.J., Furuta, K.: Swinging up a pendulum by energy control. Automatica 36(2), 287–295 (2000)
Baspinar, C.: Generalized swing-up control of underactuated mechanical systems. IEEE Control Syst. Lett. 6, 2144–2149 (2022)
Chang, E., Matloff, L.Y., Stowers, A.K., Lentink, D.: Soft biohybrid morphing wings with feathers underactuated by wrist and finger motion. Sci. Robot. 5(38), eaay1246 (2020)
Dai, S., Wu, Z., Wang, J., Tan, M., Yu, J.: Barrier-based adaptive line-of-sight \(3\)-d path-following system for a multijoint robotic fish with sideslip compensation. IEEE Trans. Cybern. 53(7), 4204–4217 (2023)
Elmokadem, T., Zribi, M., Youcef-Toumi, K.: Trajectory tracking sliding mode control of underactuated AUVs. Nonlinear Dyn. 84(2), 1079–1091 (2016)
Fantoni, I., Lozano, R.: Non-linear Control for Underactuated Mechanical Systems. Springer, Berlin (2001)
Fantoni, I., Lozano, R., Spong, M.W.: Energy based control of the Pendubot. IEEE Trans. Autom. Control 45(4), 725–729 (2000)
Feliu-Talegon, D., Acosta, J.Á., Ollero, A.: Control aware of limitations of manipulators with claw for aerial robots imitating bird’s skeleton. IEEE Robot. Autom. Lett. 6(4), 6426–6433 (2021)
Gamba, J.D., Featherstone, R.: A springy leg and a double backflip. IEEE Robot. Autom. Lett. 8(8), 4657–4664 (2023)
Javadi, M., Harnack, D., Stocco, P., Kumar, S., Vyas, S., Pizzutilo, D., Kirchner, F.: AcroMonk: a minimalist underactuated brachiating robot. IEEE Robot. Autom. Lett. 8(6), 3637–3644 (2023)
Kant, N., Mukherjee, R., Chowdhury, D., Khalil, H.K.: Estimation of the region of attraction of underactuated systems and its enlargement using impulsive inputs. IEEE Trans. Rob. 35(3), 618–632 (2019)
Kolesnichenko, O., Shiriaev, A.S.: Partial stabilization of underactuated Euler–Lagrange systems via a class of feedback transformations. Syst. Control Lett. 45(2), 121–132 (2002)
Liu, Y., Xin, X.: Set-point control for folded configuration of 3-link underactuated gymnastic planar robot: new results beyond the swing-up control. Multibody Sys.Dyn. 34(4), 349–372 (2015)
Liu, Y., Xin, X.: Controllability and observability of an \( n \)-link planar robot with a single actuator having different actuator-sensor configurations. IEEE Trans. Autom. Control 61(4), 1129–1134 (2016)
Liu, Y., Xin, X.: Global motion analysis of energy-based control for 3-link planar robot with a single actuator at the first joint. Nonlinear Dyn. 88(3), 1749–1768 (2017)
Meng, Q., Lai, X., Wang, Y., Wu, M.: A fast stable control strategy based on system energy for a planar single-link flexible manipulator. Nonlinear Dyn. 94(1), 615–626 (2018)
Nishimura, H., Funaki, K.: Motion control of three-link brachiation robot by using final-state control with error learning. IEEE/ASME Trans. Mechatron. 3(2), 120–128 (1998)
Ortega, R., Spong, M.W., Gómez-Estern, F., Blankenstein, G.: Stabilization of a class of underactuated mechanical systems via interconnection and damping assignment. IEEE Trans. Autom. Control 47(8), 1218–1233 (2002)
Spong, M.W.: The swing up control problem for the Acrobot. IEEE Control Syst. Mag. 15(1), 49–55 (1995)
Sprigings, E.J., Lanovaz, J.L., Watson, L.G., Russell, K.W.: Removing swing from a handstand on rings using a properly timed backward giant circle: a simulation solution. J. Biomech. 31(1), 27–35 (1997)
Sun, N., Fang, Y., Chen, H., Lu, B.: Amplitude-saturated nonlinear output feedback antiswing control for underactuated cranes with double-pendulum cargo dynamics. IEEE Trans. Ind. Electron. 64(3), 2135–2146 (2017)
Wang, L., Lai, X., Meng, Q., Wu, M.: Effective control method based on trajectory optimization for three-link vertical underactuated manipulators with only one active joint. IEEE Trans. Cybern. 53(6), 3782–3793 (2023)
Wang, Y., Xin, X., Liu, Y.: Energy-based control of three-link planar robot with last active link. In: Proceedings of the 2022 China Automation Congress, pp. 5071–5074 (2022)
Xian, B., Wang, S., Yang, S.: Nonlinear adaptive control for an unmanned aerial payload transportation system: theory and experimental validation. Nonlinear Dyn. 98(3), 1745–1760 (2019)
Xin, X.: Analysis of the energy-based swing-up control for the double pendulum on a cart. Int. J. Robust Nonlinear Control 21(4), 387–403 (2011)
Xin, X., Kaneda, M.: Analysis of the energy-based swing-up control of the Acrobot. Int. J. Robust Nonlinear Control 17(16), 1503–1524 (2007)
Xin, X., Kaneda, M.: Swing-up control for a 3-DOF gymnastic robot with passive first joint: design and analysis. IEEE Trans. Rob. 23(6), 1277–1285 (2007)
Xin, X., Liu, Y.: Control Design and Analysis for Underactuated Robotic Systems. Springer, London (2014)
Yang, T., Sun, N., Fang, Y.: Adaptive fuzzy control for a class of MIMO underactuated systems with plant uncertainties and actuator deadzones: design and experiments. IEEE Trans. Cybern. 52(8), 8213–8226 (2022)
Zhang, A., Lai, X., Wu, M., She, J.: Nonlinear stabilizing control for a class of underactuated mechanical systems with multi degree of freedoms. Nonlinear Dyn. 89(3), 2241–2253 (2017)
Funding
This work was supported in part by the National Natural Science Foundation of China under Grant Number 61973077.
Author information
Authors and Affiliations
Contributions
All authors contributed to the study conception and design. The first draft of the manuscript was written by [Xin Xin] and [Yongjia Wang], and all authors commented on previous versions of the manuscript. All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Conflict of interests
The authors have no competing interests to declare that are relevant to the content of this manuscript.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
This work was supported in part by the National Natural Science Foundation of China under Grant Number 61973077.
Appendices
Proof of Theorem 1
We extend the method in [15] to prove Theorem 1. Algebraic manipulations are performed using Mathematica 12.1.
To start with, define coordinate transformation:
Using (A1) with \(\theta _3=\theta _3^{*}\) and \(u_3=u_3^{*}\), we rewrite the dynamics in (1) as
where
The newly defined parameters in (A5) are determined by (2) and (3) and thus are positive constants. They are used to reduce the complexity of following discussion. Please refer Remark 2 for a detailed explanation about these parameters and the rewritten dynamics in comparison with the counterpart in [15].
Below, we present two lemmas concerning the properties of the parameters in (A5). To prove Theorem 1, we take full advantage of these properties.
Lemma 2
Regarding the parameters in (A5), the inequalities below hold:
Proof
Equations (A6), (A7), and (A8) can be shown by using (2) and (3) directly. Using (A8) with (2) yields \(b+e\ge 2\sqrt{be}>2\), which shows (A9). \(\square \)
Lemma 3
If
then \(a\ne 1\).
Proof
Assume that \(a=1\), we then obtain \(b+e=2\) from (A10), which contradicts (A9). Thus, we have \(a\ne 1\). \(\square \)
Using \(\theta _3=\theta _3^{*}\) with (5) gives \(E(\varvec{\theta },{{\dot{\varvec{\theta }}}})=E^{*}\), where \(E^{*}\) is a constant. In what follows, two steps are undertaken to prove Theorem 1.
Step 1 By progressively eliminating the nonlinear coupling in (A2)–(A4), we obtain a holonomic constraint of underactuated variable \(\phi _1\) (or \(\theta _1\), equivalently) alone in the following high-order polynomial form:
where \(\xi _{i}\ (i=0,1,\ldots ,28)\) are constants consisting of the parameters in (A5), sine and cosine of any possible \(\theta _3^{*}\), and any possible \(E^{*}\). We partition Step 1 into the following substeps and present the details.
Step 1.1 Performing the integration of (A4) with respect to time t gives
with \(\lambda _1\) being constant. The boundedness of \({\dot{\phi }}_1\) and \({\dot{\phi }}_2\) are guaranteed by \(E=E^{*}\). This leads to \(u_3^{*}+\beta _3\sin \theta _3^{*}=0\). Thus, integrating (A12) yields
with \(\lambda \) being constant. Using the boundedness of sine and cosine in (A13) gives \(\lambda _1=0\). Thus, from (A12) and (A13), we have
In what follows, we replace \(\sin \phi _2\) with (A15), and we keep the highest order of \(\cos \phi _1\) or \(\cos \phi _2\) equals to one by using
Step 1.2 We eliminate \(\ddot{\phi }_1\) and \(\ddot{\phi }_2\) in this substep. To this end, using (A2)–(A4) gives
where
To avoid contradiction, the determinant of the square matrix in the above equation must equal zero. This leads to
where \(F_i\ (i=1,2,3)\) comprise \(\sin \phi _1\), \(\cos \phi _1\), and \(\cos \phi _2\).
Step 1.3 We eliminate \({\dot{\phi }}_1\) and \({\dot{\phi }}_2\) in this substep. First, substituting (A1), (A15), and \(E=E^{*}\) into (4) and using (A5), we obtain
where constant \(\gamma \) is defined as
Next, we use (A14) to eliminate terms of \({\dot{\phi }}_2\) via two ways. By computing ((A17)\(\times e/2\)-(A18)\(\times F_2)\times \cos \phi _2\), we obtain
By computing \(E\times \cos ^2\phi _2\), we obtain
where \(G_{ij}\ (i,j=1,2)\) comprise \(\sin \phi _1\), \(\cos \phi _1\), and \(\cos \phi _2\).
Finally, eliminating \({\dot{\phi }}_1\) from (A20) and (A21) gives
where \(Q_i\ (i=1,2)\) comprise \(\sin \phi _1\) and \(\cos \phi _1\). Note that the order of \(\cos \theta _3^{*}\) remains to be one during the above derivation. Thus, \(Q_i\ (i=1,2)\) can be expressed as
where the explicit expressions of \(Q_{ij}\ (i=1,2)\) are omitted.
Step 1.4 Using (A22), we obtain
By using (A15), (A25) can be further expressed as
where \(R_1\) and \(R_2\) are polynomials in terms of \(\sin \phi _1\) with respective orders of 14 and 13. Deleting \(\cos \phi _1\) from (A26) yields (A11); that is,
Notably, if \(\cos \theta _3^*=0\), then \(R_2\) in (A26) equals zero, and \(\cos \phi _1\) does not exist in (A25). Indeed, \(Q_{11}\) can be written as \({\widehat{Q}}_{11}\times \cos \phi _1\) with \({\widehat{Q}}_{11}\) not containing \(\cos \phi _1\), and \(Q_{21}\) itself does not contain \(\cos \phi _1\). Thus, from (A23) and (A24), if \(\cos \theta _3^{*}=0\), then (A25) becomes \((1-\sin ^2\phi _1){\widehat{Q}}_{11}^2-Q_{21}^2(1-\sin ^2\phi _2)=0\), where \(\cos \phi _1\) does not exist. In this case, (A27) can be simplified to \(L=R_1\).
Step 2 Assume \({\dot{\phi }}_{1}=-{\dot{\theta }}_{1}\not \equiv 0\); that is, the PPA robot is not at an equilibrium configuration under the derived holonomic constraint in (A11). This is equivalent to the polynomial equation having infinite number of solutions, since \(\sin \phi _1\) is time-varying. Thus, the coefficients in (A11) must satisfy
In this step, we reveal the existence of at least one nonzero coefficient for any possible mechanical parameters and any given values of \(\theta _3^{*}\) and \(E^{*}\). Consequently, this proves that (A28) does not hold. The details are given below.
To start with, consider \(\xi _{28}\) in (A11); that is,
Using \(f>ad\) in Lemma 2 yields \(\left( f-ad\right) ^2+4adf\sin ^2\theta _3^{*}\ne 0\). Thus, from (A29) and \(\xi _{28}=0\), we discuss the following two cases based on whether
which is equivalent to \(e\ne \left( 1+a^2-ab\right) /a\) holds or not:
Case 1: \(e=\left( 1+a^2-ab\right) /a\)
Case 2: \(e\ne \left( 1+a^2-ab\right) /a\)
Case 1: In this case, we obtain \(\xi _{27}=0\) and
Since \(0<a<b\) and \(f>ad\) from Lemma 2, we see that \(\xi _{26}=0\) shows \(\lambda =0\). This further yields \(\xi _{25}=0\) and
where
From Lemma 3, we have \(a\ne 1\) for Case 1 and all its subcases. Thus, \(\xi _{24}=0\) shows \(\eta =0\). Regarding whether \(b=\left( 1+3a^2\right) /\left( 4a\right) \), we consider the following two cases:
Case 1.1: \(e=\left( 1+a^2-ab\right) /a\) and \(b=\left( 1+3a^2\right) /\left( 4a\right) \)
Case 1.2: \(e=\left( 1+a^2-ab\right) /a\) and \(b\ne \left( 1+3a^2\right) /\left( 4a\right) \)
Below we present the details of each case.
Case 1.1: We have \(\xi _{23}=\xi _{22}=\xi _{21}=0\), but
which contradicts (A28).
Case 1.2: From (A31) and \(\eta =0\), we have \(b=(1+5a^2)/(6a)\). This yields \(\xi _{23}=0\) and
From (A32) and \(\xi _{22}=0\), we have \(\gamma =0\). To avoid analyzing complicated coefficients, we always search for the one with the simplest structure in the remainder of Step 2. For this case, we skip the intermediate coefficients and obtain
From (A33) and \(\xi _0=0\), if \(\sin \theta _3^{*}=0\), we obtain
Note that \(\xi _{4}=0\) shows \(f=d\), and thus gives
which contradicts (A28).
If \(\sin \theta _3^{*}\ne 0\), to render \(\xi _0=0\), we have \(f=d/a\) yielding
which contradicts (A28).
Case 2: In this case, we obtain from (A29) and \(\xi _{28}=0\) that
Note that
Otherwise, if \(-3+a^2+2ae=0\), then (A34) yields \(1-3a^2+2ab=0\); that is, \(b=\left( -1+3a^2\right) /\left( 2a\right) \), since \(ad>0\). This further yields
which raises a contradiction. Thus, from (A34), we have
By substituting (A36) into (A11), we obtain
where
Note that
Otherwise, putting \(ae=2-2a^2+ab\) into (A36) yields \(f=-ad\), which contradicts the fact that f in (A5) is always positive. Thus, from (A37) and \(\xi _{26}=0\), we have \(\epsilon =0\). This yields \(\epsilon _1=0\) and \(\epsilon _2=0\).
Before proceeding to discuss Case 2 further, we first analyze a special circumstance of \(a=1\). From (A38) and (A39), if \(a=1\), then we have \(\epsilon =36d^2(-2+b+e)^2\lambda ^2=0\). This shows \(\lambda =0\), since \(b+e>2\) from Lemma 2. However, this further renders all the coefficients of polynomial L in (A11) to become zero; that is, (A28) holds. To deal with this, we derive and study another holonomic constraint of \(\phi _1\). From (A15) and \(\lambda =0\), we have
which implies a specific configuration for the PPA robot that \(\theta _1+\theta _2=2\theta _3^{*}\). By adding (A41) into the derivation in Step 1 with \(a=1\), \(\lambda =0\), and (A36), the derived holonomic constraint becomes
Consider \(\xi _{12a}\) in (A42); that is,
Note that \(e\ne 1\). Otherwise, we have \(-3+a^2+2ae=0\), which contradicts (A35). We now show \(b-e\ne 0\). On the contrary, assume \(b-e=0\), then putting \(b=e\) and \(a=1\) into (A36) yields \(f=-d\). This, together with \(b+e>2\) from Lemma 2, gives \(\xi _{12a}>0\) and thus concludes the discussion for (A42).
Thus, returning to the analysis of (A11), we just need to consider \(a\ne 1\) for Case 2 and all its subcases. In such circumstance, from (A38) and (A39), we have
We start by proving
in (A43) and (A44). By using \(be>1\) in (A8), we have \(6ab+6a^3e\ge 12a^2\sqrt{be}>12a^2\). This, together with \(1+a^4\ge 2a^2\), yields \(1-14a^2+a^4+6ab+6a^3e>2a^2+12a^2-14a^2=0\). Based on (A43) and (A44), we consider the following two cases for \(\xi _{26}=0\):
Case 2.1: \(e\ne \left( 1+a^2-ab\right) /a\) and \(\cos \theta _3^{*}\ne 0\)
Case 2.2: \(e\ne \left( 1+a^2-ab\right) /a\) and \(\cos \theta _3^{*}=0\)
Below we present the details of each case.
Case 2.1: From (A43) and (A44), we have \(\lambda =0\) and thus \(\gamma =0\). These lead to
where
Note that \(-2a+b+a^2e\ge -2a+2a\sqrt{be}>-2a+2a=0\) due to \(be>1\) in (A8). We now show \(\omega \ne 0\). On the contrary, assume \(\omega =0\), substituting (A47) into (A36) gives \(f=\left( 3a-2b\right) d\). It immediately follows that \(0<a<b\) and \(f>ad\) do not hold simultaneously. This contradicts Lemma 2.
Thus, from (A46) and \(\xi _0=0\), we have \(\sin \theta _3^{*}=0\) yielding
where
From (A30), we see that \(\xi _{24}=0\) gives \(\varepsilon =0\). We now show \(-1+a^2+4ab\ne 0\) in (A49) by contradiction. Substituting \(-1+a^2+4ab=0\) into (A49) gives \(\left( -5+a^2\right) \left( -1+5a^2\right) /4=0\). If \(-5+a^2=0\) holds, then \(-1+a^2+4ab=4+4ab>0\). If \(-1+5a^2=0\) holds, then by using (A6) we have \(-1+a^2+4ab>-1+5a^2=0\).
Thus, from (A48) and \(\xi _{24}=0\), we have
This further yields
Note that the denominator of \(\xi _{20}\) does not equal zero. Otherwise, under (A36) and (A50), \(-1-8a^2+a^4+14ab-6a^3b=0\) yields \(-3+a^2+2ae=0\); \(-7+a^2-2ab=0\) yields \(a>b\); and \(-3+a^2+2ab=0\) yields \(f=ad\). These are all impossible due to (A35) and Lemma 2. Thus, we have \(\xi _{20}>0\), which contradicts (A28).
Case 2.2: In this case, if \(\lambda =0\), then \(\gamma =0\) and we can use (A46) with \(\sin \theta _3^*=\pm 1\) to show \(\xi _0\ne 0\). Thus, we just need to consider \(\lambda \ne 0\). Note that from Step 1.1, by substituting (A1) into (A15) with \(\cos \theta _3^{*}=0\) and using (A5) with (2), we obtain
This implies that link 3 of the PPA robot is in the horizontal position and maintains a constant height. Moreover, from Step 1.4, we have \(R_2=0\) when \(\cos \theta _3^{*}=0\). Thus, in this case, we study \(L=R_1=0\) instead of (A11). By using (A36) and (A44) with \(\cos \theta _3^{*}=0\), we obtain from \(R_1\) a polynomial equation of \(\sin \phi _1\) with the highest order being equal to 12; that is,
Consider \(\xi _{12}\) in (A51); that is,
where
By using (A30), (A35), and (A40), from (A52) and \(\xi _{12}=0\), we have
Below we show \(\varDelta _{12}\ne 0\). Suppose that \(\varDelta _{12}\) equals zero, then from (A55), \(\varTheta _{12}\) must also equal zero since \(a\ne 1\). Using (A53) and (A54), we obtain b and the corresponding e from \(\varTheta _{12}=0\) and \(\varDelta _{12}=0\) as
Substituting (A56) into (A36) gives \(f=ad\), which contradicts Lemma 2. As for (A57), by using \(be>1\) in (A8), we have \((2a^3+6a^5)(6+2a^2)-(5+3a^4)(3a+5a^5)=-3a(-1+a^2)^2(5+6a^2+5a^4)>0\), which raises a contradiction. Thus, \(\varDelta _{12}\ne 0\).
From (A55), we have
By using (A58), we obtain
where \(k_i\ (i=11,10,9)\) are guaranteed to be nonzero terms. We omit the explicit expressions of other \({\widehat{\xi }}_i\) in (A59) and present only that of \({\widehat{\xi }}_{11}\) below:
Thus, \(\xi _i=0\ (i=11,10,9)\) are equivalent to
Note that (A60) can be viewed as polynomial equations with a, b, and e as variables, where the highest order of e in \({\widehat{\xi }}_{11}\), \({\widehat{\xi }}_{10}\), and \({\widehat{\xi }}_{9}\) are equal to 2, 4, and 5, respectively. Moreover, we obtain \(\xi _8\) from (A51). Below we show that (A60) and \(\xi _8=0\) do not hold simultaneously.
Starting with the assumption that (A60) holds, we first eliminate e and derive the following three polynomial equations in terms of a and b from (A60):
To this end, we divide \({\widehat{\xi }}_{10}\) by \({\widehat{\xi }}_{11}\) with respect to e to obtain
where \(p_{10}\) is the quotient and \(k_{10}r_{10}\) is the remainder with \(k_{10}\) being the nonzero term. The same notations (or with bars) apply to the following process of the derivation of (A61). From \({\widehat{\xi }}_{10}=0\) and \({\widehat{\xi }}_{11}=0\) in (A62), we have \(r_{10}=0\) in which the highest order of e has been reduced to 1. Moreover, we iterate the division by taking the divisor and nonzero part of the remainder in (A62) as the new dividend and divisor; that is, we divide \({\widehat{\xi }}_{11}\) by \(r_{10}\) with respect to e to obtain
where \(\delta _1=0\) is now the first polynomial equation, since \({\widehat{\xi }}_{11}=0\) and \(r_{10}=0\). Similarly, we replace \({\widehat{\xi }}_{10}\) with \({\widehat{\xi }}_9\) and obtain
where the highest order of e in \(r_9\) is equal to 1. From \({\overline{k}}_{11}\delta _9\), we obtain the second polynomial equation \(\delta _2=0\). Finally, we use \(r_9\) and \(r_{10}\) to obtain
This gives the third polynomial equation \(\delta _3=0\) and thus leads to (A61). Note that the highest orders of b in \(\delta _1\), \(\delta _2\), and \(\delta _3\) are equal to 12, 12, and 10, respectively.
Next, by using (A61), we eliminate b and derive two polynomial equations solely in terms of a. To this end, we take \(\delta _1\) and \(\delta _3\) as the initial dividend and divisor with respect to b and obtain
where \(m_1\) is the quotient and \({\widetilde{k}}_1n_1\) is the remainder with \({\widetilde{k}}_1\) being the nonzero part. This gives \(n_1=0\) with the highest order of b being equal to 9. We omit the subsequent process since it replicates the derivation of \(\delta _1=0\) with more iteration. From the remainder of the final division, we obtain the following polynomial equation with \(z=a^2>0\):
where \(\varsigma _{1,i}\ (i=0,1,\ldots ,362)\) are constants and \({\widehat{P}}_1\) and \(\varPhi \) are polynomials of z. Same derivation using \(\delta _2\) as the initial dividend instead of \(\delta _1\) yields the second polynomial equation with \(z=a^2>0\):
where \(\varsigma _{2,i}\ (i=0,1,\ldots ,382)\) are constants and \({\widehat{P}}_2\) is a polynomial of z. The explicit expressions of \({\widehat{P}}_1\), \({\widehat{P}}_2\), and \(\varPhi \) are omitted.
Then, note that both \(P_1=0\) and \(P_2=0\) are derived from (A61), while (A61) is derived from (A60). Thus, a necessary condition for (A60) is that (A63) and (A64) hold simultaneously. In this case, it is equivalent to the common positive real solutions of \({\widehat{P}}_1=0\) and \({\widehat{P}}_2=0\) and the positive real solutions of \(\varPhi =0\); that is,
respectively. We give a detailed explanation of these solutions in Remark 4.
Finally, we conduct an examination to see whether \(\xi _8=0\) holds under these solutions. Specifically, we substitute each positive a obtained from (A65) and (A66) into \(\delta _1=0\) in (A61), and solve b from the resulting equation. Combining with its corresponding a, we then substitute the obtained b into \({\widehat{\xi }}_{11}=0\) in (A60) to solve e and obtain the combination of (a, b, e). Now, for each combination, we first check whether the properties in Lemma 2 are satisfied with the aid of (A36). If so, we then substitute this combination into \(\xi _8\) and check whether \(\xi _8=0\) or not. Following such examination, we find that none of the solutions in (A65) or (A66) renders \(\xi _8=0\); that is, (A60) and \(\xi _8=0\) do not hold simultaneously. The details are omitted.
Thus, we conclude from (A59) that there exists at least one nonzero coefficient among \(\xi _{11}\), \(\xi _{10}\), \(\xi _{9}\), and \(\xi _{8}\), which contradicts (A28). We give some discussion concerning the analysis of Case 2.2 in Remark 3.
Thus far, we have located at least one nonzero coefficient for every case. This proves that (A28) does not hold in any circumstance. As a result, \({\dot{\theta }}_1=-{\dot{\phi }}_1\equiv 0\), which leads to \(\sin \phi _2=\lambda _0\) with \(\lambda _0\) being a constant. Consequently, \({\dot{\theta }}_2=-{\dot{\phi }}_2\equiv 0\), and hence completes the proof. \(\square \)
The three remarks given below concern the newly defined parameters in (A5), the analysis of Case 2.2 in comparison with [15], and the numerical solutions in (A65) and (A66), respectively.
Remark 2
The definition of newly defined parameters varies with actuator configuration of the three-link robot. From [15], the rewritten dynamics of the three-link planar robot with active first link are
where the angle of the first link and the control input are constants, and
From (A70), we see that the set of newly defined parameters in (A5) inherits the notations but differs in content, since the PPA robot studied in this paper is actuated by the last link instead of the first. Note that although the underactuated parts of the dynamics in (A2) and (A3) coincide with (A68) and (A69) in structure, comparing (A5) with (A70) shows that there is one more newly added parameter f for the PPA robot. This difference takes root in the fundamental structure of mechanical parameters in (2) and (3). Indeed, the counterpart of f in (A68) can be expressed by \(a\times d\), since \(a=\alpha _{12}/\alpha _{13}=\beta _2/\beta _3\) holds. However, we cannot find similar connection between f and the rest in (A5). Consequently, the existence of f significantly complicates the coefficients of the polynomial in (A11) compared to that in [15]. To deal with this increased complexity, we take full advantage of the properties of the newly defined parameters in Lemma 2 to simplify the discussion and further identify nonzero coefficient(s).
Remark 3
The condition of Case 2.2 is similar to that of Case 2.2.2 in [15]; that is, the actuated link is in the horizontal position. It is very difficult to discuss these two cases, since no useful information can be drawn to directly ease the strong coupling of the newly defined parameters inside \(\xi _i\). To unveil a nonzero coefficient, we obtain two polynomial equations solely in terms of a from \(\xi _i\). This is achieved by performing a series of iterative polynomial division, which is a method used in [15] of eliminating targeted variable(s) from multi-variable polynomial equations at the expense of increasing the highest order of other variable(s). However, unlike the counterpart in [15] where parameter e is fixed, in Case 2.2 it remains indefinite, and thus should be treated as a targeted variable to eliminate in the same manner as for b. This difference inevitably aggravates the complexity of iteration, as demonstrated in Case 2.2. As a result, we end up with high-order polynomial equations of a, which demand further analysis and inspection not encountered in [15].
Remark 4
The numerical solutions in (A65) and (A66) are calculated using the Mathematica function “NSolve”. The “WorkingPrecision” option of this function is set to 50 to provide solutions with adequate precision of 50-digit, while a lower precision would also suffice to yield the same conclusion in Case 2.2. For brevity, we only present the first six digits of these solutions in (A65) and (A66).
Stability analysis of equilibrium points
By calculating the characteristic polynomial of the robot’s linearization at the down–up–up equilibrium point \((\theta _{1},\theta _{2},\theta _{3},{\dot{\theta }}_{1},{\dot{\theta }}_{2},{\dot{\theta }}_{3})=(\pi ,0,0,0,0,0)\), we obtain
where \(\varvec{J}_{duu}\) is the corresponding Jacobian matrix, and
with
We recall the requirement on \(k_D\) in Lemma 1 for the controller in (14) to be nonsingular. From (15), we have
By using (B1), (B2), and \(\alpha _{11}\alpha _{22}-\alpha _{12}^2>0\) due to \(\varvec{M}(\varvec{\theta })|_{\varvec{\theta }=\varvec{0}_3}>0\), we have \(\varPi _{duu}<0\). This leads to \(a_5<0\) and \(a_6<0\), regardless of control gains and mechanical parameters. Hence, it can be concluded that the down–up–up equilibrium point is strictly unstable, since \(\varvec{J}_{duu}\) possesses no less than one eigenvalue in the open right-half plane. The instability of the up–down–up equilibrium point \((\theta _{1},\theta _{2},\theta _{3},{\dot{\theta }}_{1},{\dot{\theta }}_{2},{\dot{\theta }}_{3})=(0,\pi ,0,0,0,0)\) can be proved similarly.
Regarding the down–down–up equilibrium point \((\theta _{1},\theta _{2},\theta _{3},\) \({\dot{\theta }}_{1},{\dot{\theta }}_{2},{\dot{\theta }}_{3})=(\pi ,\pi ,0,\) 0, 0, 0), calculating its characteristic polynomial yields
where \(\varvec{J}_{ddu}\) is the corresponding Jacobian matrix, and
with
Similarly, exploiting the requirement on \(k_D\) in Lemma 1 gives
which leads to \(\varPi _{ddu}<0\). Thus, we have \(a_1\), \(a_3\), \(a_5\), and \(a_6\) being positive, regardless of control gains and mechanical parameters. However, the signs of \(a_2\) and \(a_4\) are left undetermined. To reveal the instability of this equilibrium point, we further compute the Hurwitz determinant
which yields
Straightforward calculation with (2) and using \(m_il_il_{ci}\ge J_i+m_il_{ci}^2\) from [28] shows \(\alpha _{13}\alpha _{22}-\alpha _{12}\alpha _{23}\le 0\) and \(\alpha _{12}\alpha _{13}-\alpha _{11}\alpha _{23}<0\). Thus, \(D_3<0\) since \(\varPi _{ddu}<0\). Hence, \(\varvec{J}_{ddu}\) has one eigenvalue in the open right-half plane at a minimum, indicating that the down–down–up equilibrium point is strictly unstable. \(\square \)
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Xin, X., Wang, Y. Analysis and control of three-link planar robot with active last link: property and energy-based approach. Nonlinear Dyn 112, 5269–5289 (2024). https://doi.org/10.1007/s11071-024-09297-1
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11071-024-09297-1