+ All Categories
Home > Documents > Mechanism and Machine Theory - Tianjin...

Mechanism and Machine Theory - Tianjin...

Date post: 05-Jun-2018
Category:
Upload: phamdiep
View: 222 times
Download: 2 times
Share this document with a friend
13
Mechanism and Machine Theory 120 (2018) 107–119 Contents lists available at ScienceDirect Mechanism and Machine Theory journal homepage: www.elsevier.com/locate/mechmachtheory Research paper Gait analysis and control of a deployable robot Hao Shang a , Dawei Wei a , Rongjie Kang a,b,, Yan Chen a,b,a Key Laboratory of Mechanism Theory and Equipment Design of Ministry of Education, Tianjin University, Tianjin 300072, PR China b School of Mechanical Engineering, Tianjin University, Tianjin 300072, PR China a r t i c l e i n f o Article history: Received 19 July 2017 Revised 1 September 2017 Accepted 21 September 2017 Available online 29 September 2017 Keywords: Threefold-symmetric Bricard linkage Deployable robot Gait control a b s t r a c t Deployable structures have the advantage of being able to change their size and morphol- ogy significantly with minimal mobility. Yet, there are very limited numbers of deploy- able robots. This paper proposes a transformable robot by applying a threefold-symmetric Bricard linkage as the body structure. The geometrics of the robot are investigated to set up relationships between its height/foot span and the joint angles of the linkage. The lo- comotion gaits of the robot can be realized through the deploying and folding motions of the Bricard linkage. From this, the corresponding gait controller is designed. Experimental results show that the robot can move in an arbitrary direction and follow a given path. Moreover, it is capable of moving through limited space easily by changing its configura- tion from folded to deployed, and vice versa. © 2017 Elsevier Ltd. All rights reserved. 1. Introduction In recent years, there has been a growing interest in the development of transformable robots, which can adjust their morphology to adapt to multiple tasks or uncertain environment for reconnaissance, rescue missions and space applications [1]. Modular robots are a kind of transformable robots built from identical or similar elements that can be connected in dif- ferent ways to form different morphologies [2]. Since the Reconfigurable Modular Manipulator System (RMMS) was invented in 1988 [3], many kinds of modular robots have appeared successively. Two typical classes of modular robots are chain-type robots, such as the PolyPod robot [4], PolyBot [5] and CONRO [6], and the lattice-type robots, such as the Molecule [7] and the 3-D-Unit [8]. Evolving both classes resulted the hybrid modular robots, including M-TRAN III, ATRON and SuperBot, [1,9,10], which are capable of self-reconfiguration. Yet the cost of such robots is rather high. In the last decade, other kinds of transformable robots were developed based on metamorphic mechanisms. Dai proposed the metamorphic robotic hand with movable palm section comprising of several links able to move relatively to each other [11]. Ding proposed a novel design of metamorphic hybrid wheel-legged rover robot whose width can be changed due to the metamorphic body mechanism [12,13]. Different kinds of transformable robots have also been developed. Chen et al. proposed a novel leg-wheel transformable mobile robot, the Quattroped, which employs a transformation mechanism that can switch the locomotion unit of the robot from legs to wheels, and vice versa [14]. Liang et al. developed an amphibi- ous robot (AmphiHex-I) with a transformable leg-flipper propulsion mechanism [15]. However, the above-mentioned robots are not able to change their size significantly, which is an important property for them to traverse through constrained environments. Corresponding authors. E-mail addresses: [email protected] (R. Kang), [email protected] (Y. Chen). https://doi.org/10.1016/j.mechmachtheory.2017.09.020 0094-114X/© 2017 Elsevier Ltd. All rights reserved.
Transcript
Page 1: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

Mechanism and Machine Theory 120 (2018) 107–119

Contents lists available at ScienceDirect

Mechanism and Machine Theory

journal homepage: www.elsevier.com/locate/mechmachtheory

Research paper

Gait analysis and control of a deployable robot

Hao Shang

a , Dawei Wei a , Rongjie Kang

a , b , ∗, Yan Chen

a , b , ∗

a Key Laboratory of Mechanism Theory and Equipment Design of Ministry of Education, Tianjin University, Tianjin 30 0 072, PR China b School of Mechanical Engineering, Tianjin University, Tianjin 30 0 072, PR China

a r t i c l e i n f o

Article history:

Received 19 July 2017

Revised 1 September 2017

Accepted 21 September 2017

Available online 29 September 2017

Keywords:

Threefold-symmetric Bricard linkage

Deployable robot

Gait control

a b s t r a c t

Deployable structures have the advantage of being able to change their size and morphol-

