Professional Documents
Culture Documents
1.Introduction
Overheadhighvoltagetransmissionlinesareanimportant
medium in electric power transmission and its safe and
stable operation directly affects the quality of the power
supply in the electric power system. With the enlargement
ofthecapacityofelectricpowersystems,thedistributionof
transmission lines becomes wider and wider, and most
overhead transmission lines are in areas far from towns,
with complex terrain and harsh environment. As electric
cables, as well as pole and tower accessories, are exposed
outside for long periods of time and influenced by
continuous mechanical tension, ice hazards, shakes,
defilements and material aging, high voltage cables are
prone to problems such as broken strands, abrasion and
corrosion, which causes hidden trouble in the safety of the
electric power supply. An automatic inspection robot for
overhead high voltage transmission lines can realize the
automatic inspection of transmission lines without any
manual intervention and is an effective measure to stop
hiddentrouble intransmissionlines.Moreover,itishighly
valued by the power industry and government
departments in various countries due to its relatively low
labourstrength,highefficiencyandlowcostforinspections.
1 Wang Wei, Bai Yu-cheng, Wu Gong-ping, Li Shui-xia and Chen Qian: The Mechanism of a Snake-Like
Robots Clamping Obstacle Navigation on High Voltage Transmission Lines
www.intechopen.com
ARTICLE
www.intechopen.com
Int. j. adv. robot. syst., 2013, Vol. 10, 330:2013
In recent years, research institutions at home and abroad
have shown a great interest in high voltage inspection
robots [19]. The prominent research institutions in this
fieldincludeIREQ(Institutderechercheenlectricitdu
Qubec, Quebec Electricity Research Institute) in
Canada, Kyushu and Chubu Electric Power in Japan,
Japan University of Political Science and Law, North
Carolina State University in America, KERI (Korea
Electrotechnology Research Institute) in Korea, etc. [2, 7,
8,1018].Inaddition,researchinstitutionsinChina,such
as Shenyang Institute of Automation of the Chinese
Academy of Sciences, CASIA (The Institute of
AutomationoftheChineseAcademyofSciences),Wuhan
University,ShandongUniversity,ShandongUniversityof
Science and Technology, Tianjin University, Shanghai
University, etc. have carried out important research on
inspection robots for single or multiple split live wires
andgroundwiresofdifferentvoltageclasses[24,1924].
Some prototypes can automatically stride across various
typical obstacles, such as counterweights, strain clamps,
suspensionclamps,jumperwires,etc.Sawadaetal.have
studied a kind of mobile robot [15] that can inspect
ground wires and realize obstacle navigation through
guide rails. However, this kind of robot has poor
adaptability. Sato, a company in Japan, has produced a
kind of linetracking robot [6] that can detect faults in
transmission lines and walk on the ground using remote
controls, but cannot realize obstacle navigation. Serge
Montambaultetal.,researchersatIREQ,havedeveloped
akindofremotecontrolrobotnamedHQLineROver[11]
thatcanachievethefunctionsofdeicing,inspectionand
maintenance of power cables, but does not have the
abilitytocrossobstaclesandcanonlyworkbetweentwo
pylons. Jaka Katrasnik, a researcher at the University of
Ljubljana in Slovenia, has proposed a kind of robot that
can climb as well as fly [13]. Nicolas Pouliot has also
proposed a kind of linetracking robot based on
LineScout technology [11], which has two parallel arms,
one for rolling and another for moving on cables [12].
PauloDebensethasdesignedakindoflinetrackingrobot
thatcanclimbonfoursplittingleads[25].
Atpresent,snakelikerobotscanbemainlyclassifiedinto
three types: ground creeping snakelike robots,
underwater swimming snakelike robots and climbing
snakelikerobots.Theclimbingrobotscanalsobedivided
into innerclimbing and outerclimbing. The climbing
snakelike robots that twist on high voltage lines may be
regarded as a kind of outerclimbing snakelike robot.
There are essential differences between outerclimbing
snakelike robots and ordinary ground creeping snake
likerobots.Thegroundcreepingsnakelikerobotrealizes
its movement by using the friction between the snake
body arising from its own motion process and the
ground to generate propulsion, while the outerclimbing
snakelike robot belongs to a threedimensional space
motionmechanism.Itsnormalpressureisgeneratedbya
winding force and the winding force and the contact
frictional force need to be controlled simultaneously in
the process of climbing. The process of winding and
climbingcanbeconsideredasthemultibodycouplingof
the robot, as well as the results of the multibody
dynamic coupling of the contact coupling between the
snakebodyandthesurfaceofconductors.
Therearerelativelyfewstudiesonouterclimbingsnake
likerobots.Therepresentativeresearchinstitutioninthis
fieldisCarnegieMellonUniversityinAmerica,whichhas
designed a robot named Modsnake [33]. It can creep on
smooth and vertical glass pipes, which it achieves by
using the movements of winding and rolling. Sun Hong,
a researcher at Shanghai Jiao Tong University in China,
has proposed a kind of outerclimbing snakelike robot
based on PR modules [34]. It adopts an inchworm
locomotion gait, the climbing movements are
accomplished through the delivery of locomotion wave
from its tail to its head and the climbing track is always
based on isometric spirals. The two locomotion modes
can both result in climbing by a snakelikerobot on high
voltage transmission cables, but their movement
efficiency is relatively low. In order to increase the
inspection speed of robots on electric cables, a climbing
method that combines Zshaped clamping climbing with
spiral and winding climbing over obstacles is presented
in this paper. This method of climbing can improve the
speed of inspections in a straight line. This scheme has
many advantages compared with the present traditional
powerlinerobot,suchasbetteradaptabilitytothepower
lineandlighterandlowerenergyconsumption.
Figure1.Threetypicalkindsofobstacleathighvoltage
transmissionlines
Therefore, a simplified model of a transmission line can
be obtained, as shown in Fig. 2. This model consists of
tworectilinearwires(equivalenttoslendercylinders)and
its inertial coordinate system of {O} can be established,
where the xaxis is the extending direction of Line 1 to
Line 2, the zaxis is perpendicular to the xaxis and
parallels the vertical plane with an upward direction as
itspositivedirection.SupposingPointAisapointinthe
xaxis, Plane OAB is a vertical plane, Plane OAC is a
plane that consists of Line 1 and Line 2, is the angle
betweenthetwoplanesand istheanglebetweenLine1
andLine2.
Figure2.Thesimplifiedmodelofhighvoltagetransmissionline
3 Wang Wei, Bai Yu-cheng, Wu Gong-ping, Li Shui-xia and Chen Qian: The Mechanism of a Snake-Like
Robots Clamping Obstacle Navigation on High Voltage Transmission Lines
www.intechopen.com
2.2Theunitstructureofasnakelikerobot
The unit structure of the snakelike robots joints
proposedinthispaperisshowninFig.3.Itiscomposed
of two space orthogonal rotation mechanisms and a
swing mechanism of road wheels. The two orthogonal
rotation mechanisms are driven by two steering gears
and realize their assembly and connection through
steering gear connectors. Rudder connectors are fixed
ontheconnectionplateofoneofthesteeringgears.The
snakelike robot can be assembled through alternate
combination with the steering gear connectors and the
rudder connectors. The road wheels are assembled at
the side of rudder connectors in each unit and they are
drivenbyelectricmotorstoprovidedrivingtorquesfor
the robot when it is walking on high voltage
transmissionlines.
Figure3.Athreedimensionalstructuraldiagramoftherobots
unit
A two dimensional assembly diagram of the robots unit
is shown in Fig. 4. There are some critical structure sizes
thatcanaffecttheobstaclenavigationcontroloftherobot
in Fig. 4, including: l1 the centre distance of the rotation
axis of the two steering gears connected by steering gear
connectors, l2 the centre distance of the rotation axis of
the two steering gears connected by rudder connectors,
W1 the distance from the symmetrical centreline of the
robots unit to the symmetrical plane of the road wheels
in their walking direction, D1 the minimum external
diameteroftheroadwheelsandH1thedistancefromthe
symmetrical plane of the road wheels to the plane of the
outer edge of the road wheels. Thesesize parameters are
alsocriticaltoestablishingthekinematicalequationofthe
robot.
Figure4.Theassemblydiagramoftherobotsunit
2.3Therectilinearlocomotionofasnakelikerobot
Therobotusesalocomotivemode,whichisshowninFig.
5, on the straightline segment of transmission lines. The
robotisunfoldedintheshapeofaZ.Thehighvoltage
transmission line is clamped by the robot in the middle
positionbetweenthetopandbottomroadwheelsandthe
clamping force on the high voltage transmission line can
be adjusted through the adjustment of the robots
pitchingjointtorques.Inordertobalancetherolltorques
causedbytheweightoftherobot,somejointsoftherobot
breakawayfromthewirestoadjustthecentreofgravity.
Moving the whole robot forward or backward can be
achieved through the control of each road wheels motor
speed.Therotatingspeedofeachelectricmotorincontact
with the lines must be given in accordance with the
following formulae, so as to satisfy the coordinated and
consistentforwardmovementofrobot.
Figure5.Therectilinearlocomotionofasnakelikerobot
i
i
v
i=1, 3, 5 2n 1
R
v
i=2, 4,6 2n
R
(1)
where v is the given forward speed of robot, R is the
radius of the road wheels, n is an integer and i is the
numberofrobotunits(asshowninFig.5).
2.4Themethodofasnakelikerobotsheadpartclamping
obstaclenavigation
A sketch map of the robots head part clamping obstacle
navigationisshowninFig.6.
Figure6.Thestateofheadpartclampingobstaclenavigation
The robot can be divided into three parts according to
their functions: the first part is the head clamping part,
whichisusedtograspLine2attherearofthehardware
fittings,thesecondpartisthetailclampingpart,whichis
4 Int. j. adv. robot. syst., 2013, Vol. 10, 330:2013 www.intechopen.com
usedtograspLine1atthefrontofthehardwarefittings,
the remaining part is the middle adjustment unit, which
is used to adjust the position and posture of the head
clamping part relative to Line 2. The tail clamping part
andheadclampingpartinthefigurearebothmadeupof
four units and, if necessary, the actual quantity can be
adjusted properly. The detailed process of obstacle
navigationisasfollows:
Figure7.Thestateofrobotswindingobstaclenavigation
3. The mathematical model of head part clamping
obstaclenavigationbyasnakelikerobot
3.1Thekinematicsmodelofsnakelikerobot
Themathematicalmodelofasnakelikerobotisshownin
Fig. 8, supposing the initial pose of the robot is arranged
alongLine1inastraightline.
Figure8.Themathematicalmodelofthesnakelikerobotandits
environmentalstructure
The pitching joint located at the road wheel of the last
contact wire of the tail clamping part is considered to be
Joint1andtheotherjointsinthemiddleadjustmentunit
are numbered in order according to their distance from
Joint 1. For the sake of convenience, several types of
coordinatesystemareestablishedasfollows:
Thekinematicalequationsofasnakelikerobotaresetup
according to the amended DH method. The equations
overlook the rotary motion of the road wheel and only
5 Wang Wei, Bai Yu-cheng, Wu Gong-ping, Li Shui-xia and Chen Qian: The Mechanism of a Snake-Like
Robots Clamping Obstacle Navigation on High Voltage Transmission Lines
www.intechopen.com
considerthepitchinganddeflectionmotionofthemiddle
joints of the robot. The coordinate system of the joints is
displayed in Fig. 8 and the transformation matrix of the
adjacentlinksisasfollows:
B
1 X Z 1
( 90 ) (q ) = T R R (2)
1
2 X X 1 Z 2
(90 ) (l ) (q ) = T R D R (3)
2
3 X X 2 Z 3
( 90 ) (l ) (q ) = T R D R (4)
i 1 X X 1 Z i
i
X X 2 Z i
(90 ) (l ) (q ) i 2n
( 90 ) (l ) (q ) i 2n 1
=
=
R D R
T
R D R
(5)
where
i
q is the rotation angle of Joint i,
i 1
i
T
is the
transformation of Link i versus Link i1 and n is an
integer greater than one, so the transformation matrix of
Linkirelativeto {B} (thebasecoordinatesystemofrobot
)canbeexpressedas:
B B 1 i 1
i 1 2 i
= T T T T(6)
The transformation matrix of {T} (the tool coordinate
system of robot) versus {B} (the base coordinate system
ofrobot)isestablished.Supposingtheoriginof {T} isthe
centre of the nth road wheel, the Link i fixed with {T}
willbeLink2n1.As:
i
T Z X
( w1) (90 ) = T D R (7)
Therefore,itcanbeknownthat:
B B i B
T i T i Z X
( w1) (90 ) = = T T T T D R (8)
3.2Thekinematiccouplingmodeloftherobotandtheline
The robot only relies on its road wheels being in contact
withthewiresintheprocessofobstaclenavigationwitha
kind of tail clamping mechanism, so the relationship
between the road wheels and high voltage transmission
lines is contact coupling. Although high voltage
transmission lines possess certain flexibility, they have
little flexible deformation even under conditions of full
tension,sotheycanbetakenasrigidstructures.Therobot
body consists of many rigid structures, so it can also be
considered as multiple rigid structures. Therefore, the
couplingmodeloftherobotandthelineenvironmentcan
be simplified as the coupling model of multiple rigid
structures. As the motion types of the robots tail
clamping part relative to high voltage transmission lines
are mainly the movement along the direction of the
transmission lines and the rotation along the direction of
the shaft axis of the transmission lines, the complex
contact coupling between the road wheels and the wires
can be expressed as the equivalent combined model of a
slidingpairandarevolutepair.
For convenience, the general mathematic model of the
robot and line environment, as well as the following
typesofcoordinatesystem,isestablished:
1. The work coordinate system of robot {S} is fixed at
Line 2 and the zaxis coincides with the rotation
centrelineofLine2.Theyaxisisperpendiculartothe
planeconsistingofthecentresofLine1andLine2.
2. The target coordinate system of robot {G} is
establishedfortheheadpartoftherobotbeingclose
to Line 2 with the right pose; if the robot wants to
realize the grasp of Line 2 with the correct pose, the
tool coordinate system of {T} must coincide with the
targetcoordinatesystemof{G}.
3. The inertial coordinate system of {O} remains
stationarywiththeearthandissetupmainlyforthe
establishment of the kinetic model. The origin of a
coordinate is the crossing point of the centrelines of
Line1andLine2.Thezaxisisverticallyupandthe
xaxisisconsistentwiththecentrelineofLine1with
thepositivedirectionofLine1pointingtoLine2.
B B 1 2 3
S G 1 G 2 G 3 G S G
= T T T T T (9)
where the subscript of G refers to the coordinate
transformation of the environment and is used to
distinguish it from the coordinate transformation of the
robot.
B
1 G Y Z Y Z 1
D1 D2
( w1) ( ) (90 ) (gq )
2
+
= T D D R R (10)
1
2 G Z 2
(gq ) = T D (11)
2
3 G X Z 3
( 90 ) (gq ) = T R R (12)
3
S G X
(90 ) = T R (13)
wheregq1istheupsettingangleofthetailclampingpart
relativetotheinitialposition,gq2isthedistancefromthe
central point of the rightmost road wheel at the tail
clampingparttotheoriginoftheworkcoordinatesystem
alongwiththedirectionoftheaxisofLine1andgq3isthe
deflection angle of the target Line 2 relative to the initial
Line1.
B B 1 6 7
G G 1 G 2 G 7 G G G
= T T T T T (14)
where:
3
4 G X Z 4
(90 ) (gq ) = T R D (15)
6 Int. j. adv. robot. syst., 2013, Vol. 10, 330:2013 www.intechopen.com
4
5 G Z 5
(gq ) = T R (16)
5
6 G Z 6
(gq ) = T D (17)
6
7 G Y Y 7
( 90 ) (gq ) = T R D (18)
where
7
G G
T is the unit matrix of order four, gq4 is the
distancefromtheoriginoftheworkcoordinatesystemto
the origin of the target coordinate system along the
direction of the axis of Line 2 and represents the
displacement distance of the target road wheel along the
direction of Line 2, gq5 is the flip angle along the axis of
Line 2 and represents the deflection angle of the target
road wheel relative to the axis of Line 2, gq6 is the
translational distance along the direction of Xg6 and
represents the normal distance of the road wheel
deviatingfromthecircumscribedcircleoflinesandgq7is
the translational distance along the direction of Yg7 and
represents the tangent distance of the road wheel
deviatingfromthecircumscribedcircleoflines.
B B 1
O G 1 G 2 G Y
( 90 ) = T T T R (19)
The following can be known according to the operation
rulesofcoordinatetransformation:
S S B
T G B G T G
= T T T (20)
S S B
G G B G G G
= T T T (21)
B T B T B
S
S G S G SO
B G
0 1
(
=
(
(
R R P
T (22)
where
B
S G
R refers to the rotation transformation of
B
S G
T ,
B
SO
P refers to the translation transformation of
B
S G
T and the superscript T refers to the transpose of
thismatrix.
z
z
T z
i
z
z
z
( )
( )
( )
(
(
(
(
= (
(
(
(
(
P n
P o
P a
J
n
o
a
(23)
where
T
i
J istheColumnioftheJacobimatrix.
When using the work coordinate system as a reference
coordinate system, the Jacobi transformation matrix of
robotcanbeobtainedbythefollowingformulae:
S
S T T G
S
T G
0
0
(
= (
(
R
J J
R
(24)
where
S
T G
R istherotationtransformationpartofthe
S
T G
T
matrix.
Figure9.Ablockdiagramforthecontrolofatraditionalrobot
The inverse kinematics solution proposed according to
the strategies of obstacle navigation in the kinematics
model is a kind of inversecomputation in kinematics for
targetlocationandcancalculatetherotationangleofeach
joint in realtime. The process of the inverse kinematics
solution also needs to receive the key parameters of gq1
andgq2outputtingfromthekineticmodelinrealtime.If
the accurate positioning of a sixDOF space of the tool
coordinate system is realized, as for six DOF robots, the
definite unique solution can be calculated. However, the
snakelike robot proposed in this paper is a kind of
redundant robot with more than six DOF and for this
type of robot there are infinite numbers of solutions, so
optimization algorithms, including gradient descent,
optimal dynamics performance, etc., are needed to find
theoptimalsolution.
AsfortheredundantrobotwithmultipleDOFproposedin
this paper, the inverse kinematics solution of the robotic
equation is the key to obtaining a good motion planning
control. At present, there are many scholars who engage in
researchonmethodstosolvetheinversekinematicssolution
fortheredundantrobotwithmultipleDOF.ShuujiKajita,a
Japanesescholar,hasproposedakindofnumericalmethod
ofinversekinematicsforbipedrobotsanditsprincipleisto
modify joint angles and recycle them when there are
differencesbetweentheresultofforwardkinematicsandthe
targetvalue[29].ZuDihasputforwardakindofsecondary
calculation used to solve the inverse kinematics of
redundant robots [30]. Masayuki Shimizu has proposed a
kind of closed solving method for the inverse kinematics
solution based on parameterization methods [31] and
Antonellipresentsanimprovedoptimizationmethodforthe
inverse kinematic solution of redundant robots and the
maximumspeedlimitofjointscanbetakenintoaccountin
this method [32]. Musto presents a novel computational
algorithmforselectinganoptimalinversekinematicsolution
in response to a pose specification in a redundant robotic
manipulator [33] and ChihJer Lin has proposed a kind of
inversekinematicsolutionbasedonfuzzyreasoning[34].
(25)
Figure10.Theblockdiagramforstandardpositiontracking
algorithm
Inaddition,theJacobimatrixcanalsoberegardedasthe
transformation matrix of the differential coefficient
movementofjointspacetooperatingspace,sotheabove
formulacanalsobewrittenasfollows:
= J(q)dq (26)
or
1
dq = J (q) (27)
The formula suggests that the deviation of the robotic
operating space can find the corresponding deviation of
thejointanglespacethroughtheinverseoperationofthe
Jacobimatrix.Asagreatdealofcalculationisneededfor
thewholealgorithm,thereareunavoidableerrorsinopen
loopcalculation.Therefore,usingtheideaofacloseloop
feedbackcontrolforreference,wecancomparethegiven
position with the feedback position and improve the
positiontrackingperformanceofthealgorithmthrougha
proportionalcontroller.
S
J is the Jacobi matrix when using the work coordinate
system of {S} as the reference coordinate system and
S
J is
theinverseofthismatrix.Asfornonredundantrobots,
S
J
canbedirectlyobtainedthroughtheinverseoperationof
S
J
innonsingularstates,whileasforredundantrobots,if
S
J is
thefullrank,
S
J isthepseudoinverseof
S
J ,thatis:
S S T S S T 1
( )
J J J J (28)
In order to avoid the singular state in the operation
process, the dexterity of the robot needs to be monitored
in real time. Concretely, this paper uses a conditional
index as the index to evaluate the dexterity of the robot.
As for redundantrobots, m<n, so the robots dexterity of
S
k( J) can be calculated according to the following
formula:
S S S
k( ) || || || ||
J J J (29)
Once the result of
S
k( ) J becomes large, it can be
concluded that the robots are near singular states. At the
moment,thecomputationalprocessisslowandtheerror
ofthecalculationislarge.
8 Int. j. adv. robot. syst., 2013, Vol. 10, 330:2013 www.intechopen.com
4.2Improvedpositiontrackingalgorithm
Although the standard position tracking algorithm
mentioned above can find and follow up the target
locationquickly,ithasthefollowingshortcomings:
Figure11.Theblockdiagramforimprovedpositiontracking
algorithm
Thestandardpositiontrackingalgorithmcannotsolvethe
above three problems well. Therefore, some simple and
effective measures are taken to improve the standard
positiontrackingalgorithminthispaper,asshowninFig.
11.Thespecificmeasuresinclude:
1. Addingthesaturationelementandlowpassfiltering
element in the circuit of path generation. The
function of the saturation element is to limit the
maximum speed of the path and the function of the
lowpass filtering element is to limit the acceleration
ofthejoints.
2. Adding multiway selective channel before the
product of the Jacobi inverse matrix and deviation
vectors;thatis,openthechannelof dz and z and
close the other four channels, which means we will
not restrict the dz and z and could avoid singular
status.
3. Using twoway selectors before the feedback
calculation of the outputting joint vector of q. Some
selectors choose the outputting joint vector of q,
while others choose constants. This will make sure
the position and posture of the robot calculated
through our algorithm avoids touching high voltage
lines and hardware fittings with manual
intervention.
4.3Thepathplanningofthetargetmotion
ThepathoftargettrajectoryplanningisshowninFig.12.
Supposing the initial state of the robot is in the state of
hanging down, the initial angle of Joint 1 is q1 and the
initial angle of the other joints is zero, the origin of the
tool coordinate system is Point T. If the robot wants to
clamp Line 2, the tool coordinate system of {T} must
coincide with the target coordinate system of {G}, where
gq7 isthecentredistanceofthetargetlocationofPointG
toLine2andgq4isthedistanceofPointGtotheoriginof
theinertialcoordinatesystemof{O}alongthedirectionof
ZS.
Figure12.Thepathoftargetpoints
The shortest path of the target trajectory to achieve the
robotsgraspmovementisthelinesegmentofTGC,butif
this path planning is adopted, the head clamping part of
the robot will inevitably interfere with Line 2. Therefore,
themiddletransitionpointsofPointGAandPointGB are
set, where Point GA and Point GB are on the same
horizontalplaneandgq6 isthedistanceofPointGBtothe
centreline of Line 2. The movement of the robot to grasp
Line2canbebrokendownintothefollowingsteps:
1 2
7
D D
gq
2
(30)
and
2
6 1
D
gq H
2
(31)
where Point GC is the corresponding target point when
theroadwheelistangenttotheline.Itcanbeknownthat:
2
6 1
D
gq H
2
(32)
5.Simulationanalysis
5.1Thesimulationexperimentofthepositiontracking
algorithm
This experiment is to verify the improvement of path
generationbytheimprovedalgorithmversustheoriginal
algorithm. The standard position tracking algorithm, the
position tracking algorithm with speed limiters and the
positiontrackingalgorithmwithspeedlimitersandfilters
are used in the experiment to follow up the travelling
target trajectory and the waveform data of the following
error, the target path velocity and the acceleration are
recorded.
Figure13.Asimulationblockdiagramforpositiontracking
algorithms
A simulation block diagram for position tracking
algorithms is shown in Fig. 13, where refpos is an input
part that receives the environmental model parameters of
gq1~gq7, and Angle_output is an output of the model that
outputs the angle information of joints involved in the
positiontrackingoftherobotandwheretheT_SGmodule
is the matrix transformation of {G} versus {T}, the T_ST
module is the matrix transformation of {T} versus {S}, the
Jacob_S_J module is the pseudo inverse transformation of
the Jacobi matrix of the robot in the coordinate system of
{S}, the Tr2diff(T2T1) module is the projection of the
difference between two transformation matrices at the
space of sixDOF, Route_select1 module is a multichannel
gate (only dx, dy, x and y are gated in this model) and
the Route_select2 module is the gating of the outputting
jointangles.Intheexperiment,q1isidenticallyequalto80
and the other rotation angles are in an allpass state. The
mainpurposeofthesesettingsistoavoidtheinterferential
configurationoftherobotandthelines.
Theinitialroboticjointvectorof[q2,q3,q4,q5,q6,q7]is
setto[0,pi/2,0,pi/6,0,0],thespeedlimitis0.1rad/sand
the filter transfer function is
1
S 1
. The experimental
simulationparametersareasfollows:
Parametersinthe
simulationmodel
Value
l1 0.05302m
l2 0.07898m
W1 0.0415m
D1 0.025m
R1 0.018m
gq1 0
gq2 0.1m
gq3 30
gq4 0.2m
gq5 0
gq6 0.035m
gq7 0.05+0.05sin(0.3t/2)m
Table1.SimulationCondition
Whengq7isinmotioninaccordancewiththechangerule
given in the table, the target trajectory will have a
periodicchange.Thecorrespondingtrackingeffectofthe
three algorithms is displayed in the figure, where
Column1isthechangingcurveoftheroboticjointangles
involvedinthepositiontracking,Column2isthevelocity
curve of the robotic joint angles, Column 3 is the
accelerationcurveoftheroboticjointanglesandColumn
4 is the deviation between the target coordinate system
andtherobotictoolcoordinatesystem.
Thesimulationexperimenthasverifiedthattheimproved
algorithmproposedinthispapercaneffectivelymakeup
fortheshortcomingsoftheoriginalalgorithmandreduce
mechanicalimpactandshock.
10 Int. j. adv. robot. syst., 2013, Vol. 10, 330:2013 www.intechopen.com
a.Thepositiontrackingalgorithmwithoutanyimprovement
b.Thepositiontrackingalgorithmwithspeedlimiters
c.Thepositiontrackingalgorithmwithspeedlimitersandfilters
Figure14.Thecurveofpositiontrackingperformanceinthe
threealgorithms
5.2Thesimulationexperimentfortheprocess
oftherobotgraspingpowerlines
The purpose of this simulation experiment is to
synthetically verify the control strategy proposed in the
system. The simulation platform is based on the
operating system of a PC with 64bitWin7, 3.4GHz basic
frequency and 16G of RAM. The cosimulation method
with Adams and Matlab is used in the system for the
simulationanalysis.Thekineticmodelissetupbasedon
the platform of Adams and the control system model is
setupbasedontheplatformofMatlab.Theequivalentof
two cylinders is adopted in the environment of high
voltage transmission lines in the kinetic model. The four
road wheels at the robots tail retain a compaction state
withthehighvoltagetransmissionlinesundertheaction
of steering gear torques. The rotation of the road wheels
isrestrainedthroughclosedcontroloftheposition.Asfor
the joints in the middle adjustment units, the classic PID
controlling method is used to control the joint rotation
angles.Themodeldimensionparametersoftherobotare
consistent with physical prototypes. The specific
simulationparametersareasfollows:
Parametersinthesimulationmodel Value
l1 0.05302m
l2 0.07898m
W1 0.0415m
D1 0.025m
R1 0.018m
gq1 0
gq2 0.1m
gq3 30
gq4 0.2m
gq5 0
Weightofsteeringgearconnectors 0.264Kg
Weightofrudderconnectors 0.101Kg
Weightofroadwheels 0.034Kg
Static friction coefficient between road
wheelandline
3.0
Dynamic friction coefficient between
roadwheelandline
1.0
Clampingtorqueofatthetailclamping
part
3.4Nm
Table2.Simulationparameters
The motion process of the robot is divided into four
stages. In the first stage (time duration: 0~4 seconds) the
robot moves gradually closer to Line 2 and the road
wheelkeepsasafedistanceof5mmfromthelines.Inthe
second stage (time duration: 4~7 seconds) the robot
adjusts its pose so that Line 2 is in clamping position in
the head clamp holder. In the third stage (time duration:
7~9 seconds) the robot adjusts its pose so that the road
wheels at the tool coordinateare moved gradually closer
to the lines and start to grip. In the fourth stage (time
duration: 9~10 seconds) the head of the robot gradually
clampsthe2ndpowerline.
11 Wang Wei, Bai Yu-cheng, Wu Gong-ping, Li Shui-xia and Chen Qian: The Mechanism of a Snake-Like
Robots Clamping Obstacle Navigation on High Voltage Transmission Lines
www.intechopen.com
Figure15.Jointdeflectionanglesandjointtorques
The changing curves of the joint angles (above) and the
joint driving torques (below) of the robot in the whole
motion process are shown in Fig. 15. The change rule of
the joints (except q1, which remains constant at 80) is
recorded. It can be seen from the changing curve of the
jointanglesthatthechangeofthejointanglesaresmooth
transitions without any large fluctuations at any motion
stage. It can also be seen from the changing curve of the
joint torques that the deflection joint torques of the robot
(Tq2Tq4Tq6)at every motion stage are relatively
small, but the pitch moments (Tq3Tq5Tq7) increase
graduallyatthefirstmotionstageandTq3>Tq5>Tq7.The
primary reason for the distribution of these moments is
thattheselfweightoftherobotdecreasesprogressivelyat
thearmoftheforceandtheactingforceofeachpitching
joint(q3q5q7).
Figure16.Thedeflectionangleofgq1
The deflection angle moving around Line 1 at the whole
motion stages of robot, that is, the environmental model
variable of gq1, is shown in Fig. 16. It can be seen from
the curve that the robot has continuous deflection
movementsaroundLine1ateachmotionstage,whichis
caused by unbalanced moments in the process of robotic
clamping obstacle navigation. The unbalanced moments
are caused by the weight of the robot and the change
trend can be reduced by increasing the frictional force
betweenthetailroadwheelsandthelines.
Figure17.Positiontrackingerrors
Figure18.Thechangingcurveoftheconditionalindexinthe
positiontrackingalgorithmofarobot
Inordertoevaluatethedexterityofthepositiontracking
algorithmoftherobotinthewholeoperatingperiod,the
conditional index in the position tracking algorithm is
drawn, as shown in Fig. 18. It can be seen that the
conditional index of the robot is within a reasonable
range, so there is no singular configuration in the whole
operatingperiod.
a)t=0sb)t=2.29sc)t=3.19s
d)t=3.99se)t=7.09sf)t=9.49s
Figure19.Thesimulationfortheprocessofsnakelikerobotto
grasppowerlines
12 Int. j. adv. robot. syst., 2013, Vol. 10, 330:2013 www.intechopen.com
The animated screenshots of the simulation for the
process of the snakelike robot grasping power lines are
shown in Fig. 19. Picture a is the initial stage of the
simulation, where q1 is identically equal to 80and
remains immovable in the whole process of the grasp
movementandtheinitialanglesoftheotherjointsareall
equal to zero. Picture b, Picture c and Picture d are the
screenshots of the first stage of the motion process.
Picturedistheendofthefirststage,wheretheheadpart
of the robot shows the clamping configuration, the
centreline of the clamping configuration parallels Line 2
and the road wheel at the head part clamping
configuration keeps a certain safe distance from Line 2.
Pictureeistheendofthesecondstage,whereLine2isin
the clamping position of the head part clamping
configuration. Picture f is the end of the third stage,
where Line 2 is clamped by the head part clamping
configurationofrobot.
6.Conclusionandfollowupwork
In this paper, the methods ofa snakelike robot climbing
at high voltage transmission lines are presented. The
motion mechanism of the snakelike robots clamping
obstacle navigation is studied, the simplified models of
kinematics and kinetics coupled with the robot and the
line environment are put forward and the position
tracking algorithm and the improved algorithm for the
robots clamping obstacle navigation are proposed.
Through simulation analysisit can be seen that the
methodproposedinthispaperiseffectiveandfeasiblein
theory. However, the realization of the robots clamping
obstaclenavigationisaffectedbyfactorsoftheweightof
thesnakelikerobot,therotationaljointswithalargearm
of force, etc. Moreover, a suitable method is needed to
solve the problem that the pitching joints at the root of
the robot (such as q1, q3, etc.) bear great torque in the
process of obstacle navigation. A method of dangling
obstacle navigation will be used in the followup study.
With the help of the action of the robots inertial force, a
method of repeated swinging is adopted to realize the
grasp of Line 2 by the head part clamping device. In
addition,themethodofwindingobstaclenavigationwill
alsobeoneoftheimportantcomponentsofthefollowup
study.
7.Acknowledgments
This work is supported by the National Natural Science
FoundationofChina(No.51105281).
7.References
[1]ZhouFY,LiYB,etal.DesignandImplementationof
Inspection Robots for High Voltage Power
Transmission Lines, Mechanical Science and
Technology,2006,25(5):623627
[2]Wu G P, Xiao X H, et al. Development of a Crawling
RobotforOverheadHighvoltageTransmissionLine,
ChinaMechanicalEngineering,2006,2(17):237240
[3]Zhou F Y, Wu A G, et al. Development of a mobile
robot for inspection of high voltage overhead power
transmission lines, Automation of Electric Power
Systems,2004,12(23):8991.
[4]WangLD,WangHG,etal,ObstaclenavigationControl
of Inspection Robot for Power Transmission Lines,
ChinaMechanicalEngineering,2007,11(22):26522655.
[5]Wang L, Cheng S, Zhang J, et al. Control of a
redundantly actuated power line inspection robot
based on a singular perturbation model. 2008 IEEE
International Conference on Robotics and
Biomimetics,2009,ROBIO2008:198203.
[6]Tsukahara K, Tanaka Y, Takasu N, et al. Vision for a
power distribution line maintenance robot
Environments input. 2006 IEEE International
Symposium on MicroNano Mechanical and Human
Science.2006:16
[7]TsukaharaK,TanakaY,HeY,etal.Conceptualdesign
ofapowerdistributionlinemaintenancerobotusing
a developed CG simulator and experimental robot
system. Lecture Notes in Computer Science
(including subseries Lecture Notes in Artificial
Intelligence and Lecture Notes in Bioinformatics).
2008,5325:340351.
[8]Park J Y, Cho B H, Lee J K. Development of robot
mechanism for inspection of liveline suspension
insulator string in 345kV power lines. 2008
International Conference on Control, Automation
andSystems.2008:20622065.
[9]Jones D, Golightly I, Roberts J, et al. Modeling and
control of a robotic power line inspection vehicle.
Proceedings of the IEEEInternational Conference on
ControlApplications.2007:632637.
[10]Tsukahara K, Tanaka Y, He Y, et al. Conceptual
design of a power distribution line maintenance
robot using a developed CG simulator and
experimental robot system. Lecture Notes in
ComputerScience(includingsubseriesLectureNotes
in Artificial Intelligence and Lecture Notes in
Bioinformatics).2008,5325:340351.
[11] PouliotN,HydroQuebec,MontrealQC,Montambault
S. LineScout Technology: From Inspection to Robotic
Maintenance on Live Transmission Power Lines. 2009
IEEE International Conference on Robotics and
Automation.2009:10341040.
[12]Nayyerloo M. Mechanical implementation and
simulationofMoboLab,amobilerobotforinspection
of power transmission lines. International Journal of
AdvancedRoboticSystems.2008,5(2):209214.
[13]KatrasnikJ,PernusF,LikarB.NewRobotforPower
Line Inspection. 2008 IEEE Conference on
Robotics,Automation and Mechatronics. 2008: 1195
1200.
13 Wang Wei, Bai Yu-cheng, Wu Gong-ping, Li Shui-xia and Chen Qian: The Mechanism of a Snake-Like
Robots Clamping Obstacle Navigation on High Voltage Transmission Lines
www.intechopen.com
[14]Peungsungwal S, Pungsiri B, Chamnongthai K,
Okuda M. Autonomous robot for a power
transmission line inspection. 2001 IEEE International
Symposium on Circuits and Systems. 2001, 2(121
124).
[15]SawadaJ,KusumotoK,MunakataT.Amobilerobot
for inspection of power transmission lines. IEEE
TransactionsonPowerDelivery.1991,6(1):309315.
[16]ZhouFY,WuAG.AutomobileInspectionRobotOn
Power Transmission Lines. Rural Electrification,
2008,2:5960.
[17]ParkJ,LeeJ,ChoB,etal.Developmentofinspection
robot system for liveline suspension insulator
strings in 345kV power transmission lines.2009 13th
European Conference on Power Electronics and
Applications.2009:18
[18] Debenest P, Guarnieri M, Takita K, Fukushima E F.
ExplinerRobotforinspectionoftransmissionlines.
2008 IEEE International Conference on Robotic and
Automation.2008:39783984.
[19] Zhang Y C, Liang Z Z, Mobile Robot for Overhead
Powerline Inspectiona Review. Robot, 2004, 9(5):
467473.
[20] Ren Z B, Yuan Y, Obstaclenavigation control of
inspection robot for power transmission lines based
on knowledge base. Computer Engineering and
Applications,2008,44(3):236239.
[21] Wu D W, Yuan Y, et al, Inspection robot control
system of power transmission line based on
production system and trajectory optimization.
Computer Engineering and Design, 2008, 29(11):
28682871.
[22]Tang L, Fang L J, et al, Inspection Robot Control
System of Power Transmission Line Based on
Distributed Expert System. Robot, 2004, 26(3): 267
271.
[23]LiWZ,WangJD,etal,Designandthestudyofthe
control system of a power transmission line
inspection robot. Manufacturing Automation, 2008,
30(11):7982.
[24]Wang L D, Wang H G, et al, Obstaclenavigation
Control of Inspection Robot for Power Transmission
Lines. China Mechanical Engineering, 2007, 18(22):
26522655.
[25] Debenest P, Guarnieri M, Takita K, Fukushima E F.
SensorArm Robotic Manipulator for Preventive
Maintenance and Inspection of HighVoltage
Transmission Lines. 2008 IEEE/RSJ International
Conference on Intelligent Robots and Systems.
2008:17371744.
[26]HasanzadehS.,AkbarzadehTA.Obstacleavoidance
ofasnakerobotmovingwithanovelgaitusingtwo
level PID controller. 2008: 427432. IEEE Conference
onRobotics,AutomationandMechatronics.2008.
[27]Rezaei Ahmadreza, Shekofteh Yasser, Kamran
Mohammad, et al. Design and control of a snake
robotaccordingtosnakeanatomy.2008:427432.
[28]TrasethAA,LeineRGlockerC,PettersenKet
al. 3D snake robot motion: Nonsmooth modeling,
simulations, and experiments. IEEE Transactions on
Robotics.2008,24(2):361376.
[29]ShuujiKajita,HumanoidRobot.TsinghuaUniversity
Press,2007.
[30]Zu D, Wu Z, et al. Efficient inverse kinematic
solution for redundant manipulators. Chinese
JournalofMechanicalEngineering.2005,41(6):7175.
[31] Shimizu M, Kakuya H, Yoon W, et al. Analytical
Inverse Kinematic Computation for 7DOF
Redundant Manipulators With Joint Limits and Its
Application to Redundancy Resolution. IEEE
TransactionsonRobotics.2008,24(5):11311142.
[32]AntonelliG.StabilityAnalysisforPrioritizedClosed
Loop Inverse Kinematic Algorithms for Redundant
Robotic Systems. IEEE Transactions on Robotics.
2009,25(5):985994.
[33] Musto J C. A twolevel strategy for optimizing the
reliability of redundant inverse kinematic solutions.
Journal of Intelligent & Robotic Systems. 2002, 33(1):
7384.
[34]LinC,ChenC.Motionplanningofredundantrobots
with singularities using transputer based fuzzy
inverse kinematic method. Computational
Intelligence,Pt.2,Proceedings,2006,4114:140145.