Abstract

In order to solve the defects of the large inertia and control difficulty of the electrically driven quadruped legs of robots, a novel leg structure and a control method are proposed in this paper. In terms of structure, the motor of the knee is arranged in the body of the robot to reduce the weight of the legs. In addition, this paper improves the PVT difference control algorithm embedded in the PMAC controller. Using the nonlinear control principle of the U-model, the optimized segmented Hermite difference method is used to implement the planning of the foot trajectory of the quadruped robot. Simulation and experiment show that the leg structure design is reasonable and the improved interpolation algorithm has good control effect.

1. Introduction

Quadruped robots, which combine the flexibility of biped robots and the stability of hexapod robots, are widely used in flood fighting, explosive disposal, military transportation, interplanetary detective, etc. Due to their superior performance, they have attracted more and more scholars for study. In recent years, experts all over the world have continuously overcome difficulties in quadruped robots and achieved a series of experimental results [13]. Among them, one of the most representative robots is Big Dog, which is developed by Boston Dynamics for more than a decade [4, 5]. With a top speed of 10 km/h, the robot can transport weapons, ammunition, food, and other items to hard-to-reach areas and can cooperate with soldiers. With the support of the national high and new technology research and development plan (863 Plan), Shandong University, Harbin Technical University, Shanghai Jiao Tong University, and other institutes have made a lot of achievements in the field of quadruped robots, successfully realizing robot steady walking on the slope and gravel road surface [69].

When a quadruped robot walks according to the planned trajectory, it is difficult to obtain an ideal foot trajectory due to the constraints of robot structure and control mode. Therefore, trajectory generation and control of quadruped robot has always been an important subject in this research field. In literature [10] He and Ma raised a method to generate cycloid trajectory of the foot. In literature [11], Lei et al. studied the kinematics and dynamics of several common trajectories and analyzed the advantages and disadvantages of cycloidal trajectory. Wang et al. proposed an improved algorithm for zero-impact cycloid trajectory to generate a foot trajectory with section of continuous function in literature [12]. However, none of the above literatures has proposed a specific method to realize the cycloid trajectory of the quadruped robot through the controller. In this paper, we designed an electrically driven leg structure and proposed a method of generating the foot trajectory of quadruped robot for the purpose of the trajectory planning. Furthermore, the planned foot trajectory is also written into the PMAC controller to realize the foot movement.

2. Structure Design and Kinematics Analysis of Leg of Quadruped Robot

2.1. Structural Design

When a quadruped robot walks, it mainly depends on the reaction force (friction and support force) of the ground to the touching foot to drive the fuselage forward. As a result, the design of leg mechanism will directly affect the stability of the quadruped robot during walking.

There are two main factors to be considered in leg design: driving method and leg structure. The common leg structures of quadruped robots can be divided into four types: full elbow joints, full knee joints, front knee joints and back elbow joints, and front elbow joints and back knee joints (Figure 1). Through the simulation of virtual prototypes and the testing of physical prototypes, Zhang et al. believed that the quadruped robots in the form of front elbow joints and back knee joints have the characteristics of high speed, small lateral offset, low energy consumption, and small fluctuation. In addition, the four symmetrical leg structures can effectively eliminate the sway of the fuselage while walking and maintain the stability of the fuselage. Most domestic and foreign quadruped robots use this method to arrange the leg structure [13].

There are two driving modes of quadruped robot: hydraulic and servo. The hydraulic actuator changes the force mainly by changing the hydraulic pressure and has the advantages of simple structure, stable acceleration and deceleration, and good reliability. However, the liquid medium is easy to be polluted, and the cost of hydraulic components is high. The servo driver has the advantages of high standardization, simple structure, low cost, and high transmission efficiency. In this paper, from the perspective of structure and application, the servo motor with high transmission efficiency is selected as the main driving mode. In order to satisfy the three conditions of low inertia and quality of the legs and ensure good motion performance and quick recovery of the stability of the whole machine after the imbalance, the leg structure is designed according to the skeletal anatomy and bionics of German shepherd dog as is shown in Figure 2. The motors of the hip and knee joint are integrated into the side swing joint of the body. The driving moment of the knee joint is transmitted to the knee joint of the leg through parallelogram and contra-parallelogram mechanism. Four identical side swing motors are arranged symmetrically on the left and right sides. The electrically driven MQ (MCVN quadruped robot) as shown in Figure 3 is designed on the basis of the idea of front elbow joints and back knee joints.

2.2. Kinematic Modeling

The leg structure of quadruped robot has two degrees of freedom: hip joint and knee joint. Its structure includes parallelogram mechanism (ABCD), the contra-parallelogram mechanism (AEFG), thigh connecting rod lAG, and crus connecting rod lGH. The parallelogram mechanism is composed of two cranks (lBC and lAD) and two connecting rods (lAB and lDC), while the contra-parallelogram mechanism is composed of two cranks (lAE and lFG) and one connecting rod lAG (Figure 4). By driving the crank lBC of parallelogram and the lAG of connecting rod of thigh, the foot can perform specific movements in XY plane [14, 15].

In light of the geometric characteristics of parallelogram and contra-parallelogram mechanisms, the corresponding angle relationship can be calculated, where lin lFGH is the same linkage with an angle of 170 degrees. Constructing auxiliary dotted lines as shown in Figure 4, the corresponding sides in triangle AEF and triangle AFG, triangle AEG, and triangle FGE are all equal, so they are congruent triangles. If θ1 and θ2 are known, θ3 can be calculated through the cosine theorem (the length of each rod is known):

Equations (1)–(5) can be sorted out as follows:where the parameters of each connecting rod of leg joint of quadruped robot are shown in Table 1:

Similarly, if the θ3 and θ1 are known, knee angle θ2 can be calculated as follows:

2.3. Forward and Inverse Kinematics

D-H (Denavit Hartenberg) coordinate method is used to analyze the kinematics of quadruped robot [1619]. Due to the complexity of D-H coordinate and the characteristics of parallelogram and contra-parallelogram linkage mechanism, the leg model of the quadruped robot is simplified in kinematics analysis. According to the conversion relationship between equations (6) and (7), the actual rotation angle of the servo motor is mapped into the D-H coordinate system. In addition, on the basis of rules of D-H coordinate system, the fixed reference coordinates (X0, Y0, Z0) at hip joint A are first determined, then the common vertical lines of joint axes 1 and 2 are obtained. Their intersection points are the origin of the link coordinate system {1}. In line with the difficulty of calculation, the direction of axis Z1 is confirmed; meanwhile the positive direction of axis X1 as the direction of the common vertical line mentioned above is specified. Finally, the direction of Y1 is determined by the right hand rule. Similarly, the linkage coordinate systems {2} and {3} can be established. The D-H coordinates of the swinging phase of the quadruped robot are shown in Figure 5.

D-H related parameters are shown in Table 2.

For the D-H coordinate system with n joints, the coordinate transformation of link i relative to link i−1 is :where i = cos (θi); i = sin (θi); i= cos (αi); i = sin (αi); li is the length of connecting rod; θi is the joint angle; αi is the connecting rod angle; and di is the offset of connecting rod.

According to the above D-H coordinate transformation, the attitude and position change of reference coordinate system {3} relative to base coordinate system {0} can be obtained as shown in the following equation:where c12 = cos (θ1 + θ2) and s12 = sin (θ1 + θ2).

Through geometric analysis, the inverse kinematic solution of the leg linkage can be received as shown in the following equation:where (x y) is the position of the robot foot in the space coordinate {0}.

3. Foot Workspace Analysis and Trajectory Planning

3.1. Foot Workspace Analysis

The foot workspace of a quadruped robot, which is one of the important indexes to measure the motion performance, is a collection of points of spatial position that can be reached. However, the workspace of each robot is only related to its own characteristic parameters. At present, analytic, numerical, and graphical methods are usually used to solve the workspace. The analytic method usually solves the workspace boundary by linear or nonlinear function relationship between the joints. In addition, its expression is relatively complex and is not suitable for applications in practical engineering [20]. The graphical method is intuitive, but it is limited by the degree of freedom. When the degree of freedom exceeds three, graphical methods usually require grouping [21]. What is more, it only needs to select as many different joint variables as possible in the numerical method. It can use the forward kinematics of the robot to solve the foot coordinates. The boundary surface formed by the coordinate points is the working interval of the robot.

Typical numerical methods include search method, iteration method, and Monte Carlo method. In this paper, Monte Carlo method is adopted to calculate the working space of the robot foot. The specific steps are as follows:(1)The forward kinematics of the leg mechanism is calculated(2)The random variables of each joint of the robot are calculated, including the constraint relationship between the angles of each joint(3)The boundary surface of foot workspace is drawn by MATLAB

3.2. Foot Trajectory Planning and Interpolation Control

In this paper, PMAC programmable multiaxis motion controller from Delta-Tau-Data-System company is selected as the main controller to control the leg servo motor. The method of calculating other points between known points based on a particular algorithm is called interpolation control. Common interpolation algorithms include line, arc, and PVT (Position Velocity and Time). The curve velocity calculated by the linear algorithm is not smooth and has acceleration and deceleration errors and is not suitable for accurate control [22]. Arc algorithm is suitable for rough interpolation and is usually mixed with other algorithms [23]. The essence of PVT algorithm is Hermite interpolation, which can generate more intuitive control curves [24, 25]. According to the position and velocity of the initial point and the position and velocity of the end point, the position and velocity of any curve at any time in the curve section can be approximately solved under the PVT mode. Furthermore, the velocity variation received is relatively smooth.

3.2.1. Foot Trajectory Planning

The movement process of quadruped robot is divided into swing and support phase. In swing phase, the length and height step have an important impact on the performance of the whole machine. In supporting the phase, the foot of the robot is always in contact with the ground, and the trajectory formed is usually a simple straight line. Therefore, the movement of the swinging phase is only to be considered in the trajectory planning. In order to reduce the impact of the foot on the ground and prevent the foot from sliding with the ground, the lifting and landing speed of the swing stage are both zero. As the trajectory of the quadruped robot is relatively free, a variety of curves, which met the above requirements, can be designed.

In this paper, a piecewise interpolation method based on known points in the workspace is proposed. At the same time, in order to facilitate the writing of trajectory function into PMAC controller, a more intuitive PVT interpolation algorithm is selected. Because the PVT interpolation function of the controller itself does not make a specific study on the selection method of segment points, the segmented point selection and the foot track characteristics of the quadruped robot based on the original PVT interpolation function are studied in this paper. The Hermite interpolation (PVT) cubic polynomial of a curve segment can be expressed as follows:where pk and pk+1 are the track points at time tk and tk+1, respectively; and +1 are the velocities at time and +1 respectively; hk = tk+1 − tk represents the time interval within the current subsection.

At the same time, in order to get a relatively smooth curve of velocity change, the proportional coefficient C was introduced in literature [26]. As shown in equation (12), the relationship between velocity and position increment is adjusted by area method. Typical velocity variation curves that used Hermite interpolation are shown in Figure 6:

Here, Δp is the increment of position change.

The smoothness of the speed change of quadruped is related not only to the speed change within a certain section, but also to the selection of segment points. A selection method of segment points is proposed in this paper. Referring to the characteristic of velocity smoothing of cycloid trajectory (equation (13)) proposed in reference [27], the swing phases in a cycle are evenly divided into four equal parts for Hermite interpolation. The velocity curve of cycloid trajectory can be approximately equivalent by choosing the appropriate proportional coefficient C.

Referring to the law of velocity variation shown in Figure 7, where the velocity at the beginning and end points of the X-axis direction is zero, a concave curve with a ratio coefficient C of 1/3 as shown in Figure 6(a) is selected (the velocity variation at Vk is relatively gentle). Meanwhile, in order to satisfy the smooth change of velocity at the transition points at T/2 time, the convex curve with a proportionality coefficient C of 2/3 as shown in Figure 6(b) is chosen for the symmetric piecewise curves of the transition point (the velocity variation at Vk+1 is relatively gentle). In the Y-axis direction, in order to meet the requirement that the velocity change at the transition point at T/2 and T/4 time is relatively smooth and the time velocity at 2/T is zero, a convex curve with a proportionality coefficient C of 2/3 as shown in Figure 6(b) is selected. To sum up, the velocity change rate coefficient of X-axis is [1/3, 2/3, 2/3, 1/3], and the velocity change rate coefficient of Y-axis is 2/3. Finally, the change curve of foot track speed is obtained as shown in Figure 8:where S is the step length, H is the step height, and T is the period of oscillation phase.

Assuming that the period of the oscillating phase is two seconds, the maximum velocity in the X-axis direction is 80 mm/s, and the maximum velocity in the Y-axis direction is 16 mm/s. In the X-axis direction, at T/2 time, the foot speed reaches the maximum value −Vmax; at T/4 and 3 T/4 time, the speed is one half of the maximum value. According to equation (13), the position increment of the four points is [−6.67, −33.33, −33.33, −6.77] mm. In the direction of Y axis, at T/4 time, the foot velocity reaches the maximum value −Vmax; at 3 T/4 time, the foot velocity is Vmax; at T/2 time, the foot velocity is zero. The position increments of the four points calculated by equation (13) are [−5.33, −5.33, 5.33, 5.33] mm. The foot trajectory function generated by interpolation is shown in the following equation:

The step length and lift height of the quadruped robot are shown in the following equation:where i and j are the numbers of sections and △Pi and △Pj are the displacement increments of each section.

According to equation (15), the step length S is 80 mm and the leg lift height H is 10.66 mm. As can be seen from Figure 9, the foot trajectory formed by the step length and step height is within the working space of the leg of the quadruped robot. Considering the mechanical characteristics of parallelogram and contra-parallelogram, the foot trajectory is symmetrically distributed along the Y-axis with an initial position of (40 mm, 330 mm), when the robot’s leg joint moves. Since the positive direction of D-H coordinate is located in the third quadrant of the rectangular coordinate system, when the robot’s leg moves to the highest point, the Y-axis coordinate is 319.34 mm. The generated foot track is shown in Figure 10.

3.2.2. Interpolation Control

The speed of the segment points and the segment points of the planned trajectory are written into the controller by script language (Figure 11). The leg servo motor is controlled to move according to the planned trajectory. The trajectory interpolation procedure within 0.5 seconds is shown in the following equation:where 500 milliseconds is the interval between segments; X 33.33 mm and Y 324.67 mm are the existing positions of P0 (the initial points) after △P increment change; −40 mm/s and −16 mm/s are the velocities of the end points of the first segment.

4. Simulation and Experimental Analysis

4.1. ADAMS Simulation

In order to verify correctness of the quadruped robot foot trajectory and the smoothness of the speed change in the direction of XY axis, the simulation is carried out by MATLAB and ADAMS in this paper [28, 29]. Firstly, SolidWorks is used to build the 3D model of the virtual prototype, and then the 3D model is imported into ADAMS to add constraints and drivers. The coordinate set on the foot track is mapped to the corresponding motor angle by MATLAB. Finally, the motor angle is imported into ADAMS to complete the simulation verification of the virtual model. The specific simulation process is shown in Figure 12.

In one cycle, the foot movement process is shown in Figure 13.

4.2. Simulation Results Analysis

When a quadruped robot travels along the foot trajectory formed by Hermite interpolation, the synthetic velocity curve along the XY axis is shown in Figure 14. According to the graph, the change of the foot speed of the robot in a single cycle is relatively smooth and can meet the requirements of the stable motion of the robot.