ogy significantly with minimal mobility. Yet, there are very limited numbers of deploy-

able robots. This paper proposes a transformable robot by applying a threefold-symmetric

Bricard linkage as the body structure. The geometrics of the robot are investigated to set

up relationships between its height/foot span and the joint angles of the linkage. The lo-

comotion gaits of the robot can be realized through the deploying and folding motions of

the Bricard linkage. From this, the corresponding gait controller is designed. Experimental

results show that the robot can move in an arbitrary direction and follow a given path.

Moreover, it is capable of moving through limited space easily by changing its configura-

tion from folded to deployed, and vice versa.

© 2017 Elsevier Ltd. All rights reserved.

1. Introduction

In recent years, there has been a growing interest in the development of transformable robots, which can adjust their

morphology to adapt to multiple tasks or uncertain environment for reconnaissance, rescue missions and space applications

[1] .

Modular robots are a kind of transformable robots built from identical or similar elements that can be connected in dif-

ferent ways to form different morphologies [2] . Since the Reconfigurable Modular Manipulator System (RMMS) was invented

in 1988 [3] , many kinds of modular robots have appeared successively. Two typical classes of modular robots are chain-type

robots, such as the PolyPod robot [4] , PolyBot [5] and CONRO [6] , and the lattice-type robots, such as the Molecule [7] and

the 3-D-Unit [8] . Evolving both classes resulted the hybrid modular robots, including M-TRAN III, ATRON and SuperBot,

[1,9,10] , which are capable of self-reconfiguration. Yet the cost of such robots is rather high.

In the last decade, other kinds of transformable robots were developed based on metamorphic mechanisms. Dai proposed

the metamorphic robotic hand with movable palm section comprising of several links able to move relatively to each other

[11] . Ding proposed a novel design of metamorphic hybrid wheel-legged rover robot whose width can be changed due to

the metamorphic body mechanism [12,13] . Different kinds of transformable robots have also been developed. Chen et al.

proposed a novel leg-wheel transformable mobile robot, the Quattroped, which employs a transformation mechanism that

can switch the locomotion unit of the robot from legs to wheels, and vice versa [14] . Liang et al. developed an amphibi-

ous robot (AmphiHex-I) with a transformable leg-flipper propulsion mechanism [15] . However, the above-mentioned robots

are not able to change their size significantly, which is an important property for them to traverse through constrained

environments.

∗ Corresponding authors.

E-mail addresses: [email protected] (R. Kang), [email protected] (Y. Chen).

https://doi.org/10.1016/j.mechmachtheory.2017.09.020

0094-114X/© 2017 Elsevier Ltd. All rights reserved.

Page 2: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

108 H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119

Fig. 1. Threefold-symmetric Bricard linkage: (a) Joints and links on the top view of the linkage; (b) θ versus ϕ for the threefold-symmetric linkage where

α = 2 π/ 3 .

Recent researches have started exploring the possibility of implementing deployable structures into transformable robots.

Lee et al. proposed a deformable wheel robot using the ball-shaped waterbomb origami pattern [16] . Miyashita et al. devel-

oped an untethered robot that is capable of self-folding from a sheet to a 3D structure, walking, swimming and dissolving in

liquid [17] . The aforementioned robots used deploying and folding motions to purely change their body morphology while

requiring additional actuation mechanisms for locomotion. Also, the deployable ratio, defined as the ratio of the maximum

and minimum area of the robot body projected onto the ground plane, of those robots are relatively small (less than 4).

On the other hand, the deployable structure based on the single overconstrained linkage can offer a very large deployable

ratio [18,19] . Kang et al. presented a deployable walking robot based on the Bricard linkage [20] . By using the deploying and

folding motions of the Bricard linkage, the robot is able to not only change its configuration, but also move around. Due to

the distinct structure of this robot, its gait control will certainly be different from other transformable robots. Massimiliano

et al. proposed an online gait learning method for the modular robots [21] . Bing et al. presented the smooth slithering

gait transition control based on a lightweight central pattern generator (CPG) model for snake-like robots [22] . Xin et al.

proposed to tune the center of gravity (COG) of the body for a quadruped robot [23] . However, the above methods are not

suitable for the presented deployable robot as it utilizes a special gait generated by the Bricard linkage. Therefore, in this

paper, our attention is drawn on the relationship between the linkage movement and the gait control.

The paper is organized as follows. Section 2 gives a brief introduction to the mechanical design and the geometric pa-

rameters of the robot. Section 3 analyzes the locomotion gait used for directional locomotion. Section 4 introduces the

