ĐIỀU KHIỂN ĐỘNG CƠ Đặt vấn đề: Ngày nay động cơ được ứng dụng rất nhiều trong kỹ thuật hiện đại, đặc biệt trong kỹ thuật Robot.. Ứng dụng dùng để di chuyển, xoay phải, trái v.v... Để c
Trang 1ĐIỀU KHIỂN ĐỘNG CƠ Đặt vấn đề:
Ngày nay động cơ được ứng dụng rất nhiều trong kỹ thuật hiện đại, đặc biệt trong kỹ thuật Robot Ứng dụng dùng để di chuyển, xoay phải, trái v.v Để chúng hoạt động theo mong muốn thì ta phải điều khiển chúng Bài tiểu luận là một phần rất nhỏ trong điều khiển Motor Điều khiển Motor quay thuận mỗi lần 1 bước vaf quay ngược 1 bước.
Lưu đồ giải thuật:
Trang 2Sơ đồ mạch:
Code chương trình:
$MOD51
ORG 0000H ;Dia chi luu chuong frinh trong ROM
MAIN:
MOV R2,#8 ;Nap R2=04H
MOV R0,#0 ;Xoa R0, R0=0
MOV DPTR,#MOTORTHUAN ;Nap con tro vung du lieu
BEGIN:
MOV ,R0 ;Chuyen noi dung R0 vao A
MOVC ,@A+DPTR ;Lay du lieu tai o nho ROM do A+DPTR tro den
MOV P2, ;Xuat gia tri A ra P2
LCALL DELAY ;Goi chuong trinh Delay 50ms
INC R0 ;Tang R0 1 don vi
DJNZ R2,BEGIN ;Lap lai cho den khi bo dem bang 0
CLR A ;Xoa A
Trang 3MOV DPTR,#MOTORNGUOC ;Nap con tro vung du lieu
BB:
MOV A,R0 ;Chuyen noi dung R0 vao A
MOVC A,@A+DPTR ; Lay du lieu tai o nho ROM do A+DPTR tro den
MOV P2,A ; Xuat A ra P2
LCALL DELAY ;Goi chuong trinh delay
INC R0 ; Tang R0 1 don vi
DJNZ R2,BB ;Lap lai cho den khi bo dem bang 0
SJMP MAIN
DELAY:
MOV TMOD,#01H ;Chon che do dinh thoi 16 bit
MOV TH0,#HIGH(-50000) ;Dinh khoang dinh thoi 50ms
MOV TL0,#LOW(-50000)
SETB TR0 ;Timer 0 hoat dong
JNB TF0,$ ;Lap lai tai cho khi TF0=0
CLR TF0 ;Xoa TF0
CLR TR0 ;Xoa TR0
RET
MOTORTHUAN:
DB 80H,40H,20H,10H,08H,04H,02H,01H ;Khai bao du lieu
MOTORNGUOC:
DB 01H,02H,04H,08H,10H,20H,40H,80H ;Khai bao du lieu
END ;Ket thuc chuong trinh
Kết quả:
