24
KT LUN VÀ ĐỊNH HƯỚNG PHÁT TRIN
1. Kết lun
Vi đề tài “Điu khin d báo phi tuyến cho h robot t hành và con
lc ngược”, lun án đã gii quyết được vn đề điu khin cho mô hình h
nhiu Robot t hành và mô hình con lc ngược. Mô hình được s dng
trong lun án là mô hình Robot t hành thiếu cơ cu chp hành. Các kết
qu nghiên cu ca lun án được tóm tt như sau:
1. Lun án tp trung phát trin b điu khin d báo da trên nguyên
lý Min-Max cho con lc ngược vi mô hình phi tuyến chu nh
hưởng ca nhiu tác động, tính n định ca h thng kín được phát
biu bng định lý và chng minh cht ch v phương pháp lun.
2. Lun án xây dng được b điu khin bám qu đạo mi theo qu
đạo ca Robot t hành Ch vi mô hình Master-Slave đảm bo tính
n định ISS trong các trường hp có nhiu tác động và chng minh
cht ch v mt lý thuyết và mô phng.
3. Lun án xây dng được b điu khin d báo bám qu đạo theo qu
đạo ca Robot t hành Ch vi mô hình Master-Slave có xét đến
đặc đim thiếu cơ cu chp hành, đảm bo n định tim cn trong
các trường hp không có nhiu tác động và chng minh cht ch v
mt lý thuyết và mô phng.
4. Lun án xây dng được b điu khin d báo bám qu đạo theo qu
đạo ca Robot t hành Ch vi mô hình Master-Slave có xét đến
đặc đim thiếu cơ cu chp hành, đảm bo n định ISS trong các
trường hp có nhiu tác động và chng minh cht ch v mt lý
thuyết và mô phng.
2. Định hướng phát trin ca lun án:
Trong phm vi hn hp ca lun án, nhng kết qu trình bày trong
lun án còn rt khiêm tn và còn nhiu hướng đề ngh cn phát trin, c
th như sau:
1. Các kết qu nghiên cu mi dng li phân tích đánh giá thông
qua mô phng k thut s, chưa được kim định qua thc tế.
2. Nhng b điu khin được đề xut trong lun án mi ch dng
li cho hai đối tượng c th là con lc ngược và Robot t hành
dng hai bánh ch động, chưa tng quát hóa được các h thiếu
cơ cu chp hành nói chung.
Nhng hn chế này cũng chính là hướng nghiên cu phát trin lun án
trong thi gian ti.
1
M ĐẦU
1. Lý do chn đề tài
Các h thiếu cơ cu chp hành như Robot t hành dng 2 bánh ch
động, Omni Robot, con lc ngược đóng vai trò quan trng trong đời
sng, công nghip, quc phòng an ninh vi nhng ng dng như h tr
vic vn chuyn nhng thiết b mà không cn s tham gia ca con
người, Robot rà phá bom mìn, phương tin hot động nhng khu vc
mà con người không đến được,... Điu này dn đến nhng nghiên cu
ci thin h thng điu khin bám qu đạo ca Robot t hành dng 2
bánh ch động đóng vai trò quan trng, là mt hướng đi cn được quan
tâm trong lĩnh vc k thut điu khin – t động hóa. Tuy nhiên nhng
nghiên cu này gp phi nhng thách thc sau:
1) Các Robot t hành dng 2 bánh ch động hot động trong môi trường
công nghip, hay nhng nơi con người không can thip được dn
đến nh hưởng ca nhiu tác động bên ngoài, ví d như nhng
chướng ngi vt không biết trước, nh hưởng ca thi tiết, gió khiến
cho nh hưởng đến cht lượng bám qu đạo.
2) Vì Robot t hành dng 2 bánh ch động còn thêm yêu cu vn
chuyn nên các thông s ca nó như khi lượng, momen quán tính
là bt định, mô hình th hin qua phương trình Euler – Lagrange là
phi tuyến.
3) Thêm na vi mc đích đơn gin hóa v cu trúc để tăng tính cơ
động nên nhiu dng Robot tnh dng 2 bánh ch động như Robot
t hành dng 2 bánh ch động li mang đặc đim ca h thiếu cơ cu
chp hành khi không có cơ cu chnh hướng trc tiếp mà thay vào
đó là s phi hp chuyn động ca 2 bánh hai bên.
4) Do kh năng hn chế ca cơ cu chp hành chính là nhng động cơ
đin trên Robot t hành dng 2 bánh ch động dn đến vic điu
khin trong thc tế phi xét đến ràng buc ca tín hiu điu khin
cũng như ràng buc ca c biến trng thái trong mô hình.
Cho đến nay mt s nghiên cu v cu trúc điu khin thích nghi bn
vng cho Robot t hành dng 2 bánh ch động đã được thc hin [1-4]
vi mc đích xem xét gii quyết nhng vn đề 1 và 2 nêu trên. Ngoài
ra, cũng cn b sung thêm, hin nay, k thut điu khin ti ưu và ti
ưu hóa đang được quan tâm vi hai hướng chính là quy hoch động
thích nghi và điu khin d báo. Nhng tr ngi trong ràng buc tín
hiu điu khin thc ra đã được xđối cho h tay máy bng phương
pháp điu khin Backstepping vi vic b sung khâu hiu chnh ngược
[5]. Tuy nhiên, vic b sung này ph thuc vào đặc đim phương trình
2
động lc hc ca tng h c th, chưa có phương pháp, nguyên lý tng
quát được công b. Đặc bit đối vi Robot t hành dng 2 bánh ch
động thì vn chưa được đề cp nhiu. K thut điu khin ti ưu và ti
ưu hóa v cơ bn có th trin khai được cho tình hung xét đến ràng
buc ca tín hiu điu khin cũng như ràng buc ca c biến trng thái
trong mô hình bng cách đưa thành phn ràng buc này vào trong bài
toán ti ưu, thm chí k c nhng dng phc tp ca ràng buc, ví d
như ràng buc dng đa din [6]. Bên cnh vic ng dng k thut quy
hoch động thích nghi đã được Xem xét trong điu khin Robot t hành
dng 2 bánh ch động [7] thì vic ng dng phương pháp điu khin d
báo trong h Robot t hành dng 2 bánh ch động vi ưu đim giúp ti
thiu hàm mc tiêu da trên mô hình d báo, x lý ràng buc tín hiu
điu khin cũng như biến trng thái cũng là hướng đi trin vng mc dù
xut hin nhng khó khăn sau:
1) nh hưởng ca nhiu trong trin khai b điu khin d báo;
2) Trin khai điu khin d báo cho h phi tuyến và h thiếu cơ cu
chp hành;
3) S thng nht ca vn đề ti ưu và vn đề n định, bám theo qu đạo
ca Robot t hành ch ca h kín khi s dng b điu khin d báo.
Vic nghiên cu ng dng ca b điu khin d báo vi nhng thun
li, khó khăn nói trên chính là động lc cho vic la chn đề tài nghiên
cu ca tác gi.
2. Mc tiêu nghiên cu ca lun án
Mc đích ca đề tài nghiên cu là xây dng b điu khin d báo mi
bám quĩ đạo cho h thiếu cơ cu chp hành, đảm bo tính n định ca h
kín có xét đến trường hp có nhiu và không nhiu. H thiếu cơ cu chp
chp hành được tp trung nghiên cu đây bao gm:
- Con lc ngược
- Robot t hành dng 2 bánh ch động thiếu cơ cu chp hành.
3. Nhim v nghiên cu ca lun án
Để đạt được nhng mc tiêu đã đề ra, lun án cn thc hin các nhim
v chính sau đây:
Thiết lp mô hình toán mô t 1 Robot t hành vi đặc đim thiếu
chp hành, làm rõ ràng buc không tích phân được. Ngoài ra để Xem
xét nhim v điu khin bám theo qu đạo ca Robot t hành ch
thì lun án Xem xét thiết lp mô hình sai lch bám vi 2 Robot t
hành có tính đến góc hướng và không tính góc hướng ca Robot;
Nghiên cu xây dng b điu khin d báo cho h con lc ngược phi
tuyến bng cách tuyến tính hóa s dng bt đẳng thc ma trn để xác
định nghim ti ưu và xem xét tính n định ca h kín;
23
Hình 3.19: Tín hiu điu khin cho robot 𝑹𝒔
T các đồ th ta có th thy robot 𝑅th bám theo robot 𝑅 vi
khong cách 0.5( ), 3 / 2
dd
ms ms
Pm

ngay c khi trong trường hp
có nhiu. Các sai lch là rt nhđiu kin ràng buc cho tín hiu điu
khin ca Robot t hành dng hai bánh ch động 𝑅 1
sS
v
ab

được thon mãn.
3.4 Kết chương 3
Có th thy rng, nhng nghiên cu trước đây [10-12, 29, 30] xem xét
điu khin bám qu đạo cho Robot t hành da trên phương pháp
BackStepping truyn thng ch tp trung vào mc đích bám qu đạo.
Ngoài ra, mt s nghiên cu s dng điu khin d báo cho Unicycle,
robot dưới nước [16,26,27] thì chưa quan tâm đến thành phn góc
hướng ca robot di động cũng như chưa ch ra c th thành phn trung
gian trong so sánh bc cu vi b điu khin trung gian phù hp. Vì vy
cn b sung mt s điu kin để cho phép so sánh gia 2 hàm ng viên
trong 2 chu k liên tiếp [26]. Thêm na cũng cn lưu ý là vic chưa
quan tâm đến thành phn góc hướng dn đến nhng nghiên cu đó mi
ch dng li h Robot đủ cơ cu chp hành khác [16,26,27].
Lun án đã khc phc nhng vn đề nói trên mt s đóng góp sau:
Đề xut b điu khin d báo có xét đến ràng buc ca tín hiu điu
khin bám theo qu đạo ca Robot tnh ch cho mt Robot t hành
chưa và có xét đến nhiu và cũng như Xem xét v mi liên h gia 2 tình
hung có nhiu và không nhiu trong vic thiết lp bài toán ti ưu hóa. Đặc
đim thiếu cơ cu chp hành đã được xét đến thông qua vic đảm bo bám
không ch v trí mà còn c góc hướng. B điu khin trung gian giúp thc
hin vic so sánh các hàm ng viên Lyapunov đã được ch ra c th đảm
báo tính kh thi trong vic kho sát tính n định ca b điu khin do.
22
Hình 3.14: Khong cách 𝑷𝒎𝒔, góc 𝝍𝒎𝒔 và giá tr đặt.
3.2.2.2 Điu khin bám vi Robot Master di chuyn trên mt đường cong.
Vn tc tnh tiến thay đổi và qu đạo thay đổi, vn tc tnh tiến và vn
tc góc ca Master (Ch) được cho như sau:
15( ): 5( / ), 0.1( / )
15( ): 10( / ), 0.1( / )
mm
mm
tsvms rads
tsv ms rads