complete control scheme for the robot. Section 5 validates the presented control scheme experimentally. Section 6 presents

the conclusion and discussion.

2. Mechanical design of the robot

The Bricard linkage is a family of the typical 6R overconstrained linkages [19] . In 2005, Chen et al. proposed the threefold-

symmetric Bricard linkage, which was obtained by combining the general plane-symmetric and trihedral Bricard linkage

[24] . She pointed out the possibility of applying this linkage to deployable structures. The configuration of this linkage is

shown in Fig. 1 (a). It has three symmetric planes (planes passing through the joint axes 1 and 4, 2 and 5, 3 and 6) and

threefold rotational symmetry. Taking Denavit–Hartenberg notations illustrated in Appendix A , the geometry condition of

this linkages are

a 12 = a 23 = a 34 = a 45 = a 56 = a 61 = l , α12 = α34 = α56 = α, α23 = α45 = α61 = 2 π − α ,

R i = 0 (i = 1 , 2 , 3 , 4 , 5 , 6) . (1)

Because of threefold symmetry, the six revolute variables must satisfy

θ1 = θ3 = θ5 = θ ,

θ2 = θ4 = θ6 = ϕ . (2)

The closure equation of this threefold-symmetric linkage is then obtained in [24] as

co s 2 α + sin

2 α( cos θ + cos ϕ) + (1 + cos 2 α) cos θ cos ϕ − 2 cos α sin θ sin ϕ = 0 (3)

Page 3: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119 109

θ

Fig. 2. A geometric model of the robot: l is the link length, θ is the joint angle, h is the height and w is the foot span of the linkage.

Body Angle SensorBattery

DC-motor Gears Omni-directional WheelSteel Frame CMOD

Fig. 3. The robotic prototype.

Fig. 1 (b) shows the relationship between θ and ϕ when α = 2 π/ 3 determined by Eq. (3) . To avoid kinematic bifurcation

[24] at point ( π , π ), the range of θ is limited within the interval [0, 0.9 π ] as shown by the red curve in Fig. 1 (b).

To evaluate the configuration of the robot, we define two dimensional parameters, the height of the linkage h and the

foot span w , as shown in Fig. 2 , which vary with the kinematic input θ of the linkage. Thus, θ can be used to control robot

configuration and locomotion, or the input θ can be derived by Eq. (4) if one dimensional parameter (height h or foot span

w ) is given.

h = l

4

3

cos θ

2

cos ϕ

2

− 2

3

cos θ − 2

3

cos ϕ − 1

3

,

w = 2 l cos θ

2

. (4)

Fig. 3 shows the prototype of the deployable robot with six links combined by revolute joints to form the deployable

body with l = 500 mm and α = 2 π/ 3 . To reduce the weight of the deployable robot, carbon fiber tubes are used to construct

the robot body. Each “foot” is connected by a steel frame and supported by two omni-directional wheels, which allows for

smooth lateral slip during locomotion. A DC-motor, power and transmission systems are contained within the each foot. In

this case, it is possible to activate the three motors to deploy or fold the robot. Also, we can activate two motors while

locking the rest one to generate locomotion. If we assemble the three motors on the joint of the linkage, it is still possible

to achieve deploying and folding motions, but additional motors are required to adjust the friction between the robot feet

and ground for locomotion. Thus, to reduce the complexity of the system, the motor/wheel units are applied to the feet of

Page 4: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

110 H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119

hmaxH

wmax

W

(a) (b)

Fig. 4. Walking through the constrained environment: (a) A horizontal space; (b) A vertical space.

0 125 250 375 500h (mm)

200

w (m

m)

400

600

800

1000

hmax

wmax

Fig. 5. The relationship between the height and foot span.

the robot. An angle sensor is assembled collinearly with the joint axis to monitor the angle θ , which is the rotation angle

about the axis of the joint 1 as shown in Fig. 1 (a). The control module (CMOD) is attached to one link of the robot body.

From the fully folded configuration to the fully deployed, the input angle θ varies from 0.9 π to 0, while the height from

493 mm to 0 mm and foot span from 156 mm to 10 0 0 mm. Hence the robot has a deployable area ratio of 0.433 m

2 /0.011

m

2 = 39.3. However, when θ approaches 0.9 π , the barycenter of the robot rises, which will reduce the stability of the

robot. On the other hand, when θ reaches 0, the robot requires a large torque from motor to hold its configuration. So the

allowable range of θ is narrowed to [5 π /36, 5 π /6].

3. Gait analysis

Due to the deployable property of this robot, it has the advanced capability to walk through constrained environments.

The locomotion gait is developed in this section.

