Professional Documents
Culture Documents
2005
O Foundation item~ Project (50575165) supported by the National Natural Science Foundation of China; project (2002AA420110,
2005AA2006-1) supported by the National High Technology Research and Development Program of China; project(20045006071 28)
supported by the Youth Chenguang Project of Science amd Technology of Wuhan City of China
Received date: 2005 - 02 - 18 ~ Accepted date: 2005 - 04 - 02
Correspondence= XIAO Xiao hui, Doctoral candidate; Tel.. q- 86-13397109529 ; E-mail: xhxiao@whu, edu. cn
X I A O Xiao-hui, et al: Dynamic simulation and experimental study of inspection robot for high-voltage transmission line • 727 •
The dynamics of inspection robot system is Fig. 2 Link coordinates of inspection robot
modeled by Lagrange's equations B°'n?. First start
First, obtain link transformation matrix as
with Lagrange function, where Ek is the total ki-
written in Eqn. (4) ; then, acquire D~i, D,j~ , Du~,
netic energy of system, Ep is the potential energy and D, E~J from Eqn. (4) and Pseud-inertia matrix
of system, as follows== J1. To save space, effective inertia and coupled in-
L=Ek--Ep (1) ertia items are described in Eqn. (5), the rest coef-
Lagrange's equation, namely dynamic equa- ficients come from Ref. [-8].
• 728 • Journal CSUT VoL 12 No. 6 2005
T,= ilOl
lOO
0
0
1
0
I1
T2 =° Tll T2 =
fo slo ;
L: c °0 10
C2 C3 - - C 2 S3
--s20 al-~olS21
--S 3 --C3
T~ = ~ T ~ =
- - 5 2 C3 52S3 --C20 dl+llCZj;
0 0
- - C2 C3 --52 --C2 S3 -- d4 cz s3 -~ ls2 + al ~
I 0 --C3 --d4c3 L;
--C2 $2$3 d4szsa~-llCZ+dl j
0 0
- - - C2 C35 C2 S35 --S2 --d4c2s3+al~
$35 C35 0 --d4c3 [ ;
Ts = T~ T~
S2 C35 - - S 2 S35 --C 2 d4szs~ ~t-dl J
0 0 0
s~ s~ - c2c,5 c6 S 2 C6"2f-C2 C35 S6 C2S35 al --d4c2s3~
$35 C6 - - $ 3 5 S6 c35 -- d4 c3 l
/'6 = ~/'6 = (4)
s2c~5c~ + c~s6 - - S 2 C35 $ 6 - 4 - C 2 C 6 - - $ 2S350 dl +~4s2s3J
0 0
6
Oil : ,=~/5
J Trace(o-~-ql
;'.__ 8ql J ml q-m2-ffm3 q-m, q-m5 q-ms;
6 /0T, " 0T T
022 = ~,, T r a c e / ~ [ J , -f~[]=, 12= +c~I3= q-cgI4= +c~sls= +(c~c~5 + s6)I6= + I2,s +s~I3ss + I4,y +
#=2
s35
2 Isw + 22
(S6C35 +C~)Issy + I3= -~-S~[4= -}- 15= + S235 16= + r e a l 2 + m 4 1 z +
m, l 2 + 17"/4d~ s~ + ms d~ s~ + ms s~xs~2 + 2m~ & z~ s~ - 2m~ ~'6d4 s~ s6 c~5
/~TD r
4.1 Composition of experimental system with Matlab program c~z~. The multi-rigid body dy-
A 20 m-span 1 " 1 simulated transmission line namic simulation software base on Matlab 7.0 was
of three-span and two-tower was set up for effec- used, which provides two functions to solve differ-
tive full-path inspection operation on simulated ential equation.
Conditions simulated are listed as follows:
field. Experimental system is shown in Fig. 3.
1) Both arms rolling along straight non-obsta-
4.2 Composition of test system cle line in parallel;
The current test system was composed of 6 2) Single arm's uplifting (rotation of joint 2) ;
hall-effect current transducers, 6-channel electric 3) Both arms' interactive sliding and transpo-
charge amplifier and INV360D 16-channel data ac- sition along guiding line (movement of Joint 4).
quisition instrument, and a notepad PC installed Input parameter was the driving torque ap-
with DASP-data acquisition and analysis platform. plied to each joint, which was converted from the
System composition is shown in Fig. 4.
motor drive current-time course measured in exper-
Dynamic experimental result of each condition
are shown in Figs. 5, 6 and 7, respectively. iment and motor torque coefficientES'131 Put driv-
ing torque into dynamic equation to obtain acceler-
5 DYNAMIC NUMERICAL SIMULATION ation, velocity and displacement of each joint.
Based on the above dynamic modeling, simu- The dynamic simulation results under condi-
late inspection robot's forward dynamics response tions 2 and 3 are shown in Figs. 8 and 9.
////
~-- Suspension
- ,// insulatorchain
I.
.2_ , Conductor q.]l~
Tension 2_ -- / ~
~,nti-aliasfilter ~ C o m p u t e r
Data acquisitioninstrument
Electric current
transducers~I ~ ~
16-channel data PC and DASP
Anti-alias Acquisition Data analysis
filter Instrument Software
4.1 Composition of experimental system with Matlab program c~z~. The multi-rigid body dy-
A 20 m-span 1 " 1 simulated transmission line namic simulation software base on Matlab 7.0 was
of three-span and two-tower was set up for effec- used, which provides two functions to solve differ-
tive full-path inspection operation on simulated ential equation.
Conditions simulated are listed as follows:
field. Experimental system is shown in Fig. 3.
1) Both arms rolling along straight non-obsta-
4.2 Composition of test system cle line in parallel;
The current test system was composed of 6 2) Single arm's uplifting (rotation of joint 2) ;
hall-effect current transducers, 6-channel electric 3) Both arms' interactive sliding and transpo-
charge amplifier and INV360D 16-channel data ac- sition along guiding line (movement of Joint 4).
quisition instrument, and a notepad PC installed Input parameter was the driving torque ap-
with DASP-data acquisition and analysis platform. plied to each joint, which was converted from the
System composition is shown in Fig. 4.
motor drive current-time course measured in exper-
Dynamic experimental result of each condition
are shown in Figs. 5, 6 and 7, respectively. iment and motor torque coefficientES'131 Put driv-
ing torque into dynamic equation to obtain acceler-
5 DYNAMIC NUMERICAL SIMULATION ation, velocity and displacement of each joint.
Based on the above dynamic modeling, simu- The dynamic simulation results under condi-
late inspection robot's forward dynamics response tions 2 and 3 are shown in Figs. 8 and 9.
////
~-- Suspension
- ,// insulatorchain
I.
.2_ , Conductor q.]l~
Tension 2_ -- / ~
~,nti-aliasfilter ~ C o m p u t e r
Data acquisitioninstrument
Electric current
transducers~I ~ ~
16-channel data PC and DASP
Anti-alias Acquisition Data analysis
filter Instrument Software
////
~-- Suspension
- ,// insulatorchain
I.
.2_ , Conductor q.]l~
Tension 2_ -- / ~
~,nti-aliasfilter ~ C o m p u t e r
Data acquisitioninstrument
Electric current
transducers~I ~ ~
16-channel data PC and DASP
Anti-alias Acquisition Data analysis
filter Instrument Software