Hình 3.174: Qu đạo trng thái ca Master– Slave
Hình 3.18: Sai lch điu khin ca Robot t hànhdng hai bánh ch động 𝑅𝑅
3
Nghiên cu xây dng b điu khin d báo cho h Robot tnh
có nhiu tác động bám theo qu đạo ca Robot ch không tính đến
góc hướng;
Nghiên cu xây dng b điu khin d báo cho h Robot t hành
không nhiu và có nhiu ngoài vi yêu cu bám theo qu đạo ca
Robot ch có tính đến góc hướng;
4. Đối tượng và phm vi nghiên cu ca lun án
Đối tượng nghiên cu ca lun án: Lun án nghiên cu phát trin
thut toán điu khin d báo mi cho h thiếu cơ cu chp hành bao
gm:
- Con lc ngược
- Robot t hành hai bánh ch động bám qu đạo ca Robot ch cùng
loi có xét đến nh hưởng ca nhiu.
Phm vi nghiên cu ca lun án: Lun án nghiên cu thut toán điu
khin d báo, gii bài toán ti ưu trc tuyến da trên cơ s bt đẳng thc
ma trn đảm bo bám theo qu đạo ca Robot ch cho h Robot t hành,
con lc ngược có xét ti nh hưởng ca nhiu b chn.
5. Ý nghĩa khoa hc và thc tin ca lun án
Lun án đưa ra phương pháp lun, xây dng mt s b điu khin d
báo mi áp dng trong mt s tình hung vi yêu câu bám theo qu đạo
ca Robot ch trong h Robot t hành, con lc ngược chu nh hưởng
ca nhiu ngoài. B điu khin được đề xut trong lun án có kh năng
đáp ng tt trong điu kin làm vic phc tp. Các b điu khin mi
được đề xut trong lun án được phân tích và chng minh tính n định
ca h kín và cht lượng ca b điu khin được kim chng bng mô
phng k thut s đảm bo tính đúng đắn ca các đề xut mi này. Lun
án góp phn b sung và làm phong phú thêm các phương pháp điu
khin cho h thiếu cơ cu chp hành nói chung, đặc bit là cho h robots
t hành bám theo quĩ đạo ca Robot ch. Chính vì thế, các kết qu
nghiên cu ca lun án va có ý nghĩa khoa hc va có ý nghĩa thc
tin.
6. Phương pháp nghiên cu
Phương pháp nghiên cu thc hin trong lun án là nghiên cu lý thuyết
kết hp vi thc nghim mô phng.
Phân tích các tài liu khoa hc, các công trình đã nghiên cu mi
nht được công b trong và ngoài nước v điu khin h Robot t
hành dng 2 bánh ch động vi Robot t hành, con lc ngược. Đặc
bit là các phương pháp điu khin phi tuyến, ti ưu đã áp dng cho
mô hình Robot t hành thiếu cơ cu chp hành, trên cơ s đó đưa ra
4
định hướng nghiên cu thiết kế b điu khin và phương pháp phân
tích tính n định ca h thng.
Nghiên cu và xây dng các b điu khin d báo bám qu đạo cho
các h chuyn động thiếu cơ cu chp hành, chu tác động ca nhiu
tp trung vào h bám Robot t hành ch và con lc ngược. Các kết
qu nghiên cu được phân tích lý thuyết và kim chng bng mô
phng trên phn mm Matlab có s dng mt s công c chuyên
dng Yalmip, Casadi.
7. Kết qu mi ca lun án
Kết qu nghiên cu mi ca lun án có th được tóm tt tp trung vào
các đim chính sau:
Lun án đã tp trung phát trin b điu khin d báo da trên nguyên
lý Min Max cho con lc ngược vi mô hình phi tuyến chu nh hưởng
ca nhiu tác động, tính n định ca h thng kín được phát biu bng
định lý và chng minh cht ch v phương pháp lun.
Lun án đã xây dng được b điu khin bám qu đạo mi theo qu
đạo ca Robot t hành Ch vi mô hình Master-Slave đảm bo tính n
định ISS trong các trường hp có nhiu tác động và chng minh cht
ch v mt lý thuyết và mô phng.
Lun án đã xây dng được b điu khin d báo bám qu đạo theo qu
đạo ca Robot t hành Ch vi mô hình Master-Slave có xét đến đặc
đim thiếu cơ cu chp hành, đảm bo n định tim cn trong các
trường hp không có nhiu tác động và chng minh cht ch v mt lý
thuyết và mô phng.
Lun án đã xây dng được b điu khin d báo bám qu đạo theo qu
đạo ca Robot t hành Ch vi mô hình Master-Slave có xét đến đặc
đim thiếu cơ cu chp hành, đảm bo n định ISS trong các trường
hp có nhiu tác động và chng minh cht ch v mt lý thuyết và mô
phng.
8. Cu trúc ca lun án
Lun án được trình bày trong 3 chương vi ni dung tóm tt như sau:
Chương 1: Tng quan v điu khin d báo phi tuyến và mô hình Robot
t hành; Phân tích mô hình ca h mt Robot t hành vi đặc đim thiếu
cơ cu chp hành và ràng buc không tích phân được. T đó Xem xét
mô hình sai lch bám ca h gm 2 Robot t hành vi tình hung có và
không xét đến góc hướng. Nghiên cu tng quan các phương pháp điu
khin d báo đã công b và nhng vn dng và đề xut hướng nghiên
cu ca lun án.
21
2. Gii Bài toán ti ưu 3.2.1 để xác định được tín hiu điu khin ti ưu
()
s
h
ut
.
3. Tính tín hiu điu khin cho Robot t hành dng hai bánh ch động
T
s
R
theo công thc (3.17).
4. Đưa tín hiu va tím được vào Slave ch trong khong
1
,
hh
tt
.
5. Cho 1hh
ri quay li bước 1.
3.2.2 Kết qu mô phng
3.2.2.1 Điu khin bám vi Robot Master di chuyn trên mt đường thng.
Vn tc tnh tiến thay đổi vn tc góc bng không, vn tc tnh tiến và
vn tc góc ca Master (Ch) được cho như sau:
15( ): 5( / ), 0( / )
15( ): 10( / ), 0( / )
mm
mm
tsvms rads
tsv ms rads


