TRNG I HC BCH KHOA H NI

TRUNG TM O TO TI NNG V CHT

LNG CAO

BI TIU LUN ROBOTICS

GVHD:
SVTH :
LP :
18/03/16

PGS.TS.Phan Bi Khi
Nguyn Vn S
Nguyn Minh Trc
KSTN-CT-K53
1

NI DUNG
Xy dng cu trc v thit lp phng trnh ng hc
Gii bi ton ng hc (ngc v thun)
Tnh ton tnh hc
Tnh ton ng lc hc
Thit k v m phng

18/03/16

 Xy dng cu trc v thit lp phng trnh ng

hc
Gii bi ton ng hc (ngc v thun)
Tnh ton tnh hc
Tnh ton ng lc hc
Thit k v m phng
18/03/16

XY DNG CU TRC V THIT LP

PHNG TRNH NG HC

18/03/16

XY DNG CU TRC V THIT LP

PHNG TRNH NG HC

18/03/16

XY DNG CU TRC V THIT LP

PHNG TRNH NG HC

18/03/16

XY DNG CU TRC V THIT LP

PHNG TRNH NG HC

CD=

6 phng trnh ng hc

18/03/16

XY DNG CU TRC V THIT LP

PHNG TRNH NG HC
Kt qu 6 phng trnh ng hc

18/03/16

 Xy dng cu trc v thit lp phng trnh

ng hc
Gii bi ton ng hc (ngc v thun)
Tnh ton tnh hc
Tnh ton ng lc hc
Thit k v m phng
18/03/16

GII NG HC THUN

18/03/16

10

GII NG HC THUN
3 Phng trnh v tr ca im tc ng cui:

Thay kt qu vo ta c:

18/03/16

11

GII NG HC THUN

th xp[1]
18/03/16

th yp[1]
12

GII NG HC THUN

th zp[1]
18/03/16

Qu o im E
13

TNH VN TC IM E,VN TC
GC CC KHU

18/03/16

14

TNH VN TC IM E,VN TC
GC CC KHU
Vn tc gc tuyt i cc khu thao tc

18/03/16

15

TNH VN TC IM E,VN TC
GC CC KHU
Vn tc gc tng i cc khu

18/03/16

16

TNH VN TC IM E,VN TC
GC CC KHU
Vn tc im tc ng cui E

18/03/16

17

GII BI TON NG HC NGC

18/03/16

18

GII BI TON NG HC NGC

6 phng trnh ng hc sau khi thay cc s liu

18/03/16

19

GII BI TON NG HC NGC

th theta[1]
18/03/16

th d[2]
20

GII BI TON NG HC NGC

th theta[3]
18/03/16

21

 Xy dng cu trc v thit lp phng trnh ng

hc
Gii bi ton ng hc (ngc v thun)
Tnh ton tnh hc
Tnh ton ng lc hc
Thit k v m phng
18/03/16

22

TNH TON TNH HC

18/03/16

23

TNH TON TNH HC

18/03/16

24

TNH TON TNH HC

Phn lc cc khp theo th t F[3,2];F[2,1];F[1,0]

18/03/16

25

TNH TON TNH HC

Momen phn lc cc khp theo th t M[3,2]; M[2,1];
M[1,0].

18/03/16

26

TNH TON TNH HC

Tnh lc dn ng cc khp bo m Robot
cn bng

18/03/16

27

 Xy dng cu trc v thit lp phng trnh ng

hc
Gii bi ton ng hc (ngc v thun)
Tnh ton tnh hc
Tnh ton ng lc hc
Thit k v m phng
18/03/16

28

TNH TON NG LC HC

18/03/16

29

TNH TON NG LC HC

18/03/16

30

TNH TON NG LC HC

18/03/16

31

 Xy dng cu trc v thit lp phng trnh

ng hc
Gii bi ton ng hc (ngc v thun)
Tnh ton tnh hc
Tnh ton ng lc hc
Thit k v m phng
18/03/16

32

THIT K V M PHNG

18/03/16

33

THIT K V M PHNG

18/03/16

34

THIT K V M PHNG

18/03/16

35

THIT K V M PHNG

18/03/16

36

THIT K V M PHNG
M phng bi ton ng hc thun

18/03/16

37

THIT K V M PHNG
Kt qu m phng bi ton ng hc thun

Trc X trn Simmechanics

18/03/16

Trc X tnh ton trn Maple

38

THIT K V M PHNG

Trc Y trn Simmechanics

18/03/16

Trc Y tnh ton trn Maple

39

THIT K V M PHNG

Trc Z trn Simmechanics

18/03/16

Trc Z tnh ton trn Maple

40

THIT K V M PHNG

Hnh chiu qu o xung XOY

18/03/16

Qu o im E trn Maple
41

THIT K V M PHNG
M phng bi ton ng hc ngc

18/03/16

42

THIT K V M PHNG
Kt qu m phng

th gc quay theta[1]
18/03/16

th gc quay theta[1] -Maple

43

THIT K V M PHNG

th d[2]
18/03/16

th d[2]-Maple
44

THIT K V M PHNG

th gc quay theta[3]
18/03/16

th gc quay theta[3]-Maple
45

THIT K V M PHNG

Qu o c chiu xung mt phng XOY

18/03/16

46

THIT K V M PHNG
Vi d v qu o hnh xon c
Ta c phng trnh ca ng

18/03/16

47

THIT K V M PHNG
Hnh chiu ca qu o

18/03/16

48

THIT K V M PHNG
Qu o chuyn ng ca im tc ng cui
hon ton chnh xc vi qu o thit k ng
trn tm I(450,550) bn knh R=150mm.
Cc th theta[1],d[2],theta[3] c o bng
cc khi Sensor trong Simmechanics ,ta thy
hon ton chnh xc vi tnh ton trn Maple

18/03/16

49

TI LIU THAM KHO

Bi ging Robotics-PGS.TS.Phan Bi Khi.
ng lc hc h nhiu vt-GS.TSKH.Nguyn
Vn Khang.
n ng dng Simmechanics vo m phng
cn trc quay ca Lu Vn Hiu K45i hc
Bch Khoa H Ni.
Phn help ca phn mm Maple.
Phn help ca phn mm Matlab.
18/03/16

50