Upload
betogetherbeurself
View
214
Download
0
Embed Size (px)
Citation preview
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
1/9
InternationalJournalofAdvancedRoboticSystems,Vol.7,No.4(2010) 39ISSN17298806,pp.3947
Design, Modeling and Control
of a Biped Line-Walking Robot
Ludan Wang1, Fei Liu1, Shaoqiang Xu1, Zhen Wang1, Sheng Cheng1 and Jianwei Zhang1,21LaboratoryofIntelligentRobotEngineering,KunshanInstituteofIndustryResearch,Kunshan,China2TAMS,DepartmentofInformatics,UniversityofHamburg,Hamburg,Germany
Abstract:Thesubjectofthispaperisthedesignandanalysisofabipedlinewalkingrobotforinspectionofpower
transmissionlines.Withanovelmechanismthecentroidoftherobotcanbeconcentratedontheaxisofhipjoint
tominimizethedrivetorqueofthehipjoint.Themechanicalstructureoftherobotisdiscussed,aswellasforward
kinematics.Dynamicmodel isestablished in thispaper toanalyze the inversekinematicsformotionplanning.
Thelinewalkingcycleofthelinewalkingrobotiscomposedofasinglesupportphaseandadoublesupportphase.
Locomotion of the linewalking robot is discussed in details and the obstaclenavigation process is planed
accordingto
the
structure
of
power
transmission
line.
To
fulfill
the
demands
of
line
walking,
acontrol
system
and
trajectoriesgenerationmethod are designedfor theprototype of the linewalking robot.Thefeasibility of this
conceptisthenconfirmedbyperformingexperimentswithasimulatedlineenvironment.
Keywords:Bipedlinewalkingrobot,Singlesupportphase,Doublesupportphase,Obstaclenavigation1.IntroductionThepurposeofpowertransmissionlineinspectiontaskis
tocheck therunningstateandfind thedamagesofhigh
voltagepowertransmissionlinesequipments.Uptonow,
power transmission lines equipments are mainly
inspectedmanuallybyworkerswith a telescope on the
ground.Theseworkingmodeshavemanydisadvantages,
such as long inspection cycle, high working intensity,
hugeexpenseandhighdanger.Performingtheinspection
by helicopters, as another method, is more efficient
comparedtomanuallyoperation,butitismoreexpensive
and climatedependent. Since the early 1990s, many
researchers have investigated in the development of
inspectionrobotstoassistpeopleortoreplacepeopleon
powertransmissionlinesite.
As illustrated in figure1, despite the tension conductor
therearesomeaffiliatedpowerfittings,suchasdamper
weights, suspension clamps, installed on the power
transmission line system. Thus, although the best
approachto
locomotion,
considering
power
consumption
andspeeddisplacement,isrollingontheconductor,high
degreeofmobility shouldbe added to the linewalking
robottoovercome thosepowerfittingsasobstacles.One
commonapproachtolinewalkingrobotforfulfillpower
transmissionlineinspectiontaskusesaconventionalrail
wheeled vehiclewith the addition of a device that can
overcome obstacles on the line. A wheeled trolley
(Sawada,J.et.al.,1991)thatcarriesanarcshapedrailwas
developedby Sawada and his group. By extending the
rail toeither sideof the tower thebodyof robot canbe
carried to theother sideofobstacles.LineScout (Pouliot
andMontambault,
2008),
aline
walking
robot
developed
at HydroQuebecs research institute (IREQ), is a
platformcancrossobstaclesbydeployinga twogripper
auxiliaryframeunder thecableandsecuringagraspon
bothsidesoftheobstacle.Thetractionwheelscanthenbe
releasedfromtheconductor,flippeddown,andmovedto
theothersideoftheobstacle.
Fig.1.Structureofpowertransmissionline
Generally, robots with structure mentioned above are
relativelyheavy since thewheeled systemandobstacle
navigation device are developed separately.Articulated
legwheel systems,with compact configuration, help to
provide enhanced locomotion capabilities on uneven
terrain, thus legged structureswith twoormorewheels
are
predominant
in
the
development
of
power
transmission line inspection robot nowadays. The
principalreasonforarticulationsistoenabletherobotto
accommodate and overcome most obstacles by
permitting the correspond wheel to rise up when it
collides with the obstacle. Tribrachiation mobile robots
(Tang, L.; et. al., 2004), (Liang, Z.; et. al., 2005),
(Nayyerloo, M.; et. al., 2008), with multidegreeof
freedom structure, allow a minimum of two traction
wheelstobesecuredtothecable.Technically,morethan
two legsprovide redundant support and often increase
theloadcapacityandsafety.However,thesebenefitsare
achieved at the cost of increased complexity, size, and
weight.As
aresult,
the
biped
is
the
most
common
congiguration of power transmission line inspection
tower
power transmission line clampdamper-weight
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
2/9
InternationalJournalofAdvancedRoboticSystems,Vol.7,No.4(2010)
40
robotstudiednowadayssinceitrequiresminimumjoints
andactuators toprovide locomotion.Thechallenge is to
provide adaptability to such robots so that they may
surmountavarietyofobstaclesusinglimitedresources.
Due to the unpredictable environment of power
transmission grids, the linewalking robot is unable to
movereliably
at
fast
speed,
thus
the
gravity
force
plays
a
dominantrole inrobotdynamicswhen therobotmoves
on the power transmission line. During the obstacle
navigation process, likebiped robot for groundmotion
(Shih,C.&Gruver,W.1992),walkingof line inspection
robot isaperiodicphenomena, the locomotionofbiped
robot can be divided into singlesupported phase and
doublesupported phase respectively (Wang, L.; et. al.,
2009).Inordertoassistandobtainastablemotioninthe
singlesupported phase it is important to either anchor
thesupportingarm to the linewithgripper toresist the
gravity or control the total center of gravity position
beneaththe
supporting
arm.
Dual
arm
robots
(Wang,
L.;
et. al., 2006), (Cai, L.; et. al., 2008) with weight central
adjustment system were designed, and the
counterweights,whichgenerallycontainingelectricaland
electronic components, can be shifted forward or
backwardtocenterthemassoneitherofthetwoarms,by
which the robot ishanging to keep thehorizonposeof
thebodyandprotectthelineagainstthegrippingforces.
Due to additional counterweight system, obstacle
navigationprocessof those robots is complexand time
consuming.Expliner(Debenest,P.;et.al.,2008)isanother
type twoarm vehicle for power transmission line
inspection,
by
transferring
a
fair
amount
of
its
weight
beneath thesupportingarm theotherarmcanbe raised
andpivotedtotheothersideoftheobstacles.Thisrobot
haspotentialtoovercomeobstacleswithincomparatively
fewer steps since the rising locomotion of arm canbe
realized by adjusting center gravity position properly
alone. But inherently requires a large space for the
locomotion of counterweight,which results in the less
compactconfiguration.
Thelinewalkingrobotpresentedisintendedtoprovidea
novelmechanismforpower transmission line inspection
purpose. It featuresabiped structureand is supported
bytwofeet.Eachlegoftherobothasaprismaticjointto
adjustthelengthofthelegandthecentroidofthelegcanbe adjusted to the axis of the hip joint to reduce the
energy consumption related to gravity.The structureof
this paper is as follows. Section 2 describes the
mechanismof thebipedrobotand itskinematicsmodel;
section3describesthekinematicsanddynamicsmodelof
therobot.Locomotionstridesoftherobotareproposedin
section 4. Robot control and trajectories generation are
presented in section 5 for subsequent evaluation of the
linewalkingmechanism.Theexperiment ispresentedin
detail in section 6; finally section 7 presents the
conclusion.
2.MechanicalSystem2.1.Mechanismoflinewalkingrobot
Thelinewalkingrobotisdesignedasabipedrobotandit
is supported by two feet which can hold the power
transmission lines.Bothof the feetcanbeputonorput
offline
by
the
multi
articular
movement
of
the
robot
and
with thealternativefootmovement therobotcanrealize
linewalking locomotion. The mechanism of the line
walking robot is showed in Figure 2. The robot is
composed of three segments: leg,waist andbody.Each
legof theLWR is composedofonepitchjoint,one roll
joint and one prismaticjoint. Pitchjoint and rolljoint
providesteeringcapabilityofthefeetrelativetoleg,and
byadjustinganglesof thejoints therobotcanadapt the
feet totheorientationofline.Theprismaticjointsenable
therobottoexpendorcontractitslegs.Theslideblocksof
the two legs are connectedby a rotationjointthe hip
articulationand
the
angle
of
this
joint
together
with
the
lengthofthetwolegsdeterminethegaitoftherobot.
Fig.2.3DModelofthebipedlinewalkingrobot
2.2.KinematicsModel
Basedonthemorphologyofthebipedrobot,atleastone
foot must remain in contact with the line all the time.
Hence,robotkinematicsmodeling isestablished relative
tothe
supporting
foot.
Since
the
robot
features
a
symmetry structure, there is no difference between
attaching coordinate frame to the left foot or the right
foot.Herethestartfootcoordinateframeisattachedto
theleftfoot,whichisanchoredontheline.Therightfoot
can move freely and is described as the end foot
coordinate frame. Figure.3 illustrates coordinate frame
assignment. DenavitHartenberg notation is used to
define the link parameters that are indicated in Table.1
whenleftfootanchoresontheline.
Left yaw
Left pitch
Left prismatic
Hip rotation
Power transmission line
Feet
Right yaw
Right pitch
Right prismatic
Screws
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
3/9
LudanWang,FeiLiu,ShaoqiangXu,ZhenWang,ShengChengandJianweiZhang:Design,ModelingandControlofaBipedLineWalkingRobot
41
Motionjoint 1ia 1i id i
Leftpitch 0 0 0 1
Leftyaw 0 2 0 2
Leftprismatic 0 0 d3 0
Hiprotation
0
2 04
Rightprismatic 0 2 d5 0
Rightyaw 0 0 0 6
Rightpitch 0 2 0 7
Table1.LinkDHParameters
Fig.3.Coordinateframesoflinewalkingrobot
Parameters1
,2
, 3d , 4 , 5d , 6 , 7 are controlled
variablesandnotethat 1
where isaconstant
which represent the title angle of the line and is
variableofleftpitchjoint.
Inthe
single
support
phase,
the
mechanism
of
the
line
walking robot formsanopenkinematicschain.And the
final robot transformation matrix can be written as
follows:
1000
1000
0
7
zzzz
yyyy
xxxx
pasn
pasn
pasn
pasnT (1)
The forward kinematics of the robot is derived in the
equationsetsasfollows:
542
62642
742762642
742762642
31541421
621641421
7621641421741421
7621641421741421
31541421
621641421
7621641421741421
7414217621641421
dssp
ccscsa
csssscccss
ssscscccsn
dcdccscsp
csssscccsa
sssscscccscccscss
cssscscccssccscsn
dsdcssccp
cscsssccca
sssccsscccccssccs
scsscccssccsscccn
z
z
z
z
y
y
y
y
x
x
x
x
(2)
In thedoublesupportphase forward kinematics canbe
determinedsimilarly.
3.DynamicsandInversKinematics3.1.Dynamicsmodel
Inamatrix
form,
the
robot
dynamics
can
be
expressed
as
tqGtqtqhtqtqDtF ,
Where tq , tq , tq are 1n vectors of generalized
jointvariable,velocity,andacceleration,respectively.
Inpracticalsituation, the linewalkingrobot isunable to
move at fast speed. Therefore, the accelerationrelated
inertia matrix tqD and the velocityrelated Coriolis
and centrifugal force vector tqtqh , are neglectable.
Thegravitationeffectsofthelinksplayadominantrolein
robot
dynamics.
When
the
right
foot
of
line
walking
robotfixedonaline,wehavetheelementsofthegravity
term 7654321
,,,,,, gggggggqG are
0
0
7
6
414217655
41421557654
1765433
421576552
4142155765
13765431
g
g
scccsgmmmg
scccslmdmmmg
gcmmmmmg
ssgsdmmmhmg
csscclmdmmm
gsdmmmmhmg
(3)
Where:iic cos ; iis sin im is the mass of link i ,
lis the distancebetween yawjoint and the centroid of
prismaticjoint.
As shown in figure.4, the linewalking robot forms as a
plain fivelink close chainRPRPRmechanismwith two
freedomofdegreesinthedoublesupportedphasewhen
walkingonaline.Thetwoprismaticjointsareselectedto
determinethelocomotionofthedoublesupportedphase,
byusingLEmethodthedynamicmodeloftherobotcan
bederived
as
afunction
of
the
trajectories
of
the
two
prismaticjoints,andthegravitytermasfollows.
3513
2
5
2
3
22
5755
5375
2
3
2
5
22
3133
tan2
1
2tan2
1
tan2
1
2tan2
1
dldglm
dldldglmg
dldglm
dldldglmg
S
SS
S
SS
(4)
WhereSl isthestepsize.
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
4/9
InternationalJournalofAdvancedRoboticSystems,Vol.7,No.4(2010)
42
3.2.InverseKinematics
Inverse kinematics canbeused to obtainjoint variables
with a known configuration of start and end foot
placements. By applying standard algebraic and
trigonometric techniques to the forward kinematics, the
joint variable can be found as a function of end foot
coordinates.In
order
to
minimize
the
influence
of
gravity
andreducethedriventorqueduringthewalkingprocess,
jointsvariablesaredeterminedaccordingtotheelements
of thegravity term in thedynamicequation.By solving
equation 01g and 0
4g wehave:
76555
10
mmmhmd
(5)
Byplungingaboveeq5totheforwardkinematics
equation(2)jointvariablescanbefoundusing
42
1
7
4
1
6
76555
52
1
4
543
1
2
1
2sin
sin
sin
tan0
sssn
sa
mmmhmd
dsp
dcpd
pp
zz
y
z
y
xz
(6)
Whichareall functionsofdesired location.Similarjoint
variables solutions are obtained in the right foot
supported phase,but using the right foot as a ground
reference.
Fig.4.Closechainstructureindoublesupportphase
During the doublesupport phase, both feet have line
contact,thusformaplanarfivebarmechanismwithtwo
DOFs as shown in Figure .4.As shown in figure 5,by
solving the triangle form equationwe can get thejoint
displacementof 3d , 4 and 5d asfollows:
sin2
2arccos
sin2
15
22
55
53
22
5
2
34
3
22
33
kk
kk
dxlxldd
ddldd
xdxdd
(7)
Where
is
the
inclination
angle
of
the
line.
As
shown
in
Figure5(thesubscriptskandk+1representstartingstage
andendingstage respectively),with forwardkinematics
equation we can get other joints displacements as
follows:
2
62642
2
4
2
2
626422
7
4116
542
2
3545
2
4
2
2
42354
1
arcsin
sincossinarcsinarcsin
arcsin
scccsss
sscccsns
aadsp
ddcdsc
scpddcp
zz
yx
z
yx
(8)
dk
d kd k+1
d k+1
d
d
x
Fig.5.Closechainstructureindoublesupportphase
4.LocomotionAnalysisThewayinwhichwalkinglocomotionisimplementedin
linewalking robot isbased on so called staticwalking.
Basedonthemorphologyofthebipedlinewalkingrobot,
at leastone footmustremain incontactwith the lineall
the time, thus a walking cycle can be realized by
combining
single
supported
phase
and
double
supported
phasealternatively.Whilebothof the twofeetareon the
line in the doublesupported phase, only one foot is
stationary on the line in the singlesupportedphase. This
bipedrobotcanactuallypropelitselfusingseveraltypes
of locomotion strides. These are classifiedbased on the
type of swingfoot motion, the flipping stride and
crawling stride, which are derived from alternative
crossingand inchwormmotion,respectively.Bothof the
flipping stride and crawling stride are achieved by
anchoring one foot to the line and swinging the other
foot, the differencebetween the two strides is that the
swinging foot will stride over the fixed foot in the
flippingphase and the rear foot is changed to the front
foot, while in the crawling phase position of the
corresponding foot will be controlled to reduce or
increase the distance between the two feet like an
inchwormwhichmeans therear footalwaysbe therear
foot.
4.1.FlipperStride
Asmentionedabove,flippingstridecanbe dividedinto
singlesupportedphaseanddoublesupportedphaseshown in
Figure6.Assumingthattherobotisinitiallyinthedouble
supportedphaseandbothofthecentralgravitiesofthetwo
legslocate
at
the
right
leg.
During
the
single
supported
phase, the right leg keeps sticking on the line vertically
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
5/9
LudanWang,FeiLiu,ShaoqiangXu,ZhenWang,ShengChengandJianweiZhang:Design,ModelingandControlofaBipedLineWalkingRobot
43
and theswing foot is liftedand flippedfrom therear to
the front of the fixing foot. The following sequence of
motion canbe executed thatwould result in the robot
movingforward.
a. Contract rightprismaticjoint tomake sure that therightfootcouldcrosstherightfoot.
b. Rotatehipjointangletomove leftfootfromLF2toLF3, as determinedby eq.(6) and rotate left pitch
joint to angle which will provide correct left foot
orientation.
c. Expand rightprismaticjoint toplace the left footatLF4
With the completion of this section, the left foot of the
robot has moved forward distance in straight line. A
doublesupported phase then follows the singlesupported
phasetoadjustthecenterofgravityfromtherightfootto
theleftfootwhichisessentialtostartthefollowingsingle
supportedphase.Adjusting isachievedbyperforming the
followingsequence
and
is
illustrated
in
figure
6.
54
5
54
4
2-3
1-4
Fig.6.FlipperStride
d. Expand right prismatic joint and contract leftprismaticjointtoadjustthecenterofgravitiesofthe
two legs from the right leg to the left legandmake
sure the left leg is vertical, at the same time, three
joints:Ryawjoint,Lyawjointandhipjointshould
rotateat thesame time tokeep theorientationsand
positionofthetwofootfixed,asdeterminedbyeq6.
The robot is now again in the beginning of single
supportedphase.
4.2.CrawlingStride
The flipper model of locomotion requires considerable
space,makingitstraveldifficultinconfinedspace.Hence
a walking stride with crawling motion of the robot is
performedusingsignificantlylessspaceabovetherobot.
Thisstrideiscalledcrawlingstride.Thecrawlingstrideis
achieved primarilyby themotion of the swinging foot
along the line without crossing the sticking foot. The
followingsequenceofactionsprovidethecrawlingstride.
Assuming that the robot is initiallyat theendofdouble
supportedphase,
and
is
supported
at
RF
1,
the
robot
must
performthefollowingprocess.
a. Expand the right prismaticjoint and rotate the hipjointtomovetheleftfootalongthelinefromLF1to
LF2, at the same time the leftyawjoint shouldbe
rotatedtoprovidethecorrectorientationofleftfoot.
b. Expand right prismatic joint and contract leftprismaticjointtoadjustthecenterofgravitiesofthe
twolegs
from
the
right
leg
to
the
left
leg
and
make
sure the left leg is vertical, at the same time, three
joints:Ryawjoint,Lyawjointandhipjointshould
rotateat thesame time tokeep theorientationsand
positionofthetwofootfixed.
c. Expand the left prismatic joint and rotate the hipjointtomovetherightfootalongthelinefromRF2
toRF3,atthesametimetheleftrightjointshouldbe
rotated to provide the correct orientation of right
foot.
d. Contract right prismatic joint and expand leftprismaticjointtoadjustthecenterofgravitiesofthe
twolegs
from
the
left
leg
to
the
right
leg
and
make
sure theright leg isvertical,at thesame time, three
joints:Lyawjoint,Ryawjointandhipjointshould
rotateat thesame time tokeep theorientationsand
positionofthetwofootfixed.
e. Therobotisnowagainintheinitialmode.
Fig.7.CrawlingStride
Figure 7 conceptually describes how the proposed gait
patternworks.Withthecompletionofthissequence,the
rightand left feethavemoved forward indistance.The
robotcouldsimilarlyrepeatthestepinreverseorderand
move in reverse direction. Since the robot requires
significantly less vertical space, the crawling stride is
adaptedformoreconfinedenvironments,butataslower
paceowingtodecreasedsteplength.
4.3.CrossingBetweenCrossLine
Totraversebetweentwocrossedlinesinhorizontalplane,
rotationofthetwopitchjointsmustbeconsideredtoadapt
theorientationofthefeettothelines.Alsotheprocesscan
be realizedby thealternatingof thesinglesupportedphase
and doublesupported phase, and either the flipping or
crawling stridecanbeused.Thedifference is thatbefore
step c in the flipping and crawling stride, the rightpitch
jointshould
rotate
to
adjust
the
position
of
the
left
foot
to
the targetplace that isabove thecrossed lineand the left
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
6/9
InternationalJournalofAdvancedRoboticSystems,Vol.7,No.4(2010)
44
pitchand leftyawjoints rotate toprovidecorrected left
footorientation.Thefollowingstepsaresimilar.
4.4.ObstacleNavigation
Accordingtothestructureofthepowertransmissionline
system obstacles canbe divided into two types: lower
obstacleslike
counter
weight
and
higher
obstacles
like
clamps. For lower obstacles, obstaclenavigation canbe
realizedduringtheprocessofflipperstride,asshownin
figure1.4,andtheonlythingthatshouldbepayattention
to is to contract the prismaticjoint of the sticking leg
enoughinstep(a)tomakesurethattheleftfootcanpass
over the obstacle in step (b). While for the higher
obstaclessuchasclamps,theswingingfootcannotstride
overitthusbeforestep(c)intheflippingstride,theright
pitchjointshouldberotatetoavoidtheobstacleandafter
step (c) the right pitch joint should be rotated to the
inverse direction to set the foot on the line. Figure 9
illustratethe
difference
of
obstacle
navigation
process
whenencounteranhigherobstacle.
obstacle
Fig.8Obstaclenavigationprocessoflowerobstacles
obstacleobstacle
Fig.9Obstaclenavigationprocessofhigherobstacles
The walking steplength of the linewalking robot is
determinedby the geometry size of the robot and the
inclinationangleof theline that therobotiswalkingon.
Suppose the inclination angle is as shown in Figure
9.a, by applying standard algebraic and trigonometric
techniques the steplength of the robot can be found
using
sincos 22staticstaticswingUp
dddstep (9)
sincos 22sticstickswingDown
dddstep (10)
SinceUpDown
stepstep and the steplength is a constant
inthedoublesupportedphase,thesteplengthis
sincos 22sticsticswing
dddstep (11)
Tostick
d value equation (10) is a monotone decreasing
function andswing
d is a constant (determinedby eq. 5),
thusthesteplengthgetthemaximalvaluewhenstick
d is
theminimum.
sincosmin
2
min
2
max sticsticswingdddstep (12)
5.RobotControl5.1.RealizedDevices
Therobotconsistsoftwolegscoupledwitharotatejoint.
Each leghasaprismaticjointand two rotatejoints.The
combinationofDCservomotorandballscrewischosen
for the prismaticjoint. The dimension of the prototype
robot is approximately 800mm high and 100mm wide
whenallthejointsareinthezeroposition.Themaximum
lengthofthetowerobstaclesthattherobotcanovercome
is 300mm, and the minimum cross angle of the
suspensionangletoweris120degrees.
The biped linewalking robot is controlled by an
industrialPC.
The
driver
module
is
based
on
the
TMS320F2812digitalsignalprocessorchipfromTI.Each
DSPcontrollerhastwobuiltinquadratureencoderpulse
(QEP)circuitstoreadtheencoderoftheservomotor,thus
with each chip, twomotors canbe controlledwith the
encoder feedback.The total servomotornumber of the
linewalking robot is 7, which means at least 4 driver
modulesareneeded.ThecontrolprogramiswritteninC
languageandtheservofrequencyis1KHz.
Asthegravityeffectsaredeterminedbytheconfiguration
ofall the robot linksandplay adominant role in robot
dynamic model. In order to compensate for gravity
effects,
we
can
pre
compute
these
torque
values
based
on
thedesiredtrajectoryandfeedthecomputedtorquesinto
thecontrollertominimizetheeffects.
5.2.TrajectoriesGeneration
A quintic polynomial specifying the joint position, q ,
velocity, q , and acceleration, q , at thebeginning and
theendofthepathsegmentisusedtogenerateasmooth
trajectorywithoutjerk.A fifthorderpolynomial is thus
used
tatatatataatq 5
4
4
3
3
2
210
Where 0 ttt , and 0t is the start time of thetrajectory. Constraints on the polynomial are imposed
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
7/9
LudanWang,FeiLiu,ShaoqiangXu,ZhenWang,ShengChengandJianweiZhang:Design,ModelingandControlofaBipedLineWalkingRobot
45
using initial and final values of position, velocity, and
acceleration. As time to complete the joint motion
decreases, the velocity and acceleration required to
achieve the desired final position increases. Hence the
final time,ft , of a joint trajectory is limited by the
maximum torque that the corresponding motor can
sustain at a specified speed. Figure 10 shows thejoint
position trajectories in flipping stride with final times
requiredtocompleterespectivejointresponses.
It should be mentioned that in order to reduce the
complexities of the controller only the two prismatic
jointsareactivelycontrolledinthedoublesupportphase
and theangleofhipjoint is lockedasaconstant,which
means, according to the geometry technology, the hip
joint ismovedon thecircumcircleof RLO asshown in
figure11.Thus,asshowninfigure12,duringthedouble
supportphasethedisplacementofhipjointisaconstant
value, and only the two prismatic joints need to be
controledto
track
the
caculated
trajectories
as
the
two
yawjointscanbetreatedaspassivejoints.
0 5 10 15 20150
200
250
300
time/s
displacement/mm
right prismatic joint
left prismatic joint
0 5 10 15 20-60
-40
-20
0
20
40
60
80
time/s
displacement/deg
right yawleft yaw
hip joint
Fig.10.Tajectoriesofawalkingcycle(onesinglesupport
phaseandonedoublesupportphase)
4
5
Fig.11.Optimizeddoublesupportphaseadjustment
0 2 4 6 8 10 12 14 16 18 20150
200
250
300
time/s
displacement/mm
right prismatic joint
left prismatic joint
0 2 4 6 8 10 12 14 16 18 20-60
-40
-20
0
20
40
60
80
time/s
displacement/deg
right yaw
left yaw
hip joint
Fig.12.Tajectoriesofawalkingcycle(onesinglesupport
phaseandonedoublesupportphase,optimized)
6.ExperimentsExperimentswereconductedtoverifythemechanismof
thebipedlinewalkingrobotdevelopedinthisstudy.
(a) (b)
(c) (d)
Fig.13.Picturesoflinewalkingprocess
AsshowninFigure.13,thelinewalkingrobotwashung
from the simulation line, and the experiments were
executed in two steps: firstly, theCoMof the robotwas
locatedattheleftleg,withtheposeadjustmentindouble
supportphasetheCoMwasadjustedtotherightleg,and
theleft
leg
was
lifted
by
the
contraction
of
right
prismatic
joint, finallywith the rotation of hipjoint left leg was
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
8/9
InternationalJournalofAdvancedRoboticSystems,Vol.7,No.4(2010)
46
swung from rear to front to realize onewalking cycle.
Figure 14 shows the process of obstacle navigation of
relative lowobstacle (damperweight), and the stride is
notdifferentfromtheflipperstrideexceptthattheswung
legistherightleg.
(a) (b)
(c) (d)
Fig.14.Picturesofobstaclenavigation(damperweight)
Figure15showspartoftheobstaclenavigationprocessof
relative high obstacle (single clamp), during which the
right pitchjoint needs tobe rotated forth andback to
makesurethatthelegcankeepawayfromobstacles.
(a) (b)
Fig.15.Picturesofobstaclenavigation(singleclamp)
7.ConclusionAbipedmechanism,whichisappliedinthedesigningof
robots for the inspection ofpower transmission lines is
proposed in this paper. The novel mechanism design
enablesthe
centroid
of
the
robot
to
be
concentrated
on
the
hipjointtominimizethedrivetoqueofthehipjointand
keep the robot stable during the singlesupport phase.
The forward and inverse kinematics equations were
proposed for trajectory generation, anddynamicmodel
wasestablishedforlocomotionplanning.Aprototypeof
power transmission line inspectionrobotwasdeveloped
based on this mechanism and experiments showed its
validity. Future work should focus on inclusion line
detectingsensor,
on
board
control,
and
evaluation
of
the
robot in realpower transmission line environmentwith
obstacles.
8.ReferencesCai, L.; Liang, Z.; Hou, Z.G.& Tan,M. (2008). Fuzzy
controloftheinspectionrobotforobstaclenegotiation,
Proceedings of IEEE International Conference on
Networking,SensingandControl,pp.117122,ISBN:
9781424416851,Sanya,China,April2008
Debenest, P.; Guarnieri, M.; Takita, K.; Fukushima, E.;
Hirose,S.;
Tamara,
K.;
Kimura,
A.;
Kubokawa,
H.;
Iwama, N. & Shiga, F. (2008). ExplinerRobot for
inspection of transmission lines, Proceedings of the
IEEE International Conference on Robotics and
Automation,pp.39783984, ISBN: 9781424416462,
Pasadena,CA,May2008,ICRA2008
Liang, Z.; Li, E.; Tan, M.; Liu, G. & Rees, D. (2005)
ControlofInspectionRobotsforPowerTransmission
Lines Based on Remote Video over Internet.
International Conference on Computational
Intelligence forModelling, Control andAutomation
and International Conference on Intelligent Agents,
pp:
877
882,
ISBN:
0
7695
2504
0,
Vienna
,
Austria,
November2005
Nayyerloo,M.;Yeganehparast,S.;Barati,A.&Foumani,
M.(2008).Mechanicalimplementationandsimulation
ofmonolab, amobile robot for inspection of power
transmissionlines,InternationalJournalofAdvanced
RoboticSystems,Vol5,No.2,(June2008),pp.209214,
ISSN:17298806
Pouliot, N. and Montambault, S. (2008). Geometric
Design of the LineScout, a Teleoperated Robot for
PowerLineInspectionandMaintenance,Proceedings
oftheIEEEInternationalConferenceonRoboticsand
Automation, pp 3970 3977, ISBN: 978142441646
2,Pasadena,Canada,May2008Sawada,J.;Kusumoto,K.;Munakata,T.& Ishikawa,Y.
(1991). A mobile robot for inspection of power
transmission lines. IEEE Transactions on Power
Delivery, Vol.6, No. 1, (Jan 1991),pp.309315, ISSN:
08858977
Shih,C.&Gruver,W.(1992).ControlofaBipedRobotin
the DoubleSupport Phase, IEEE Transactions on
Systems, Man, and Cybernetics, VOL.22, NO.4,
(July/august1992),pp.729735,ISSN:00189472
Tang,L.;Fang,L.&Wang,H.(2004).Obstaclenavigation
control for a mobile robot suspended on overhead
groundwires,
Proceedings
of
2004
8th
International
Conference on Control, Automation, Robotics &
8/3/2019 Design, Modeling and Control of a Biped Line-walking Robot
9/9
LudanWang,FeiLiu,ShaoqiangXu,ZhenWang,ShengChengandJianweiZhang:Design,ModelingandControlofaBipedLineWalkingRobot
47
Vision,pp.20802087, ISBN:0780386531,Kunming,
China,December2004,ICARCV2004
Toussaint, K.; Montambault, S. & Pouliot, N.
(2009).Transmission Line Maintenance Robots
Capable of Crossing Obstacles: StateoftheArt
Review and Challenges Ahead. Journal of Field
Robotics,Vol26,
No5,
(Mar
2009),
pp.477499,ISSN:
15564967
Wang, L.; Fang., L.; Wang, J. H. & Zhao, M. (2006,).
Development and control of an autonomously
obstaclenavigation inspection robot for extrahigh
voltage power transmission lines, Proceedings of
SICEICASE InternationalJointConference 2006,pp.
54005405, ISBN: 8995003847, Busan, Korea ,
October.2006,SICEICASE2006,
Wang,L.;ChengS.&Zhang,J.(2009).Developmentofa
linewalkingmechanism forpower transmission line
inspectionpurpose,Proceedingsofthe2009IEEE/ASJ
InternationalConference
on
Intelligent
Robots
and
Systems, pp. 33233328, ISBN: 9781424438037,St.
Louis,MO,USA,October2009,IROS2009