Fig. 4 shows how the robot walks through horizontal and vertical space. The maximum value of the height, h max , and

foot span, w max , can be derived as

h max = H − C 1 , w max = W − C 2 ,

(5)

where H and W are the height and width of the environmental constraints, C 1 and C 2 are space margins, which include the

space for assembling the steel frames and carbon fiber tubes.

The height h and foot span w are coupled in such a robot. The relationship between them is shown in Fig. 5 . Given

a constraint h max , the possible range of h is plotted with the blue curve in Fig. 5. Similarly, the possible range of w is

Page 5: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119 111

D2 D1

D3

3

1 2

F3

F1 F2

3

1 2

Folded DirectionFoldedInitial

Initial Deployed Deployed Direction

O4

O3O3

O1 O1

O2

(a)

(d)

(b)

(e)

(c)

(f)

LOCKED

LOCKED

Fig. 6. The locomotion gait.

Fig. 7. Scheme of step combination: (a) A combinational step composed of two basic steps; (b) Six segments defined by the six combinational step vectors;

(c) Vector resultant.

illustrated by red curve when w max is given. The corresponding configuration parameters, θh or θw

, can then be calculated

by Eq. (4) .

Although the robot has single degree of freedom, it is actuated by three DC-motors on the three feet, which follow

certain pattern to comply with the motion of the linkage. To enable the robot to walk in a specific direction, one motor is

locked and the other two are activated with identical rotating speed causing the movement of the robot. Fig. 6 shows the

working principle of the locomotion gait. From an initial configuration, Fig. 6 (a), the robot is deployed with one foot locked.

The centroid of the robot then moves from the point O 1 to O 2 , Fig. 6 (b), so the robot can move in three directions, D 1 , D 2

and D 3 , Fig. 6 (c). Similarly, when the robot is folded from an initial configuration, Fig. 6 (d), the centroid moves from the

point O 3 to O 4 , Fig. 6 (e). Thus, F 1 , F 2 and F 3 are the three possible directions the robot can move in when folded, Fig. 6 (f).

We define D i ( i = 1, 2, 3) and F j ( j = 1, 2, 3) as the basic deploying and folding step, respectively. The robot moves along D i

( i = 1, 2, 3) if the motor i is locked and along F j ( j = 1, 2, 3) if the motor j is locked.

To achieve walking in any direction, a vector resultant method was proposed. We combine two basic steps D i and F j in

sequence to form a combinational step, P k , where i,j = 1, 2, 3, i � = j as shown in Fig. 7 (a). By using all possible combinations

of D i and F j , the robot can walk in 6 directions in a plane. The corresponding combinational step is denoted by a vector

P k = D i + F j , (6)

where k = 1, 2, 3, 4, 5, 6.

Page 6: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

112 H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119

Fig. 8. Locomotion gait generator.

In such combinational step, the robot body will be deployed and then folded. To ensure the robot has the same config-

uration (i.e. the same joint angle θ ) before and after one combinational step, the two basic steps, D i and F j , included in a

combinational step should have identical length satisfying the following condition

| D i | =

∣∣F j ∣∣ = δ, (7)

where δ is the basic step length. Thus, the combinational step length is | P k | =

3 δ. If the value of the basic step length δincreases, the robot will walk a longer distance within a combinational step, and vice versa. The relationship between the

step length δ and the change of θ in a basic step will be explained in Section 4 .

As shown in Fig. 7 (b), the plane is divided into six segments by the six combinational steps ( P 1 , P 2 , P 3 , P 4 , P 5 and P 6 ).

Given a desired vector Q indicating the walking direction, the robot can follow it by using two adjacent combinational steps

P k and P k +1 in the segment where Q locates, Fig. 7 (c). Thus, the desired vector Q is composited by P k and P k +1 as

Q = μk P k + μk +1 P k +1 , (8)

where μk , μk +1 ∈ (0 , 1) . Since the direction of P k and P k +1 are determined, there is a unique solution to μk and μk +1 as

long as the desired vector | Q | ∈ (0 , √

3 δ] .

A gait generator is then designed as shown in Fig. 8 . Starting from a given vector Q , its component vectors, P k and P k +1 ,

are determined by two adjacent combinational steps in Fig. 7 (b). Then, their coefficients μk and μk +1 can be calculated with

Eq. (8) . The corresponding basic steps ( μk D i , μk F j , μk +1 D

′ i and μk +1 F

′ j ) can be obtained with Eq. (6) .

4. The control system

To control the locomotion of the robot, the obtained gait parameters, μk D i , μk F j , μk +1 D

′ i and μk +1 F

′ j , should be related

