Զѧ
ACTA AUTOMATICA SINICA
2000Vol.26No.3P.310-316



ʽϵͳĹ켣ٿ
Ľܡΰ
ժҪоʽϵͳĹ켣ٿ⣬һµĸٷƳʵȫֹ켣ٵһά̬һʽ˵Ŀ.᷽Ч.
ؼʡϵͳʽϵͳ켣ٿƣƶ.
TRAJECTORY TRACKING CONTROL OF CHAINED SYSTEMS
DONG WenjieHUO Wei
(The Seventh Research Division,Beijing Univ.of Aero.& Astro.,Beijing100083)
AbstractThis paper investigates the trajectory tracking problem of chained systems.A new tracking approach is presented.The proposed one-dimensional dynamic tracking controllers can globally make the states of the systems asymptotically track the given trajectories.An application to a wheeled mobile robot is described.Simulation results show that our approach is effective.
Key wordsNonholonomic system,chained form system,trajectory tracking control,mobile robot.
1
ܷ˶ѧԼϵͳ(Ʒϵͳ)ĿǵȤõ˹㷺о(ģ1ݼеĲο).ϵͳBrokettڹ⻬״̬ɵıҪеù⻬״̬ϵͳĽֱڸϵͳ򶨣ϵͳս.ˣ򶨸ϵͳļַʱ򶨡򶨼ߵĻϿƵ.⣬ϵͳĸٿҲõ˹㷺о.ԵؽٿƿɷΪ·ٺ͹켣.·һֲʱļλø٣켣Ҫϵͳָʱ䵽ָλ.һԣ켣ٵʵֱ·ѵö.ڼʵʵķϵͳʽ˺ϳϵͳ·ѻ2ݣ켣⻹һо.ģ3ö̬Իķ˼ʽ˵ĸٿ.΢ƽ̹ĸϳϵͳĹ켣Ҳģ3еķ.ַĲ֮ǱջϵͳͶ̬άϸ.ȱ㲢ǵʽ˺ϳɾֲȫֱ任ʽϵͳ.ʽϵͳĹ켣ٿ⣬ƳһάĶ̬˷ģ3пάϸԼջϵͳȱݣ˶ѧԼɻΪʽϵͳһϵͳĹ켣.
2ʽϵͳ
ʵʵķϵͳɾֲȫֵȼ۱任Ϊ׼ʽϵͳ.ʧһԣʽϵͳĹ켣ٿ.ԪϵͳһʽΪ4
(1)
v=v1,v2cϵͳ.ϵͳصΪǿɿصģֲԻϵͳɿ.Ҫٵ켣y=y1,,ynTRnyοϵͳ
(2)
¼.
1.y3,,ynн.
2.
ʵϣֻиپͬṹĹ켣ʵ壬yοϵͳ(2)Ǻ.⣬Թ켣yu貢.
۵Ƕʽϵͳ(1)ƿvʹ
3
ΪƳ¹켣Ա任
e=(x-y),(3)
з쳣ֵ任=i,jRnn£
(4)
ʽk1,k2,,kn-3Ʋ.ڦǷ任󣬹ʹ켣ȼƿvʹ任e=e1,,enT0.
ɷ(1)(2)ͦĶ壬׵ñ任
(5)
̬(5)¶.
1.ϵͳ(1)͸켣y12£
(6)
ʹx(t)ٸĹ켣y(t)ͬʱʹvuЦ102030i,j,k1,,kn-3ʽ(4)壬kn-20.
һ֤Ҫõ.
(չBarbalat2).΢f(t)tʱĳ޵ĳ䵼ɱʾ֮ͣһ㣬ڶһtʱ.
1֤.(5)(6)ɵıջϵͳΪ
(7)
ȡ

Vط(7)󵼣
(8)
VмVlim0VĶ֪peн磬Ӷɼ1֪xi(3in)н磬ҿǵʽ(7)2֪н.
֤֪

н磬һ.֪V㣬ʽ(8)֪pen.
u1н֪u21en㣬u21en󵼣
(9)
е1һ(䵼н)(u1,1xi(3in)н磬enp).֪(u21en)㣬ʽ(9)֪u31en-1㣬֪u21en-1u1en-1.
ζu21ej(j=n-1,,3)󵼣ظ֤̣֤u21ej-1u1ej-1(j=n-1,,3).
u1н磬p֪u21p.u21p󵼣

