Code chương trình con caidat thong so

Một phần của tài liệu LUẬN VĂN CÔNG NGHỆ ĐIỆN TỬ ĐIỀU KHIỂN PID TAY MÁY (Trang 76)

VI. Kết quả hạn chế:

Code chương trình con caidat thong so

thong so

Network 1 // Network Title

// chuyen thoi gian lay mau thanh so thuc

LD SM0.0 BTI VB136, AC0 ITD AC0, AC0 DTR AC0, VD320 MOVR VD320, VD376 /R 1000.0, VD376

LD SM0.0 BTI VB136, AC0 ITD AC0, AC0 DTR AC0, VD320 MOVR VD320, VD376 /R 1000.0, VD376

LD SM0.0 MOVB 16#DB, SMB67 // T=100ms MOVW 100, SMW68 MOVW 0, SMW70 MOVB 16#DA, SMB67 PLS 0

Code chương trình con HSC0

Network 1 // Instruction Wizard HSC

LD SM0.0 MOVB 16#7C, MOVD 0, SMD38 //Load CV MOVD 0, SMD52 //Load PV HDEF 0, 9 HSC 0 S SM37.7, 1

Code chương trình con xung – goc 0 0

Network 1 // Network Title

// Lay gia tri hien tai cua HSC0 ==> VW0

LD SM0.0 MOVD HC0, AC0 DTI AC0, AC0 MOVW AC0, VW0

Network 2

// Chuyen tu xung sang goc cua khau de ==> VW10 LD SM0.0 MOVD HC0, AC0 *D +360, AC0 /D 400, AC0 DTI AC0, VW10

Code chương trình con goc - xung 0

Network 1 // Network Title

// Chuyen tu goc sang xung cua khau de ==> vw20 LD SM0.0 ITD VW8, AC0 *D 400, AC0 MOVD AC0, VD708 /D +360, VD708 DTI VD708, VW20

DTR VD708, VD712 // lay xung hien tai chuyen thanh so thuc dua vao VD712 Network 2

// Xac dinh sai so can tren va can duoi cua khau de ==> VW30

LD SM0.0

MOVW VW20, VW30 -I VW0, VW30

Code chương trình con xung –chieu cao cao

Network 1 // Network Title

// Lay gia tri hien tai cua HSC1 ==> VW2

LD SM0.0 MOVD HC1, AC1 DTI AC1, AC1 MOVW AC1, VW2

Network 2

// Chuyen tu xung sang goc cua khau 1 ==> VW12

// 8460: xung Encoder 2

LD SM0.0 MOVD HC1, AC0 *D +360, AC0

Một phần của tài liệu LUẬN VĂN CÔNG NGHỆ ĐIỆN TỬ ĐIỀU KHIỂN PID TAY MÁY (Trang 76)

Tải bản đầy đủ (DOC)

(83 trang)
w