Զѧ
ACTA AUTOMATICA SINICA
1997ꡡ234ڡVol.23No.41997



˵ĩ³ٿ1)
˹̸쿡Ŵ
ժҪϾŶĩ޻˵Ķѧԣ鹹Բȷϵͳƥģ͸. ͨԲȷϵͳ³ٿƷչһµԼ˵³ٿƷ. и˶PUMA562˵ʵ. 
ؼʡԼˣ³ƣȷϵͳ ϵͳ˶ѧ.
THE ROBUST TRACKING CONTROL OF RESTRAINED ROBOT 
WITH RANDOM PERTURBATION ON THE BASE
WANG XINGGUI
(The PLA College of Ordance Engineering, Shijiazhuang 050003)
TAN DALONGWU ZHENWEIZHANG CHUNJIE
(Shenyang Institute of Automation, the Chinese Academy of Sciences, Shenyang 110015)
AbstractAccording to the dynamics of the restrained robot system with random perturbation on the base, a matching model of imaginary linear uncertain system is established in this paper. The method to design a robust stabilizing controller for the linear uncertain system is introduced, and a force robust tracking control method is developed for the restrained robot. The effectiveness of this method has been verified by experiment with the PUMA562 mounted on a omnidirectional vehicle.
Key wordsRestrained robot, robust control, uncertain system, nonlinear system, robot dynamics.
1
˲ϵͳҵɹΪĩԼĿ⣬У Эϵͳ. ˣԼĻ˿оǵӣ14. Ŀǰоȵǹ̶Լ˵/λûϿƣҪǽϵͳ˶ԼȻֱȡͬĿƲԣ13. Լֻͨü򵥵Ļַƣʵþ̬׼̬ƱΪ̬Ĺ. ṩֵ漰ʵֳԼ˶켣Ĳ. ڿռˮ»ҵĻ˼ԶװСϵĻ˵ȣЩϵͳڹʱ̶ܹȻ˵ĻŶʱоµĸЧĿƷ. 
2ĩ޻˵Ķѧ
˻ŶΪRm(m6)Ӧ˵צ˹켣Ŷe

(1)
ʽJ(,)ΪӦJacobian任. 
צ˹ϵĻ˶ѧ̣Ŷʱָ켣ƽԻ Զϸߴ

(2)
ʽ=-dΪλƫ
Ϊƫ
Ϊצ˽Ӵƫ
Ϊϵͳƾ. ʽ(2)ǻ˻ŶʱצϵϵͳӦָ켣ıƫ̬. 
˵ĩޣŶʱάֻצλ˲䣬˵ʵƽ(ؽڿռ)ƫָ켣ƽ. (2)бӦıϵ󽫲Ŷ ʹʵϵͳΪȷϵͳ

(3)
ʽЦMx, Cx, GxΪϵͳƾŶ. 
3
3.1鹹ģ
ȶһ鹹ԲȷƥģͣҲǹһʽ(3)еԶȷϵͳģ

(4)
ʽΪ鹹ϵͳ״̬
ĸ
r(t)ϵͳοźţ
鹹ϵͳƾ
ϵͳŶͲοΪԾź. 
ϵͳ(4)Ĳȷƥ
A=BD(r), D(r)=[r1I,r2I, 0],
B=BE(S), 2I+E(S)+ET(S)0.
(5)
Уr1ܦ1, r2ܦ2; Iλ. 
3.2³ٿ
1.ʵʲȷϵͳ(3) Ŷ磺
[(t)+Mx(t)]-1Mx(t)ܦǣ1;
[(t)+Mx(t)]-1Gx(t)ܦ1;
[(t)+Mx(t)]-1Cx(t)ܦ2;
Cx(t)(t);Gx(t).
(6)
鹹ȷϵͳ(3) һģ0 㡡2(1-)ݦģз

(7)
ʽ(7)뷽(2) ϵͳ

(8)
ʹʵϵͳ(3)ڲȷ(6)Ŷھܱ֤³ٿ. ȶ֤4(P65). 
Цã1/ģPRiccati
ATP+PA-PBR-1BTP+Q=0
(9)
⣬ʽмȨѡȡ
R=I/(æ-1),
(10)

(11)
ʽЦšСrm=max{r1,r2}. 
4ŶPUMA562ĩ޿ʵ
PUMA562˵ʵϵͳͼ1ʾ. ʵʱûצץһ̶Ŷʱֻצλ˲. װ/شڻ˿. ɶ1 ʽ(6)ĲȷŶΪ=0.5,1=1, 2=1. ƥ(5)Уr11, r21 E(S)0.5. ȡ=1, =2, R=1 ȨQ=diag(4,4,2). ÷ʽ(7)k1=7.356, k2=6.740, k3=2.828. ʽ(8)³ٿתΪ/ƫĺ

(12)
Ϊʵƫֵ. ʵʱֻŶu=v=0.05.sin(.t)(m),PUMA562ؽλΪ
=90.0,-51.588, 179.515,0.0,-37.927, 0.0T().
ϵͳĽӴԸնΪ
ke=diag(10000.0, 10000.0, 10000.0; 10000.0, 10000.0, 10000.0)(N/m;N.m/rad).
ͼ2ͼ3Ϊ/شʵߣʵֵ/С1(kg)/(kg.m). ɼٿЧϺãϵͳкǿ³ԣͼ߲ƽǴ. ͼ2ͼ3ɼFy,Fz仯ɼֵFx0, NyNz0Ϊʵʱֻ45㷽ƽ.


ͼ1PUMA562ʵϵͳͼ


ͼ2צԼʵ


ͼ3צԼʵ
5С
һµԼ˵³ٿƷ. ÷صǣԼƫʱϵͳĶ̬̣ʽ(8)аϵͳѧȫԲ ԭϵͳ켣ʱ亯. ˴С桢СôƵ ˷ֻͨü򵥵ĻַԼʱϵͳĶ̬Ȳȱ. رʺϵͳ켣ϱƾʱ䣬ҴΧ䶯ϵͳ. 
1)ȻѧйѧԺѧоʵһĿ.
ߵλ:˹йžеѧԺϵʯׯ050003
̸쿡ŴܡйѧԺԶ110015
ο
[1]Mills J K, Goldenberg A A. Force and position control of manipulators during constrained motion tasks. IEEE Trans. on Robotics and Automation, 1989, 5(1):3046.
[2]Yabuta T. Nonlinear basic stability concept of the hybrid position / force control scheme for robot manipulators. IEEE Trans. on Robotics and Automation, 1992, 8(5):633671.
[3]Yoshikawa T, Zheng X Z. Coordinated dynamic hybrid position/force control for multiple robot manipulators handling one constrained object. Int. J. of Robotics Research, 1993, 12(3): 219230.
[4]˹.Эѧ켣滮Ϳо.ҵѧʿģ 1994.
[5]ï.³ϵͳӦ(ʿ).йռ似оԺƹо1992.
ոڡ1995-11-20