to the rotational angles of the three motors, ψ 1 ( t ), ψ 2 ( t ) and ψ 3 ( t ). We assume that if the robot changes its configuration

from A to B (the corresponding configuration parameters are θA and θB respectively) by the locomotion gait, the centroid of

the robot will move along vector e AB , shown in Fig. 9 . The corresponding displacement of the wheeled foot, s f , is contributed

by the wheel’s rotation, s r , as well as its associated lateral slip, s s .

Given the configuration parameters θA and θB , the corresponding foot span w A and w B can be calculated by Eq. (4) . Thus,

as shown in Fig. 9 , the following relationships can be established

| e AB | =

3

3

| w A − w B | =

2

3 l

3

∣∣∣∣cos θA

2

− cos θB

2

∣∣∣∣ ,

| s r | =

3

2

| s f | =

3

2

| w A − w B | =

3

2

| e AB | . (9)

Then the rotation angle of the motors, ψ AB , can be derived as

ψ AB =

i mw

| s f | R

=

3 i mw

| e AB | 2 R

, (10)

where ψ AB is the rotation angle of the two activated motors (the rest one is locked) in locomotion gait, R is the radius of

the robot wheel and i mw

is the transmission ratio between the motor and wheel. Substituting | e AB | = | μk D i | , | e AB | = | μk F j | ,| e AB | = | μk +1 D

′ i | and | e AB | = | μk +1 F

′ j | into Eq. (10) respectively, the corresponding rotation angle of motors, ψ Di , ψ Fj , ψ

′ Di

and ψ

′ Fj

can be determined.

Meanwhile, we define θd ( θd ≥ θmin ) and θ f ( θ f ≤ θmax ), as the fully deployed and folded configuration in locomotion gait

respectively. In a basic step D i or F j , the configuration of the robot varies from θ f to θd or from θd to θ f , and the centroid

Page 7: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119 113

LOCKED

s r

eAB

sss f

w A

w B

s r

(a) (b) (c)

Fig. 9. The relationships among the configuration parameters, gait parameters and displacement of the wheeled foot: (a) The configuration A; (b) The

configuration B; (c) The locomotion from the configuration A to B.

Host Computer

ArduinoMega 2560

DC-motors Robot

AngleSensor

ElectromagneticEncoders

MotorRotation Angles

RobotConfiguration

Task Message

Motor Rotation Angles

Robot Joint Angle

PWMSignalsDirection

Distance

Fig. 10. The hardware of the control system.

of the robot therefore moves along vector e df or e fd ( | e df | = | e fd | = δ). Substituting | e df | = δ into Eq. (9) , the relationship

between the basic step length δ and configuration parameter θ can be derived as

δ =

2

3 l

3

∣∣∣∣cos θd

2

− cos θf

2

∣∣∣∣, (11)

The hardware of the control system is shown in Fig. 10 , consisting of a host computer, an on-board micro-computer

(Arduino Mega 2560), three DC motors with transmission system, three electromagnetic encoders on the motors and an

angle sensor on one joint of the linkage. Task messages, like walking direction and distance, are sent form the host computer

to the on-board micro-computer via a Bluetooth module. The micro-computer then converts the task messages to PWM

signals to drive the three motors. The rotation angles of the motors, ψ 1 ( t ), ψ 2 ( t ) and ψ 3 ( t ), are fed back to the micro-

computer to form a motor control loop with a PID algorithm while the joint angle θ of the Bricard linkage is fed back to

the micro-computer to form a robot configuration control loop.

The control scheme of the robotic system is designed in Fig. 11 . In this paper, we assume that (1) the environmental

constraint H or W is given; (2) the walking path of the robot is given and divided to a series of the path vectors Q n ( | Q n | ≤

Page 8: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

114 H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119

Fig. 11. The control scheme.

0

0

μ , μ , μ , μ1 1 1 1

μ , μ1 1

ψ

0

ψΒψΑ

ψ1

ψψ

Fig. 12. Motion parameter derivation of the first experiment: (a) Gait generation; (b) Rotation angles ψ 1d ( t ), ψ 2d ( t ) and ψ 3d ( t ) for the three motors.

Page 9: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119 115

Desired Path Actual Path

0 90 180 270 360 450x(mm)

y(m

m)

270

360

90

180

0

SensorCoils

ElectromagneticTransmitter

(a) (b)

Fig. 13. The tracking system of the robot: (a) Hardware; (b) Trace of the robot.

(deg

)

0 0.8 1.6 2.4 3.2 4.0 4.8 5.6 6.4 7.2 8.0 8.8 9.6

160

90

100

110

120

130

140

150

t (s)

Desired curve Actual curve

Fig. 14. The change of the configuration parameter θ in the locomotion gait test.

3 δ, n = 1, 2, 3…). Therefore, the locomotion control of the robot includes the following steps. Firstly, the configuration limit

