5.3. Xây dựng chương trình điều khiển
5.3.3. Lập trình trình xử lí tín hiệu xung tốc độ cao từ Encoder
Sau khi cấu hình phần cứng cho bộ HSC để sử dụng sinh viên chi cần khái báo địa chỉ vùng nhớ của HSC mà sinh viên chọn để sử dụng. Có thể dùng khối “CTRL_HSC” trong việc quản lí giá trị xung đọc về.Các bước thêm khối “CTRL_HSC” như sau: Instructions ▶ Technology ▶ Counting ▶ CTRL_HSC. Khi thêm khối CTRL_HSC thì mô hình sẽ tự tạo 1 khối Instance
Data block để lưu trữ dữ liệu của khối CTRL_HSC.
Hình 5. 35 Khối xử lý xung tốc độ cao CTRL_HSC70 70
TIEU LUAN MOI download : skknchat@gmail.com
Báo cáo đồ án tốt nghiệp
Bảng 5. 2 Tham số của CTRL_HSCTham số Tham số HSC DIR CV RV PERIOD NEW_DIR NEW_CV NEW_RV NEW_PERIOD
Số xung Encoder lưu ở ô nhớ ID1000 đang ở kiểu dữ liệu số nguyên Dint cần chuyển sang kiểu sô thực Real để tiện tính toán
Hình 5. 36 Chuyển đổi giá trị xung Encoder đếm được
Hình 5. 37 Lệnh chuyển đổi kiểu dữ liệu (CONV) 71
Báo cáo đồ án tốt nghiệp Lớp: TĐH & ĐK - K55
Lập trình tính tốc độ dịch chuyển của băng tải
Cứ sau mỗi 100“xungms,_hiệnchương_tại”trình NGẮT sẽtốcđọcđộgiádịchtrịchuyểnxungencodercủabăngvề vàtải
gán cho vùng nhớ sau đó tính theo công thức.
=( × × )/ ( 0.1 × ) ( / )
Với:
: xung Encoder đếm được
Gán
: đường kính con lăn bị dẫn (
phép toán trên vào lệnh CALCULATE
Hình 5. 38 Lệnh CALCULAT
Các phép toán biểu thức được ghi ở ô “OUT:=”, IN1, IN2,IN3,IN4 và IN5
là tham số đầu vào tương ứng lần lượt với , , , 0.1 và . OUT là kết quả phép toán.
Hình 5. 39 Tính tốc độ dịch chuyển của băng tải
72
GVHD: SV: Phạm Khắc Hải
K55