Sheng Xiang MASc 2018
Sheng Xiang MASc 2018
System
by
Xiang Sheng
B.Sc., Harbin Institute of Technology, 2013
All rights reserved. This thesis may not be reproduced in whole or in part, by
photocopying or other means, without the permission of the author.
ii
by
Xiang Sheng
B.Sc., Harbin Institute of Technology, 2013
Supervisory Committee
Supervisory Committee
ABSTRACT
This thesis focuses on mechanical design and simulation studies of a quadruped robot
motion control system, targeting at designing an autonomous legged robot. The
designed quadruped robot with “X”-configuration is developed for traversing rocky
and sloped terrain with a static walking gait.
The mechanical design of the quadruped robot is illustrated in Chapter 2, includ-
ing the main body design, leg design and component selection. In the design process,
appropriate mechanical structures are utilized to minimize the energy consumption.
To improve energy efficiency, a set of principles is proposed. Corresponding imple-
mentations are also concretely introduced in this chapter. In addition, to simplify the
mechanical structure of the quadruped robot, the mass is symmetrically distributed
about the frontal and lateral planes. To improve the leg agility, the leg mass is min-
imized. On the one hand, the lightweight design is implemented by optimizing the
mass distribution of the leg mechanism. On the other hand, the key components are
assembled in the body part instead of the legs as many as possible. A sufficient leg
length is also selected not only to allow the robot to step on or over obstacles, but also
to avoid the leg getting caught by objects. Particularly, the leg structure is demon-
strated, including the hip joint, thigh part, knee joint and limb part with a telescoping
joint. When the robot sustains extensive payload, the deformed shape in joints may
lead to structural failures, thereby influencing the quadrupedal locomotion. Finite
element analysis (FEA) is performed when designing the structural components in
reasonable structures. The design processes of the shoulder part and brass rod are
demonstrated as examples. Based on the setup of loads and fixtures, the maximum
iv
deformed shape of these structural components are analyzed. From FEA simulation
results, the yield strength is two orders of magnitude larger than the maximum of
von Mises stress. Hence, these components are suitable to be incorporated in the
quadruped robot.
Based on the designed mechanical structure, simulation studies of the quadruped
robot motion control system are analyzed in Chapter 3, including the modeling for
a robotic leg and animated simulation. Since the quadrupedal locomotion is exe-
cuted by manipulating the postures of four legs, the leg model is significant to the
motion control system, thereby being analyzed mathematically. Two links kinematic
conversion is implemented between the foot-end trajectory and joint angles. The dy-
namic model of the leg is also computed to discovery the relationship between the
actuating torques and joint angles. To animate the quadrupedal locomotion, a CAD
robot model is converted into MATLAB. Following the predefined footfall pattern,
four legs move in sequence to execute the creeping gait. The segment of the desired
trajectory of the foot-end fits a fifth order polynomial and does not include the set
of singular configurations. Then, the PD control is utilized to adjust the leg pos-
ture to track the desired path. Furthermore, the actual joint angles are calculated in
the MATLAB/SimMechanics quadruped robot by using Euler-Lagrange equations.
Lastly, simulation results are presented to analyze the tracking performance in the
joint angles and foot-ends.
Finally, conclusions of the thesis are summarized, and future work is presented in
Chapter 4.
v
Contents
Supervisory Committee ii
Abstract iii
Table of Contents v
Acknowledgements xi
Nomenclature xii
1 Introduction 1
1.1 Configurations of the Quadruped Robot . . . . . . . . . . . . . . . . 3
1.1.1 “M”-configuration . . . . . . . . . . . . . . . . . . . . . . . . 4
1.1.2 “X”-configuration . . . . . . . . . . . . . . . . . . . . . . . . . 5
1.1.3 “O”-configuration . . . . . . . . . . . . . . . . . . . . . . . . . 6
1.2 Leg Mechanism of the Quadruped Robot . . . . . . . . . . . . . . . . 7
1.2.1 Robotic Legs with Compressed Air . . . . . . . . . . . . . . . 8
1.2.2 Compliant Legs with Steel Coil Springs . . . . . . . . . . . . . 10
1.3 Some Distinctive Mechanisms . . . . . . . . . . . . . . . . . . . . . . 12
1.3.1 Robots with One DOF for Each Leg . . . . . . . . . . . . . . 12
1.3.2 Robots with Flexor Reflex . . . . . . . . . . . . . . . . . . . . 13
1.4 Some Comments . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 15
1.5 Thesis Organization . . . . . . . . . . . . . . . . . . . . . . . . . . . . 16
Bibliography 66
vii
List of Tables
List of Figures
Figure 2.4 Illustration of three types of aluminum plates in the body part:
(a) the aluminum plate A which is assembled to fix the poten-
tiometer at both ends of the body part, (b) the aluminum plate
B which is machined to clamp the motor and (c) the aluminum
plate C which is mounted in the middle of the body part to clamp
the motor. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 20
Figure 2.5 Illustration of two types of bearing housings in the body part:
(a) the bearing housing A to fix the potentiometer at both ends
and (b) the bearing housing B to clamp the ball bearing in the
middle portion. . . . . . . . . . . . . . . . . . . . . . . . . . . . 21
Figure 2.6 Illustrations of the motor and its connection: (a) the Swiss Maxon
DC motor and (b) the CAD model to illustrate the connection
of the motor, aluminum plate and bevel pinion. . . . . . . . . . 22
Figure 2.7 Illustrations of the potentiometer and its connection: (a) the
potentiometer–SAKAE 22HP-10, (b) the CAD model of the con-
nection among the motor, two bearings, two types of bearing
housings and the potentiometer and (c) section views of the CAD
model without the motor. . . . . . . . . . . . . . . . . . . . . . 23
Figure 2.8 Illustrations of the structure in the hip joint: (a) the brass rod,
(b) brass tube, (c) shoulder part, (d) pin joint and (e) key parts
of the hip joint. . . . . . . . . . . . . . . . . . . . . . . . . . . . 26
Figure 2.9 Illustrations of the thigh part: (a) the CAD model of the thigh
part with the brass rod, (b) the assembly of the thigh part and
(c) Section views of the CAD model of the thigh part with the
brass rod. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 28
Figure 2.10Illustrations of the CAD model of thigh rails: (a) the inside thigh
rail and (b) outside thigh rail. . . . . . . . . . . . . . . . . . . . 29
Figure 2.11Illustrations of two types of bearing housings in the knee joint:
(a) the bearing housing C to fix the potentiometer at the outside
thigh rail and (b) the bearing housing D to clamp the ball bearing
at the inside thigh rail. . . . . . . . . . . . . . . . . . . . . . . . 30
Figure 2.12Illustrations of the knee joint: (a) the CAD model to illustrate
the knee joint and (b) the mechanical structure of the knee joint. 31
x
Figure 2.13Illustrations of the limb part: (a) the CAD model of the limb
part, (b) the assembly of the limb part and (c) section views of
the CAD model of the limb part. . . . . . . . . . . . . . . . . . 33
Figure 2.14Illustrations of analysis results for the shoulder part: (a) von
Mises stress, (b) resultant displacement and (c) equivalent strain. 34
Figure 2.15Illustration of study results of a brass rod: (a) von Mises stress,
(b) resultant displacement and (c) equivalent strain. . . . . . . 37
Figure 3.1 Diagram of one leg with relative coordinates for each joint. . . . 40
Figure 3.2 Classification of periodic gaits [14]. . . . . . . . . . . . . . . . . 51
Figure 3.3 Internal contact directions of the creeping gait. . . . . . . . . . 51
Figure 3.4 The schematic model of a quadruped system. . . . . . . . . . . 52
Figure 3.5 Sequence of the locomotion cycle simulation in [15]. . . . . . . . 53
Figure 3.6 PD control schematics. . . . . . . . . . . . . . . . . . . . . . . . 55
Figure 3.7 Nominal trajectory of the leg. . . . . . . . . . . . . . . . . . . . 55
Figure 3.8 A posterior extreme set point for one step shown with Cartesian
coordinates. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 56
Figure 3.9 The simulated animation for the simplified model. . . . . . . . 57
Figure 3.10The MATLAB/SimMechanics quadruped model. . . . . . . . . 58
Figure 3.11Illustrations of the desired and tracked angle of the hip joint and
knee joint of hind legs: (a) the left-hind hip joint, (b) left-hind
knee joint, (c) right-hind hip joint and (d) right-hind knee joint. 59
Figure 3.12Illustrations of the desired and tracked angle of the hip joint and
knee joint of front legs: (a) the left-front hip joint, (b) left-front
knee joint, (c) right-front hip joint and (d) right-front knee joint. 60
Figure 3.13Illustrations of the desired and tracked angle of four foot-ends:
(a) the left-hind foot-end, (b) left-front foot-end, (c) right-hind
foot-end and (d) right-front foot-end. . . . . . . . . . . . . . . . 61
Figure 4.1 An overview of the control architecture for the quadrupedal lo-
comotion. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 65
xi
ACKNOWLEDGEMENTS
Acronyms
PC personal computer
DOF degrees of freedom
PAM pneumatic artificial muscle
PPAM pleated pneumatic artificial muscle
WSM wide stability margin
CPG central pattern generator
SLIP spring loaded inverted pendulum
IMU inertial measurement unit
IEPF iterative-end-point-fit
MPC model-predictive control
CAD computer-aided design
PCB printed circuit board
PD proportional-derivative
RISC reduced instruction set computing
ARM advanced RISC machine
FPGA field-programmable gate array
RPM revolutions per minute
FEA finite element analysis
LH left-hind
LF left-front
RH right-hind
RF right-front
COM center of mass
ESC electronic speed control
Chapter 1
Introduction
Mobile robots have been developed to replace human beings to work in some complex
and dangerous environments, such as humanitarian de-mining, disaster sites, and bat-
tlefields. For example, since increasing number of landmines have been deployed, the
detection and removal of antipersonnel landmines draw a wide range of concerns. To
clear the mines in an area efficiently and safely, the robot is required to be equipped
with sensitive sensors, efficient manipulators and advanced mobility functions [16].
The integrated robotic system is built based on a legged robot combining with a sen-
sor for the landmine detection, a manipulator to adjust the position of the sensor, a
global-position system to identify the landmine location. To accomplish these tasks,
legged robots exhibit potential advantages as follows:
• The inherent omnidirectionality of legged robots can steer the direction of move-
ment without forward/backward manoeuvers.
• Legged robots can step over loose and sandy terrain. Equipped with appropriate
tactile sensors, legged robots can identify the inclination angle of the contact
surface to prevent slippage.
• Legged robot can optimize the posture for the scanning manipulator to approach
landmines without changing its footholds.
Among these categories, quadruped robots are superior to biped robots on as-
pects of the static stability. Also, compared with insectoid robots, the design and
manufacture of quadruped robots are relatively easier due to the simple mechanical
structure. To find a compromise leg number for legged robots, following factors are
taken into consideration. On the one hand, reducing the leg number can simplify the
mechanical structure and control strategy. On the other hand, the stability of the
3
1.1.1 “M”-configuration
“Cheetah” series are typical sample robots with the “M”-configuration. As shown in
Figure 1.2a. “Cheetah I” (or called “WildCat”) is the fastest free running quadruped
robot in the world. The robot can run up to 9 m/s while maintaining its balance [2].
The outstanding running speed largely attributes to its articulated back which can
flex back and forth on each step. Since the elastic structure is implemented in the
body part like some mammals, its running speed can be considerably increased by
extending the stride length. Moreover, by upgrading the running controller of the first
generation, “Cheetah II” (see Figure 1.2b) can execute mild running turns and jumps
over obstacles autonomously [3]. Besides, by minimizing the vertical movements of
the body part, “Cheetah II” can also balance objects on its back even running on
rough terrain.
Hiroshi Kimura et al. from Tokyo Institute of Technology developed “Patrush
II” in 1994, as shown in Figure 1.3a. Each leg is actuated by three DC motors with
neural oscillation central pattern generator (CPG). By applying the biological-type
control, “Patruch II” can perform dynamic walking and present adaptive ability on
irregular terrain.
5
(a) (b)
Figure 1.2: Illustrations of “Cheetah” series with the “M”-configuration: (a) “Chee-
tah I” [2] and (b) “Cheetah II” [3].
(a) (b)
1.1.2 “X”-configuration
Quadruped robots with the “X”-configuration can efficiently walk on rough terrain,
and even are capable of climbing in some circumstances. As two typical robots with
the “X”-configuration, “BigDog” [34] and “LittleDog”, which are developed by Boston
6
Dynamics Inc. in 2005 and 2013 respectively, perform excellent locomotion on rough
terrain. “BigDog” is appropriate for a relatively smooth surface with dynamic gaits,
and “LittleDog” presents outstanding performance on rough terrain with static gaits.
As shown in Figure 1.4a., “BigDog” is a self-contained quadruped robot, and can
execute dynamic walking in the outdoor environment while carrying heavy loads. Four
articulated legs are incorporated into “BigDog” to absorb shock and to recycle energy.
The four-DOF leg has three active joints and one passive joint, which are built by
hydraulic cylinders and a pneumatic spring, respectively. This robotic platform has
successfully performed different kinds of locomotion gaits, such as walking, trotting,
and bounding. Equipped with a gasoline engine and hydraulic actuators, the robot
can carry up to 154 kg payload and last for around 2.5 hours. The power supply is
provided by an internal combustion engine to drive a hydraulic pump, which delivers
the hydraulic oil to the actuators.
Also, Boston Dynamics Inc. developed “LittleDog” which can traverse a variety
of rough terrain quickly and robustly [31], as shown in Figure 1.4b. “LittleDog” is
designed for research on learning locomotion by applying motor learning, dynamic
control and terrain estimation. For each leg of “LittleDog”, two motors are used
to actuate the hip joint and one motor is utilized to drive the knee joint with an
85:1 ratio. The mass of the body is much larger than the compliant leg, which are
1.8 kg and 0.25 kg, respectively. “LittleDog” is equipped with a variety of sensors
including an IMU, 3-axis force sensors, a high-resolution camera, and so on. Besides,
six degrees of freedom (DOFs) position information is provided by a Vicon motion
capture environment, which is operated for the quadrupedal locomotion. With the
help of a sub-millimeter accuracy terrain map, desired trajectories are computed by
an embedded 1 kHz microprocessor, in which an internal proportional-derivative (PD)
controller is programmed. In addition, an external computer transmits other control
commands through a wireless connection.
1.1.3 “O”-configuration
As a typical robot with the “O”-configuration, Legged Squad Support System (“LS3”)
quadruped robot (see Figure 1.4c) has potential capability in delivering extensive
loads.
“LS3” is designed as a rough-terrain robot to help marines and soldiers to carry
their load in the battlefield [32]. An “LS3” can carry up to 181 kg of load for a mission
7
Figure 1.4: Illustrations of quadruped robots by Boston Dynamics Inc: (a) “BigDog
”, (b) “LittleDog” and (c) “LS3” [2].
covering a 32 km and lasting for 24 hours. By obtaining terrain mapping from stereo
and LIDAR sensors, “LS3” can perform autonomous navigation without a dedicated
operator, by using terrain sensors and GPS to identify designated locations. “LS3”
can keep its paces in uneven and slippery surfaces and can stand upright in spite of
some external disturbances.
(a) (b)
Figure 1.5: (a) 3D one-legged hopping machine and (b) its pneumatic circuit [6].
The biped “Lucy” has been developed as a six-DOF biped robot which is actuated
by twelve PPAMs. As shown in Figure 1.6a, the upper body and two compliant legs
are connected by two one-dimensional pin joints [7], which can avoid legs turning over
in the frontal plane. Since the PPAM can only be pulled, each articulated joint of the
biped “Lucy” is actuated by a pair of PPAMs (see Figure 1.6b) as a bidirectionally
working revolute joint. Unlike the pneumatic cylinder, the joint angles and the leg
stiffness are controlled independently, and are measured by different gauge pressures
separately. By switching the valve, the control strategy is implemented by a one-DOF
pendulum, as illustrated in Figure 1.6c.
Figure 1.6: (a) The biped “Lucy” on treadmill, (b) its physical pendulum and (c) 3
contraction levels of the PPAM [7].
Besides, a jumping robot named “Mowgli” has been constructed with the McK-
ibben pneumatic muscle, as shown in Figure 1.7. Six McKibben PAMs are incorpo-
rated into two articulated legs to actuate hip, knee and ankle joints. However, unlike
10
the biped “Lucy”, the artificial muscles of “Mowgli” are composed of rubber tubes.
For the electro-pneumatic system, “Mowgli” has the potentiometer, pressure sensor
and touch switch, which are assembled on the joint, muscle and foot-end, respectively.
With 3 kg weight, “Mowgli” can jump up to 0.5 m with soft landings, which is more
than 50% of its body height (0.9 m with legs extended).
(a) (b)
Figure 1.7: Illustration of “Mowgli”: (a) the jumping posture and (b) landing posture
[8].
ARL “Monopod” (linear joints) The Ambulatory Robotics Lab (ARL) “Mono-
pod” is developed by Buehler et al., which is incorporated with the mechanical struc-
ture of the pneumatic cylinder and steel coil springs. As shown in Figure 1.8a, the
ARL “Monopod” consists of a body and a prismatic leg [9]. The motor torque is
converted into an axial force by a timing belt and pulley, as shown in Figure 1.8b.
The pitch motion of the body is determined by the leg swing. The 55 Nm hip torque
is actuated by an 80 W motor and is transmitted to the joint by a 30:1 gear ratio.
From experimental results, the ARL “Monopod” can move at a speed of 1.2 m/s.
By including the leg spring in the leg mechanism, the hip swing motion minimizes
the energy consumption with the design. The ARL “Monopod” performs the stable
locomotion, including the leg swing phase and vertical hopping motion.
11
(a) (b)
Figure 1.8: (a) The ARL “Monopod” and (b) the schematic of its important variables
[9].
Figure 1.9: (a) The “KOLT” quadruped robot, (b) its electro-pneumatic leg and (c)
the schematic of its thrusting system [10].
For the electro-pneumatic leg, the hip motion and knee motion are set to be
decoupled with the help of a cable and pulleys, as shown in Figure 1.9c. A pneumatic
spring is assembled in the thigh part to store elastic energy. The knee joint determines
the leg stiffness, which is 15.9 kN/m with the leg fully extended. To connect the
pneumatic spring and air cylinder, a check valve is used to retain the pressurized air
12
having a relatively simple mechanical design, the robot in the series can successfully
achieve dynamic stability. “Scout II” is a self-propelled running robot, which has only
one actuator for each hip as well [12]. Besides the hip actuator, a compliant prismatic
joint is also incorporated in the leg. The controller can determine the locomotion of
the robot by adjusting angular positions and torques of the front and hind legs [43].
The simplification for the leg structure can minimize the energy consumption and
enhance mechanical reliability. With simple stiff legs, these quadruped robots can
realize walking and stair climbing in bounding.
(a) (b)
Figure 1.10: Illustration of “Scout” series: (a) “Scout I” [11] and (b) “Scout II” [12].
Experimental results illustrate that “Scout II” can run up to 1.5 m/s in bound-
ing. This robot is highly dominated by the passive dynamics to realize a high efficient
energy transformation. Overall, “Scout” series set an example of using a relatively
simple control strategy and a simple mechanical structure. However, the mechan-
ical structure cannot actuate a compliant leg with a relatively long length. This
disadvantage may restrict the available footholds on rough terrain.
ous generation in both size and weight. As illustrated in Figure 1.11a, there are four
joints on each leg of “Tekken II”. DC motors (23 W) are used to actuate the hip joint
around the pitch axis, while the motion around the yaw axis is activated by motors
(8 W). A spring-lock mechanism is incorporated in the ankle joint. By controlling hip
yaw joints, the locomotion direction can be adjusted. Rate gyros and inclinometers
are applied to measure the pitch and roll angles of the body part.
The flexor reflex is designed to tackle the collision avoidance with obstacles. Dur-
ing the flexion phase of the step cycle, a stimulus on the paw dorsum produces an
enhanced flexion in order to avoid obstacles. Inspired by a spinal cat, an ankle joint
with a spring and a lock are designed in “Tekken I”. This mechanism can realize
obstacle avoidance by adjusting the posture of the foot-end during the first half of a
swing phase. The sequence of flexor reflex is illustrated in Figure 1.11b [13]. In the
first step (also called the flexor neuron active phase), the knee joint is flexed after
the robot detects the stumbling. Then, the flexor reflex is lifted in the second step.
After the leg escapes the stumbling condition, the ankle joint will move back to the
initial situation. The flexor reflex can be triggered by enlarging the desired angle in
a certain range. The knee joint angle can be measured at the moment of the flexor
neuron active phase. Under the effect of the rubber elasticity, the ankle joint can
return back to the initial angle, when the leg gets rid of the influence from obstacles.
However, since lots of small bumps and pebbles present considerable friction on rough
terrain, the passive ankle mechanism do not perform well in the outdoor environment.
Furthermore, “Tekken II” also applies other excellent structures to improve the
locomotion performance, such as low leg inertia moment and powerful actuators. In
addition, a small gear reduction ratio is applied to reinforce the compliance of joints.
Step 1 Step 3
Step 2
(a) (b)
Figure 1.11: (a)“Tekken II” and (b) flexor reflex activated on stumbling [13].
15
Chapter 2
This chapter focuses on the mechanical design of the designed quadruped robot which
is composed of a body part and four compliant legs. To simplify the mechanical
structure of the designed quadruped robot, the mass distribution is symmetrical about
the frontal and lateral planes. The mechanical structure is built in a computer-aided
design (CAD) model (see Figure 2.1). Particularly, the leg mechanism includes a hip
joint, a thigh part, a knee joint and a limb part with a telescoping joint. In the sequel,
we will introduce the mechanical structure of each part.
Body
Limb Hip
Foot-end
Thigh
Knee
Figure 2.2: (a) Energy flow diagram of the quadruped robot. (b) Design principles
to improve energy efficiency. (c) Strategies to implement design principles.
The designed quadruped robot comprises the body part and four compliant legs.
The mass of the body is 4 kg, and the mass of each leg is 1 kg. The whole robot is
actuated by twelve motors to perform passive dynamic walking. The rotation angle
of each motor is measured by a potentiometer.
19
Parameters Value
Body length 0.521 m
Body width 0.146 m
Body thickness 0.095 m
Leg length 0.152 m
Ground clearance 0.254 m
Body mass 4 kg
Individual leg mass 1 kg
Total mass 8 kg
Leg spring compliance 5250 N/m
Swiss Maxon DC motor
DC servo motor
41.022.022
SAKAE 22HP-10
Potentiometer
20 KΩ
of the body part. As shown in Figure 2.4b and Figure 2.4c, the other two types of
aluminum plates are assembled in the body part, respectively. These six plates are
used to fix two types of brass shafts via sixteen ball bearings.
Figure 2.4: Illustration of three types of aluminum plates in the body part: (a) the
aluminum plate A which is assembled to fix the potentiometer at both ends of the
body part, (b) the aluminum plate B which is machined to clamp the motor and (c)
the aluminum plate C which is mounted in the middle of the body part to clamp the
motor.
Four circle grooves are machined on the surface of the aluminum plate A as bearing
housings to clamp four ball bearings. Two clearance holes and two circle grooves (play
a role as bearing housing) are manufactured in each piece of the other two types of
plates. Particularly, the clearance holes in Figure 2.4b and Figure 2.4c are machined
for brass shafts and servo motors, respectively. The brass shaft is used to connect
21
the motor, pulley, ball bearing and potentiometer to transmit the actuating torque.
Hence, the potentiometer can measure the angular position of the motor shaft. The
pulley can transmit the actuating torque to the hip joint. Two types of bearing
housings are designed to be mounted on the body part, as shown in Figure 2.5. The
bearing housing A in Figure 2.5a is assembled in the middle of the body part to clamp
the ball bearing. The bearing housing B in Figure 2.5b is placed on aluminum plates,
which are illustrated in Figure 2.4b and Figure 2.4c. This bearing housing not only
can help the ball bearing to clamp the brass shaft, but also can fix the housing of the
potentiometer.
(a) (b)
Figure 2.5: Illustration of two types of bearing housings in the body part: (a) the
bearing housing A to fix the potentiometer at both ends and (b) the bearing housing
B to clamp the ball bearing in the middle portion.
the robot, three screws are used to fix the motor at the aluminum plate B and C. In
the aluminum plate B and C, small clearance holes are machined to clamp motors.
To actuate the hip joint, motors are horizontally fixed on the aluminum plate B and
C, which are shown in Figure 2.4b and Figure 2.4c. Through brass shafts, motors in
the body part are connected to potentiometers. Meanwhile, the torque is transformed
from the motor side to the drive gear by the timing belt.
(a) (b)
Figure 2.6: Illustrations of the motor and its connection: (a) the Swiss Maxon DC
motor and (b) the CAD model to illustrate the connection of the motor, aluminum
plate and bevel pinion.
(a) (b)
(c)
Figure 2.7: Illustrations of the potentiometer and its connection: (a) the
potentiometer–SAKAE 22HP-10, (b) the CAD model of the connection among the
motor, two bearings, two types of bearing housings and the potentiometer and (c)
section views of the CAD model without the motor.
2.2.4 Potentiometers
SAKAE 22HP-10 potentiometers, pictured in Figure 2.7a, are chosen because of their
precise ±0.25% linearity to the measurements of the angular positions of the hip and
knee joints. The potentiometer is a three-terminal resistor whose rated power is 2 W
and the resistance is 20 KΩ. To measure the angular position of the hip joint, a brass
shaft is used to connect the shafts of the potentiometer to motor by a spring pin and
a set screw, respectively. By using a nut and a tooth lock washer, the housing of the
potentiometer is clamped to the bearing housing and fixed to the aluminum plate in
24
the body part. The angular position can be measured by the angle difference between
the shaft and the housing of the potentiometer.
Figure 2.7b illustrates the connection among the motor, pulley, and potentiometer
in the body part. A brass shaft is used to transmit the actuating torque from the
motor side to the joint side. To prevent bending or twisting in the brass shaft,
the shaft length is designed as short as possible while the position of the motor is
appropriately selected. Two bearings are used to fix the brass shaft to two aluminum
plates. The motor is placed at one end of the brass shaft, while the potentiometer is
mounted on the other end. The similar structure is applied to measure the angular
position of the knee joint.
2.2.5 Gears
The bevel gearbox plays a central role to transmit the torque from the motor side to
the joint side and change the operating angle. Bevel gears in the designed quadruped
robot are mounted on shafts, which are capable of supporting high forces and are 90◦
apart. To reduce the risk of skipping in the hip joint and knee joint, large gears with
deep teeth are selected. In addition, couplings are not implemented in the body and
compliant legs, which reduces the possibility of slipping.
For the hip joint, to execute the rotation of the thigh part, miter gears are mounted
on a brass rod and two brass tubes. Unlike the mechanical structure of the hip joint,
the knee joint is actuated through a bevel gear pair with a 5:1 ratio. Either type of
joints transmits the rotational motion at a 90◦ angle. To actuate the joint effectively,
bevel gears should be precisely mounted on the input link and the output link. In
addition, to avoid concentrating the load at the end of the tooth, bevel gears should
be assembled with minor adjustments. This assembly allows the displacement of
bevel gears, which are caused by deflection under operating loads. The incorrect
installation may damage the joint.
• The effective leg length will influence the speed of movement and the agility of
the leg. The stride length can be increased by extending the leg length. Hence,
the mobile speed of the quadruped robot can be improved. In addition, extend-
ing the leg length can reduce the energy cost of transport, thereby improving
the endurance.
• Mass distribution affects the speed of movement by influencing the stride fre-
quency. In this way, the posture of the robotic leg would be easily controlled,
when key components are assembled in the body part as many as possible.
• Leg kinematics determines the endurance. The hip joint can rotate in the frontal
plane and lateral plane. The knee joint rotates in the frontal plane. The bevel
gear pairs with high gear ratio is supposed to be used in the joints to reinforce
the endurance. As a prismatic joint, the compressed spring can be assembled in
the limb link to adjust the leg stiffness and to absorb the impact at collision.
In the process of the leg design, above elements are taken into consideration. Table
2.2 demonstrates the relationships between desired characteristics and technological
instantiations.
26
(a) (b)
(c) (d)
(e)
Figure 2.8: Illustrations of the structure in the hip joint: (a) the brass rod, (b) brass
tube, (c) shoulder part, (d) pin joint and (e) key parts of the hip joint.
To provide the support force in the hip joint, three bevel gears are mounted in
the pin joint. The steel shoulder shaft and brass rod are perpendicularly assembled.
For each hip joint, two bevel gears are mounted on two brass tubes which are placed
in the steel shaft as drive gears. The third one is mounted on the brass rod which
is placed in the thigh part as the drive gear. For each hip joint, two miter gears are
mounted on two brass tubes, and are driven by two groups of timing belts separately.
Since two bevel gears are actuated by two motors, they do not need to synchronize
with each other. When rotating directions of the two gears are the opposite, the
thigh part swings forward or backward. When rotating directions of the two gears
are the same, the thigh part is actuated to move in the frontal plane. By controlling
the angle difference between gears, the direction of the quadrupedal locomotion can
be adjusted. Mounted on two brass tubes, two drive gears are able to rotate in
opposite directions. These two tubes are assembled on the shoulder steel shaft and
are separated by two delrin washers. The steel shaft connects two aluminum plates
of the body part. Two delrin washers can avoid the friction loss between two brass
tubes. With the help of the lubricant, two brass tubes can rotate around the steel
shaft flexibly.
On the leg side, the hip joint of the quadruped robot is designed in a frontal and
vertical sliding mechanism. The pin joint (see Figure 2.8e) prevents the leg from
rotating in the horizontal plane. Additionally, when the drive gear rotates around
the brass rod, the angular offset is transferred to the hip joint to actuate the thigh
part.
Furthermore, the position of the drive gear is determined by the length of the brass
rod. The hip joint can transmit the actuating torque efficiently through the miter
gearbox. Correct assembly of three miter gears can avoid skipping in the mechanical
transmission.
(a) (b)
(c)
Figure 2.9: Illustrations of the thigh part: (a) the CAD model of the thigh part with
the brass rod, (b) the assembly of the thigh part and (c) Section views of the CAD
model of the thigh part with the brass rod.
with sufficient lengths, leg links can help the robot to step onto or over obstacles.
After taking above factors into consideration, the lengths of the thigh link and limb
link are both selected around 0.15 m. The step height can reach up to approximately
0.1 m.
As shown in Figure 2.9c, two partially threaded cap screws are applied at the side
29
surface to fix the inside thigh rail, aluminum tube and driven gear. On the one hand,
the inside thigh rail and aluminum tube are machined with two clearance holes at
their side surfaces. On the other hand, two threaded holes are machined in the side
surface of the driven gear. For each hole, a partially threaded cap screw is used to fix
the thigh rail, aluminum tube and driven gear successively through these holes at the
side surface. The aluminum tube connects the brass rod through two ball bearings.
Besides, circle grooves are machined in thigh rails and aluminum tubes as bearing
housings, which are used to clamp ball bearings to hold the pin joint, as shown in
Figure 2.10b. Two partially threaded cap screws are applied to fix the outside thigh
rail and aluminum tube through the clearance hole and threaded hole.
(a) (b)
Figure 2.10: Illustrations of the CAD model of thigh rails: (a) the inside thigh rail
and (b) outside thigh rail.
As illustrated in Figure 2.10, the inside and outside thigh rail have the similar
outline. However, the upper portions of these thigh rails are different. Figure 2.10a
shows that two clearance holes are machined in the side surface. A relatively large hole
is designed for the aluminum tube to be assembled. As shown in Figure 2.10b, a cycle
groove is machined in the outside thigh rail as a bearing housing. Two clearance holes
are manufactured for two cap screws to fix the aluminum tube to the outside thigh
rail. For each thigh part, a motor is placed vertically between thigh rails to actuate
the knee joint. The actuating force is redirected by a bevel gearbox. An aluminum
plate is placed horizontally between thigh rails to clamp the motor. Moreover, this
aluminum plate is fixed by four standard rounded head screws to provide a channel
30
bracing for thigh rails to avoid collapsing. A bevel pinion is mounted on the motor
shaft through a collar.
(a) (b)
Figure 2.11: Illustrations of two types of bearing housings in the knee joint: (a)
the bearing housing C to fix the potentiometer at the outside thigh rail and (b) the
bearing housing D to clamp the ball bearing at the inside thigh rail.
Potentiometers are assembled to measure the angular position of knee joints. Ball
bearings are mounted on thigh rails to fix rotating shafts and are clamped by bearing
housings. The stress pattern is press-fit among the brass rod, ball bearing and thigh
rail. Two ball bearings are assembled to fix both ends of the brass rod. Each ball
bearing is clamped by an aluminum plate and a bearing housing. Two types of bearing
housings are used in the body part. As shown in Figure 2.12, the potentiometer is
fixed on the brass shaft by a spring pin. The potentiometer can obtain the angular
position of the knee joint by measuring the deviation between the thigh part and limb
31
part. On the one hand, the knee brass shaft and bevel gear rotate with the limb and
the shaft of the potentiometer. On the other hand, the housing of the potentiometer
rotates with the thigh part. Hence, the measured information can be transmitted to
the controller in real time.
(a) (b)
Figure 2.12: Illustrations of the knee joint: (a) the CAD model to illustrate the knee
joint and (b) the mechanical structure of the knee joint.
perform multi-modal locomotion, such as the trotting gait, pacing gait and bounding
gait. This special mechanism reduces the energy consumption during continuous leg
movements, and the passive prismatic joint can reduce the vibration of the body part
effectively. Moreover, all parts should be machined within an appropriate tolerance
in the machining process. Otherwise, machining errors may cause unsuccessfully
installation, which may damage the mechanical structure.
(a) (b)
(c)
Figure 2.13: Illustrations of the limb part: (a) the CAD model of the limb part, (b)
the assembly of the limb part and (c) section views of the CAD model of the limb
part.
In the FEA simulation, the shoulder part sustain the leg, whose mass is 1 kg. Hence,
the load is set as 10 N and distributed in the small cylinder portions of two brass
34
(a)
(b)
(c)
Figure 2.14: Illustrations of analysis results for the shoulder part: (a) von Mises
stress, (b) resultant displacement and (c) equivalent strain.
tubes. As shown in Figure 2.8e, the steel shaft is fixed to the body part by two
aluminum plates. The fixture type is set as fixed geometry. Based on the above
information, the strain distribution is analyzed.
35
Results
Figures 2.14 illustrates the compressive and tensile strain distribution of the steel
shoulder shaft with two brass tubes. As mentioned in Section 2.1, a steel shaft
connects two aluminum plates and provides a support force for the compliant leg in
the swing phase. Two brass tubes are mounted on the steel shaft. A gear and a pulley
are mounted on each of brass tubes to actuate the hip joint. Hence, two miter gears
are able to rotate against each other. Figures 2.14a shows the distribution of von
Mises strain in steel shaft. The von Mises strain of the shoulder part is distributed
along lines extending from two ends to the midpoint. The transverse compressive
strain is mainly distributed in the middle position of the steel shoulder shaft and the
area around grooves. As shown in Figure 2.14a, the minimum von Mises stress is
approximately 15.45 N/m2 . The utmost pressure-point is the midpoint of the steel
shaft, which sustains 6.55×106 N/m2 .
Figure 2.14b illustrates that the maximum displacement of the shoulder part is
3.65×10−3 mm. In Figure 2.14c, the equivalent strain of the steel shaft with two brass
tubes presents a range from 2.50×10−10 to 2.36×10−5 . Overall, these analysis results
show the stress condition of the shoulder part. The mechanical structure meets the
expected stress distribution.
The brass rod sustains a reaction force 10 N through a driven gear and two ball
bearings, as shown in Figure 2.9c. Particularly, the bevel gear is mounted on the
middle cylinder of the brass rod. Two ball bearings are used to fix the small cylinder
of the brass rod to the aluminum rod. Hence, the force is applied on three contact
faces. For the fixture details, the clearance hole in the brass rod is set as the fixture,
whose type is fixed geometry.
Results
Figure 2.15 shows the analysis results of the brass rod, such as the distribution of
compressive and tensile stresses.
In Figure 2.15a, the von Mises stress of the brass rod ranges from 8.71 N/m2 to
2.09×106 N/m2 . The data of von Mises stress illustrates that the utmost pressure
position is the connection area between the small brass cylinder and middle brass
cylinder. In addition, the yield strength of the brass is 2.39×108 N/m2 . Hence, the
maximum pressure on the brass rod is smaller than the yield strength of the material.
The brass rod can successfully sustain the leg weight.
Figure 2.15b shows the resultant displacement, when the load is applied in the
brass rod. As expected, the connection portion between the small cylinder and middle
cylinder sustains the maximum deflection. The maximum resultant displacement is
approximately 9.44×10−3 mm.
Figure 2.15c shows the distribution of equivalent strain in the brass rod. The area
between two cylinders of different diameters sustains the maximum equivalent strain,
which is 1.50×10−5 . The plot indicates the minimum equivalent stain is 5.71×10−10 .
In summary, from the FEA of the shoulder shaft, the middle portion sustains
extensive pressure. A brass rod is designed to provide a support force by wrapping
this fragile position. Hence, the shoulder part and brass rod constitute a pin joint
which is the key part of the hip joint to execute the leg movement. The brass rod
can help the shoulder part to sustain the leg weight in the swing phase and to bear
the body weight in the stance phase. In addition, to reduce the pressure of the fragile
portion of the steel shaft, three miter gears are mounted in the hip joint to bear the
load as well. In this way, three miter gears not only drive the thigh part accurately,
but also to some extent bear the leg weight during the swing phase.
37
(a)
(b)
(c)
Figure 2.15: Illustration of study results of a brass rod: (a) von Mises stress, (b)
resultant displacement and (c) equivalent strain.
2.5 Conclusions
In this chapter, the mechanical structure of the designed quadruped robot is illus-
trated, aiming to develop a legged robot. The designed symmetrical structure can
realize the bi-direction locomotion and simplify the control problem to some extent.
38
The mechanical design consists of main body design, compliant leg design, joint de-
sign, and component selection. From the mechanical perspective, the inertia of the
body and leg is reduced by adjusting the positions of components and by changing
the shapes of thigh and limb rails. Besides, to increase the stiffness of the compliant
leg, a linear telescoping joint is incorporated into the limb part. The passive prismatic
joint is included in the leg structure to absorb the impact force at collision and to
prevent unforeseen perturbations in a passive way. With the designed mechanical
structure, the quadruped robot can perform various types of behaviour gaits, such as
trotting, pacing and bounding.
The mechanical structure of the quadruped robot is analyzed and verified by the
FEA simulations. The shoulder part is taken as an example to demonstrate the use
of FEA in the mechanical design. The middle position of the shoulder part is the
utmost pressure-point. To sustain the extensive load, a brass rod is used to provide
an additional support to this fragile portion. Due to the deflection under operating
loads, the maximum displacement of the rod end is approximately 9.44×10−3 mm,
which is acceptable in experiments. For both components, since the yield strength is
two orders of magnitude larger than the maximum of von Mises stress, the design of
structure components is reasonable.
39
Chapter 3
Simulation studies of a quadruped robot motion control system are illustrated in this
chapter, including modeling for a robotic leg and the animated simulation. Since the
quadrupedal locomotion is implemented by controlling the postures of four legs, the
leg model plays an essential role in the motion control system. The leg model needs
to be analyzed mathematically, facilitating the controller design to track the desired
trajectory. To solve this tracking problem, kinematic and dynamic models of the leg
are derived in light of the work in [51]. Two links kinematic conversion is calculated
between the foot-end trajectory and joint angles. The dynamic model is implemented
to compute the relationship of the actuating torques and joint angles.
After analyzing the leg model, the collaboration of four robotic legs is developed
for the quadrupedal locomotion. By setting various footfall patterns, different kinds
of gaits can be performed. A four-beat gait has been defined based on the legged
motion analysis in [52]. One step cycle of the designed gait is divided into the swing
and stance phases. In the swing phase, the contact schedule is associated to the
creeping gait and predefined in Section 3.2.1. In the stance phase, the footholds are
maintained while shifting the body part forward.
PD control is applied for each joint to operate the leg posture. The corresponding
actuating torques are computed to manipulate the foot-ends to realize path following.
Moreover, the segment of the desired trajectory of the foot-end in the swing phase
fits a fifth order polynomial (results in relatively smooth accelerations). A CAD
robot model is converted into MATLAB to animate the quadrupedal locomotion.
40
Simulation results are demonstrated to analyze the tracking performance in the joint
angles and foot-ends.
Leg base 𝜽𝟏
𝒛𝟎 𝒐𝟎
𝒚𝟎 𝒙𝟎
𝒍𝟏
𝜽𝟐
𝒚𝟏 𝒐𝟏
𝒛𝟏 𝒙𝟏
𝒍𝟐
𝒚𝟐 𝒐𝟐
Foot End
𝒛𝟐 𝒙𝟐
Figure 3.1: Diagram of one leg with relative coordinates for each joint.
provide a systematic way for this analysis. The Denavi-Hartenberg (DH) convention
is implemented in this two-link model, according to [51].
In the leg model, two revolute joints are taken into consideration, and the prismatic
joint in the limb part is not considered. The rotations of the hip and knee joints in
the lateral plane manipulate the quadruped robot to move forward and backward.
The movement direction is maintained which is controlled by rotating the hip joint in
the frontal plane. Since we only consider the rectilinear translation in this thesis, the
rotation of the hip joint in the frontal plane is not taken into consideration. Besides,
joint friction is ignored in the quadruped model. The frame of the foot-end (the
tool frame) is fixed based on DH coordinate frame assumptions [51]. By the DH
convention, there exists a unique homogeneous transformation matrix Ai that takes
the coordinates from the base frame oi−1 xi−1 yi−1 zi−1 to the tool frame oi xi yi zi . This
matrix Ai is depicted as a product of four basic transformation matrices
0 0 0 1
where
cθ −sθi 0 0 1 0 0 0
i
sθi cθi 0 0 , T ransz,d = 0 1 0 0
Rotz,θi =
0 i
,
0 1 0
0
0 1 di
0 0 0 1 0 0 0 1
1 0 0 0 1 0 0 li
0 cαi −sαi 0 , T ransx,l = 0
1 0 0
Rotx,αi =
0 i
,
s α i cα i 0
0
0 1 0
0 0 0 1 0 0 0 1
42
cθi = cosθi , sθi = sinθi , cαi = cosαi and sαi = sinαi according to [51]. In addition, θi ,
li , di , αi are parameters associated with the link i and the joint j and denote joint
angle, link length, link offset and link twist, respectively. θi and αi are unique angles
in the model within a multiple of 2π. θi is the joint valuable for a revolute joint, and
di is the joint valuable for a prismatic joint.
The robotic leg is defined using Cartesian coordinates. The coordinate frames of
the leg are depicted in Figure 3.1. The base frame o0 x0 y0 z0 is established at the hip
joint of the leg model, where the origin o0 is located at the middle point of the brass
rod between the thigh rails. The o1 x1 y1 z1 frame is fixed at the knee joint, as shown
by the DH convention. The origin o1 is assigned at the middle point of the brass shaft
between the knee rails. The tool frame o2 x2 y2 z2 is fixed by setting the origin o2 at
the foot-end. l1 and l2 denote the thigh and limb lengths, respectively. The angular
positions of the hip and knee joints are θ1 and θ2 , respectively. The DH parameters
are illustrated in Table 3.1.
Link Name a α d θ
Thigh l1 0 0 θ1
Limb l2 0 0 θ2
T10 = A1
c1 −s1 0 l1 c1
s1 c1 0 l1 s1
=0
0 1 0
0 0 0 1
T20 = A1 A2
c1 −s1 0 l1 c1 c2 −s2 0 l2 c2
s1 c1 0 l1 s1 s2 c2 0 l2 s2
=0
0 1 0 0
0 1 0
0 0 0 1 0 0 0 1
c12 −s12 0 l1 c1 + l2 c12
s12 c12 0 l1 s1 + l2 s12
=0
,
0 1 0
0 0 0 1
where c12 = cos(θ1 + θ2 ) and s12 = sin(θ1 + θ2 ). The first two entries of the last
column of T20 are the x and y coordinates of the foot-end in the base frame, and they
are defined as
x = l1 c1 + l2 c12 ,
(3.2)
y = l1 s1 + l2 s12 .
x2 + y 2 − l12 − l22
c2 = ,
2l1 l2
q
s2 = ± 1 − c22 . (3.4)
44
The multiple solutions in (3.4) correspond to the “elbow-up” position and “elbow-
down” position, respectively. Then, we compute θ2 by using the two-argument arct-
angent routine
θ2 = atan2(s2 , c2 ).
This approach ensures that all solutions are found in the proper quadrant.
After finding θ2 , we solve (3.2) for θ1 . Particularly, (3.2) can be rewritten as
x = k1 c1 − k2 s1 ,
(3.5)
y = k1 s1 + k2 c1 ,
where
k1 = l1 + l2 c2 ,
k2 = l2 s2 .
and
γ = atan2(k2 , k1 ).
k1 = r cos γ,
(3.6)
k2 = r sin γ.
x
= cos γ cos θ1 − sin γsin θ1 ,
r
y
= cos γ sin θ1 + sin γcos θ1 ,
r
or equivalently,
x
cos(γ + θ1 ) = ,
r
y
sin(γ + θ1 ) = .
r
45
Hence,
θ1 = atan2(y, x) − atan2(k2 , k1 ). (3.7)
Note that in (3.4), the sign of s2 determines the value of k2 , thereby influencing the
value of θ1 according to (3.8). These two solutions correspond to two different pos-
tures of the leg. The angular position of the hip joint (θ1 ) and knee joint (θ2 ) can
be computed based on the related parameters, such as the desired position and link
length. In summary, forward and inverse kinematics can realize mutual transforma-
tion between the foot-end trajectory and joint angular positions.
o o o 1
46
0 0 1 1
the Jacobian matrix in the frame o0 x0 y0 can be represented as
" #
−l 1 s 1 − l2 s 12 −l 2 s 12
J◦ = .
l1 c1 + l2 c12 l2 c12
0 0
and
−l1 s1 − l2 s1 −l2 s1
Jv◦2 = l1 c1 + l2 c1 +l2 c1 .
0 0
Hence, the foot-end can be controlled to move in an arbitrary direction generally.
However, when θ2 = ±π, the foot-end can only move in two specified directions
which are vertical to the limb link.
47
1 1
K = ml1 voT1 vo1 + ml2 voT2 vo2 ,
6 6
where ml1 and ml2 denote the mass of the thigh and limb links, respectively. Besides,
the potential energy P due to gravity can be represented as
where h1 = c12 l2 + c1 l21 and h2 = c12 l22 . h1 and h2 denote the heights of the center
of gravity for thigh and limb links, respectively. The center of mass is located in
the geometric center of each link, which means the distance from the origins in the
thigh and knee joints to the center of masses of links are l21 and l22 , respectively. The
Lagrangian of the system, L is given by
L =K − P
1 1
= ml1 voT1 vo1 + ml2 voT2 vo2 − (ml2 gh2 + ml1 gh1 ). (3.11)
6 6
where o0 and o1 are the origins of the base and tool frames in the thigh and knee
joints, respectively. Then, we take the derivation for (3.11), the velocity vo1 at the
48
−l1 s1 θ˙1
vo1 = l1 c1 θ˙1 ,
We also get
2
voT1 vo1 = l12 θ˙1 . (3.12)
Similarly, the velocity vo2 at the origin o2 relative to the base frame o0 x0 y0 z0 is
depicted as
−l1 s1 θ˙1 − l2 s12 (θ˙1 + θ˙2 )
0
We also get
2 2
voT2 vo2 = (l12 + 2l1 l2 c2 + l22 )θ˙1 + (2l1 l2 c2 + 2l22 )θ˙1 θ˙2 + l22 θ˙2 . (3.13)
1 1 2 1
L(θ, θ̇) = m1 l12 θ12 + m2 (l12 + 2l1 l2 c2 + l22 )θ˙1 + m2 (l1 l2 c2 + l22 )θ1 θ2
6 6 3 (3.14)
1 2 l1 l2
+ m2 l22 θ˙2 − (m1 g c1 + (m1 gl2 + m2 g )c12 ).
6 2 2
d ∂L ∂L
( )− = τ,
dt ∂ θ̇ ∂θ
" # " #
τ1 θ1
where τ = and θ = . τ1 and τ2 denote the torques of the hip and knee
τ2 θ2
49
∂L 1 1 1
= m1 l12 θ˙1 + m2 (l12 + 2l1 l2 c2 + l22 )θ˙1 + m2 (l1 l2 c2 + l22 )θ˙2 ,
∂ θ˙1 3 3 3
∂L 1 1
= m2 (l1 l2 c2 + l22 )θ˙1 + m2 l22 θ˙2 ,
∂ θ˙2 3 3
∂L l1 l2
=m1 g s1 + (m1 l2 + m2 )gs12 ,
∂θ1 2 2
∂L l2 1 2 1
=(m1 l2 + m2 )gs12 − m2 l1 l2 θ˙1 s1 − m2 l1 l2 θ˙1 θ˙2 s2 ,
∂θ2 2 3 3
d ∂L 1 1 1
( ) =( m1 l12 + m2 (l12 + 2l1 l2 c2 + l22 ))θ¨1 + m2 (l1 l2 c2 + l22 )θ¨2
dt ∂ θ˙1 3 3 3
2 1 2
− m2 l1 l2 s2 θ˙1 θ˙2 − m2 l2 s2 θ˙2 ,
3 3
d ∂L 1 1 1
( ) = m2 (l1 l2 c2 + l22 ))θ¨1 + m2 l22 θ¨2 − m2 l1 l2 s2 θ˙1 θ˙2 .
dt ∂ θ˙2 3 3 3
where
" #
1
+ 31 m2 (l12 + 2l1 l2 c2 + l22 ) 31 m2 (l1 l2 c2 + l22 )
m l2
3 1 1
D(θ) = 1 1
,
m (l l c + l22 )
3 2 1 2 2
m l2
3 2 2
" #
− 23 m2 l1 l2 s2 θ˙2 − 13 m2 l1 l2 s2 θ˙2
C(θ, θ̇) = 1 ,
m l l s θ˙
3 2 1 2 1 1
0
" #
−m1 g l21 s1 − (m1 gl2 + m2 g l22 )s12
G(θ) = ,
−(m1 gl2 + m2 g l22 )s12
" # " # " #
τ1 θ¨1 θ˙1
and τ = , θ̈ = , θ̇ = . D(θ) is the mass-inertia matrix, C(θ, θ̇) is the
τ2 θ¨2 θ˙2
matrix of centripetal and Coriolis terms, and G(θ) is the gravity vector. By utilizing
(3.17), the actual angular positions can be calculated in the MATLAB/SimMechanics
quadruped model based on the joint torques.
Several typical kinds of gaits are described in the following. The pacing, trotting
and bounding gaits are two-beat gaits. The creeping and tölting gaits are four-beat
gaits.
52
• In the pacing gait, lateral pairs of legs move synchronously. The pacing gait is
appropriate for the quadruped robot to execute a high-speed locomotion on flat
ground.
• In the trotting gait, diagonal pairs of legs move at the same time. Its energy
consumption is relatively low at a high-speed motion.
• In the bounding gait, the front pair of legs and hind pair of legs move in se-
quence.
• In the creeping gait, as shown in Figure 3.4, the quadruped robot continuously
executes the footfall pattern LH, LF, RH, and RF in a lateral footfall sequence
[52]. The abbreviations stand for left hind (LH), left fore (LF), right hind
(RH) and right fore (RF). In this static gait, triple feet alternately provide the
support. Since its energy cost is relatively low at a low-speed motion, this gait
is appropriate for traversing rocky and sloped terrain.
• The tölting gait is extracted from the locomotion performance of icelandic horses
in [53]. The tölting gait has the same footfall sequence as the creeping gait.
But the touch-down phase of the tölting gait occupies less percentage in one
step cycle than the creeping gait. Consequently, a single foot and double feet
alternately provide the support.
Main body
Travel
RH LH
RF
LF
Generally, various kinds of gaits have their own advantages in different environ-
ments in [54]. The creeping gait is a suitable choice for the quadruped robot in a low
speed motion. Since triple feet alternately provide the support in the locomotion, this
four-beat gait presents high stability. In addition, the energy cost of the creeping gait
is lower than other gaits at a low-speed motion. Hence, the creeping gait is chosen to
be applied in the designed robot. Figure 3.3 shows internal contact directions in the
creeping gait.
As one type of four-beat gaits, the creeping gait is selected to perform the low-
speed locomotion due to its low energy consumption and substantial available footholds.
In the creeping gait, the predefined footfall pattern is (LH→ LF→ RH → RF →
LH→. . . ), and this sequence can be readily generated in MATLAB. A step cycle of
the quadrupedal locomotion can be divided into the swing and stance phases accord-
ing to [52]. Figure 3.5 shows that the sequence of swing and stance phases for a
one-legged robot is separated by a short moment called toe-off in [15].
3.2.2 PD Control
To manipulate the leg posture to execute the locomotion, each joint is operated by
the PD controller. Figure 3.6 shows the block diagram of a quadruped robot motion
control system. The desired trajectories of foot-ends are formed based on the footfall
sequence of the creeping gait, and the desired angular positions for the hip and knee
joints can be calculated by using inverse kinematics equations. For each joint, the
control signal is calculated by a PD controller based on the difference between the
desired and actual angular positions. By importing the control signal to the ideal
motor block, the joint torque is generated to manipulate the leg posture, thereby
executing the quadrupedal locomotion. In the MATLAB/SimMechanics model, the
54
actual angular positions of hip and knee joints are computed based on (3.17). Many
physical effects are ignored in this simplified model.
For each joint, a PD controller is applied to make the response to meet the design
specifications, as shown in the area of the orange dotted lines in Figure 3.4. Based
on the error value of angular positions, the proportional and derivative gains are
implemented to generate the actuating torques. To set up the parameters of the PD
controller, the proportional gain Kp is adjusted firstly. Kp is proportional to the
current value of the error ∆θ = θ − θd , where θ and θd denote the actual joint angle
and the desired joint angle, respectively. Then, to reduce the effect of the error, the
derivative gain Kd is used to exert the control influence, which is generated by the
rate of error change. After several tests, the appropriate Kp and Kd for the hip joint
are chosen as 20 and 2, respectively. Kp and Kd for the knee joint are selected as
10 and 1, respectively. Similarly, by applying the PD controller, the control signal
for the motor in the knee joint is generated to actuate the limb link. Meanwhile, the
PD controller in the hip joint provides the control signal to the ideal motor block to
actuate the whole leg, which is twice the mass of the limb. Hence, it is reasonable
that PD parameters for the hip joint are twice as parameters for the knee joint. Since
the residual error in the system is relatively small and no need to be eliminated, the
integral term is not added in the controller. The details of the trajectory generator
and SimMechanics quadruped model in Figure 3.6 are illustrated in Section 3.2.3 and
3.2.4.
PD control
Trajectory 𝜽𝒅 𝚫𝜽 𝝉 SimMechanics 𝜽
generator
𝑲𝒑 quadruped model
𝑲𝒅 𝑺
Hip joint
𝒙
Knee joint
Highest
Step Length
significant points are selected to form the desired trajectory of the foot end in the
swing phase. First of all, the start point of one step cycle is the posterior extreme
position (PEP) where the foot-end lifts off the ground. As shown in Figure 3.8, the
origin of the base frame is set at the hip joint of the leg, and the PEP is at [-0.051 m,
0.254 m, 0 m]. Then, the leg swings to the highest position. This half-way point of
the swing phase is at [0 m, 0.203 m, 0 m]. Finally, the foot-end strikes the ground in
the touchdown phase at the anterior extreme position (AEP), which is at [0.051 m,
0.254 m, 0 m]. In addition, two relative points are also chosen to smooth the path
around the highest position. These relative points are at [0.036 m, 0.218 m, 0 m]
and [0.036 m, 0.218 m, 0 m], respectively. Based on three significant points and two
relative points, a fifth order polynomial can be formulated to form each individual
spline segment of the desired trajectory.
Leg base 𝒛𝟎 𝒐𝟎
at [0 m, 0 m, 0 m] 𝒚𝟎 𝒙𝟎
𝒍𝟏
𝒍𝟐
Figure 3.8: A posterior extreme set point for one step shown with Cartesian coordi-
nates.
link length. The LH, LF, RH and RF legs are painted blue, red, green and yel-
low, as illustrated in Figure 3.9. The simplified CAD model is converted into the
MATLAB/SimMechanics model with the help of MATLAB/SimMechanics packages.
Related MATLAB/Simulink blocks are also set up to model the dynamics of the
quadruped robot. The desired trajectories are generated in MATLAB based on a
fifth polynomial. Environment blocks should be carefully set to provide the global
information about the workspace, such as the gravitational acceleration and global
coordinate system. The gravitational acceleration is set to be 9.81 m/s2 in the simu-
lation.
relative coordinate systems should be initialized in the hip and knee joints and foot-
ends, as illustrated in Figure 3.1. In other words, as discussed in Section 3.1, we
need to define the transformation matrix from the hip joint to the knee joint, and
furthermore, define the transformation matrix from the knee joint to the foot-end. By
applying transformation matrices, the directions of axes are re-oriented in the base
frames. For example, the knee joint angular position θ2 of the LF should be initialized
as −θ2 to present the rotation angle. The details of the MATLAB/SimMechanics
model are illustrated in Figure 3.10.
(a) (b)
Angle of the Right-hind Hip Joint Angle of the Right-hind Knee Joint
1.4 1.8
Desired Desired
1.3 Actual 1.6 Actual
1.2 1.4
1.1 1.2
Angle(rad)
Angle(rad)
1 1
0.9 0.8
0.8 0.6
0.7 0.4
0.6 0.2
0 1 2 3 4 5 6 7 8 9 10 11 0 1 2 3 4 5 6 7 8 9 10 11
Time(sec) Time(sec)
(c) (d)
Figure 3.11: Illustrations of the desired and tracked angle of the hip joint and knee
joint of hind legs: (a) the left-hind hip joint, (b) left-hind knee joint, (c) right-hind
hip joint and (d) right-hind knee joint.
equations. The actuating torques are computed by using PD control based on the
desired angular positions. By implementing Euler-Lagrange equations, the actual
joint positions are generated, as illustrated in Figure 3.6. The actual trajectories of
the foot-ends are further calculated by using forward kinematics equations. In Figure
3.11, Figure 3.12 and Figure 3.13, the blue curves denote the desired trajectories for
the joint angles or foot-ends, and the red curves denote the actual trajectories for the
joint angles or foot-ends in each case.
We take the left-hind (LH) leg as an example to demonstrate the quadrupedal
locomotion in one step cycle as shown in Figure 3.11a and Figure 3.11b. Each step
cycle lasts for 5.25 s, and the swing phase is from 0.25 s to 1.25 s. Then, the LH leg
goes through a rest period while the other legs are in the swing phase in order. The
LH leg is in a stance phase from 4.5 s to 5.5 s. The foot-end lifts off the ground at
60
Angle of the Left-front Hip Joint Angle of the Left-front Knee Joint
-1.4 -0.6
Desired Desired
Actual Actual
-1.6 -0.8
-1.8 -1
Angle(rad)
Angle(rad)
-2 -1.2
-2.2 -1.4
-2.4 -1.6
-2.6 -1.8
0 1 2 3 4 5 6 7 8 9 10 11 0 1 2 3 4 5 6 7 8 9 10 11
Time(sec) Time(sec)
(a) (b)
2.2 1.4
Angle(rad)
Angle(rad)
2 1.2
1.8 1
1.6 0.8
0 1 2 3 4 5 6 7 8 9 10 11 0 1 2 3 4 5 6 7 8 9 10 11
Time(sec) Time(sec)
(c) (d)
Figure 3.12: Illustrations of the desired and tracked angle of the hip joint and knee
joint of front legs: (a) the left-front hip joint, (b) left-front knee joint, (c) right-front
hip joint and (d) right-front knee joint.
the PEP of the step cycle to the half-way point, and then touches down at the AEP.
Figure 3.11 and Figure 3.12 demonstrate the tracking performance of the designed
motion controller for the hind legs and front legs in two step cycles. The desired and
tracked angle trajectories of each joint are illustrated in the subfigures of Figure 3.11
and Figure 3.12. From the simulation results, it can be observed that, at the beginning
of the locomotion, it takes around 0.25 s for each joint to track the desired angular
position. Then, each joint angle is capable of tracking the desired angular position
with an approximately 0.001 rad. The tracking performances around the red circles
are illustrated in the time series plots.
The simulation results of foot-end positions in a sequence of LH, LF, RH, and
RF are shown in Figure 3.13. At the beginning of the simulation, the foot-end is
61
controlled to track the initial point of the desired trajectory, so the displacement of
the position is relatively large. After around 0.25 s, the foot-end starts to track the
desired path in a relatively good condition.
Position of the Left-hind Foot End Position of the Left-front Foot End
Desired Desired
Actual Actual
-0.2 -0.2
-0.22
-0.22
Y-direction
Y-direction
-0.24
-0.24
-0.26
-0.26
-0.28
-0.3 -0.28
0.1 0.2
0.05 15 15
0.1
0 10 10
0
-0.05 5 5
X-direction -0.1 0 Time(sec) X-direction -0.1 0 Time(sec)
(a) (b)
Position of the Right-hind Foot End Position of the Right-front Foot End
Desired Desired
Actual Actual
-0.2 -0.2
-0.22
-0.22
Y-direction
Y-direction
-0.24
-0.24
-0.26
-0.26
-0.28
-0.3 -0.28
0.1 0.2
0.05 15 15
0.1
0 10 10
0
-0.05 5 5
X-direction -0.1 0 Time(sec) X-direction -0.1 0 Time(sec)
(c) (d)
Figure 3.13: Illustrations of the desired and tracked angle of four foot-ends: (a) the
left-hind foot-end, (b) left-front foot-end, (c) right-hind foot-end and (d) right-front
foot-end.
3.3 Conclusion
In this chapter, we focus on modeling for a robotic leg and the animated simulation of
the designed quadruped robot. Forward and inverse kinematics equations are utilized
in the leg model, and singularities of the Jacobian matrix is calculated to identify the
singular configurations. Then, Euler-Lagrange equations are applied to calculate the
hip and knee joint torques, respectively. Furthermore, an animated simulation of the
62
quadrupedal locomotion is emulated with the creeping gait. The desired trajectories
of foot-ends are generated based on the predefined footfall sequence. At last, the
MATLAB/SimMechanics model is established in MATLAB. By using PD control to
manipulate the joints, the foot-ends track the desired paths well.
63
Chapter 4
4.1 Conclusions
This thesis mainly introduces the mechanical design and simulation studies of a
quadruped robot motion control system. An animated simulation of the quadrupedal
locomotion has been emulated by combining MATLAB and SolidWorks.
In Chapter 2, the mechanical structure of the quadruped robot is presented. Par-
ticularly, section 2.1 introduces some key components, such as DC motors and poten-
tiometers. Additionally, the leg mechanism is optimized to improve the characteris-
tics of the compliant leg, such as the speed, endurance, agility and strength. Several
methods are applied to design the robot from the aspects of the leg length, mass
distribution, leg kinematics, elastic energy storage and muscle power. To absorb the
impact force at collision, linear telescoping joints are incorporated in the limb links
to realize the internal energetic conversion. In Section 2.4, the structural compo-
nents are optimized to enhance the fragile position by using FEA. Besides, structural
components in the hip joint are demonstrated as examples in the design process.
In Chapter 3, the modeling for the robotic leg and animated simulation are illus-
trated. Kinematic and dynamic parameters of the leg model are specified based on
a CAD model, which is drawn by SolidWorks. Based on the deviation between the
desired and tracked joint angles, the PD control is implemented to generate a PWM
signal to actuate the DC motor. Actuated by the joint torques, the hip and knee
joints are manipulated to adjust the leg postures. By choosing appropriate footholds,
the quadrupedal locomotion is executed in a creeping gait. One step cycle of the
quadruped movement is divided into the stance and swing phases. In the stance
64
phase, the quadruped robot maintains the foothold position while shifting the body
part forward. In the swing phase, four legs are controlled to execute the quadrupedal
locomotion in the predefined footfall pattern.
Actuator control
Position & force control
Figure 4.1: An overview of the control architecture for the quadrupedal locomotion.
High-speed control operations can be implemented in the FPGA with short processing
time. Proper gaits can also be applied in this architecture according the environmental
conditions. For instance, when the terrain is relatively smooth, dynamic gaits can be
applied for a high speed locomotion. Otherwise, static gaits is the optimal option,
when the robot moves in rough terrain.
For the low level control, the ARM architecture is used to generate the leg tra-
jectory by controlling the joint angles. The stride of one step cycle is adjusted in
this level for the dynamically stable legged robot. By controlling the joint angles,
the act of positioning the foot-ends interacts with the stability of the quadrupedal
locomotion. To balance steady-state mobility, the ARM architecture is applied for
positioning the foot-ends in the appropriate locations. The ARM architecture not
only can operate the legs touching the ground in the desired footholds, but also can
adjust the posture of the robot.
Overall, the hierarchical structure of the path planner is expected to be developed
for the designed quadruped robot in the future.
66
Bibliography
[3] S. Seok, A. Wang, M. Y. Chuah, D. Otten, J. Lang, and S. Kim, “Design prin-
ciples for highly efficient quadrupeds and implementation on the MIT Cheetah
robot,” in Proc. IEEE Int. Conf. Robot. Autom., Karlsruhe, Germany, May. 2013,
pp. 3307–3312.
[11] K. S. Yamazaki, “The design and control of Scout I, a simple quadruped robot,”
Ph.D. dissertation, McGill Univ., Montreal, QC, Canada, 1999.
[17] C. S. Sharp, O. Shakernia, and S. Sastry, “A vision system for landing an un-
manned aerial vehicle,” in Proc. IEEE Int. Conf. Robot. Autom., Seoul, Korea,
May. 2001, pp. 1720–1727.
[19] J.-F. Lalonde, N. Vandapel, D. F. Huber, and M. Hebert, “Natural terrain classi-
fication using three-dimensional ladar data for ground robot mobility,” J. Robot.
Syst., vol. 23, no. 10, pp. 839–861, 2006.
[22] M. H. Raibert, Legged Robots that Balance. Cambridge, MA, USA: MIT press,
1986.
[25] Y. Li, B. Li, J. Ruan, and X. Rong, “Research of mammal bionic quadruped
robots: A review,” in Proc. Int. Conf. Robot., Autom. Mechatronics, Qingdao,
China, Sep. 2011, pp. 166–171.
[27] S. Peng, C. P. Lam, and G. R. Cole, “A biologically inspired four legged walking
robot,” in Proc. IEEE Int. Conf. Robot. Autom., Taipei, Taiwan, Sep. 2003, pp.
2024–2030.
a four legged walking machine,” in Proc. From Animals to Animates: 5th Int.
Conf. Society for Adaptive Behaviour, Zrich, Switzerland, 1998, pp. 400–407.
[35] X. Zhou and S. Bi, “A survey of bio-inspired compliant legged robot designs,”
Bioinspir. Biomim., vol. 7, no. 4, pp. 1–20, 2012.
[36] S. P. Singh and K. J. Waldron, “Attitude estimation for dynamic legged locomo-
tion using range and inertial sensors,” in Proc. IEEE Int. Conf. Robot. Autom.,
Barcelona, Spain, Apr. 2005, pp. 1663–1668.
[37] B. Brown and G. Zeglin, “The bow leg hopping robot,” in Proc. IEEE Int. Conf.
Robot. Autom., Leuven, Belgium, May. 1998, pp. 781–786.
[45] S. Hirose and Y. Umetani, “The basic motion regulation system for a quadruped
walking vehicle,” in Design Engineering Tech. Conf. ASME, Los Angeles, USA,
Sep. 1980, paper 80-DET-34, pp. 1–6.
[48] H.-W. Park, M. Y. Chuah, and S. Kim, “Quadruped bounding control with
variable duty cycle via vertical impulse scaling,” in Proc. IEEE/RSJ Int. Conf.
Intell. Robots Syst., Chicago, USA, Sep. 2014, pp. 3245–3252.
71
[49] N. Kohl and P. Stone, “Policy gradient reinforcement learning for fast
quadrupedal locomotion,” in Proc. IEEE Int. Conf. Robot. Autom., New Or-
leans, USA, Apr. 2004, pp. 2619–2624.
[52] R. B. McGhee and A. A. Frank, “On the stability properties of quadruped creep-
ing gaits,” Mathematical Biosciences, vol. 3, no. 3, pp. 331–351, 1968.
[53] M. Hildebrand, “Symmetrical gaits of horses,” Science, vol. 150, no. 3697, pp.
701–708, 1965.
[54] W. Xi, Y. Yesilevskiy, and C. D. Remy, “Selecting gaits for economical locomo-
tion of legged robots,” Int. J. Robot. Res., vol. 35, no. 9, pp. 1140–1154, 2016.