đồ án môn học thiết kế hệ thống điều khiển thiết kế dẫn động cho kho hàng tự động

ể Ở đây sử ụ d ng các thi t bế ị như cảm bi n, ếcông tắc hành trình, encoder, PLC,… để có thể điều khi n, kiể ểm soát được kho hàng.. Em xin cám ơn sự giúp đỡ tận tình, chu đáo, của thầy

TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI

VIỆN CƠ KHÍ

Bộ Môn Cơ Điện Tử

-    -

ĐỒ ÁN MÔN HỌC

THI ẾT K H Ế Ệ THỐNG ĐIỀ U KHI N Ể

Nhiệ m vụ thi t kế: Thi t k d ế ế ế ẫn độ ng cho kho hàng t ự ng độ

Gi ảng viên hướng dẫn: TS Nguyễn Thành Hùng

Sinh viên th c hi n: ự ệ Trần Hoàng Đạt

MSSV: 20170683

Hà N i, Tháng 6 ộ năm 2021

TRƯỜNG ĐẠI HỌC BÁCH KHOA HÀ NỘI

VIỆN CƠ KHÍ

Bộ Môn Cơ Điện Tử

-    -

ĐỒ ÁN MÔN HỌC

THI ẾT K H Ế Ệ THỐNG ĐIỀ U KHI N Ể

Nhiệ m vụ thi t kế: Thi t k d ế ế ế ẫn độ ng cho kho hàng t ự ng độ

Gi ảng viên hướng dẫn: TS Nguyễn Thành Hùng

Sinh viên th c hi n: ự ệ Trần Hoàng Đạt

MSSV: 20170683

Hà Nội, Tháng 6 năm 2021

2

Mục L c ụ

Lời nói đầu……….3

Danh m c b ng bi u hình vụ ả ể ẽ……… 4

Chương 1: Phân tích nguyên lí, thông số k thuỹ ật……….5

1.1 Nguyên lí hoạt động……….………… … 5

1.2 Xác định các thành ph n c a h ầ ủ ệ thống điều khiển……….……….6

Chương 2: Thiết kế h ệ thống điều khiển……… 15

2.1 Tính toán hàm truy n cề ủa động cơ và mô phỏng hàm truy n b ng ề ằ

Matlab Simulink……… … 15

2.2 Thi t k h ế ế ệ thống điều khi n cho các chuyể ển động chính………20

2.3 Sơ đồ thuật toán………20

Chương 3: Lập trình điều khiển PLCvà mô ph ng trên Tiaportalỏ ……… 23

3.1 Lập trình điều khi n trên ể PLC……….…23

3.2 Mô phỏng trên Tiaportal V15……… 33

3.3 Sơ đồ mạch điện……… 33

Chương 4: Kết luận……… 35

Tài li u tham khệ ảo………36

Lời Nói Đầu

Trong th i kì công nghi p hóa, ờ ệ hiện đại hóa ngày nay s n xu t ngày càng phát ả ấtriển, hàng hóa làm ra càng nhiều càng đáp ứng được nhu c u tiêu dùng cho xã ầhội Từ đó nảy sinh ra c n có nh ng kho hàng hiầ ữ ện đại đáp ứng yêu c u s n xuầ ả ất

và kh c ph c nh ng h n ch ắ ụ ữ ạ ế những kho hàng cũ Ngày trước, ản ph s ẩm đượ ạo c t

ra m t cách th công nên vi c mang hàng vào kho hoàn toàn th công d a vào ộ ủ ệ ủ ựsức người là chính và khó qu n lý S ả ự ra đời c a kho hàng t ủ ự động gi i quyả ết được điều đó mà ít sự can thiệp của con người

Tiếp nối đồ án 1 v tài ới đề “thi t k h dế ế ệ ẫn động cho kho hàng t ự động” Đồ

án này là thi t k hế ế ệ thống điều khi n ể Ở đây sử ụ d ng các thi t bế ị như cảm bi n, ếcông tắc hành trình, encoder, PLC,… để có thể điều khi n, kiể ểm soát được kho hàng

Em xin cám ơn sự giúp đỡ tận tình, chu đáo, của thầy Nguyễn Thành Hùng, chỉ