[ θmin , θmax ] is derived by the environmental constraints. Secondly, the basic step length δ is determined by the change of

the robot configuration from θ f to θd in Eq. (11) , and the robot configuration is tuned from θ0 to θ f . Then, a series of the

path vectors Q n ( | Q n | ≤ √

3 δ, n = 1, 2, 3…) are obtained by discretizing a continuous path which is given. Thus, the vector

sequence of the robot centroid, μk D i , μk F j , μk +1 D

′ i and μk +1 F

′ j , can be calculated by the locomotion gait generator. The

motor rotation angles, ψ Di , ψ Fj , ψ

′ Di

and ψ

′ Fj

, are subsequently obtained by Eq. (10) , and the corresponding reference signals

for the three motors, ψ 1d ( t ), ψ 2d ( t ) and ψ 3d ( t ) are generated by the motor controller. The actual rotation angles ψ 1 ( t ), ψ 2 ( t )

and ψ ( t ) are fed back to the motor controller to form a close-loop control of the motor rotation angles.

3
Page 10: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

116 H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119

Fig. 15. The traces of the robot following square and circular paths in the second experiment.

0 0.25 0.5 0.75 1.0 1.25x(m)

y(m

)

0.75

0.25

0.5

0

Desired Path Actual Path

Fig. 16. The influence of step length δ on the gait errors.

5. Experiments

To validate the presented gait controller, three experiments were conducted in this section. The first experiment was

to test the performance of the locomotion gait generator. The desired vector Q was set to 430 mm in magnitude and 40 °about the reference axis x , Fig. 12 (a). Based on the locomotion gait generator in Fig. 8 , the combinational steps, μ1 P 1 and

μ2 P 2 , and the basic deploying and folding steps, μ1 D 1 , μ1 F 2 , μ2 D 1 and μ2 F 3 , are obtained as shown in Fig. 12 (a) where

μ1 = 0.196 and μ2 = 0.369 ( δ= 500 mm).

The desired rotation angle ψ d ( t ) for each motor versus time is shown in Fig. 12 (b). During the step μ1 D 1 , the motor 1

is locked while the motors 2 and 3 are rotating to angle ψ A = 42,120 ° (the corresponding number of wheel turns is 0.78).

To achieve the step μ1 F 2 , the motor 2 is locked while the motors 1 and 3 are rotating inversely by angle ψ A . Similarly,

the motors 1 and 3 are locked again in the step μ2 D 1 and μ2 F 3 , respectively, while the other motors rotating by angle

ψ B = 78,840 ° (the corresponding number of wheel turns is 1.46) or - ψ B .

To evaluate the locomotion accuracy of the robot, a 3D electromagnetic tracking system, Ascension (produced by NDI),

with maximum measurement error below 1 mm, is used to record the trace of the robot. As shown in Fig. 13 (a), three sensor

coils are mounted on the steel frames of the feet. The positions of the feet are measured and the projection of the robot

centroid onto the ground plane can then be calculated which represents the robot position.

Page 11: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119 117

Fig. 17. The change of the configuration parameter θ when traversing through the constrained environments, where i-ii-iii correspond to the configuration

of the robot: (a) Traversing through a vertical gap; (b) Traversing through a horizontal gap.

Page 12: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

118 H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119

As shown in Fig. 13 (b), the maximum error between the desired and actual paths is 5.15 mm at the final point of the path

vector Q (| Q | = 430 mm). Meanwhile, the joint angle θ is monitored in real time and shown in Fig. 14 . It can be seen that the

actual angle θ generally follows the theoretical curve, and the maximum error is 2.41 ° at t = 2.2 s. Errors are generally due

to imprecise assembly and friction within the robot that were not accounted for in the controller.

The second experiment was to test the robot’s ability of following a curved continuous path. Fig. 15 shows the ex-

perimental results for both square and circular paths. The square path has a side length of 1700 mm and total length of

6800 mm. It was achieved by 82 basic deploying and folding steps. The radius of the circular path is 10 0 0 mm, thus its total

length is 6280 mm. The circular path is achieved by 90 basic steps. The position errors at the final points of the two paths

were 63.32 mm and 58.88 mm respectively. In comparison with the results from the first experiment, it was found that the

error at the final points increases if the total lengths of the path increases.

It can be seen that there are relatively large errors between the desired continuous path and the actual tooth-like path.

This is mainly due to the special gait of the robot. As shown in Fig. 6 , the robot can only walk straight in six directions, D i

( i = 1, 2, 3) and F j ( j = 1, 2, 3), during a basic step by deploying or folding its body structure. To follow a desired continuous

path, we need to combine a series of basic steps which actually form a tooth-like path. Such gait errors cannot be eliminated

but can be reduced by decreasing the length of the basic step, δ. Fig. 16 shows the influence of step length δ on the gait

errors. The robot followed a straight line with different values of δ (430 mm and 290 mm). The maximum errors between

the desired paths and actual paths are 67.19 mm and 49.45 mm, respectively. To further improve the tracking accuracy, a

position feedback loop for the centroid of the robot is required in future.

In the last experiment, the robot was required to traverse through narrow gaps shown in Fig. 17 using its locomotion

gait. The initial configuration of the robot is set to θ0 = 90 °. To traverse the vertical gap with W = 500 mm, Fig. 17 (a), the robot

first folds its body to θ= 135 ° then utilizes the locomotion gait with the configuration parameter θ varying between 150 °and 135 ° (the corresponding foot span w ranges from 259 mm to 383 mm). Similarly, for a horizontal gap of H = 260 mm,

Fig. 17 (b), the robot deploys from its initial configuration to θ= 40 ° and then moves through the gap. During the locomotion

gait, the joint angle of the robot varies between 40 ° and 25 ° while the height h between 159.38 mm and 98.65 mm. This

experiment demonstrated that the robot was capable of traversing through confined spaces.

6. Conclusions

This paper presents the gait analysis and control of a Bricard linkage based deployable robot, which has a capability of

large-scale transformation with a deployable area ratio of 39.3. The configuration limit of the robot is obtained based on

the geometric analysis of the Bricard linkage with respect to the required height h and foot span w . The locomotion gait

of the robot was developed with a vector resultant method, which enables the robot to crawl in an arbitrary direction.

Experiments were conducted showing that the robot can follow a given path and traverse through horizontal and vertical

gaps. This robot can change its configuration to adapt to narrow space, and is therefore suitable for reconnaissance or rescue

missions in constrained environments, such as nuclear plants, collapsed buildings, etc. Future work will focus on developing

the robot to identify the constrained environment with vision or force sensors. Moreover, position feedback of the robot’s

centroid will be implemented to improve the locomotion accuracy.

Acknowledgments

The financial supports from the Natural Science Foundation of China (Project Nos. 51422506 , 51375329 and 51290293 )

are greatly acknowledged.

Appendix

A. The Denavit–Hartenberg notation

In the Denavit–Hartenberg notation, as shown in Fig. A1 , a i (i +1) is the length of a link between two adjacent revolute

joints i and i + 1, αi (i +1) is the twist angle between two axes of adjacent revolute joints i and i + 1, R i is the offset between the

Fig. A1. The Denavit–Hartenberg parameters.

Page 13: Mechanism and Machine Theory - Tianjin Universitymotionstructures.tju.edu.cn/files/paper/2018_Shang_Kang_Chen_MMT... · Mechanism and Machine Theory 120 (2018) 107–119 Contents

H. Shang et al. / Mechanism and Machine Theory 120 (2018) 107–119 119

endpoints of two links connected by one revolute joint along the axis i , and θ i is the rotation angle about the axis of the

joint i ( i = 1, 2, 3, 4, 5, 6).

References

[1] B. Salemi , M. Moll , W.-M. Shen , Superbot: a deployable, multi-functional, and modular self-reconfigurable robotic system, in: Proceedings of theIEEE/RSJ International Conference on Intelligent Robots and Systems, IROS’06, 2006, pp. 3636–3641 .

[2] K. Støy , Reconfigurable Robots, in: Springer Handbook of Computational Intelligence, Springer Berlin Heidelberg, 2015, pp. 1407–1421 . [3] D. Schmitz , P. Khosla , T. Kanade , The CMU reconfigurable modular manipulator system, Carnegie Mellon University, 1988 Technical Report

CMU-RI-TR-88-7 . [4] M. Yim , Locomotion with a Unit-Modular Reconfigurable Robot Ph.D. Thesis, Department of Mechanical Engineering, Stanford University, 1994 .

[5] D. Duff, M. Yim , K. Roufas , Evolution of polybot: a modular reconfigurable robot, in: Proceedings of the Harmonic Drive International Symposium and

Proceedings of COE/Super-Mechano-Systems Workshop, Japan, 2001 . [6] A. Castano , R. Chokkalingam , P. Will , Autonomous and self-sufficient conro modules for reconfigurable robots, in: Proceedings of the Fifth International

Symposium on Distributed Autonomous Robotic Systems (DARS’00), Knoxville, TX, 2000, pp. 155–164 . [7] K. Kotay , D. Rus , M. Vona , C. McGray , The self-reconfiguring robotic molecule, in: Proceedings of the Conference on Robotics and Automation (ICRA’98),

Leuven, Belgium, 1998, pp. 424–431 . [8] S. Murata , H. Kurokawa , E. Yoshida , K. Tomita , S. Kokaji , A 3-d self-reconfigurable structure, in: Proceedings of the IEEE International Conference on

Robotics and Automation (ICRA’98), Leuven, Belgium, 1998, pp. 432–439 .

[9] H. Kurokawa , K. Tomita , A. Kamimura , S. Kokaji , T. Hasuo , S. Murata , in: Distributed self-reconfiguration of M-TRAN III modular robotic system Inter-national Journal of Robotics Research, 27, 2008, pp. 373–386 .

[10] E.H. Østergaard , K. Kassow , Design of the ATRON lattice-based self-reconfigurable robot, J. Autonomous Rob. 21 (2) (2006) 165–183 . [11] G. Wei , J.S. Dai , S. Wang , H. Luo , Kinematic analysis and prototype of a metamorphic anthropomorphic hand with a reconfigurable palm, Int. J.

Humanoid Rob. 8 (3) (2011) 459–479 . [12] Z. Wang , X. Ding , A. Rovetta , Structure design and locomotion analysis of a novel robot for lunar exploration, in: Twelfth IFToMM world congress,

Besancon, France, 2007, pp. 1–5 .

[13] X. Ding , K. Xu , Design and analysis of a novel metamorphic wheel-legged rover mechanism, J. Central South Univ. 40 (2009) 91–101 . [14] S.C. Chen , K.J. Huang , W.H. Chen , S.Y. Shen , C.H. Li , P.C. Lin , Quattroped: a leg–wheel transformable robot, in: IEEE/ASME Transactions on Mechatronics,

2013, pp. 1–10 . [15] X. Liang , M. Xu , L. Xu , P. Liu , X. Ren , Z. Kong , J. Yang , S. Zhang , The AmphiHex: a novel amphibious robot with transformable leg-flipper composite

propulsion mechanism, in: Proceedings of the IEEE International Conference on Intelligent Robots and Systems, Algarve, Portugal, 2012, pp. 3667–3672 .[16] D.-Y. Lee , J.-S. Kim , S.-R. Kim , J.-S. Koh , K.-J. Cho , The deformable wheel robot using magic-ball origami structure, ASME 2013 International Design

Engineering Technical Conferences and Computers and Information in Engineering Conference (IDETC/CIE), 2013 .

[17] S. Miyashita , S. Guitron , M. Ludersdorfer , C. Sung , D. Rus , An untethered miniature origami robot that self-folds, walks, swims, and degrades, in: 2015IEEE International Conference on Robotics and Automation (ICRA), Seattle, Washington, 2015, pp. 1490–1496 .

[18] G.T. Bennett, A new mechanism, Engineering (1903) 777–778. [19] R. Bricard , Mémoire sur la théorie de l’octaèdre articulé, J. de mathématiques pures et appliquées 3 (1897) 113–148 .

[20] H. Shang , D. Wei , R. Kang , Y. Chen , A deployable robot based on the Bricard linkage, in: Mechanism and Machine Science: Proceedings of ASIAN MMS2016 & CCMMS 2016, Springer Singapore, 2017, pp. 737–747 .

[21] M. D’Angelo , B. Weel , A.E. Eiben , et al. , Online gait learning for modular robots with arbitrary shapes and sizes, in: A.-H. Dediu, et al. (Eds.), Theoryand Practice of Natural Computing, Springer, Berlin, Heidelberg, 2013, pp. 45–56 .

[22] Z. Bing , L. Cheng , G. Chen , F. Röhrbein , K. Huang , A. Knoll , Towards autonomous locomotion: CPG-based control of smooth 3D slithering gait transition

of a snake-like robot, Bioinspiration Biomimet. 12 (3) (2017) 035001 . [23] Y. Xin , B. Li , Z. Hong , Y. Li , A combined COG adjustment approach of the crawl gait for quadruped robot, in: Chinese Control & Decision Conference,

Yinchuan, China, 2016, pp. 6 851–6 856 . [24] Y. Chen , Z. You , T. Tarnai , Threefold-symmetric Bricard linkages for deployable structures, Int. J. Space Struct. 42 (2005) 2287–2301 .


Recommended