еһһ(䵼н)༸(u1xj(3jn)н磬pu1ej(3jn)).֪(u21p)㣬ʽ֪u21e1.
ǵu21ej(1jn),p㣬u21V.VмVlim0u1㣬һVlim=0.ej(1jn)p.Ӷʽ(3)֪xyʽ(6)ĵڶʽ֪vu.֤.
ע.һάٿ(6)ȫֵģûκ.ʽϵͳĹ켣⣬ҿ˷ö̬Իƿȱ㣺1)άϸߣ2).
4ϵͳĸٿ
ڰѵϵͳĸٽƹ㵽ϵͳĸȥ.֤˼·ƣӦĽ.
ԵԪϵͳ
(10)
Ҫٵ켣οϵͳ
(11)
¼.
3.yi,j(3inj,1jm)н.
4.u=u1,,um+1Tн磬ҵ
x=x1,x2,1,,xn1,1,,x2,m,,xnm,mT,y=y1,y2,1,,yn1,1,,y2,m,,ynm,mT,Ϊƿv=v1,v2,,vm+1Tʹó.
һڵ˼·Ǳ任(3)з쳣ֵ任=diagۦ1,21,,m1,l1(2lm)Ϊlȥһк͵һкӦľ󣬶l=li,jRnlnl(1lm)£
(12)
k1,l,k2,l,,knl-3,lƲ.ɷ(10)(11)ͦĶ壬׵e=e1e2,1,,en1,1,e2,m,,enm,mTĶ̬Ϊ
(13)
l=1,2,,m.Ӧڶ1¶.
2.ϵͳ(10)켣yڼ34£

ʹx(t)ٸĹ켣y(t)ͬʱʹvu,Ц10203,l0knl-2,l0(1lm).
5
Ϊ֤ɵЧ˵ĽḺܷ́Լ(11)ʽ˵ĸٿ.(11)ʽ˵˶ѧΪ
(14)
xp,yp,,c,Lģ3еĶ壬w=w1,w2TΪϵͳĿ.״̬任
(15)
任
(16)
ɰѷ(14)任ɵԪʽϵͳ
(17) 
ٶҪٵĹ켣(x*p,y*p)ΪƽϵһԲx*p=acost,y*p=bsint.*ͦ*c(11)ʽ˵ķԼΨһȷ.Դ˹켣ʽ(15)(16)ı任ɵõ
(18) 
ҿ



֤yu㶨1ļ.ɶ1֪
(19)
ʹx(t)ٸ켣y(t)ͬʱʹvuЦ10,20,30,k10,k20.ͨ򵥵ķ任ɵԭϵͳĸٿɣڴȥ.
УL=0.2,a=1,b=2,=1,xp(0),yp(0),(0),c(0)=1.80.90.50.5ݣp(0)=0.2ȡ1=12.252=7,3=8,k1=5,k2=15.ͼ1234ֱӳĸ״̬ĸͼ5ӳxp-ypƽĸ.


ͼ1xpx*pʱ


ͼ2ypy*pʱ


ͼ3ȸ٦*ʱ


ͼ4c٦*cʱ

ͼ5xp-ypx*p-y*p
6
оʽϵͳĹ켣ٿ⣬һµĸٿƷƳʵȫָٿƵһά̬.˷˶̬Էƿȱ㡪άϸߺͱջϵͳ.һʽ˵ĸУЧ.⣬Ʒƹ㵽ʽѧϵͳĹ켣ټδ֪ʽѧϵͳӦ켣ٿƣĸ.
Ȼѧ.
ĽܡպѧоҲʿ.оΪ˶ѧơ³ơϵͳ.
ΰ203.
Ľܣպѧоҡ100083
ΰպѧоҡ100083E-mail:whuo @redchina.com
ο
1ݡKolmanovsky I,McClamroch N H.Development in nonholonomic control problems.IEEE Control System Magazine,1995:2036
2ݡSamson C.Control of chained systemsApplication to path following and time-varying point-stabilization of mobile robots.IEEE Trans.Autom.Control,1995,40:6477
3ݡd'Andrea-Novel B,Campion G,Bastin G.Control of nonholonomic wheeled mobile robots by state feedback linearization.Int.J.Robotics Research,1995,14:543559
4ݡMurray R M,Sastry S S.Nonholonomic motion planningsteering using sinusoids.IEEE Trans.Autom.Control,1993,38:700716
ոڡ1997-11-02
޸ڡ1998-05-18
