CHƯƠNG V : THUẬT TOÁN ĐIỀU KHIỂN
5.1.Ý tưởng :
Dùng máy tính thi
ết kế giao diện truyền thông số vị trí xuống vi điều khiển, sau đó
vi điiều khiển sẽ nhận v
à xử lí tín hiệu đó rồi cho động cơ chạy đến vị trí định
trước.
5.2. Thực hiện
5.2.1.Thiết kế giao diện và lập trình dùng Visual Basic 6.0
Giao di
ện giúp người dùng truyền 2 byte chứa vị trí cần đi của vít-me và các thông
s
ố về chiều quay.
a.Giao diện
Hình 5.1 Giao diện VB
b.VB code
Private Sub cmd1_Click()
If cmd1.Caption = "Vitri" Then
vitri = Val(txt1.Text) * 199
malenh(0) = 251
bytetosend(0) = vitri And 255
bytetosend(1) = vitri \ 256 And 255
MSComm1.Output = bytetosend()
MSComm1.Output = malenh()
Else
cmd1.Caption = "Vitri"
cmd5.Enabled = True
vitri = Val(txt1.Text) * 197
malenh(0) = 251
bytetosend(0) = vitri And 255
bytetosend(1) = vitri \ 256 And 255
.OutBufferSize = 512
.InputMode = comInputModeBinary
'.InputMode = comInputModeText
.PortOpen = True
End With
cmd2.Enabled = False
cmd3.Enabled = False
End Sub
Private Sub test_Click()
If test.Caption = "Test" Then
txt1.Enabled = False
cmd5.Enabled = False
cmd1.Enabled = False
cmd2.Enabled = True
cmd3.Enabled = True
test.Caption = "Untest"
Else
txt1.Enabled = True
cmd2.Enabled = False
cmd3.Enabled = False
test.Caption = "Test"
cmd5.Enabled = True
cmd1.Enabled = True
End If
End Sub
5.2.1.Lập trình điều khiển dùng Atmega8
Sau khi nh
ận vị trí do máy tính gửi xuống lúc này VĐK sẽ cho trục vít-me quay
đến đúng vị trí thì dừng.
Code :
#define PARITY_ERROR (1<<UPE)
#define DATA_OVERRUN (1<<OVR)
#define DATA_REGISTER_EMPTY (1<<UDRE)
#define RX_COMPLETE (1<<RXC)
// USART Receiver buffer
#define RX_BUFFER_SIZE 8
char rx_buffer[RX_BUFFER_SIZE];
#if RX_BUFFER_SIZE<256
unsigned char rx_wr_index,rx_rd_index,rx_counter;
#else
unsigned int rx_wr_index,rx_rd_index,rx_counter;
#endif
// USART Receiver interrupt service routine
interrupt [USART_RXC] void usart_rx_isr(void)
{
char status,data;
status=UCSRA;
data=UDR;
if (data == 253)
{
flag = 1;
thuan=1 ;nghich=0;OCR1A=80 ;
}
else if (data == 254)
{
flag =2 ;
thuan=0 ;nghich=1;OCR1A=80 ;
}
else if (data==252)
{