Latest revision as of 12:18, 19 January 2023

Abstract

For improving the energy efficiency of hopping robot, an asymmetric spring loaded inverted pendulum hopping model with leg mass is considered. The period orbit problem of two-legged hopping robot is investigated. Firstly, the hybrid dynamic model is constructed. Then the passive hopping gaits are found using quasi-newton optimization method. Secondly, a PD controller is implemented to track the desired pitch trajectory of the body. Through applying control during stance phase, period orbits of the robot with offset body mass is obtained. Finally, the effect of the location of the leg mass and the body mass on hopping performances is investigated.

Keywords: Hopping robot, asymmetric, passive dynamics, periodic motion, energy efficiency

1. Introduction

Hopping robots use isolated footholds, so it can negotiate uneven terrain. Due to these advantages, it has been studied by many researchers in recent years. Raibert and his coworkers had developed one-legged and two-legged hopping robots [1] based on a spring-loaded inverted pendulum (SLIP) model. These robots had a massless telescopic leg and a point foot. They use a three-part algorithm to control the robot. Since then, many jumping robots such as robots with spring leg [2-5] and robots with multi-joint leg [6-8] are constructed.

The SLIP model is the simplest mathematical model for hopping robot and it captured the basic dynamicbehaviors of the running of many animals [9]. The control of the SLIP model is very simple because it doesn’t consider the dynamic coupling between the body and the legs. The control strategy based on SLIP model is necessary to be modified in order to successful apply in the control of the real robots [10], so it is necessary to construct a more realistic model similar to the real hopping robots.

In the hopping control, the energy consumption is especially crucial because it directly affects the size of the actuator and in return influences the weight of the robots. So, it is necessary to achieve the hopping gait with minimal power consumption. In this field, there are some remarkable researches on passive hopping. It has been found that using the proper initial conditions, the hopping robots can excuates periodic motion without input torque [11-12]. Papadopoulos and Cherouvim proved that the passive gait is the least energy-consuming gait [2]. Ahmadi and Buehler used hip and leg compliance to realize passive motion [3-4]. Schammass et al exploited the passive dynamics of the system to reduce the energy consumption [13]. The simulation results shown that the robot including hip compliance reduced approximately 67% of the total energy compared to the robot without hip compliance. Hyon et al used a new gait-searching algorithm to find the passive orbit and proposed two kinds of controllers to realize orbital stabilization [14-16].

All of these hopping robots have symmetric configuration with the center of mass (COM) along the geometrical axis of a telescopic leg. In reality, the COM of most animals offsets the hip joint and the weight of the leg can’t be ignored. The offset body-mass offers greater flexibility in the design of hopping robot because the actuator can be placed within the body freely. The asymmetrical body mass configurations have been considered by several scholars [17-23]. Kuswadi et al. proposed an asymmetric model of a single-legged robot and realized a sustained hopping motion. The center of gravity of the model isn’t on the line of action of the actuator [19]. Sayyad et al analyzed a springy-legged offset-mass (SLOM) configuration and proposed an energy compensated model to explore the possibility of a periodic motion [20]. But all these paper doesn’t consider the rotation of the body. Poulakakis et al used a SLIP-embedding control law to control an asymmetric spring loaded inverted pendulum (ASLIP) hopping model, but the leg is assumed to be massless [22-23].

In this paper, an asymmetric spring loaded inverted pendulum hopping model (ASLIP) is proposed, where the leg mass is considered and the center of mass of the body is not located in the hip joint. The goal is to study of the effect of the offset mass of the body and the mass of the leg on the robot’s hopping performance.

This paper is organized as follows. In Section 2, the dynamic model is presented along with its mechanical properties and motion equations. In Section 3, the Poincare mapping is used to analyze the passive periodic hopping motion of the hopping robot and the fix point is obtained using optimization, and the effects of the offset mass and the leg mass on the hopping motion are presented in Section 4.

2. Dynamical model

Figure 1 is the simplified model of the ASLIP hopping robot. The hopping robot consists of two parts, a body and a springy telescope leg. The body and the leg is connected by a torsional spring on the hip joint ${\displaystyle H}$. In the model, the hip joint doesn’t coincide with the center of mass of the body. The mass of the leg is also taken into account. A coupling between the leg swing motion and the body rotation is introduced, which made the analysis of the dynamics of the robot more complicated. Supposing the position of the center of mass of the leg ${\displaystyle S_{1}}$ and the position of the center of mass of the body ${\displaystyle S_{2}}$ are given by ${\displaystyle FS_{1}=\alpha l}$ and ${\displaystyle HS_{2}=\beta l_{b}}$, where ${\displaystyle 0<\alpha ,\beta <1}$. The variable ${\displaystyle l}$ denotes the length of the leg, ${\displaystyle theta}$ represents the leg angle with respect to the vertical axis ${\displaystyle \varphi }$ indicates the body angle with respect to the horizontal axis. Other physical parameters and its values are listed in Table 1.

Figure 1. Model of robot

The hopping motion of the robot is composed of two phases: stance phase and flight phase. The switch from the stance phase to the flight phase is called lift-off, triggered by ${\displaystyle l\geq l_{0}}$. The switch from the flight phase to the stance phase is called touchdown, triggered by ${\displaystyle zh\leq l_{0}\cos(\theta )}$. We use the event-based subscript to describe the motion during different phases. The subscript ${\displaystyle st}$ represents the stance phase, ${\displaystyle fl}$ represents the flight phase, ${\displaystyle td}$ is the moment at touchdown and ${\displaystyle l_{0}}$ is the moment at lift off.

During the stance phase the leg is in contact with ground at a toe point ${\displaystyle F}$ (end of the leg). Supposing that the robot does not bounce back nor slip relative to the ground, the leg rotates around the toe. Then the toe can be modeled as a pivot. We choose polar coordinates ${\displaystyle {\boldsymbol {q}}_{st}={\left[{\begin{array}{ccc}l&\theta &\varphi \end{array}}\right]}^{T}}$, as the generalized coordinates. Using the Lagrange method [22], the equations of motion is obtained as:

where ${\displaystyle {\boldsymbol {M}}_{st}}$ is the symmetric positive definite inertia matrix during the stance phase, which deponds on the generalized coordinates ${\displaystyle {\boldsymbol {q}}_{st}}$; ${\displaystyle {\boldsymbol {C}}_{st}}$ is the matrix containing centrifugal force and Coriolis force during the stance phase, which is a function of ${\displaystyle {\boldsymbol {q}}_{st}}$ and ${\displaystyle {\boldsymbol {\dot {q}}}_{st}}$; ${\displaystyle {\boldsymbol {G}}_{st}}$ is the gravity vector during the stance phase, which is a function of ${\displaystyle {\boldsymbol {q}}_{st}}$; ${\displaystyle {\boldsymbol {K}}_{st}}$ is the equivalent driving torque vector of torsion spring during the stance phase, which is related to ${\displaystyle {\boldsymbol {q}}_{st}}$; ${\displaystyle {\boldsymbol {\tau }}_{st}={\left[{\begin{array}{ccc}f&0&{\tau }_{st}\end{array}}\right]}^{T}}$; ${\displaystyle f}$ is the driving force to the leg, while ${\displaystyle {\tau }_{st}}$ denotes the hip torque during the stance phase.

During the flight phase the leg loses contact with the ground. The COM of the robot moves along the ballistic trajectory and the angular momentum of the robot about the COM is conserved. The length of the leg is assumed to keep constant. We select Cartesian coordinates ${\displaystyle {\boldsymbol {q}}_{fl}={\left[{\begin{array}{cccc}x_{h}&z_{h}&\theta &\phi \end{array}}\right]}^{T}}$ as the generalized coordinates, ${\displaystyle \left(x_{h},z_{h}\right)}$ is the position of the hip joint. The dynamics is given by:

where ${\displaystyle {\boldsymbol {M}}_{fl}}$ is the symmetric positive definite inertia matrix during the flight phase, which deponds on the generalized coordinates ${\displaystyle {\boldsymbol {q}}_{fl}}$; ${\displaystyle {\boldsymbol {C}}_{fl}}$ is the matrix containing centrifugal force and Coriolis force during the flight phase, which is a function of ${\displaystyle {\boldsymbol {q}}_{fl}}$ and ${\displaystyle {\boldsymbol {\dot {q}}}_{fl}}$; ${\displaystyle {\boldsymbol {G}}_{fl}}$ is the gravity vector during the flight phase, which is a function of ${\displaystyle {\boldsymbol {q}}_{fl}}$; ${\displaystyle {\boldsymbol {K}}_{fl}}$ is the equivalent driving torque vector of torsion spring during the flight phase, which is related to ${\displaystyle {\boldsymbol {q}}_{fl}}$; ${\displaystyle {\boldsymbol {\tau }}_{fl}={\left[{\begin{array}{cccc}0&0&0&{\tau }_{fl}\end{array}}\right]}^{T}}$; ${\displaystyle {\tau }_{fl}}$ is the hip torque during the flight phase.

At touchdown, the leg touches down the ground and inelastic impulse occurs. The generalized displacements keep constant, but the generalized velocities change instantaneously

where the subscript ${\displaystyle td-}$ and ${\displaystyle td+}$ represent the moment before and after touchdown respectively.

At lift-off, there are no discontinuous changes of states except for:

It can be seen that during the landing phase, the leg compresses and releases the spring to realize the energy conversion from the above equations. Since the loss caused by friction is not considered, the mechanical energy is conserved. In the flight phase, the mechanical energy of the system is also conserved. At touchdown, the robot legs collide with the ground, which will lead to energy loss. In order to simplify the analysis, the energy loss at touchdown is not considered in this paper. The robot is a complex switching system with multi variables, strong coupling and nonlinearity, so it is impossible to obtain the analytical solution of the trajectory of the system, and can only be solved by numerical calculation.

3. Passive hopping motion

To improve the energy efficiency, firstly we consider the completely passive hopping which means that there is no driving force applied on the robot. A very useful and common method to study the existence and stability of periodic motions is the Poincare map. According to the trajectory of the state variables in the Poincare section, we can find the periodic motion. Through Poincare map, we can transform the existence of the periodic orbits of the hopping robot to the fixed point in the Poincare section.

The robot has 4 DOF during flight and 3 DOF during stance. For reducing the number of the independent variables, we choose the moment just after touchdown as the Poincare section and state vector is defined as ${\displaystyle x=\left[{\begin{array}{cccccc}l_{td}&\theta ^{td}&{\varphi }_{td}&{\dot {l}}_{td}&{\dot {\theta }}_{td}&{\dot {\varphi }}_{td}\end{array}}\right]^{T}}$. For ${\displaystyle l_{td}=l_{0}}$ at touchdown, the number of the independent variables reduces to 5. In the process of iteration, let the state vector in the ${\displaystyle j^{th}}$ step is ${\displaystyle {\bf {x}}^{j}}$, we can get the state vector ${\displaystyle {\bf {x}}^{j+1}}$ in the ${\displaystyle (j+1)^{th}}$ step after one mapping. This process can be described as a Poincare map ${\displaystyle x^{j+1}=P\left(x^{j}\right)}$.

For a certain state vector ${\displaystyle {\bf {x}}}$, the point is called a fixed point if it maps itself through one map,

Then we build the Poincare map of the hopping robot. The dynamic Eqs. (1) and (2) are rewritten into a standard state-space form.

where ${\displaystyle {\boldsymbol {x}}_{st}={\left[{\boldsymbol {q}}_{st}^{\mbox{T}},{\boldsymbol {\dot {q}}}_{st}^{\mbox{T}}\right]}^{\mbox{T}}}$ is the state vector during the stance phase and ${\displaystyle {\boldsymbol {x}}_{fl}={\left[{\boldsymbol {q}}_{fl}^{\mbox{T}},{\boldsymbol {\dot {q}}}_{fl}^{\mbox{T}}\right]}^{\mbox{T}}}$ during the flight phase. Because the number of the state variables between the stance phase and the flight phase is different, we need to construct two mapping between the transitions of these two phases. The mapping is represented by the following equations

Combining these four sub-maps, then the whole Poincare mapping is ${\displaystyle {\boldsymbol {P}}={\boldsymbol {P}}_{st}\circ {\boldsymbol {P}}_{lo}\circ {\boldsymbol {P}}_{fl}\circ {\boldsymbol {P}}_{td}}$.

Since the Poincare map of the hopping robot have been constructed, now we consider the method of finding the fixed point. The Newton-Raphson’s method [15] is commonly used to find the fixed point

where, ${\displaystyle {\bf {I}}}$ is the identity matrix, ${\displaystyle D{\boldsymbol {P}}\left({\boldsymbol {x}}\right)=\partial {\boldsymbol {P}}\left({\boldsymbol {x}}\right)/\partial {\boldsymbol {x}}}$ is the jacobian matrix of the Poincare map at ${\displaystyle {\bf {x}}^{j}}$.

Because the Newton-Raphson’s method demands the initial value of the state vector to be very close to the accurate value of the fixed point, it’s difficult to give the initial value. If the initial value is selected improperly, the algorithm will diverge soon.

In this paper we used the optimization algorithm to solve the nonlinear equations. Firstly we transformed the problem into a minimum value problem. Eq. (5) can be rewritten as

Then the problem becomes an unconstrained optimization problem. We can use the quasi-Newton method to find the minimum value of Eq.(11). If the minimum value of ${\displaystyle f(x)}$ is zero, the point ${\displaystyle {\bf {x}}}$ is considered as the fixed point. In reality, due to calculation error, the point is considered as the fixed point if ${\displaystyle f(x)<{10}^{-6}}$.

In this paper, quasi Newton method is used to solve the minimum problem

where ${\displaystyle {\boldsymbol {s}}_{k}=x_{k+1}{\mbox{-}}x_{k}}$, ${\displaystyle H_{k}=B_{k}^{-1}}$, ${\displaystyle y_{k}=\nabla f\left(x_{k+1}\right){\mbox{-}}\nabla f\left(x_{k}\right)}$, ${\displaystyle H_{k+1}=H_{k}-{\frac {H_{k}y_{k}y_{k}^{T}H_{k}}{y_{k}^{T}H_{k}y_{k}}}+{\frac {s_{k}s_{k}^{T}}{y_{k}^{T}s_{k}}}}$.

4. The effect of the center of mass of the leg and the body

Using the proposed algorithm, passive hopping gaits are found. According to the Hyon [14], all passive running gaits of the ARL monopod robot were unstable except for a vertical hopping. The obtained gaits of our hopping robot are also quasi-period ones, not stable limit cycle. The distance between the COM of the leg and the toe is ${\displaystyle \alpha l}$, and the distance between the COM of the body and the hip joint is ${\displaystyle \beta l_{b}}$. The location of the COM of the leg and the body is depend on ${\displaystyle \alpha }$ and ${\displaystyle \beta }$, respectively, we examine the influence of ${\displaystyle \alpha }$ and ${\displaystyle \beta }$ on the jumping performance of the robot.

4.1 The effect of the center of mass of the leg

Firstly the effect of α is examined when the COM of the body is coincide with hip joint (${\displaystyle \beta }$ is zero). The base parameters given in Table 1. The results are shown in Figure 2. The location of the COM of the leg is displaced along the leg from the toe to the hip joint, which means that the value of ${\displaystyle \alpha }$ is between 0 and 1. When ${\displaystyle \alpha =0}$, the center of the leg is located in the toe and the model is similar to a two-mass model; when ${\displaystyle \alpha =1}$, the center lies in the hip joint and the model is the ARL monopod. In Figure 2 it can be seen that when α increases, the apex height of the COM of the robot and the compression of the leg spring decreases, while the step length increases. The step length reached at the maximum value when ${\displaystyle \alpha =0.7}$. The following conclusions can be drawn. If the robot is wanted to have a long jump, the COM of the leg should be close to the hip joint. If the robot is wanted to have a high jump, it should be far away from the hip joint and at the same time the robot should provide greater power by increasing the compression of the spring.

Figure 2. The step length , the apex height and the minimum value of the leg length during stance phase

In Figure 3 with the increase of α, the angle of the center of mass at the take-off time (take-off angle) decreases, the horizontal velocity of the center of mass increases, and the vertical velocity decreases. With ${\displaystyle \alpha =0.9}$ these velocities are approximately equal. The decrease of vertical velocity means the decrease of flight time, but the step size of the robot increases with the increase of horizontal velocity. Due to the dual influence of flight time and horizontal velocity, the robot ${\displaystyle \alpha =0.7}$. The maximum step size is reached at 0.7.

Figure 3. The horizontal and vertial velocity of the COM at takeoff

During the change of leg centroid, the stance time changed very little and remained around 0.2s (Figure 4). However, as the COM of the leg gets closer to the toe, the total jump time increases and the duty cycle decreases, which means that the time spent by the robot in the take-off phase increases and the gait frequency decreases. Before the next jump, the swing of the leg is controlled more easily.

Figure 4. Bounce period, stance time v.s. ${\displaystyle \alpha }$

In Figures 5 and 6, it can be seen that with the increase of α, the center of mass of the leg is closer to the hip joint, and the body angle amplitude decreases, but the leg angle amplitude increases. The closer the center of mass of the leg is to the hip joint, the closer the leg swing curve is to the sine curve. When the center of mass of the body is located at the hip joint, the leg swing curve is a sine curve.

Figure 5. Trajectory of the leg

Figure 6. Trajectory of the body

4.2 The effect of the center of mass of the body

