NOMENCLATURE
- ${m_{lon}}$ ,
-
mass of the longitudinal moving mass
- ${m_{lat}}$ ,
-
mass of the lateral moving mass
- ${m_B}$ ,
-
mass of the airship body B except the moving mass
- ${m_S}$ ,
-
mass of the whole system S
- ${\mu _{lon}}$ ,
-
mass ratio of longitudinal moving mass to the whole system
- ${\mu _{lat}}$ ,
-
mass ratio of lateral moving mass to the whole system
- ${\mu _B}$ ,
-
mass ratio of airship body to the whole system
- ${{\bf{P}}_{\bf{B}}}$ ,
-
position vector of the mass centre of B in the body frame
- ${{\bf{P}}_{\bf{S}}}$ ,
-
position vector of the mass centre of S in the body frame
- ${{\bf{P}}_{{\bf{lon}}}}$ ,
-
position vector of the longitudinal moving mass in the body frame
- ${{\bf{P}}_{{\bf{lat}}}}$ ,
-
position vector of the lateral moving mass in the body frame
- ${\bf{X}}$ ,
-
vector of state variations
- ${\bf{U}}$ ,
-
indirect control vector
- ${\bf{Y}}$ ,
-
output vector
- ${\bf{M}}$ ,
-
mass matrix
- ${{\bf{M}}_{\bf{T}}}$ ,
-
transform matrix
- ${m_{ij}}$ ,
-
added masses of the airship
- ${T_Z}$ ,
-
control forces along the z-axis
- ${T_D}$ ,
-
control differential thrust about the z-axis
- ${T_{cl}}$ ,
-
left vectored thrust
- ${T_{cr}}$ ,
-
right vectored thrust
- ${\delta _{cr}}$ ,
-
right vectored angle
- ${\delta _{cl}}$ ,
-
left vectored angle
- ${\Delta _{cof}}$ ,
-
mass coefficient matrix
- ${x_{lon}}$ ,
-
x-position of longitudinal moving mass
- ${y_{lat}}$ ,
-
y-position of lateral moving mass
- $h$ ,
-
flight altitude of the airship
- $x,y,z,\phi ,\theta ,\psi $ ,
-
inertial position and Euler angle
- $u,v,w,p,q,r$ ,
-
linear and angular velocities in the body-fixed frame
- $Vx,Vy,Vz$ ,
-
linear velocity in the inertia-fixed frame
1.0 INTRODUCTION
Stratospheric airships can be used as real-time surveillance platforms for environment monitoring and civil communication at a working altitude of 20km(Reference Schmidt1,Reference Yang, Yang and Deng2) . Solar energy is the ideal power choice for long-endurance stratospheric airships. The output performance of solar array on stratospheric airships is affected by airship’s attitude. A key technical challenge for stratospheric platforms is autonomous station keeping or the ability to remain fixed over a geolocation in the presence of winds. Attitude control systems, which are a necessary part of airship systems, mainly implement two functions. One function is to enable pointing at the ground target for observation; another function is to adjust the attitude to improve the output performance of solar panels(Reference Zhang, Li, Lv, Tan, Zhu and Sun3,Reference Yang and Liu4) .
The typical actuators used are aerodynamic control surfaces, vectored thrust and ballonets(Reference Zheng, Chen, Xu and Zhu5,Reference Yang6) ; however, not all these actuators can work well under special working conditions, such as low density and low speed. Most studies in this field emphasise composite control with multiple actuators. Liu(Reference Liu, Wu and Hu7) investigated the feasibility and stability of equilibrium flight of an airship in a longitudinal plane equipped with ballonets and ballast. Fan(Reference Fan, Yu and Yan8) studied the altitude control system of a high-altitude airship with an auxiliary ballonet and an elevator. Guo(Reference Guo and Zhou9) presented a design method for stratospheric airships with an aircrew propeller and aerodynamic surface. Di(Reference Di, Han and Yao10) established a method to solve the problem of attitude control given an aerodynamic fin and vectored thruster. Chen(Reference Chen, Dong, Zhang and Duan11) provided the attitude moment allocation between aerodynamic surfaces and vectored propellers by using weighted generalised inverse (GI) methods. The above-mentioned studies focused on pitch control but did not consider roll control because of the limited control authority of existing actuators.
Moving-mass control is a method that can change external moment by displacing the internal masses of the aircraft to change its centre of mass. Through this method, the attitude of aircraft can be changed. Successful applications can be found in studies on spacecraft(Reference White and Robinett12), re-entry vehicles(Reference Regan and Kavetsky13), underwater vehicles(Reference Woolsey and Leonard14), Kinetic Kill Vehicles (KKV)(Reference Menon and Sweriduk15), saucer-like air vehicles(Reference Deng, Gu, Zhao and Yu16) and missiles(Reference Vaddi17). This idea is also reflected in low-altitude airship control(Reference Gao and Shan18). In the field of stratospheric airships, application involving moving mass control was first reported publicly in our research, which referred to Chen(Reference Chen, Zhou, Yan and Duan19), in which the moving-mass control scheme and dynamics for stratospheric airships were presented and a nonlinear composite controller with aerodynamic control surfaces, moving mass and vectored thrust for pitch control was considered. Subsequently, ascending and descending schemes for a stratospheric airship based on pitch control were proposed, where the pitch angle is controlled by ballonets and elevators(Reference Chen, Zhou, Wen and Duan20).
This study is a continuation of our previous work(Reference Chen, Zhou, Yan and Duan19). To achieve attitude control for station keeping in still air, two moving masses are used for roll and pitch regulation, whereas the altitude and yaw angle are regulated by two vectored thrusters. The paper is structured as follows: section 1 introduces the composite control state of stratospheric airships. Section 2 details the configuration of an airship with moving masses and presents the whole system’s mass centre with the positions of the moving masses. The design process of an attitude controller in station keeping is considered in section 3. The performance of station keeping is then tested by simulation in section 4. Lastly, section 5 concludes the study with some observations.
2.0 MOVING-MASS SCHEME
For a stratospheric airship with a length of 170m, a moving-mass scheme of two moving masses is designed. The moving-mass actuator comprises two rails installed along the envelope bottom, with two moving masses moving freely on the rails. The configuration of the airship and moving-mass module is shown in Fig. 1 (Reference Chen, Zhou, Yan and Duan19).
The mass of the airship body B is ${m_B}$ , and the masses of the longitudinal and lateral moving masses are ${m_{lon}}$ and ${m_{lat}}$ , respectively. The mass of the system S is ${m_S}$ , where ${m_S} = {m_B} + {m_{lon}} + {m_{lat}}$ . The mass ratios are defined as ${\mu _B} = \frac{{{m_B}}}{{{m_S}}}$ , ${\mu _{lon}} = \frac{{{m_{lon}}}}{{{m_S}}}$ and ${\mu _{lat}} = \frac{{{m_{lat}}}}{{{m_S}}}$ . As shown in Fig. 1, the mass centre of B is ${B^ * }$ , which is fixed and independent of the motion of the moving masses; the mass centre of S is ${S^ * }$ , which is displaced with motion of the moving masses. The position vectors of ${B^ * }$ and ${S^ * }$ in the body frame are ${{\bf{P}}_{\bf{B}}} = (x{}_G,{y_G},{z_G})$ and ${{\bf{P}}_{\bf{S}}} = ({x^{\prime}_G},{y^{\prime}_G},{z^{\prime}_G})$ , respectively. The two rails are located in the $xOz$ and $yOz$ planes of the body frame, such that the position vectors of the longitudinal and lateral moving masses can be set at ${{\bf{P}}_{{\bf{lon}}}} = \left( {{x_{lon}},0,{z_{lon}}} \right)$ and ${{\bf{P}}_{{\bf{lat}}}} = \left( {0,{y_{lat}},{z_{lat}}} \right)$ , respectively. The relationship of ${{\bf{P}}_{\bf{S}}}$ with ${{\bf{P}}_{\bf{B}}}$ , ${{\bf{P}}_{{\bf{lon}}}}$ and ${{\bf{P}}_{{\bf{lat}}}}$ is ${\bf{P}}_{\bf{S}}^{} = \frac{{{m_B}{\bf{P}}_{\bf{B}}^{} + {m_{lon}}{{\bf{P}}_{{\bf{lon}}}} + {m_{lat}}{{\bf{P}}_{{\bf{lat}}}}}}{{{m_S}}}$ , where ${{\bf{P}}_{\bf{B}}}$ is fixed for a given airship body, and ${{\bf{P}}_{\bf{S}}}$ varies with the position of moving masses ${{\bf{P}}_{{\bf{lon}}}}$ and ${{\bf{P}}_{{\bf{lat}}}}$ .
3.0 ATTITUDE CONTROLLER FOR STATION KEEPING
The current study investigates the attitude control of airships during station keeping. With respect to energy and mass constraints, stratospheric airships have a low thrust-to-weight ratio. When they take off from the ground, their ultimate altitude is determined by the net lift/weight, whereas the horizontal position is uncontrolled. While flying at a working altitude of 20km, as a real-time surveillance platform, they should have the ability to change attitude to meet the mission requirements. Meanwhile, if the altitude is maintained, then high-resolution observations can be achieved. Here, pitch and roll are controlled by the moving masses, whereas yaw and altitude are regulated by two vectored thrusters. Since airship operation in still air is assumed, horizontal position control is not considered; however, it is indirectly influenced by attitude control. Aerodynamic surfaces are not effective at low airspeeds for station keeping.
3.1 Attitude controller structure
This section proposes the design procedure of a nonlinear control system for airships. The nonlinear composite control system is depicted in Fig. 2; it consists of two basic structures: one for altitude holding and another for attitude regulation. The input of altitude holding is the expected altitude ${z_c}$ and attitude angles ${\phi _c}{\theta _c}{\psi _c}$ ; the output is the desired linear acceleration ${\dot w_c}$ and angular accelerations ${\dot p_c}$ , ${\dot q_c}$ and ${\dot r_c}$ , which are responsible for tracking the expected altitude and attitude. The controller is designed on the basis of output feedback linearisation control; the output of the system is ${\bf{Y}} = {\left[ {z\begin{array}{*{30}{c}}{}\end{array}\phi \begin{array}{*{30}{c}}{}\end{array}\theta \begin{array}{*{30}{c}}{}\end{array}\psi } \right]^{\rm{T}}}$ . The output of the controller is the altitude regulation forces along the z-axis ${T_{Zc}}$ and differential thrust around the z-axis ${T_{Dc}}$ and the positions of the longitudinal and lateral moving masses $x{}_{lon}$ , ${y_{lat}}$ . The nonlinear mapping module transforms the control forces along the z-axis ${T_{Zc}}$ and differential thrust around the z-axis ${T_{Dc}}$ to the independent outputs of every thrust ${\left[ {\begin{array}{*{30}{c}}{{T_{cl}}}&{{T_{cr}}}&{{\delta _{cl}}}&{{\delta _{cr}}}\end{array}} \right]^{\rm{T}}}$ .
3.2 GI-based attitude controller
Generally, airship dynamics can be expressed as
where ${\bf{X}} = {(w,p,q,r)^{\rm{T}}}$ is a four-dimension state vector, ${\bf{U}} = {\left[ {{T_Z},{T_D},{x_{lon}},{y_{lat}}} \right]^{\rm{T}}}$ is a direct control vector and ${\bf{Y}} = {\left[ {z,\phi ,\theta ,\psi } \right]^{\rm{T}}}$ is an output vector. ${\bf{f = f(X)}}$ is a nonlinear state-dependent function; ${\bf{g = g(X)}}$ is independent of the control variable, as shown in Equation (2); details of the dynamic model can be seen in Chen(Reference Chen, Zhou, Yan and Duan19).
where ${{\bf{\Delta }}_{{\bf{cof}}}} = diag({m_s} + {m_{33}},{I_x} + {m_{44}},{I_y} + {m_{55}},{I_z} + {m_{66}})$ is the mass coefficient matrix, and $({x_s},{y_s},{z_s})$ is the position of the side vectored thrust in the body frame; here, ${x_s}{\rm{ = }}{z_s}{\rm{=0}}$ . The derivation of ${\bf{Y}}$ is defined by ${\boldsymbol{\ddot{\rm Y}}} = {{\bf{h}}_{\bf{X}}}{\boldsymbol{\dot{\rm X} = }}{{\bf{h}}_{\bf{X}}}{\bf{(f + gU)}}$ , where ${{\bf{h}}_{\bf{X}}} = \frac{{\partial {\bf{h(X)}}}}{{\partial {\bf{X}}}}$ . For a given commanded input ${{\bf{Y}}_{\bf{c}}}{\rm{ = }}{\left[ {{z_c},{\phi _c},{\theta _c},{\psi _c}} \right]^{\rm{T}}}$ , the desired behaviour of a closed system is defined by ${{\bf{Y}}_{\rm{d}}} = ff({\bf{Y,}}{{\bf{Y}}_{\bf{c}}})$ . Here, $ff()$ is designed as a Proportional–Integral–Differential (PID) controller to obtain the desired accelerations of closed system ${{\textbf{Y}}_{\rm{d}}} = {({{\ddot{\rm z}}_d},{\ddot \phi _d},{\ddot \theta _d},{\ddot \psi _d})^{\rm{T}}}$ .
where ${k_{p\phi }}$ , ${k_{d\phi }}$ , ${k_{i\phi }}$ , ${k_{p\theta }}$ , ${k_{d\theta }}$ , ${k_{i\theta }}$ , ${k_{d\psi }}$ , ${k_{p\psi }}$ , ${k_{i{\rm{z}}}}$ and ${k_{p{\rm{z}}}}$ are controller parameters.
By changing ${\boldsymbol{\ddot{\rm Y}}}$ in the previous equation to track ${{\bf{Y}}_{\rm{d}}}$ , the final form of a nonlinear feedback control law is obtained on the basis of the GI calculation as
where ${\left( {{{\bf{h}}_{\bf{X}}}{\bf{g}}} \right)^{{\bf{ - 1}}}}$ denotes the GI of matrix ${{\bf{h}}_{\bf{X}}}{\bf{g}}$ , and ${{\bf{h}}_{\bf{X}}}{\bf{g}}$ is called the control efficiency matrix.
Given the desired altitude and attitude ${{\bf{Y}}_{\bf{c}}}{\rm{ = }}{\left[ {{z_c},{\phi _c},{\theta _c},{\psi _c}} \right]^{\rm{T}}}$ , the desired attitude and velocity can be deduced from the kinematics ${w_c} = {\dot z_c} + u\theta $ , where ${\dot z_c} = k({z_c} - z)$ is the tracking vertical velocity; ${\theta _c} = {c_1}$ , ${\phi _c} = {c_2}$ , where c 1 and c 2 are the given attitude from the task requirements; and ${\psi _c} = {\rm{arctan}}( - {V_w}_y{\rm{/}} - {V_{wx}})$ , and ${V_w}_y$ , ${V_{wx}}$ are the wind components in the inertial frame along the x and y directions, respectively.
3.3 Nonlinear mapping module
The airship has two vectored thrusters with four control variables for altitude and yaw control. Thus, control allocation is necessary for two-channel synchronised control. The local vectored-thrust frame is established in the vectored-rotation plane (Fig. 3), where ${\delta _{{\rm{cl}}}}$ , ${\delta _{{\rm{cr}}}}$ are the deflect angle of the left and right vectored propellers, respectively; it can deflect around the installed axis at a range of $[ - {180^ \circ },{180^ \circ }]$ . ${T_{{\rm{cl}}}}$ , ${T_{{\rm{cr}}}}$ is the generated force whose amplitude is decided by the rotational speed of the propeller.
In the vectored-rotation plane, the vectored thrust can be decomposed into two orthogonal forces: ${T_{{\rm{clH}}}} = {T_{{\rm{cl}}}}{\rm{sin}}\left( {{\delta _{{\rm{cl}}}}} \right)$ , ${T_{{\rm{clV}}}} = - {T_{{\rm{cl}}}}{\rm{cos}}\left( {{\delta _{{\rm{cl}}}}} \right)$ , ${T_{{\rm{crH}}}} = {T_{{\rm{cr}}}}{\rm{sin}}\left( {{\delta _{{\rm{cr}}}}} \right)$ and ${T_{{\rm{crV}}}} = - {T_{{\rm{cr}}}}{\rm{cos}}\left( {{\delta _{{\rm{cr}}}}} \right)$ . Here, ${T_{{\rm{clH}}}}$ , ${T_{{\rm{clV}}}}$ , ${T_{{\rm{crH}}}}$ and ${T_{{\rm{crV}}}}$ are called indirect control variables, and they can also be decomposed into the body-fixed frame with transform matrix
Thus, we have
where ${T_{\rm{X}}}$ , ${T_Z}$ , ${T_\phi }$ and ${T_\psi }$ are the forces and moments generated by the thrusters. Here, only the altitude and yaw are controlled by the two thrusters; thus, ${T_Z}$ and ${T_\psi }$ are the control forces, and ${T_{\rm{X}}}$ and ${T_\phi }$ are considered the disturbance forces. When the controller calculates the commanded control force ${T_{{\rm{Zc}}}}$ and ${T_{{\rm{\psi c}}}}$ , the indirect control variables can be deduced by the inverse transform of ${{\bf{M}}_{\bf{T}}}$ :
Then, the direct control variables ${T_{{\rm{cr}}}} = \sqrt {T_{{\rm{crH}}}^2 + T_{{\rm{crV}}}^2} $ , ${T_{{\rm{cl}}}} = \sqrt {T_{{\rm{clH}}}^2 + T_{{\rm{clV}}}^2} $ and ${\delta _{{\rm{cr}}}} = {(\tan \frac{{T_{{\rm{crH}}}^{}}}{{T_{{\rm{crV}}}^{}}})^{ - 1}}$ , ${\delta _{{\rm{cl}}}} = \tan \frac{{T_{{\rm{clH}}}^{}}}{{T_{{\rm{clV}}}^{}}}{^{ - 1}}$ are obtained.
4.0 SIMULATION RESULTS FOR STATION KEEPING
Given that the body of an airship is similar to a spindle, that is, with a large length and round cross section, the rail in the $xOz$ plane can be regarded as a straight line parallel to the body axis, and the rail in the $yOz$ plane can be considered an arc. The maximum radius of the cross section is given as 25m. Hence, the position vectors of the longitudinal and lateral moving masses can be set as ${P_{lon}} = \left( {{x_{lon}},0,25} \right)$ and ${P_{lat}} = (0,{y_{lat}},25\cos (\arcsin \frac{{{y_{lat}}}}{{25}}))$ , respectively, with rail lengths $\left| {{x_{lon}}} \right| \le 40$ and $\left| {{y_{lat}}} \right| \le 15$ . When the masses are at their initial position, ${x_{lon}} = {y_{lat}}=0$ , the moving-mass ratio is given by ${\mu _{{\rm{lon}}}}=0.2$ , ${\mu _{{\rm{lat}}}}=0.1$ .
4.1 Open-loop control
Open-loop control is given to validate the control ability of moving masses. When the airship is cruising with an initial speed of 3m/s, the masses first move to the maximum positive displacement from the initial position, then move to the maximum negative displacement, then move back to the initial position. In this process, the masses move at a constant speed, either in the positive or negative direction. The attitude and position of the airship and relative moment are observed, as shown in Figs 4 and 5.
Simulation results reveal that when the longitudinal moving mass is at a positive displacement in the body frame, the airship is placed in a nose-down position; when the longitudinal moving mass is at a negative displacement, the airship is placed in a nose-up position. The maximum pitch angle obtained is 0.41rad. The pitch angle induces the maximum altitude variation of 1350m downward; the plenary inertial velocity is reduced along with the pitch control, whether the airship is nose up or nose down. Similarly, the maximum roll response to movement of the lateral moving mass is 0.08rad. The airship demonstrates light damping in yaw at a low velocity. The sideslip angle induced by roll generates aerodynamic moment in the yaw direction, resulting in a change in the yaw angle; given such coupling dynamics, the roll angle induces the yaw drift of 0.109rad; thus, the airship has lateral position deviation along with roll control. As the horizontal velocity is uncontrolled, the airship’s horizontal position changes with the yaw deviation and reduces its forward velocity.
The primary functional moments in this process are the gravitational and aerodynamic moments: the change in gravitational moment is attributed to the movement of the centre of mass S, whereas the change in aerodynamic moment is induced by a variation in the angle of attack and sideslip angle; detailed analyses can be seen in Chen(Reference Chen, Zhou, Yan and Duan19).
4.2 Closed-loop control
As a real-time surveillance platform, station keeping allows the airship to stay within a certain horizontal range, whereas the altitude is maintained to achieve high-resolution observations; the pitch and roll are controlled to meet the mission requirements with respect to ground targets or to regulate the solar output, and the yaw control lets the airship head against the wind to reduce position drift or to change its course.
The given hovering altitude is ${h_c}=2 \times {10^4}m$ . Motion planning is considered to realise smooth manipulation, so a maximum desired height difference $\Delta h=50m$ is selected. When ${h_c} - h \gt \Delta h$ , the tracking target is the command vertical velocity $\dot h \to {\dot h_c}$ . When ${h_c} - h \le \Delta h$ , the tracking target is the final position $h \to {h_c}$ . The commanded attitude is given as follows:
The simulation results of the closed-loop attitude system are shown in Figs 6–8.
The simulation results reveal that the attitude tracks the command value on the same level that can be realised by open control, and the altitude error is controlled within 100m (Fig. 6(a)). As the yaw is controlled, the lateral deviation is controlled; the stable deviation is 253.7m for consistency with plot as shown in Fig. 7(b). As the horizontal velocity is uncontrolled, the forward velocity decreases gradually (Fig. 7(d)). Figure 7(c) shows the airflow angle, which varies with the attitude variation, such that the aerodynamic moments change.
The indirect control force and real output of every thruster are shown in Fig. 8. Two thrusters are composited to generate vertical and differential forces.
4.3 Station-keeping performance
The performance of moving-mass control in station keeping is tested under different velocities. The range of airspeed is from 0m/s to 3m/s, and the controller parameters are kept constant in closed control. The open and closed moving-mass control results are shown in Figs 9 and 10, respectively.
As shown in Fig. 9, with an initial velocity of 0m/s (i.e. no wind), the yaw has considerable deviation (Fig. 9(d)) due to strong roll and yaw coupling; thus, the airship turns around within a small range, and the airship demonstrates light damping in yaw at a low velocity (Fig. 9(d)). With the increase in airspeed, the coupling between the pitch and the altitude is evident, the altitude changes rapidly (Fig. 9(a)) and the position range is enlarged (Fig. 9(c)).
The station-keeping performance of the closed-loop system is shown in Fig. 10; compared with the performance of open control (Fig. 9), the station-keeping range is enlarged. Nevertheless, the airship moves regularly (Fig. 10(c)), and the altitude does not fluctuate remarkably. Under normal situations, with an increase in airspeed from 0.5m/s to 3m/s, the station-keeping range is increased. Lateral deviation stops when the yaw angle is controlled to trim point. With the increase in airspeed, the closed-loop yaw control should be implemented to suppress the deviation of lateral and altitude displacements; thus, the forward displacement is enlarged, which can be seen from comparison of Fig. 9(c) and (d) with Fig. 10(c) and (d).
With an initial velocity of 0m/s, the closed-loop control system adapts to the no-wind situation; however, it does not achieve the best station-keeping performance because of the strong coupling between yaw and roll (Fig. 9(d)). In closed control, the yaw angle is controlled, such that the airship no longer turns around. Thus, the station-keeping range is enlarged, as shown in Fig. 10(c).
On the basis of the above discussion, the following conclusions can be drawn: in attitude control during station keeping, the yaw control can be chosen on the basis of the task requirements. With low airspeed (approximately 0m/s), the airship can hover within a small range without yaw control. With an increase in airspeed, the yaw can be controlled to obtain stable lateral deviation, and the airship slowly moves forward with a stable altitude.
5.0 CONCLUSION
Moving-mass control is introduced to stratospheric airships for attitude control with station keeping at a given altitude. The altitude and yaw angle are regulated by two vectored thrusters, whereas the roll and pitch are controlled by two moving masses. The performance of moving-mass control in station keeping is tested under different velocities. In open-loop attitude control, the coupling between pitch and altitude and between roll and yaw is evident; thus, altitude and lateral displacements are induced. Under low airspeed, the airship can adjust its pitch and roll, hovering within a fixed range with uncontrolled yaw deviation. With an increase in airspeed, the closed-loop yaw control should be implemented to suppress the deviation of lateral and altitude displacements; thus, the forward displacement is enlarged. Nevertheless, stable station-keeping performance is guaranteed, because there is not big drift of planary positions under the assumption of still air. On the other hand, the main limitation of this controller is that the airship in still air is assumed; otherwise, the horizontal position of the airship drifts in an uncontrolled manner. If there is wind, the horizontal position of the airship needs to be controlled for station keeping. The velocity control can be implemented by extra thrusters, or a new control scheme should be proposed.
ACKNOWLEDGEMENTS
This work is supported by the National Science Foundation of China (no. 61733017) and the Foundation of State Key Laboratory of Robotics of China (no. 2018O13) and is sponsored by the Shanghai Pujiang Program (no. 18PJD018).