4.3. Analysis of Experimental Results

The quadruped robot designed in this paper uses steel processing leg structure. In order to verify the trajectory of one leg when the robot swings, and to avoid the friction caused by the contact between the other three legs and the ground affecting the trajectory of the foot, aluminum profiles are used to construct a support frame to support the entire body in the air. The standard laser tracker R-20 Radian of the automatic precision engineering company (API) is adopted in the measurement system. The spatial position of the measuring point relative to the measuring coordinate system is calculated by the laser interference principle [30]. The experimental platform is shown in Figure 15.

Due to the limited space of the body of the quadruped robot, in order to increase the reliability of the robot in the process of moving and the bearing capacity of the body of the robot, PMAC 16-axis ck3e controller with small size and good openness is selected as the main controller. The controller is equipped with the corresponding EtherCAT slave station module to realize the information interaction between switch and analog. The DB59M024035-KYAN brushless DC servo motor of Nanotec German is used as the servo motor. The specific models are shown in Table 3.

The control principle of the whole machine is shown in Figure 16.

The initial joint angle of the robot is set as 40° for the hip joint and 80° for the knee joint. According to the kinematics model, the initial angle of the calf motor is calculated as 52.8°. The trajectory drawing software embedded in PMAC is used to draw the movement trajectory of the robot foot in the oscillating phase in a single cycle (Figure 17). Under the initial conditions, the program of fast return to zero is executed, then the foot moves to (40 mm, 330 mm), and the foot of the robot walks according to the preset trajectory. In one period, the displacement in the X-axis direction is 80 mm, and the displacement in the y-direction is about 10.66 mm. The sampling time is set by the laser tracker, and the foot motion track is measured as shown in Figure 18. Due to the gap in the leg structure during processing and assembly, the mechanical mechanism of the foot has a slight vibration in the actual movement process, which leads to the deviation between the fitted track and the actual track. The displacement in the X-axis direction is 81.3 mm with an error of 1.65%. The maximum displacement in the Y-axis direction is 10.3 mm with an error of 3.4%. The error is small and can fully meet the walking requirements.

5. Conclusion

(1)In order to reduce the inertia of quadruped robot’s legs, a leg structure is designed in this paper. The motor of hip joint and knee joint is reasonably arranged on the body, and the parallel quadrilateral and contra-parallel quadrilateral bar structures are used for power transmission.(2)For the quadruped robot with the goal of trajectory planning, MATLAB software is adopted, Hermit interpolation algorithm is applied, and the characteristic of smooth velocity change of cycloid trajectory is used for reference. Proportional coefficient C is reasonably selected to approximate the velocity change curve of the foot trajectory, so as to generate the movement trajectory of the foot of the quadruped robot. ADAMS software is used to simulate. According to the simulation results, the quadruped robot can move using the designed trajectory, and the speed changes in the process of movement are relatively smooth.(3)The PMAC bus controller with small volume and high integration is adopted as the main controller. The forward and inverse solution algorithm is written and the PVT interpolation library function is called to control the leg servo motor by writing the motion program through scripting language, so as to test the real prototype. The experimental results show that the trajectory generated by piecewise interpolation based on the cycloid velocity curve can be realized under the leg structure of the quadruped robot in this paper. At the same time, the velocity variation is relatively stable during the movement. This experiment offers a theoretical basis for the trajectory design, optimization, and overall debugging of the electrically driven quadruped robot.

Data Availability

The data used to support the findings of this study are available from the corresponding author upon request.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This work was supported by the Kunming University of Science and Technology Talent Research Start-up Fund Project (No. KKZ3201601002), Major Science and Technology Project in Yunnan Province (No. 2017RA010), National Key Research and Development Plan Project (No. 2017YFC1702503), and the National Natural Science Foundation of China (Nos. 51965029, 61873115, and 51565021).