Then we investigate the effect of the COM of the body on the hopping performance, it can be expressed by ${\textstyle \beta }$. The periodic gait of the hopping robot without active control is in Figure 7 when the COM of the body doesn’t locate in the hip joint. It shows that there was little change in the angle of the leg and the body, the motion of the robot is a vertical hopping and the robot doesn’t leave the ground, so it is necessary to control the robot in order to get a forward hopping. The control scheme is using the hip actuator to control the pitch angle to track the desired trajectory during the stance phase. A PD (Proportional-Derivative) controller is used to track the desired pitch trajectory [24-26].

Figure 7. Periodic passive hopping gait without active control

Using the pitch angle of passive hopping of ARL robot as the desired trajectory and computing the limit cycle with the optimization method, the passive gait of the asymmetrical hopping robot is obtained. Figures 8 and 9 are the posture and the limit cycle during one hoping cycle. It is can be seen that with active control, a satisfactory periodic motion is obtained when the robot has an asymmetric body mass. It can be seen that the toes of the robot collided with the ground in the flight phase. In order to prevent the toes of the robot from contacting the ground in the flight stage, the jumping height of the robot should be increased.

Figure 8. Active periodic gait of the hopping robot when ${\textstyle \alpha =0.7}$, ${\textstyle \beta =0.13}$

Figure 9. Limit cycle of the hopping robot

Although in theory ${\textstyle \beta }$ can be taken in [0,1], ${\textstyle \beta }$ is less than 1 for the following two reasons. The first reason is that it is unable to find fixed point. The second reason is that the minimum length of the leg length at the landing stage is 0, which means that the compression of the spring reaches 100%. In fact, due to the structure of the spring itself, the compression cannot be pressed to the bottom. The above two cases can be increased by improving the control method and increasing the spring stiffness to increase the range of ${\textstyle \beta }$. As can be seen from Figure 10, with the increase of ${\textstyle \alpha }$, the maximum allowed value of ${\textstyle \beta }$ is small. It shows that the closer the robot leg is to the hip joint, the smaller the allowable eccentricity of the body.

Figure 10. The maximum allowable value of ${\textstyle \beta }$ v.s. ${\textstyle \alpha }$

Figure 11 shows that with the increase of ${\textstyle \beta }$, the angle of the center of mass at the take-off decreases, the vertical velocity remains almost unchanged, while the horizontal velocity increases rapidly, and the step size of the robot becomes larger. The farther the body centroid is from the hip joint, the better. Because the change of bounce cycle time is very small, most of the energy provided by the leg spring is transformed into forward movement. However, due to the low centroid height of the robot at the take-off, the maximum height in the flight phase is also low, and the robot toe is easy to collide with the ground. So ${\textstyle \beta }$ cannot be too large.

Figure 11. The horizontal and vertical velocity of the center of mass at take-off

As can be seen from Figure 12, with the increase of ${\textstyle \beta }$, the minimum length of the leg in the landing stage decreases rapidly, and the compression amount of the spring changes from 38% to 69%, indicating that the farther the center of mass of the body is from the hip joint, the greater the force required to be provided by the leg spring. It should be considered to increase the stiffness of the spring.

Figure 12. Minimum length of legs in landing phase with different of ${\textstyle \beta }$

Figure 13 shows that with the increase of ${\textstyle \beta }$, the center of mass of the body deviates more and more from the hip joint, and the rotation amplitude of the body and legs increases. The closer the body centroid is to the hip joint, the closer the leg swing curve is to the sinusoidal curve. The angle of the body and leg increases at the take-off, correspondingly the take-off angle of the body centroid decreases. Body eccentricity provides a larger take-off range for robot motion.

(a) (b)

Figure 13. Leg angle and the body angle vs. time

Figure 14 shows that the greater the body eccentricity, the greater the driving torque required by the robot to drive the body pitching motion in the landing phase, because the swing range of the body in the landing phase also becomes larger.

Figure 14. Influence of body eccentricity ratio on driving torque

5. Conclusion

The period orbit problem of an asymmetric spring loaded inverted pendulum is addressed. The dynamic equations of the two link robot are established. Then the Poincare mapping method is used to turn the solution of the periodic motion of the hopping robot into the solution of the fixed point, and then the optimization method is used to obtain the fixed point of the hip robot. With a PD controller, a period orbit can be obtained. Through investigating the effect of the location of the leg mass and the body mass on the hopping performance, if the robot is wanted to jump longer, the center of mass of the leg and the body should be far away from the hip joint.

References