bảo, góp ý t ng tu n trong kừ ầ ỳ h c, ọ em đã hoàn thành đồ án ti p theo cế ủa mình

Và là hệ thống dẫn động em t thi t k , nên ch c ch n s còn nhi u thi u sót, rự ế ế ắ ắ ẽ ề ế ất mong nhận được sự nhận định, ch b o c a các thỉ ả ủ ầy cô để cho đồ án hoàn thiện chính xác hơn

Hà Nội, Tháng 6, năm 2021Giảng Viên Hướng Dẫn Sinh viên thực hiện

Trần Hoàng Đạt

TS Nguy n Thành Hùng ễ

4

Danh M c B ng Bi u Và Hình V ụ ả ể ẽ

Hình 1.1 Sơ đồ động h c c a h ọ ủ ệ thống ……… 6

Hình 1.2 Động cơ MI1020 ……….7

Hình 1.3 Động cơ MI1016 ……… 7

Hình 1.4 Động cơ DCM775 ……….8

Hình 1.5 Ngu n t ong 24V 30A ồ ổ ……… 8

Hình 1.6 PLC Siemens S7-200, CPU 226 AC/DC/Rly……… 9

Hình 1.7 Rơ le trung gian……….10

Hình 1.8 C m bi n ti m cả ế ệ ận……….10

Hình 1.9 C m bi n quang trả ế ở……… 11

Hình 1.10 Công tắc hành trình……… 11

Hình 1.11 Encoder……… 12

Hình 1.12 Module h áp LM2596ạ ……… 12

Hình 1.13 Đèn Laser 5V……… 13

Hình 1.14 B trí các thi t bố ế ị……… 14

Hình 2.1 Mô hình động cơ 1 chiều có tả ……….…15i Hình 2.2 Sơ đồ hàm truy n cề ủa động cơ (k T=k k a, e=k b)……….17

Hình 2.3 Kh o sát hàm truyả ền trên Matlab Simulink………18

Hình 2.4 Động cơ sau khi thêm bộ điều khiển PID……… 19

Hình 2.5 Sơ đồ thu t toánậ ……….……22

Bảng 3.1 Đầu vào PLC……….23

Bảng 3.2 Đầu ra PLC………24

Hình 3.1 Chương trình PLC……….32

Hình 3.2 Giao diện TiaPortal………33

Chương 1: Phân tích nguyên lý và thông số kỹ thuật

1.1 Nguyên lí ho ạt động

1.1.1 Giới thi u chung ệ

Hệ thống c khí c b n c a m t ơ ơ ả ủ ộ nhà kho t ự động m t robot ho t ng tlà ộ ạ độ ự động thông qua bộ điều khiển v di chuyà ển theo đường ray mang hàng s p x p vào để ắ ếkho

Số lượng ro t s dbo ử ụng trong m t nhà o ít hay nhi u ộ kh ề hoàn toàn ph thu c vàụ ộ o đặc tính của à kho nh đó.Nếu m t nhà ộ kho tự động c n kh n ng lầ ả ă ưu trữ cao nhưng tốc độ thấp thì s l ng robot ố ượ khôn nhiều và h th ng b ng chuyg ệ ố ă ền không á ph c tqu ứ ạp Nhưng nếu m t nhà o cộ kh ần kh n ng l u ả ă ư trữ cao v i t c ớ ốđộc o thì sca ố lượng robot rấ ớt l n di chuyển ên các ratr y độ ập, theo c l đường cong ho c chuyặ ển ray dẫn n h th ng b ng chuyđế ệ ố ă ền để phân ph i cho các robot ốnày r t ph c t p ấ ứ ạ

Kho hàng tự động g m m t hồ ộ ệ thống đường ray cho robot di chuy n, c nh h ể ạ ệthống kệ hàng Tốc độ di chuyển của robot theo chi u dài tề ối đa là 5 m/p và di chuyển theo chiều cao là 2,8 ps Tm/ ốc độ ấ l y, trả hàng là 8m/p, trọng lượng tối

1.2 Xác định các thành phần của h ệ thống điề u khi n ể