Hình 3.12: Qu đạo trng thái Master (Ch) – Slave (T)
Hình 3.13: Sai lch điu khin ca Robot t hành dng hai bánh ch động 𝑹𝒔𝑹𝒎
𝒅
20
khong cách đặt d
ms
P
và góc đỡ d
ms
, ta cũng có th d thy rng
d
ms ms
P
P d
ms ms
.
đây ta cn có 1
ss
v
ab

. Điu này luôn được tha mãn trong sut
quá trình hot động ca Robot t hành dng 2 bánh ch động
s
R.
3.2 Thiết lp B điu khin d báo bn vng bám qu đạo cho h hai
Robot t hành kiu Ch - T (Master-Slave) có nhiu
3.2.1 Thut toán điu khin d báo có tính đến Nhiu và Phân tích tính
n định.
Vi cách làm tương t như trong 3.1, ta có th thiết lp mô hình sai lch
gia Robot Slave (T)
R
và Robot Master (Ch)m
R
là:

2
cos( ) sin( )
sin( ) cos( )
sin( ) sin( ) 2
dd
se m ms s se s ms m ms ms
dd
se m nms s se s ms m ms ms
se dd
m
m
s
ms ms ms ms se s
xv yvP
yv xdP
vP ky
d
R
d













 







(3.14)
Ta s thiết kế thut toán điu khin d báo bn vng cho h (3.14) để đưa
s
ev min lân cn vi gc ta độ bng cách s dng mô hình danh dnh
(thu được t mô hình thc tế sau khi loi b nhiu) làm mô hình d báo.
Bài toán ti ưu 3.2.1 (Thiết lp ti chu k trích mu có tính đến
góc): Tìm:

(| )
2
cos( ) sin( )
sin( ) cos(
n
arg m
2
i
)
sin( )
.
si
n(),()
:
()
sh
dd
se m ms s se s ms m ms ms
dd
se m ms s se s ms m ms ms
se d
m
s
ssh
d
m
mmsm
eh
ut
smsss
s
es
v
u
v
J
xv yvP
yv xdPt
et u
s
Pky
t
d
 







 
 




() ( | ))
(| )
(|)
sh sh h
sh tube
sh h tube
pt pt t P
utU
et Tt



Thut toán điu khin 3.2.1:
1. Ti thi đim h
t, tiến hành đo các trng thái và tín hiu điu khin
ca Master (Ch) và T (Slave) gm:
s
u,m
u,
s
p
,m
p
.
5
Chương 2: Điu khin d báo tuyến tính và phi tuyến trong các h
chuyn động; Xây dng cu trúc điu khin d báo cho h con lc ngược
bng cách tuyến tính hóa mô hình và s dng bt đẳng thc ma trn.
Tiếp đến phát trin cho cu trúc điu khin d báo trc tiếp cho h Robot
t hành vi yêu cu điu khin bám theo qu đạo ca Robot t hành
ch và chưa xét đến góc hướng. Các định lý v tính n định ca h kín
được phát biu và chng minh cht ch. Các kết qu phân tích lý thuyết
được đánh giá thông qua mô phng bng phn mm Matlab.
Chương 3: Điu khin d báo bám theo qu đạo ca Robot t hành ch
có xét đến góc hướng; Xây dng cu trúc điu khin d báo bám theo
qu đạo ca Robot t hành ch cho h Robot t hành trong 2 tình hung
có xét và chưa xét đến góc hướng. Các định lý v tính n định ca h
kín được phát biu và chng minh cht ch. Các kết qu phân tích lý
thuyết được kim chng da trên mô phng bng phn mm Matlab s
dng mt s công c chuyên dng Yalmip, Casadi.
Cui cùng, phn Kết lun tng hp các kết qu nghiên cu đã đạt được,
nhng đóng góp mi và hướng m rng nghiên cu phát trin ca lun án.
1. TNG QUAN V D BÁO PHI TUYN VÀ MÔ HÌNH ROBOT
T HÀNH
Ni dung chính trong chương này là xây dng mô hình động lc hc
ca Robot t hành da trên kết qu nghiên cu ca [1-4], cũng như
hình sai lch bám ca h gm 2 Robot t hành [8-13] làm cơ s cho
vic thiết kế b điu khin d báo có kh năng bám theo qu đạo ca
Robot t hành ch chương sau. Ngoài ra ni dung còn được b sung
thêm v phân tích đặc đim tích phân được và không tích phân được
làm cơ s định hướng cho vic thiết kế cu trúc điu khin sau này.
Nhng nghiên cu trước đây v điu khin chuyn động cho Robot t
hành dng 2 bánh ch động cũng như k thut điu khin d báo s
được làm rõ.
1.1 Tình hình nghiên cu
Phn này trình bày v điu khin d báo; Điu khin Robot t hành và
mt s phương tin chuyn động liên quan; Mt s vn đề tiếp tc được
khai thác.
1.2 Hướng nghiên cu
Phn này trình bày các hướng nghiên cu chính ca lun án.
1.3 Mô 1 Robot t hành
1.3.1 Phương trình động hc
Mô hình động hc ca mt Robot t hành dng 2 bánh ch động là
mt h phương trình toán hc mô t các mi quan h gia vn tc dài,