Skip to main content

ORIGINAL RESEARCH article

Front. Robot. AI, 26 October 2021
Sec. Robotic Control Systems
This article is part of the Research Topic Towards Real-World Deployment of Legged Robots View all 8 articles

Terrain-Perception-Free Quadrupedal Spinning Locomotion on Versatile Terrains: Modeling, Analysis, and Experimental Validation

  • 1Shenzhen Institute of Artificial Intelligence and Robotics for Society (AIRS), Shenzhen, China
  • 2Institute of Robotics and Intelligent Manufacturing (IRIM), The Chinese University of Hong Kong (CUHK), Shenzhen, China
  • 3George W. Woodruff School of Mechanical Engineering, Georgia Institute of Technology, Atlanta, GA, United States
  • 4Beijing Institute for General Artificial Intelligence, Beijing, China

Dynamic quadrupedal locomotion over rough terrains reveals remarkable progress over the last few decades. Small-scale quadruped robots are adequately flexible and adaptable to traverse uneven terrains along the sagittal direction, such as slopes and stairs. To accomplish autonomous locomotion navigation in complex environments, spinning is a fundamental yet indispensable functionality for legged robots. However, spinning behaviors of quadruped robots on uneven terrain often exhibit position drifts. Motivated by this problem, this study presents an algorithmic method to enable accurate spinning motions over uneven terrain and constrain the spinning radius of the center of mass (CoM) to be bounded within a small range to minimize the drift risks. A modified spherical foot kinematics representation is proposed to improve the foot kinematic model and rolling dynamics of the quadruped during locomotion. A CoM planner is proposed to generate a stable spinning motion based on projected stability margins. Accurate motion tracking is accomplished with linear quadratic regulator (LQR) to bind the position drift during the spinning movement. Experiments are conducted on a small-scale quadruped robot and the effectiveness of the proposed method is verified on versatile terrains including flat ground, stairs, and slopes.

1 Introduction

Quadruped robots, equipped with advanced walking ability over unstructured terrains, have started to make their way into human environments (Ijspeert, 2014; Yang et al., 2020; Bledt and Kim, 2020). The current quadruped robots can mimic not only static gaits of animals but also highly agile and dynamic behaviors, such as galloping, jumping, and back-flipping (Katz et al., 2019; Kim et al., 2019), which enable them to traverse unstructured terrains (Bledt et al., 2018; Kim et al., 2020; Jenelten et al., 2020). Yet, certain locomotion behaviors have not been explored, e.g., the circular spinning locomotion (Carpentier and Wieber, 2021). Dogs often spin to inspect the environment and search for potential threats (Park et al., 2005; Chen et al., 2017). For the robot counterpart, spinning gait is also an indispensable component to fulfill for trajectory tracking tasks in autonomous navigation (Xiao et al., 2021), because any curves can be decoupled into forward, lateral, and spinning locomotions (Ma et al., 2005; Wang et al., 2011; Hong et al., 2016). However, the highly dynamic spinning is still challenging due to the complex dynamics, such as uncertain contact, inaccurate foot placement, and potential tripping (Ishihara et al., 2019). Consequently, it is significant to investigate a method that can accomplish the accurate spinning locomotion over complex terrains.

Currently, most legged robots generate spinning motions by manipulating with yaw joints on pelvis or waist. (Miao and Howard, 2000) proposed a tripod turning gait for a six-legged walking robot by tuning the appropriate motion trajectory of the supporting leg relative to the robot body in simulation. (Roy and Pratihar, 2012) focused on improving turning gait parameters to minimize the energy consumption of a six-legged walking robot. Estremera et al. (2010) analyzed and formulated a spinning crab gait for a six-legged walking robot over rough terrain. Park et al. (2005) proposed a spinning gait for a quadruped walking robot with a waist joint, but the robot could not walk with the spinning gait on rough terrain. Chen et al. (2017) introduced a tripod gait-based turning gait of a six-legged walking robot. (Mao et al., 2020) demonstrated the Hexa-XIII robot with 12-leg joint motors and 1 waist motor. The six-legged robot improves the stability and decreases the leg interference for spinning compared with the common tripod gaits. However, the aforementioned turning/spinning gaits that are based on stability margin all belong to the static gait planning, which is only available for low-speed walking (Hong et al., 2016).

In the meantime, quadrupedal hardware has advanced significantly to enable highly mobile and agile motions. For example, the MIT Cheetah achieved a high speed of 3.7 m/s for straight running (Kim et al., 2019). The MIT mini Cheetah robot is capable of accomplishing highly dynamic motions, including trotting, running, bounding, and back-flipping (Bledt et al., 2018; Kim et al., 2019). These quadruped robots have 3 degrees of freedom (DoF) on each leg, but without rotational DoF in the pelvis (Estremera and Gonzalez, 2002; Ma et al., 2005). This leg configuration becomes mainstream on current quadruped robots due to better bionics in geometric topology. In this case, the spinning locomotion can be only realized through the rolling of the spherical foot-ends on the ground (Miura et al., 2013; Yeon and Park, 2014), which leads to the gait instability and CoM drift.

To address this challenge, this study first proposes a gait planning method with a modeled spherical foot for turning and spinning in the trotting gait. Based on the geometrical relationship of the foot end effector and body coordinate, a desired turning foot position is generated (Palmer and Orin, 2006; Roy and Pratihar, 2012; Liu et al., 2017). A spinning gait is obtained when the turning radius becomes zero. The CoM trajectory is generated directly by mapping from the planned foot positions. Second, a linear quadratic regulator (LQR) feedback controller is devised to compensate the cumulative errors along the trajectory to track the fixed point under a small turning radius (Thrun et al., 2009; Xin et al., 2021). The proposed method is validated on a quadruped robot platform for spinning over versatile terrains, and the results show improved convergence and stability when spinning with a trotting gait on challenging terrains. The main contributions of this letter lie in the following threefold:

i) Devise a turning/spinning gait planner with foot end effector kinematic correction and a CoM trajectory planner based on generalized support polygon.

ii) Devise a LQR controller to guarantee the spinning radius to be strictly bounded.

iii) Conduct experimental validations of the quadruped robot with satisfactory locomotion performance.

The rest of this article is organized as follows. Section 2 introduces the overall framework of this study. A turning/spinning step planner with a foot-end effector kinematic correction. A legged odometry feedback planner based on the LQR technique is introduced in Section 3 to guarantee the spinning movement to be bounded within a limited range. Simulation and experiment results are shown in Section 4. Section 5 concludes this study.

2 Framework

In order to achieve terrain-perception-free yet accurate spinning locomotion on versatile terrains, this study proposes a control framework as shown in Figure 1. This control framework incorporates the MIT mini cheetah controller as the low-level motion control module (Kim et al., 2019), which consists of the model predictive control (MPC) and whole-body control (WBC) modules. The robot’s state estimator and kinematics/dynamics model is used to obtain the current position, velocity, acceleration of the CoM and joints, respectively, using a linear Kalman filter. The errors of the foot rolling are taken into account in the motion planning process, and the kinematics of the legs is corrected by the foot end effector kinematic modification method (FKM). The proposed LQR controller is used to generate the body control commands, where the tracking error of the trajectory is strictly bounded. With the leg kinematics correction, the resultant body position and velocity are sent to MPC and WBC to calculate the expected position, velocity, and torques for joint actuators (Luo et al., 2019). The MPC computes the optimal reaction forces over a time horizon with a linearized single rigid body template model. The WBC tracks the computed reaction forces generated from the MPC for uncontrollable maneuvers such as galloping. These modules including MIT controller, projected support polygon (PSP), CoM trajectory planner, FKM, and LQR form our accurate spinning control framework (ASC).

FIGURE 1
www.frontiersin.org

FIGURE 1. The control framework for the terrain-perception-free and accurate spinning movement of quadruped locomotion. The blue region highlights the work proposed in this study. MIT Mini Cheetah tracking controller functions as the low-level motion controller. A state estimator provides state measurements for the kinematics correction, LQR controller, and CoM trajectory planner. q and q̇ are the joint position and velocity, respectively. The robot states θb, φb, and ψb are the roll, pitch, and yaw angular of the body. ωb, ab are the angular velocities and linear accelerations of the body. The foot states Pf,cmd, vf,cmd, and af,cmd are the position, velocity, and acceleration commands, respectively. Pf,cmd, vf,cmd, ωb, and ab are elements of R3N×1, where N is the number of foot contact on the ground.

Since the foot-end effector of the robot is spherical, the foot-end effector rolls on the ground as the leg posture changes. For small-scale quadruped robots, the ratio between radius of ball foot and shank length is large. As a result, the large radius foot will change the contact point and CoM position as the robot spins around the yaw axis during the support phase as shown in Figure 2. This deviation is not negligible during a highly agile locomotion and the spherical contact engagement needs to be investigated and modeled.

FIGURE 2
www.frontiersin.org

FIGURE 2. The illustration of a small-scale quadruped robot spinning by rolling the spherical foot end effector on the ground.

Additionally, in order to further guarantee the accuracy of the locomotion, a method of planning the trajectory of the CoM that mitigates translational drifting is developed. During the double support of the robot, the CoM drift is difficult to avoid. Once the CoM shifts from the diagonal of the support foot point, additional torque is applied by the gravity and affects the stability of the robot. On unstructured terrains, there are frequent undesired ground contacts due to the unpredictability and complexity. To improve the performance, the slope of the terrain is estimated based on the location of the feet. By mapping from the next foothold, the CoM position is adjusted to ensure motion feasibility based on PSP.

3 Gait and Center of Mass Trajectory Planning for Spinning Locomotion

In this section, a turning/spinning gait planner with foot-end effector kinematic modification (FKM), a CoM planner based on projected support polygon (PSP), and a CoM trajectory tracker based on an LQR controller are introduced respectively.

3.1 Turning/Spinning Gait Planner and Foot End Effector Kinematic Modification

As shown in Figure 3, the angle γ represents the circle angle in the turning process from the point A to the point B. Therefore, the translation variation of the support leg relative to the body of the robot between A and B is the variation of the CoG of the robot relative to the forward direction of the x axis and the lateral direction of the y axis.

FIGURE 3
www.frontiersin.org

FIGURE 3. (A) Transformation process of the circling/spinning gait divided into translation and rotation. (B) The inverse kinematics for a leg with a spherical foot-end effector that rolls on ground during the support phase.

Let Δlx,t and Δly,t be the variation which is given as follows :

Δlt=Δlx,tΔly,tΔlz,t=RsinγR(1cosγ)0.(1)

The hip position of right front (RF) leg in the body of the robot coordinate system is (L/2, −W/2), where L and W are the length and width of the robot body, respectively, because the body rotates γ angle in the counterclockwise direction. In the moment, the support legs are all right below the hip as shown in Figure 3A. The rotation variation of the hip of the body is also the variation of the support leg in the plane coordinate system. Therefore, the variation of the hip of the robot relative to the body rotation (Δlr) can be obtained as follows:

Δlr=Δlx,rΔly,rΔlz,r=L2cosγ+W2sinγL2sinγW2cosγ0.(2)

Based on the translation variation and rotation variation equations, the expression of the moving foot step of support legs with respect to the body coordinate system in the initial state can be obtained as follows:

Δl=Δlt+Δlr=Rsinγ+L2cosγ+W2sinγR(1cosγ)+L2sinγW2cosγ0.(3)

The sum of the current projection position of the hip joint and the calculated step length is used to plan the next footholds, which is given as follows:

Pf,cmd=Pshoulder,i+Δl.(4)

Due to the relative rolling between the spherical foot end and the ground surface, the contact point will constantly change and the movement trajectory of the body deviates from the desired trajectory. The deviation caused by the spherical end effector occurs not only in the vertical direction but also in the horizontal direction, which consequently leads to a severe tracking error and even locomotion failure. Therefore, it is necessary to propose a kinematics correction algorithm to eliminate this deviation.

Regardless of the shape and volume of the foot, the foot position vector p can be obtained by the forward kinematic as follows:

p̂=s23L3+s2L2s1c23L3+s1c2L2c1c23L3c1c2L2,(5)

where si = sinαi, ci = cosαi, sij = sin(αi + αj), and cij = cos(αi + αj) and αi, and αj are the ith and jth joint angles as shown in Figure 3B, respectively.

Similarly, the inverse kinematics solution is obtained through the leg kinematics which is denoted as follows:

α=α1α2α3=arctanP̂yP̂xarcsinA+L22L322L2AarctanA(P̂x)2P̂z±arccosAL22L322L2L3,(6)

where A=(P̂x)2+(P̂y)2+(P̂z)2. α1, α2, α3 represents the hip joint angle, thigh joint angle, and calf joint angle, respectively.

Even if no slip occurs, the contact point is constantly changing and the body CoM deviates from the desired trajectory as shown in Figure 3B and Supplementary Video S1. This deviation is attributed to the ball foot-end effector roll as the body moves during the support phase (Guardabrazo et al., 2006). In order to eliminate this modeling error, the required joint rotation angles need to be corrected to eliminate the mismatch between the point-foot model and ball foot (Kwon and Park, 2014). The ideal point-foot position relative to the hip joint coordinate system is derived by the forward dynamics in the following way (Lavaei et al., 2017):

Δ=PtPI=PtP,(7)

where PtP is the arc length between the foot reference point P and the real contact point Pt. P and PI are the same point at the initial contact state. Assuming there is no slip, the displacement offset of the foot on the ground is equivalent to the rotated distance on the foot. As shown in Figure 3B, the real foothold is obtained as follows:

OrefPt=L3s23L2s2L3s1c23L2s1c2L3c1c23+L2c1c2r,(8)

where r represents the radius of spherical foot-end effector. For the ideal foothold, we have the following:

OrefPI=OrefPt+Δ=L3s23L2s2ΔxL3s1c23L2s1c2ΔyL3c1c23+L2c1c2r,(9)

where Δx, Δy represents the vector Δ in the x and y directions of the base reference coordinate system. Therefore, the angle ϕ between the third linkage and the perpendicular of the horizontal plane can be obtained and Δz = 0, Δ, and OrefP are coplanar; therefore, we have the following:

Δ=ΔxΔy0=rs23φs12c232+s232rs1c23φs12c232+s2320,(10)

where φ = arccos (−c1c23) and |Δ| = .

Hence, the kinematic solution to the ideal foothold in the base–joint coordinate system can be obtained as follows:

OrefPI=PIxPIyPIz=L2s23L3s2rs23φs12c232+s232L3s1c23L2s1c2rs1c23φs12c232+s232L3c1c23+L2c1c2r.(11)

For the single leg with a spherical foot end, the position of the ideal foothold point in the root joint coordinate system is known. The rotation angle vector of each joint of the leg can also be solved through the following inverse kinematics:

α=α1α2α3=arctanPIyΔyPIz+rarcsinA+L22L322L2AarctanA(PIx+Δx)2PIx+Δx±arccosAL22L322L2L3,(12)

where A=(P̂Ix+Δy)2+(P̂Iy+Δy)2+(P̂Iz+r)2. α1′, α2′, α3′ represents the hip joint angle, thigh joint angle, and calf joint angle, respectively.

Besides, a terrain estimation method is devised for uneven terrains by taking the height difference of the four legs into account. The terrain height can be modeled using the following linear regression:

z(x,y)=a0+a1x+a2y.(13)

Coefficients a=(a0,a1,a2)T of (Eq. 13) are obtained through the solution of the minimum squares problem as is described in a study by ((Bledt et al. (2018) which are given as follows:

a=(WTW)1WTpcz,(14)

where pc=(pcx,pcy,pcz)T is the most recent contact point of each foot, and W=[1pcxpcy]4×3. When the robot encounters uniformly changing terrains such as block roadblocks and stairs, this modeling method is still effective. In this way, the terrain information has been roughly estimated to assist in the modification of the upcoming footstep location. The body posture angle of the robot will be adjusted according to the angle of the ground plane in (Eq. 13) to adapt to the terrain.

When the robot walks on unstructured terrain, the estimated terrain is combined to modify the current planned position. The upcoming footstep location is shown as follows:

Pf,cmd=100010a1a21Pf,cmd+00a0,(15)

where a0, a1, a2 are obtained through the solution of the least squares problem as mentioned above. When the robot is walking on a plane, using (Eq. 15) to calculate the next footing point is an effective method. However, when the robot is traversing on unstructured terrain, the upcoming footstep location needs to be modified so that the actual foot-end effector trajectory of the quadruped robot can track the planned trajectory.

3.2 Center of Mass Planner Based on Projected Support Polygon

A majority of studies in turning gaits belong to the static gait planning with a slow walking speed because the gaits are optimized based on stability margin (SM) to ensure the balance (Chen et al., 2017; Luo et al., 2021). SM is the shortest distance from the vertical projection of the CoM to any point on the boundary of the support polygon pattern. For dynamics gait like trotting of quadruped robots, the two supporting point feet cannot form conventional polygon patterns (Luo et al., 2020). Here, we calculate the desired CoM trajectory by introducing the PSP concept, mapping the foot position of the swing leg as a virtual vertex (Figure 4).

FIGURE 4
www.frontiersin.org

FIGURE 4. The illustration of the desired CoM trajectory calculation is based on the PSP CoM planner.

The midpoint of diagonal line of two supporting feet is marked as O. Four vectors riFR:1,FL:2,BR:3,BL:4 start from O, pointing to the position of each foot point. Then, four virtual vectors can be obtained by projecting on the ground.

Instead of uniform interpolating centroid positions based on the velocity at the current and desired centroid positions, a set of weights are used to calculate foot position in the swing phase. The weights P obey common unimodal distributions like geometric, Poisson, or Gaussian distribution.

P(c|sϕ,ϕ)=D(sϕ,ϕ),(16)

where P (c|sϕ, ϕ) ∈ [0, 1] corresponds to the adaptive weighting factor during the scheduled stance and swing phase. The phase ϕ represents the gait phase, and sϕ acts as a switch between swing (P (c|ϕ) = 0) or stance (P (c|ϕ) = D (sϕ)). The closer the leg is to the middle of the stance phase, the heavier the coefficient P(c|sϕ, ϕ) = D(sϕ, ϕ) of the support foothold location. On the contrary, the closer the leg is to the middle of swing phase, the smaller the P (c|sϕ, ϕ) = D(sϕ, ϕ) of the foothold location is.

Vi=P(i,ϕ)rî.(17)

Vi is the vertex of the foothold location after multiplying the weights. Four projected supporting vertexes Pi can be obtained from Vi. Given the average value of the vertices, the expected value of the robot’s expected CoM value is approximated as follows:

p̂CoM,i=1Ni=1NPi,v̂CoM=p̂̇CoM.(18)

The difference between the planned CoM position p̂CoM,i and the current CoM position p̂CoM,curr divided by the gait cycle T is the desired velocity. Adding the current CoM by the product of the average velocity v̂CoM and the unit time δt position, we interpolated the CoM trajectory of f points between the current CoM position and the planned CoM position p̂CoM=[p̂CoM,1,p̂CoM,2,,p̂CoM,f]T and sent the continuous CoM position and velocity trajectories (the velocity one is calculated by differentiating the position trajectory) to the MPC and WBC controllers.

3.3 Center of Mass Trajectory Tracking

Searching methods are common for path tracking problems of mobile robots. The goal point and path curvature connecting to the goal point are calculated in every step. The goal point pr,i=[pr,i,x,pr,i,y]T is illustrated in Figure 3. The legs’ steering angle δ can be determined using only the goal point location and the angle between the vehicle’s heading vector and the look-ahead vector. The search for goal point pr,i is determined from the CoM position without look-ahead distance to the desired path (Lr). The distance between the points on the desired path with the current CoM position p is calculated by the Euclidean distance. The index i and nearest point on the path pr,i can be obtained. θr is the reference yaw angle of body in the world coordinate. The angular velocity of body is ω. The steering angle δ, the angle between the leg trajectory, and the x axis of body can be determined by the tangent angle of the goal point. The curvature of a circular arc of goal point can be calculated directly.

pr,i=arg miniLrp2,θr=arctan(ṗr,i),R=(1+ṗ2)(3/2)ÿ.(19)

The generalized ball foot error obtained in the previous section is regulated with a LQR controller. p is the CoM position and γ is the attitude angle of the body. Define state vector X=[pT,γ]T and control vector u=[vT,δ̇], the body dynamics are formulated as follows:

ẋ=vcosγ,ẏ=vsinγ,γ̇=ω.(20)

By defining X̃=XXr, ũ=uur, and linearizing the dynamics around the reference point, the system governing equation is reformulated as follows:

X̃̇=AX̃+Bũ,(21)

where A and B are given as follows:

A=00vrsinγ00vrcosγ000,B=cosγ0sinγ0tanγvrcosδ,(22)

where vr is the desired velocity on pr,i. For controller implementation, (Eq. 21) is discretized with the forward Euler discretization:

X̃̇(k)=X̃(k+1)X̃(k)Δt.(23)

Then the LQR controller is obtained by minimizing the performance index:

J=k=1(X̃T(k)QX̃(k)+ũT(k)Rũ(k)),(24)

where positive definite matrices Q and R are weighting parameters.

4 Simulation and Experiment Results

To validate the proposed method, three sets of experiments are conducted in simulations and experiments: the feasible spinning locomotion of trotting gait, the bounded small radius of spinning, and spinning on the slopes and stairs. While our ASC method is generalizable to model any turning action, we primarily focus on showing its effectiveness on fast spin maneuvers over various terrains, where the motion is prone to failures. The experiments are tested on a real small-scale quadruped robot platform.

4.1 Experiment Platform

The experiment platform for the spinning test is a small-scale quadruped robot, which is electrically actuated with 12 degrees of freedom, 9 kg weight, and 28 cm tall. The body clearance is 29 cm and length is 38 cm, and the length of thigh and calf joint is 21.5 and 20 cm, respectively. The radius r of foot is 2.25 cm. The locomotion controller is executed on an Intel UP board low-power single-board computer, with a quad-core Intel Atom CPU, 4 GB RAM. Linux with the CONFIG PREEMPT RT patch works as the operating system. UP board is used to run the low-level controller, including MPC, WBC, and the state estimator.

4.2 Experimental Validation of Spinning on the Flat Ground

The above method is validated through comparative experiments. The robot is expected to spin at trotting gait on the flat ground. The velocity of the robot in the x and y directions is 0 m s−1. The angular velocity ω is 0.7 rad s−1. The gait planner, FKM, PSP CoM planner, and LQR controller are verified for spinning both on simulation and the quadruped platform. The experiment screenshots of the quadruped robot spinning on the flat ground are shown in Figure 5.

FIGURE 5
www.frontiersin.org

FIGURE 5. Screenshots of the quadruped robot spinning on the flat ground with an ACS controller.

The CoM trajectories during spinning are shown in Figure 6. The PSP CoM planner was used by default in each trial to avoid falling. Eight cycles’ data containing about 100 steps were recorded. The results of first 5 seconds were removed, when the robot went straight to the preset position. Figure 6A shows the simulated results of different control methods. The black line is the trajectories of MIT controller with a circle having a radius of 2.79 cm, and the trajectory variance is 0.57 mm2. Based on the MIT controller, FKM method is added, and the corresponding trajectories are brown lines. The brown circle has a radius of 1.4 cm with a variance of 0.43 mm2. In our ASC framework, an LQR controller is also added, together with an MIT controller and FKM, to further reduce the radius and bound the trajectories to the origin point. The red lines are the trajectories formed by using our ASC method. The radius reduces to 1.12 cm and the trajectory variance is 0.31 mm2, which clearly shows an improvement in tracking accuracy. Figure 6B shows the experimental results on the Mini Cheetah quadruped hardware platform. Though the CoM trajectories have a clear stochastic disturbance compared to simulation, the results show similar features. By using ACS, the CoM trajectory of the robot that spins converges to the fixed point with a radius of 3.84 cm (variance: 0.56 cm2). After adding FKM, the CoM trajectory reaches an intermediate level with a radius of 4.28 cm (variance: 0.5 cm2). With merely an MIT controller, the radius of the CoM trajectory increase to 7.67 cm (variance: 2.50 cm2) and shows an inconsistent tracking performance. In addition, spinning is conducted by using merely LQR and MIT controller in Supplementary Figure S5. LQR tends to bind the radius to zero directly, and the trajectory crosses the origin repeatedly. Based on the four sets of comparative experiment, we consider that the components in our ASC framework have different functionalities: i) PSP CoM planner component projects the CoM onto the diagonal of the supporting foot to avoid falling during spinning, which is used by default in our spinning results. ii) FKM eliminates the position error by modeling the mismatch of the point-foot assumption and the ball foot in practice. iii) By incorporating with the LQR, systematic errors are further reduced and a bound is established on the robot’s absolute position.

FIGURE 6
www.frontiersin.org

FIGURE 6. The CoM trajectory of the robot during the spinning experiments in simulation (A) and in the hardware platform (B). The black lines represent the CoM trajectory with merely an MIT controller. The brown lines denote the CoM trajectory after adding FKM. The red lines represent the CoM trajectory after adding FKM and LQR.

Figure 7 shows the drift, velocity, and the attitude of the x and y axes during the spinning. 10 s’ records containing about 20 steps were recorded. In Figure 7A, the x (3.49 cm) and y (1.96 cm) axes drift with an MIT controller is 2 times larger than the drift (x: 0.62 cm, y: 0.71 cm) using our ASC method in simulation. The drift is also closer to the origin in the world coordinate system. Figure 7B represents the drift of the x and y axes on the quadruped hardware platform. Similar to simulation, the fluctuation range of the x (1.25 cm) and y (1.06 cm) axis drifts is small (while the drifts fluctuation range of the x and y axes is (3.22 cm) and (2.77 cm) and fluctuating around 0, which is beneficial for the center of the robot spinning closer to the origin in the world coordinate system. Besides the effective tracking of the desired CoM point during the robot spinning, the stability of the robot during the spinning is also improved. As shown in Figure 7, the roll angle, pitch angle, linear acceleration, and angular acceleration of the robot are recorded. The accuracy of roll and pitch in the dynamic motion is crucial. Large roll and pitch angle variations will cause the robot to tilt or even fall. With our ASC method, the experiment has smaller fluctuations in roll and pitch. The pitch angle of body ranges from -0.02 to 0 rad, and shows a smaller drift from 0 rad in simulation. In the quadruped platform experiment, the calculated mean angle and variance are 1.77 × 10−3 rad, 1 × 10−4 rad for pitch, and −1.35 × 10−2 rad and 1.17 × 10−4 rad for roll, compared with the −1.75 × 10−3 rad, 5.85 × 10−4 rad for pitch, and 1.83 × 10−2 rad and 3.70 × 10−4 rad for roll with using MIT controller methods, respectively.

FIGURE 7
www.frontiersin.org

FIGURE 7. The CoM position, velocity, and attitude of body during spinning in simulation (A) and experiments (B) are recorded. The black and red lines represent the results of the MIT controller and our ASC controller, respectively.

Figure 8 shows a linear and angular acceleration phase diagram to demonstrate the stability improvement during spinning. The smaller the acceleration values in the x and y directions, the more stable the robot body. In simulation (Figure 8A), our ASC method reduces the variance from (x: 1.51 × 10−1 (m/s2)2, y: 1.42 × 10−1 (m/s2)2) to (x: 8.48 × 10−2 (m/s2)2, y: 8.69 × 10−2 (m/s2)2) for linear acceleration, and (Roll: 3.3 × 10−3 (rad/s2)2, Pitch: 8.7 × 10−2 (rad/s2)2) to (Roll: 1.1 × 10−3 (rad/s2)2, Pitch: 1.3 × 10−3 (rad/s2)2) for angular acceleration. In the experimentation (Figure 8B), the differences are not so obvious as in simulation, showing the variance from 0.933(m/s2)2 to 0.784(m/s2)2 for a linear acceleration of the x direction, and (Roll: 0.142(rad/s2)2, Pitch: 0.146(rad/s2)2) to (Roll: 0.088(rad/s2)2, Pitch: 0.084(rad/s2)2) for angular acceleration, respectively. It is concluded that our work bound the acceleration during the spinning of the quadruped robot, showing better stability and smaller trajectory tracking errors.

FIGURE 8
www.frontiersin.org

FIGURE 8. The linear acceleration and angular acceleration of the robot during spinning experiments in simulation (A) and the quadruped platform (B), respectively. The black and red lines represent the experimental results with MIT controller and our ASC controller, respectively.

4.3 Experimental Validation of Spinning on Uneven Terrains

The spinning experiment is also conducted on slope and stair terrains to demonstrate the robustness of the proposed method. These terrains are also common scenes in human daily life. Compared with the flat ground spinning, these terrains bring gravity effect and obstacles as disturbance during spinning. By using the terrain estimation method mentioned above, our ASC method also showed robust performance on these terrains, as shown in Figure 9 and Supplementary Video S2. As shown in Figure 10, the CoM trajectory and attitude of the robot body are recorded while spinning on the slope and stairs. A constant 0.7 rad/s spinning speed was maintained. With the terrain adaptation, the pitch angles changed periodically, ensuring the body is parallel to the slope. The small peaks are caused by the repeated steps. With our ASC method, the roll angle of the robot spinning on the slope has a small range from 0.352 to 0.165 rad, fluctuating around 0. The variance decreased from 5.8 × 10−3 rad2 to 9.8 × 10−4 rad2. For stairs, the performance is worse than that of the slope due to the discrete available footsteps and slipping and stumbling that occurs occasionally. With the ASC controller, the roll angle of the robot spinning on the stairs has a small range from 0.2597 to 0.2057 rad, and the variance decreases from 3.28 × 10−3 rad2 to 1.43 × 10−3 rad2. Figures 10E,F record the errors of position and angle of spinning on different terrains with varied spinning velocities of 0.8, 1.0, and 1.2 rad/s. The data are statistical results of 5 trials. In each trail, the robot spins at least 10 cycles corresponding to over 120 steps. The errors increase with larger angular velocities and the ground has the minimum error as expected. Other detailed velocity and acceleration data are in the Supplementary Materials. Overall, the effectiveness of the proposed method is demonstrated for improving both the accuracy and stability for spinning on slope and stairs.

FIGURE 9
www.frontiersin.org

FIGURE 9. Screenshots of the quadruped robot spinning on the (A) slope and (B) stairs with the proposed ASC method.

FIGURE 10
www.frontiersin.org

FIGURE 10. The CoM trajectory, the roll and pitch angles, the displacement, and velocity of the x and y axes in the experiment of spinning on the slope (A, B) and stairs (C, D). The black and red lines represent the experimental data with the MIT controller and our ASC controller, respectively. The statistical attitude errors (E) and trajectory errors (F) are recorded when spinning on different terrains with varied velocities of 0.8, 1.0, and 1.2 rad/s.

5 Conclusion and Future Work

The work presented in this study proposes an approach for terrain-perception-free but accurate spinning locomotion of a quadruped robot including a gait planner with spherical foot end effector modification, a CoM trajectory planner, and a LQR feedback controller. The roles of these three components are different and indispensable to accomplish the accurate spinning task. Specifically, the CoM trajectory planner is a modification of the traditional linear interpolation method. However, using only the linear interpolation method cannot maintain spinning on ground, and the robot falls after several turns of spinning. The foot end effector modification of the point-foot model error shows an improvement for the position error elimination during spinning. Besides the foot end effector rolling, an LQR feedback controller is added to further reduce the system errors. Experimental results on versatile terrains including flat ground, slope, and stairs are demonstrated. The radius of CoM trajectory and the variance of body state was reduced from 7.67 to 3.84 cm for ground through the comparison experimentation. Spinning is a type of agile locomotion and an indispensable part of turning. In fact, spinning can be treated as a special case of turning gait with a zero turning radius. According to our results, spinning can enlarge the defects of the model errors (foot end effector rolling in this work) or controllers. Thus, spinning can be treated as a standard evaluation method for testing the motion ability of legged robots, as proposed in the analysis of this study. Perception and path planning will be integrated into our framework in the future. By grasping a better understanding of the environment including the terrains and obstacle, accurate spinning ability has great potential to provide the legged robot with better adaptivity in narrow spaces.

Data Availability Statement

The original contributions presented in the study are included in the article/Supplementary Material; further inquiries can be directed to the corresponding authors.

Author Contributions

JL, HZ, DW, and YZ conceived the idea and designed the experiments. DW and HZ carried out the experiments and collected the data. HZ, JL, and YZ provided theory support. JL, HZ, NB, YZ, AZ, LR, and DW discussed the results. HZ and DW wrote the manuscript, and JL, LR, NB, ZZ, and YZ contributed to editing the manuscript.

Funding

This work was supported in part by the National Natural Science Foundation of China under Grant 51905251, in part by the National Key R&D Program of China (2019YFB1310402), and in part by AIRS project under Grant AC01202101023.

Conflict of Interest

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

Publisher’s Note

All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article, or claim that may be made by its manufacturer, is not guaranteed or endorsed by the publisher.

Supplementary Material

The Supplementary Material for this article can be found online at: https://www.frontiersin.org/articles/10.3389/frobt.2021.724138/full#supplementary-material

References

Bledt, G., and Kim, S. (2020). “Extracting Legged Locomotion Heuristics with Regularized Predictive Control,” in 2020 IEEE International Conference on Robotics and Automation (ICRA), Paris, France, May 31–Auguset 31, 2020, 406–412. doi:10.1109/ICRA40945.2020.9197488

CrossRef Full Text | Google Scholar

Bledt, G., Powell, M. J., Katz, B., Di Carlo, J., Wensing, P. M., and Kim, S. (2018). “Mit Cheetah 3: Design and Control of a Robust, Dynamic Quadruped Robot,” in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain, October 1–5, 2018, 2245–2252. doi:10.1109/IROS.2018.8593885

CrossRef Full Text | Google Scholar

Carpentier, J., and Wieber, P.-B. (2021). Recent Progress in Legged Robots Locomotion Control. Curr. Robot. Rep. 2, 231–238. doi:10.1007/s43154-021-00059-0

CrossRef Full Text | Google Scholar

Chen, G., Jin, B., and Chen, Y. (2017). Tripod Gait-Based Turning Gait of a Six-Legged Walking Robot. J. Mech. Sci. Technol. 31, 1401–1411. doi:10.1007/s12206-017-0241-y

CrossRef Full Text | Google Scholar

Estremera, J., Cobano, J. A., and Gonzalez de Santos, P. (2010). Continuous Free-Crab Gaits for Hexapod Robots on a Natural Terrain with Forbidden Zones: An Application to Humanitarian Demining. Robot. Auton. Syst. 58, 700–711. doi:10.1016/j.robot.2009.11.004

CrossRef Full Text | Google Scholar

Estremera, J., and Gonzalez de Santos, P. (2002). Free Gaits for Quadruped Robots over Irregular Terrain. Int. J. Robot. Res. 21, 115–130. doi:10.1177/027836402760475333

CrossRef Full Text | Google Scholar

Guardabrazo, T. A., Jimenez, M. A., and Gonzalez de Santos, P. (2006). Analysing and Solving Body Misplacement Problems in Walking Robots with Round Rigid Feet. Robot. Auton. Syst. 54, 256–264. doi:10.1016/j.robot.2005.10.007

CrossRef Full Text | Google Scholar

Hong, Z., Li, B., Zhang, H., Xin, Y., and Li, Y. (2016). “A Turning Gait Generation Approach for Quadruped Robot Based on Trotting Gait,” in 2016 35th Chinese Control Conference (CCC), Chengdu, China, July 27–29, 2016, 6068–6073. doi:10.1109/ChiCC.2016.7554309

CrossRef Full Text | Google Scholar

Ijspeert, A. J. (2014). Biorobotics: Using Robots to Emulate and Investigate Agile Locomotion. Science 346, 196–203. doi:10.1126/science.1254486

PubMed Abstract | CrossRef Full Text | Google Scholar

Ishihara, K., Itoh, T. D., and Morimoto, J. (2019). 2019 Ras Adcom. IEEE Robot. Automat. Mag. 26, 119. doi:10.1109/mra.2019.2891189

CrossRef Full Text | Google Scholar

Jenelten, F., Miki, T., Vijayan, A. E., Bjelonic, M., and Hutter, M. (2020). Perceptive Locomotion in Rough Terrain - Online Foothold Optimization. IEEE Robot. Automat. Lett. 5, 5370. doi:10.1109/lra.2020.3007427

CrossRef Full Text | Google Scholar

Katz, B., Di Carlo, J., and Kim, S. (2019). “Mini Cheetah: A Platform for Pushing the Limits of Dynamic Quadruped Control,” in 2019 International Conference on Robotics and Automation (ICRA) (IEEE), Montreal, QC, Canada, May 20–24, 2019, 6295–6301. doi:10.1109/icra.2019.8793865

CrossRef Full Text | Google Scholar

Kim, D., Carballo, D., Di Carlo, J., Katz, B., Bledt, G., Lim, B., et al. (2020). “Vision Aided Dynamic Exploration of Unstructured Terrain with a Small-Scale Quadruped Robot,” in 2020 IEEE International Conference on Robotics and Automation (ICRA), Paris, France, May 31–August 31, 2019, 2464–2470. doi:10.1109/ICRA40945.2020.9196777

CrossRef Full Text | Google Scholar

Kim, D., Di Carlo, J., Katz, B., Bledt, G., and Kim, S. (2019). Highly Dynamic Quadruped Locomotion via Whole-Body Impulse Control and Model Predictive Control. arXiv. preprint arXiv:1909.06586.

Google Scholar

Kwon, O., and Park, S. (2014). Adaptive Dynamic Locomotion of Quadrupedal Robots with Semicircular Feet on Uneven Terrain. Int. J. Control. Automat. Syst. 12, 147–155. doi:10.1007/s12555-013-0253-z

CrossRef Full Text | Google Scholar

Lavaei, M., Mahjoob, M., and Behjat, A. (2017). “Derivation of the Constraint Equations in the Kinematic Modeling of Legged Robots with Rigid Semi-spherical Feet,” in 2017 18th International Conference on Advanced Robotics (ICAR) (IEEE), Hong Kong, China, July 10–12, 2017, 373–378. doi:10.1109/icar.2017.8023635

CrossRef Full Text | Google Scholar

Liu, W., Zhou, L., Qian, H., and Xu, Y. (2017). “Turning Strategy Analysis Based on Trot Gait of a Quadruped Robot,” in 2017 IEEE International Conference on Robotics and Biomimetics (ROBIO), Macau, Macao, December 5–8, 2017, 1306–1311. doi:10.1109/ROBIO.2017.8324598

CrossRef Full Text | Google Scholar

Luo, J., Gong, Z., Su, Y., Ruan, L., Zhao, Y., Asada, H. H., et al. (2021). Modeling and Balance Control of Supernumerary Robotic Limb for Overhead Tasks. IEEE Robot. Automat. Lett. 6, 4125–4132. doi:10.1109/lra.2021.3067850

CrossRef Full Text | Google Scholar

Luo, J., Su, Y., Ruan, L., Zhao, Y., Kim, D., Sentis, L., et al. (2019). Robust Bipedal Locomotion Based on a Hierarchical Control Structure. Robotica 37, 1750–1767. doi:10.1017/s0263574719000237

CrossRef Full Text | Google Scholar

Luo, J., Zhao, Y., Ruan, L., Mao, S., and Fu, C. (2020). Estimation of Com and Cop Trajectories during Human Walking Based on a Wearable Visual Odometry Device. IEEE Trans. Automat. Sci. Eng. doi:10.1109/tase.2020.3036530

CrossRef Full Text | Google Scholar

Ma, S., Tomiyama, T., and Wada, H. (2005). Omnidirectional Static Walking of a Quadruped Robot. IEEE Trans. Robot. 21, 152–161. doi:10.1109/tro.2004.835448

CrossRef Full Text | Google Scholar

Mao, L. H., Tian, Y., Gao, F., and Zhao, Y. (2020). Novel Method of Gait Switching in Six-Legged Robot Walking on Continuous-Nondifferentiable Terrain by Utilizing Stability and Interference Criteria. Sci. China Technol. Sci. 63, 1–14. doi:10.1007/s11431-020-1588-5

CrossRef Full Text | Google Scholar

Miao, S., and Howard, D. (2000). Optimal Tripod Turning Gait Generation for Hexapod Walking Machines. Robotica 18, 639. doi:10.1017/s0263574700002642

CrossRef Full Text | Google Scholar

Miura, K., Kanehiro, F., Kaneko, K., Kajita, S., and Yokoi, K. (2013). Slip-turn for Biped Robots. IEEE Trans. Robot. 29, 875–887. doi:10.1109/tro.2013.2257574

CrossRef Full Text | Google Scholar

Palmer, L. R., and Orin, D. E. (2006). “Attitude Control of a Quadruped Trot while Turning,” in 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems, Beijing, China, October 9–15, 2007, 5743–5749. doi:10.1109/IROS.2006.282381

CrossRef Full Text | Google Scholar

Park, S.-H., Kim, D.-S., and Lee, Y.-J. (2005). “Discontinuous Spinning Gait of a Quadruped Walking Robot with Waist-Joint,” in 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems (IEEE), Edmonton, AB, Canada, August 2–6, 2005, 2744–2749. doi:10.1109/iros.2005.1544956

CrossRef Full Text | Google Scholar

Roy, S. S., and Pratihar, D. K. (2012). Effects of Turning Gait Parameters on Energy Consumption and Stability of a Six-Legged Walking Robot. Robot. Auton. Syst. 60, 72–82. doi:10.1016/j.robot.2011.08.013

CrossRef Full Text | Google Scholar

Thrun, S., Montemerlo, M., and Palatucci, M. (2009). Stanley: The Robot that Won the Darpa Grand challenge. J. Field Robot. 23, 661–692. doi:10.1007/978-3-540-73429-1_1

CrossRef Full Text | Google Scholar

Wang, X., Li, M., Wang, P., and Sun, L. (2011). “Running and Turning Control of a Quadruped Robot with Compliant Legs in Bounding Gait,” in 2011 IEEE International Conference on Robotics and Automation, Shanghai, China, May 9–13, 2011, 511–518. doi:10.1109/ICRA.2011.5979619

CrossRef Full Text | Google Scholar

Xiao, A., Tong, W., Yang, L., Zeng, J., Li, Z., and Sreenath, K. (2021). Robotic Guide Dog: Leading a Human with Leash-Guided Hybrid Physical Interaction. International Conference on Robotics and Automation (ICRA 2021). Xi’an, China: arXiv. preprint arXiv:2103.14300.

Google Scholar

Xin, G., Xin, S., Cebe, O., Pollayil, M. J., and Mistry, M. (2021). Robust Footstep Planning and Lqr Control for Dynamic Quadrupedal Locomotion. IEEE Robot. Automat. Lett. 1–1. doi:10.1109/lra.2021.3068695

CrossRef Full Text | Google Scholar

Yang, C., Yuan, K., Zhu, Q., Yu, W., and Li, Z. (2020). Multi-expert Learning of Adaptive Legged Locomotion. Science 5, 1–14. doi:10.1126/scirobotics.abb2174

CrossRef Full Text | Google Scholar

Yeon, J. S., and Park, J. H. (2014). A Fast Turning Method for Biped Robots with Foot Slip during Single-Support Phase. IEEE/ASME Trans. Mechatron. 19, 1847–1858. doi:10.1109/TMECH.2014.2316007

CrossRef Full Text | Google Scholar

Keywords: quadruped robot, turning gait, spinning locomotion, trajectory tracking control, versatile terrains

Citation: Zhu H, Wang D, Boyd N, Zhou Z, Ruan L, Zhang A, Ding N, Zhao Y and Luo J (2021) Terrain-Perception-Free Quadrupedal Spinning Locomotion on Versatile Terrains: Modeling, Analysis, and Experimental Validation. Front. Robot. AI 8:724138. doi: 10.3389/frobt.2021.724138

Received: 12 June 2021; Accepted: 24 August 2021;
Published: 26 October 2021.

Edited by:

Luis Sentis, University of Texas at Austin, United States

Reviewed by:

Huihua Zhao, SRI International, United States
Hae-Won Park, Korea Advanced Institute of Science and Technology, South Korea

Copyright © 2021 Zhu, Wang, Boyd, Zhou, Ruan, Zhang, Ding, Zhao and Luo. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Jianwen Luo, jamesluo@cuhk.edu.cn; Ye Zhao, ye.zhao@me.gatech.edu

Disclaimer: All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article or claim that may be made by its manufacturer is not guaranteed or endorsed by the publisher.