- Động cơ điện 1 chi u kích t ề ừ độ ậc l p

8

DCM775, 24V +

Hình 1.4 Động cơ DCM775

- Nguồn 1 chiều cấp cho đầu vào của PLC

Hình 1.5 Ngu n t ong 24V 30A ồ ổ

- Khối điều khi n: PLC ể

Hình 1.6 PLC Siemens S7-200, CPU 226 AC/DC/Rly

+ S d ng PLC S7-200, CPU 226 hãng SIEMENS (ử ụ 6ES7216-2AD23-0XB0)

▪ Số đầu vào/ra có s n: 24 DI / 16DO ẵ

▪ Số đầu vào / ra s cố ực đại ( nhờ l p ghép thêm Modul s m r ng: ắ ố ở ộDI/DO/MAX: 128 / 120 / 248

(Datasheet: http://it.rs-online.com/webdocs/002d/0900766b8002da3b.pdf)

10

- Rơ le trung gian

Hình 1.7 Rơ le trung gianRơle là một lo i thi t b ạ ế ị điện t ng m t n hiự độ à í ệu đầu ra thay đổi nhảy cấp khi tín hiệu đầu vào đạt những giá trị xác định Dng để đóng cắt mạch điện điều khiển, bảo v vệ à điều khi n s l m vi c c a mể ự à ệ ủ ạch điện động l c T c dự ắ ụng điều khiển chiều quay động cơ

- Cảm biến ti m cệ ận Autonics PRDT18-14XO-V

• Ngõ ra điều khiển : Thường Mở

• Chất liệu : Đồng thau (mạ niken)

• Cấu trúc bảo vệ : IP67

- Cảm biến ánh sáng Quang tr ở

Hình 1.9 C m bi n quang tr ả ế ở

Cảm biến ánh sáng quang tr CDS Light Sensor có tích h p s n opamp và ở ợ ẵbiến trở so sánh m c tín hi u giúp cho việc nh n biết tín hi u tr nên d ứ ệ ậ ệ ở ễdàng, s dử ụng để nhận bi t hay b t t t thiế ậ ắ ết b ị theo cường độ ánh sáng môi trường

- Công t c hành trình ắ

Hình 1.10 Công t c hành trình ắ

- Đèn Laser

Hình 1.13 Đèn Laser 5V

- Cách b trí thi t b ố ế ị

+ Trục X: Đặt duy nh t 1 c m bi n quang tr ấ ả ế ở ở phần đế xe

Bố trí thêm 3 đèn laser ở 3 ô dưới cùng của kho hàng

+ Tr c Y: Bụ ố trí 7 c m biả ến Y0 đến Y6 trên thân xe

+ Tr c Z: Hai công t c hành trình ụ ắ ở 2 đầu

14 Hình 1.14 B trí các thi t b ố ế ị

Cảm biến Y0Cảm biến Y1Cảm biến Y2Cảm biến Y3Cảm biến Y4Cảm biến Y5Cảm biến Y6

Cảm biến X1

Công tắc hành trình

Đèn 1 Đèn 2 Đèn 3 Đèn C0

Chương 2: Thiế t Kế Hệ Th ống Điề u Khiển

2.1 Tính toán hàm truy n cề ủa động cơ và mô phỏng hàm truy n b ng Matlab ề ằ

Simulink

2.1.1 Hàm truy n cề ủa động cơ

Hình 2.1 Mô hình động cơ 1 chiều có t i [1] ảMomen của động cơ: [2]

Áp d ng biụ ến đổi Laplace ngược cho phương trình (2.3), ( 4): 2

n n n

=,

J B là momen quán tính và ma sát của tải

Với J Olà t ng momen quán tính tr c chính cổ ụ ủa động cơ, B O là tổng ma sát Quan h ệ giữa momen động cơ T Ovới v trí tị ải L:

(s)

(L s R )(J s B ) k

k n G

10(s)

(0,14s 12)(0, 077s 0, 03) 1,127

I K kT

Suy ra hàm truy n cề ủa bộ điều khi n PI: ể

444, 2(s) K i 269, 63

p

K R

Hình 2.4 Động cơ sau khi thêm bộ điều khiển PID

Từ mô ph ng ta th y rỏ ấ ằng động cơ ổn định sau 0,25s Cải thiện đáng kể so với khi không có bộ điều khi n PID ể

2.2 Thiế t k h ế ệ thống điều khiển cho các chuyển động chính

+ Động cơ điện 1 chi u ề

+ Cảm biế tiệm cận n Y0, Y1, Y2, Y3, Y4, Y5, Y6

+ Rơle trung gian

2.3 Sơ đồ thu t toán ậ

Sơ đồ thuật toán bên dưới đây: Khi có tín hiệu từ nút bấm (Nhập hàng hoặc Xuất hàng) hàng i và c t j, các tr c s ở ộ ụ ẽ được chuyển động như hình bên dưới V ới:

X+: Động cơ trục X quay thu n (Ti n t ậ ế ừ chỗ ấ l y hàng vào)

X-: Động cơ trục X quay nghịch (Lùi t kho ra ch l y hàng) ừ ỗ ấ

Y+: Động cơ trục Y quay thu n (Nâng lên) ậ

Y-: Động cơ trục Y quay nghịch (H ạ xu ngố )

Z+: Động cơ trục Z quay thuận (Đưa vào)

Z-: Động cơ trục Z quay ngh ch (L y ra) ị ấ

21

Hình 2.5 Sơ đồ thuật toán

23

Chương 3: Lập trình điều khiển PLC

và mô ph ng trên Tiaportal ỏ

3.1 Lập trình điều khi n trên PLC ể

5 0.4 Rơ le 1 (Điều khi n chiể ều Động cơ X)

6 0.5 Rơ le 2 (Điều khi n chiể ều Động cơ X)

7 0.6 Rơ le 3 (Điều khi n chiể ều Động cơ Y)

8 0.7 Rơ le 4 (Điều khi n chiể ều Động cơ Y)

9 1.1 Rơ le 5 (Điều khi n chiể ều Động cơ Z)

10 1.2 Rơ le 6 (Điều khi n chiể ều Động cơ Z)

B ảng 3.2 Đầu PLC ra

3.1.2 Chương trình PLC

Chương trình PLC viết trên Tiaportal V16

25

27

29

31

Hình 3.1 M t vài Network trong cộ hương trình PLC

33

3.2 Mô ph ng trên Tiaportal V16 ỏ

Hình 3.2 Giao di n TiaPortal ệ

3.3 Sơ đồ ạch điệ m n

35

Chương 4: Kết Luận

Sau 1 h c k ọ ỳ làm đồ án này, em đã rút ra được nhiều ki n th c vế ứ ề điều khi n mể ột

hệ thống tự động Tính toán l a chự ọn động cơ ph hợp, thi t k bế ế ộ điều khiển PID, l p mậ ột sơ đồ thuật toán hoàn ch nh, mô ph ng hoỉ ỏ ạt động, ki m tra và chể ỉnh sửa

Mặc d đã cố gắng tìm hiểu và thực hiện song do kiến thức của em còn hạn chế nên đề tài còn nhiều thiếu sót Em kính mong thầy cô góp ý để đề tài này được hoàn thiện hơn

Một lần nữa em xin gửi l i cờ ảm ơn chân thành nhất đến sự giúp đỡ tận tình của các th y cô trong b môn ầ ộ Cơ Điện Tử , và nhất là sự hướng d n, ch b o nhiẫ ỉ ả ệt tình từ thầy giáo Nguyễn Thành Hùng đã giúp chúng em nắm rõ được các yêu cầu để hoàn thành đồ án này

Tài Li u Tham Kh o ệ ả[1] Aborisade, David O, DC Motor with Load Coupled by Gears Speed Control using Modified Ziegler-Nichols Based PID Tunings, 2014

[2] Bùi Qu c Khánh, Nguyố ễn Văn Liễn, Cơ sở truyền động điện,

Nhà xu t b n khoa h c và k thu t, 2006 ấ ả ọ ỹ ậ

[3]https://support.controltechnologycorp.com/customer/elearning/younkin/motor[4] Hà T t Th ng, Giáo trình PLC, 2007 ấ ắ