mô phỏng hệ thống giữ xe tự động sử dụng mạch điện tử DDC c466 của PNTECH CONTROLS, sử dụng chính là IC PIC32
Bạn đang xem bản rút gọn của tài liệu. Xem và tải ngay bản đầy đủ của tài liệu tại đây (459.27 KB, 42 trang )
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
LỜI MỞ ĐẦU
Với các nước phát triển, ngành công nghệ tự động đ ược áp d ụng vào nhi ều
lĩnh vực khác nhau. Trong đó có thể kể đến những ứng dụng th ực t ế trong
cuộc sống hằng ngày là “Giữ xe tự động”. “Gi ữ xe t ự động” là m ột ph ần
không thể thiếu ở các nước phát triển, khi mà mật độ ô tô ở các n ước này
lớn. Mô hình giữ xe ra đời góp phần mang lại sự chuyên nghi ệp h ơn trong
dịch vụ giữ xe ô tô, đáp ứng nhu cầu ngày càng cao của cuộc sống công
nghiệp là sự tiện lợi và nhanh chóng, nhưng cũng không kém ph ần hiệu qu ả
so với các dịch vụ cổ điển.
Đối với nước ta thì dịch vụ này còn khá m ới, ch ưa đ ược áp d ụng r ộng rãi.
Nhưng trong tương lai, cùng với xu thế phát triển chung trên th ế gi ới, n ước
ta sẽ ngày càng phát triển, giao thông vận tải phát tri ển, đ ời s ống v ật ch ất
ngày càng được nâng cao, khi đó ô tô thay thế dần xe máy. Khi ấy vi ệc gi ữ xe
bằng phương pháp thủ công sẽ không còn được áp dụng mà thay vào đó là
các phương pháp bán tự động hoặc tự động.
Được sự hướng dẫn của thầy Đỗ Văn Điện và tham khảo từ các mô hình
trên mạng, nhóm chúng em đã làm mô phỏng hệ th ống gi ữ xe t ự đ ộng s ử
dụng mạch điện tử DDC-C466 của PNTECH CONTROLS, sử dụng chính là IC
PIC32. Do thời gian và kiến thức có hạn nên không th ể tránh đ ược nh ững sai
sót trong hệ thống. Mong quý thầy cô nhận xét và góp ý đ ể chúng em hoàn
thiện hơn.
Chúng em xin chân thành cảm ơn.
Nhóm SVTH
Khoa Điện – Điện tử
1
Đồ án hệ thống giữ xe tự động
Khoa Điện – Điện tử
GVHD: Đỗ Văn Điện
2
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
LỜI NHẬN XÉT
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
............................................................................................................................................................
Khoa Điện – Điện tử
3
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
MỤC LỤC
Lời mở đầu.................................................................................................. 1
Lời nhận xét................................................................................................ 2
Chương A:..................................................................................................... 4
Giới thiệu về mô hình giữ xe tự động.
Chương B:..................................................................................................... 5
Cấu trúc hệ thống
I.
II.
III.
IV.
V.
Giới thiệu các thiết bị...............................................................6
Giới thiệu các đầu vào, đầu ra của mạch DDC-C46....8
Sơ đồ đấu dây phần cứng và mạch nguyên lý...............9
Nguyên lý hoạt động.................................................................11
Chương trình DDC-C46............................................................13
Khoa Điện – Điện tử
4
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
Chương A: Giới thiệu về dây chuyền giữ xe tự
động.
Ở các nước phát triển thì có thể nói “dịch vụ giữ xe ô tô” là m ột d ịch v ụ
không thể thiếu. Còn ở các nước đang phát triển, nh ư n ước ta, thì d ịch v ụ
này hầu như chưa được phát triển. Tuy nhiên, với xu th ế hội nhập th ế gi ới,
nước ta ngày càng phát triển, thì có thể, đây sẽ là một d ịch vụ không th ể
thiếu ở nước ta trong tương lai.
Các phương pháp giữ xe ô tô hiện nay:
- Thủ công: vốn đầu tư thấp, máy móc, trang thiết bị đ ơn gi ản, t ốn nhi ều
thời gian và nhân công lao động. Đòi hỏi phải có lao động của con ng ười.
- Bán tự động: vốn đầu tư tương đối cao, máy móc, trang thiết bị t ương đ ối
hiện đại. Thay thế con người làm một phần công việc, tiết ki ệm đ ược th ời
gian và nhân công lao động nhưng chưa tuyệt đối.
- Tự động: vốn đầu tư cao, máy móc trang thiết bị hiện đ ại, làm vi ệc thay
thế hoàn toàn con người, tiết kiệm được thời gian và nhân công lao động
một cách tuyệt đối. Tuy vốn đầu tư cao nhưng với số lượng ô tô phát tri ển
nhanh như ở Việt Nam thì đây là cách giúp tiết kiệm được thời gian.
Khoa Điện – Điện tử
5
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
Chương B: Cấu trúc của hệ thống
Mô hình hệ thống giữ xe tự động
Khoa Điện – Điện tử
6
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
I. Giới thiệu các thiết bị
Hệ thống gồm có:
1. Động cơ
Động cơ
• 1 động cơ điều khiển cổng
• 1 động cơ xoay đế giữ xe
• 1 động cơ nâng xe
• 1 động cơ kéo thanh trượt giữ lấy xe
• 1 động cơ kéo lên xuống theo tầng.
2. Công tắc hành trình: ngay các mỗi tầng để xe
3. Nút nhấn:
•
•
1 nút nhấn giữ xe
1 nút nhấn cất xe
4. Bộ phận quét thẻ: Một bộ phận quét thẻ để nhận dạng mã thẻ và vị trí
cất xe (theo mã thẻ)
Khoa Điện – Điện tử
7
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
5. Bàn điện có chứa các relay và mạch điện tử đấu nối các đầu vào và ra,
các mạch ứng dụng
.
Khoa Điện – Điện tử
8
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
II. Giới thiệu các đầu vào, đầu ra của DDC-C46
- 12 đầu vào tự do: đầu vào áp, dòng, điện trở, công tắc
- 6 đầu ra relay, 4 đầu ra analog
Khoa Điện – Điện tử
9
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
III. Sơ đồ đấu dây phần cứng của mô hình
* Sơ đồ đấu dây
Khoa Điện – Điện tử
10
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
* Mạch động lực và điều khiển đảo chiều động cơ
Mạch động lực đảo chiều động cơ DC
Bảng trạng thái:
NO KT
1
1
0
0
NC KT
0
0
1
1
NO KN
0
1
1
0
NC KN
1
0
0
1
Mạch điều khiển đảo chiều động cơ DC
Khoa Điện – Điện tử
11
Trạng thái ĐC
Quay thuận
Hãm
Quay nghịch
Hãm
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
IV. Nguyên lý hoạt động
- Tòa nhà giữ xe mô phỏng có 2 tòa nhà đối diện nhau, m ỗi tòa nhà có 3
tầng, mỗi tầng giữ 1 xe và mỗi vị trí giữ xe được gán với mã thẻ giữ xe.
* Giữ xe:
- Khi khách hàng đến giữ xe, khách hàng sẽ chạy xe vào trong v ị trí gi ữ xe đã
định sẵn, kéo phanh tay và nhanh chóng rời khỏi xe, ra ngoài nh ận th ẻ và
quét thẻ qua bộ phận quét thẻ đặt ngoài cổng.
- Khách hàng nhấn nút Cất xe, cổng tòa nhà sẽ đóng lại đ ể xe sau không vào
khi hệ thống đang làm việc.
- Đối với các thẻ có vị trí 1, 3, 5 thì hệ th ống lần lượt th ực hiện các b ước:
+ Hệ thống cáp nâng xe lên tới tầng đã định sẵn
+ Nâng xe nhằm tạo khoảng cách giữa bánh xe và mặt sàn
+ Trượt đẩy xe vào vị trí đặt xe
+ Hạ xe xuống mặt sàn
+ Rút bộ phận nâng ra khỏi tầng giữ xe
+ Cửa mở ra cho xe tiếp theo vào
- Đối với các thẻ có vị trí 2, 4, 6 thì hệ th ống lần l ượt th ực hiện các b ước:
+ Xoay toàn bộ cơ cấu nâng và trượt xe 180 độ để hướng vào tầng
chẳn
+ Hệ thống cáp nâng xe lên tới tầng đã định sẵn
+ Nâng xe nhằm tạo khoảng cách giữa bánh xe và mặt sàn
+ Trượt đẩy xe vào vị trí đặt xe
+ Hạ xe xuống mặt sàn
+ Rút bộ phận nâng ra khỏi tầng giữ xe
+ Xoay ngược lại 180 độ về vị trí ban đầu
+ Cửa mở ra cho xe tiếp theo vào
* Lấy xe:
- Khi khách hàng đến lấy xe, quét thẻ qua bộ phận quét th ẻ đ ặt ngoài c ổng.
Khoa Điện – Điện tử
12
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
- Khách hàng nhấn nút Lấy xe, cổng tòa nhà sẽ đóng lại đ ể xe sau không vào
khi hệ thống đang làm việc.
- Đối với các thẻ có vị trí 1, 3, 5 thì hệ th ống lần lượt th ực hiện các b ước:
+ Hệ thống cáp nâng cơ cấu nâng và trượt lên tới tầng đã định sẵn
+ Cơ cấu trượt trượt đến vị trí bánh xe
+ Nâng xe nhằm tạo khoảng cách giữa bánh xe và mặt sàn
+ Trượt kéo xe ra khỏi tầng để xe
+ Hạ xe xuống
+ Cửa mở ra cho khách chạy xe ra khỏi tòa nhà
- Đối với các thẻ có vị trí 2, 4, 6 thì hệ th ống lần l ượt th ực hiện các b ước:
+ Xoay toàn bộ cơ cấu nâng và trượt xe 180 độ để hướng vào tầng
chẳn
+ Hệ thống cáp nâng cơ cấu nâng và trượt lên tới tầng đã định sẵn
+ Cơ cấu trượt trượt đến vị trí bánh xe
+ Nâng xe nhằm tạo khoảng cách giữa bánh xe và mặt sàn
+ Trượt kéo xe ra khỏi tầng để xe
+ Hạ xe xuống
+ Xoay ngược lại 180 độ về vị trí ban đầu
+ Cửa mở ra cho khách chạy xe ra khỏi tòa nhà
Khoa Điện – Điện tử
13
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
V. Chương trình
/*
* File: main.c
* Author: Phat
*
* Created on October 26, 2012, 9:15 AM
*/
#include "include/main.h"
#include <math.h>
//#include "include/hardware.h"
#include "include/Framework.h"
#include "include/Uart.h"
// Configuration bits
#if defined(__PIC32MX__)
#pragma config FPLLMUL = MUL_20 // PLL Multiplier
#pragma config FPLLIDIV = DIV_2 // PLL Input Divider
#pragma config FPLLODIV = DIV_1 // PLL Output Divider
#pragma config FPBDIV = DIV_1 // Peripheral Clock divisor
#pragma config FWDTEN = OFF // Watchdog Timer
#pragma config WDTPS = PS1 // Watchdog Timer Postscale
#pragma config FCKSM = CSDCMD // Clock Switching & Fail Safe Clock Monitor
#pragma config OSCIOFNC = OFF // CLKO Enable
#pragma config POSCMOD = HS // Primary Oscillator
#pragma config IESO = OFF // Internal/External Switch-over
#pragma config FSOSCEN = OFF // Secondary Oscillator Enable (KLO was off)
#pragma config FNOSC = PRIPLL // Oscillator Selection
#pragma config CP = OFF // Code Protect
#pragma config BWP = OFF // Boot Flash Write Protect
#pragma config PWP = OFF // Program Flash Write Protect
#pragma config DEBUG = OFF // Background Debugger Enable
#endif
static UINT RFID_Recv_TimeOut = 0;
int RFID_Recv_Len=0;
UINT8 RFID_Recv[7];
BOOL RFID_Flag = FALSE;
unsigned long int RFID_Recv_Keytag = 0;
void main_proc(void);
/*
*
*/
unsigned char CountT1=0;
unsigned int HOLDING_REGISTERS[70];
unsigned int INPUT_REGISTERS[12];
BOOL M[64];
Khoa Điện – Điện tử
14
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
TIMER Timer1;
TIMER Timer2;
TIMER Timer3;
TIMER Timer4;
TIMER Timer5;
TIMER Timer6;
TIMER Timer7;
TIMER Timer8;
TIMER Timer9;
TIMER Timer10;
TIMER Timer11;
TIMER Timer12;
TIMER Timer13;
TIMER Timer14;
TIMER Timer15;
TIMER Timer16;
TIMER Timer17;
TIMER Timer18;
TIMER Timer19;
TIMER Timer20;
TIMER Timer21;
TIMER Timer22;
TIMER Timer23;
TIMER Timer24;
TIMER Timer25;
TIMER Timer26;
TIMER Timer27;
TIMER Timer28;
TIMER Timer29;
TIMER Timer30;
TIMER Timer31;
TIMER Timer32;
TIMER Timer33;
TIMER Timer34;
TIMER Timer35;
TIMER Timer36;
TIMER Timer37;
TIMER Timer38;
TIMER Timer39;
TIMER Timer40;
TIMER Timer41;
TIMER Timer42;
TIMER Timer43;
TIMER Timer44;
TIMER Timer45;
Khoa Điện – Điện tử
15
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
TIMER Timer46;
TIMER Timer47;
TIMER Timer48;
int main(void)
{
SYSTEMConfig(GetSystemClock(), SYS_CFG_WAIT_STATES | SYS_CFG_PCACHE);
OpenCoreTimer(CORE_TICK_RATE);
mConfigIntCoreTimer((CT_INT_ON | CT_INT_PRIOR_2 | CT_INT_SUB_PRIOR_0));
INTEnableSystemMultiVectoredInt();
RCON=0;
//if(mGetPORFlag()) mClearPORFlag();
//if(mGetBORFlag()) mClearBORFlag();
InitializeBoard();
InitDACBM88347();
Timer1.TIMER_ENABLE=FALSE;
Timer2.TIMER_ENABLE=FALSE;
Timer3.TIMER_ENABLE=FALSE;
Timer4.TIMER_ENABLE=FALSE;
Timer4.TIMER_ENABLE=FALSE;
Timer6.TIMER_ENABLE=FALSE;
Timer7.TIMER_ENABLE=FALSE;
Timer8.TIMER_ENABLE=FALSE;
Timer9.TIMER_ENABLE=FALSE;
Timer10.TIMER_ENABLE=FALSE;
Timer11.TIMER_ENABLE=FALSE;
Timer12.TIMER_ENABLE=FALSE;
Timer13.TIMER_ENABLE=FALSE;
Timer14.TIMER_ENABLE=FALSE;
Timer15.TIMER_ENABLE=FALSE;
Timer16.TIMER_ENABLE=FALSE;
Timer17.TIMER_ENABLE=FALSE;
Timer18.TIMER_ENABLE=FALSE;
Timer19.TIMER_ENABLE=FALSE;
Timer20.TIMER_ENABLE=FALSE;
Timer21.TIMER_ENABLE=FALSE;
Timer22.TIMER_ENABLE=FALSE;
Timer23.TIMER_ENABLE=FALSE;
Timer24.TIMER_ENABLE=FALSE;
Timer25.TIMER_ENABLE=FALSE;
Timer26.TIMER_ENABLE=FALSE;
Timer27.TIMER_ENABLE=FALSE;
Timer28.TIMER_ENABLE=FALSE;
Timer29.TIMER_ENABLE=FALSE;
Timer30.TIMER_ENABLE=FALSE;
Timer31.TIMER_ENABLE=FALSE;
Khoa Điện – Điện tử
16
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
Timer32.TIMER_ENABLE=FALSE;
Timer33.TIMER_ENABLE=FALSE;
Timer34.TIMER_ENABLE=FALSE;
Timer35.TIMER_ENABLE=FALSE;
Timer36.TIMER_ENABLE=FALSE;
Timer37.TIMER_ENABLE=FALSE;
Timer38.TIMER_ENABLE=FALSE;
Timer39.TIMER_ENABLE=FALSE;
Timer40.TIMER_ENABLE=FALSE;
Timer41.TIMER_ENABLE=FALSE;
Timer42.TIMER_ENABLE=FALSE;
Timer43.TIMER_ENABLE=FALSE;
Timer44.TIMER_ENABLE=FALSE;
Timer45.TIMER_ENABLE=FALSE;
Timer46.TIMER_ENABLE=FALSE;
Timer47.TIMER_ENABLE=FALSE;
Timer48.TIMER_ENABLE=FALSE;
Init_ADC();
RFID_RECV_INIT();
BOOTLOADER_LAYER_Init();
while(1)
{
if(Load_Universal_Voltage_Input()) Get_Univeral_Input(&INPUT_REGISTERS[0]);
ConverRealValue();
main_proc();
LoadOutout();
BOOTLOADER_LAYER_Task();
BOOTLOADER_FrameWorkTask();
}
}
void InitializeBoard(void)
{
mPORTDClearBits(BIT_7|BIT_6|BIT_5|BIT_4|BIT_3|BIT_2|BIT_1|BIT_0);
mPORTDSetPinsDigitalOut(BIT_7|BIT_6|BIT_5|BIT_4|BIT_3|BIT_2|BIT_1|BIT_0);
DDPCONbits.JTAGEN = 0;
PMCONbits.ON = 0;
CM1CONbits.ON=0;
TRISB=0xffff;
}
void main_proc(void){
if(RFID_Flag){
RFID_Recv_Keytag = RFID_Recv[2]*0x1000000+RFID_Recv[3]*0x10000 +
RFID_Recv[4]*0x100+RFID_Recv[5];
//if (INPUT_REGISTERS[4]==1) RELAY4_IO=1;
Khoa Điện – Điện tử
17
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
if (Timer26.TIMER_ENABLE||(RFID_Recv_Keytag==Keytag1 &&
INPUT_REGISTERS[6]==1 )) //gui xe the keytag1
{
//M[0]=1;
// AO.AO1=50;
//DO.RELAY1=1; //nang len toi tang 1 // relay1 dong co nang
AO.AO3=100;
if(Timer26.TIMER_ENABLE==FALSE)Timer26.TIMER_VALUE=15;
Timer26.TIMER_ENABLE=TRUE;
if(Timer26.TIMER_ENABLE==TRUE && Timer26.TIMER_VALUE==0){
AO.AO3=0;
DO.RELAY1=1;
M[0]=1;
Timer26.TIMER_ENABLE=FALSE;
}
}
if (Timer1.TIMER_ENABLE||(M[0]&&INPUT_REGISTERS[0]==1)) //cong tat hanh
trinh tang 1
{
DO.RELAY1=0; //dung tai tang 1
DO.RELAY5=1; //nang xe len
if(Timer1.TIMER_ENABLE==FALSE)Timer1.TIMER_VALUE=10;
Timer1.TIMER_ENABLE=TRUE;
if(Timer1.TIMER_ENABLE==TRUE && Timer1.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY5=0;
DO.RELAY3=1; //day qua trai
M[0]=0;
M[1]=1;
Timer1.TIMER_ENABLE=FALSE;
}
}
if (Timer2.TIMER_ENABLE||(M[1]&&INPUT_REGISTERS[5]==1)) //ct hsnh trinh
cuoi xe
{
DO.RELAY3=0; //dung day xe qua trai
DO.RELAY6=1; //ha xe xuong
if(Timer2.TIMER_ENABLE==FALSE)Timer2.TIMER_VALUE=10;
Timer2.TIMER_ENABLE=TRUE;
if(Timer2.TIMER_ENABLE==TRUE && Timer2.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY6=0;
DO.RELAY4=1; //keo xe ve
M[1]=0;
M[2]=1;
Khoa Điện – Điện tử
18
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
Timer2.TIMER_ENABLE=FALSE;
}
}
if (M[2]&&INPUT_REGISTERS[4]==1) //ct hanh trinh dau xe (ben de xoay)
{
DO.RELAY4=0; //dung keo xe ve
DO.RELAY2=1;
M[2]=0;
M[3]=1;
}
if (Timer25.TIMER_ENABLE||(M[3]&&INPUT_REGISTERS[8]==1))
{
DO.RELAY2=0; //vi tri ban dau
AO.AO4=100;
if(Timer25.TIMER_ENABLE==FALSE)Timer25.TIMER_VALUE=17;
Timer25.TIMER_ENABLE=TRUE;
if(Timer25.TIMER_ENABLE==TRUE && Timer25.TIMER_VALUE==0){
AO.AO4=0;
M[3]=0;
Timer25.TIMER_ENABLE=FALSE;
RFID_Flag=FALSE;
}
}
//
===============================================================
==================== if (Timer27.TIMER_ENABLE||
(RFID_Recv_Keytag==Keytag3 && INPUT_REGISTERS[6]==1 )) //gui xe the
keytag3
{
AO.AO3=100;
if(Timer27.TIMER_ENABLE==FALSE)Timer27.TIMER_VALUE=15;
Timer27.TIMER_ENABLE=TRUE;
if(Timer27.TIMER_ENABLE==TRUE && Timer27.TIMER_VALUE==0){
AO.AO3=0;
DO.RELAY1=1;
M[4]=1;
// M[0]=1;
Timer27.TIMER_ENABLE=FALSE;
}
// AO.AO1=50;
//DO.RELAY1=1; //nang len toi tang 2 // relay1 dong co nang
}
if (Timer3.TIMER_ENABLE||(M[4]&&INPUT_REGISTERS[1]==1)) //cong tat hanh
trinh tang 2
{
Khoa Điện – Điện tử
19
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
DO.RELAY1=0; //dung tai tang 2
DO.RELAY5=1; //nang xe len
if(Timer3.TIMER_ENABLE==FALSE)Timer3.TIMER_VALUE=10;
Timer3.TIMER_ENABLE=TRUE;
if(Timer3.TIMER_ENABLE==TRUE && Timer3.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY5=0;
DO.RELAY3=1; //day qua trai
M[4]=0;
M[5]=1;
Timer3.TIMER_ENABLE=FALSE;
}
}
if (Timer4.TIMER_ENABLE||(M[5]&&INPUT_REGISTERS[5]==1)) //ct hsnh trinh
cuoi xe
{
DO.RELAY3=0; //dung day xe qua trai
DO.RELAY6=1; //ha xe xuong
if(Timer4.TIMER_ENABLE==FALSE)Timer4.TIMER_VALUE=10;
Timer4.TIMER_ENABLE=TRUE;
if(Timer4.TIMER_ENABLE==TRUE && Timer4.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY6=0;
DO.RELAY4=1; //keo xe ve
M[5]=0;
M[6]=1;
Timer4.TIMER_ENABLE=FALSE;
}
}
if (M[6]&&INPUT_REGISTERS[4]==1) //ct hanh trinh dau xe (ben de xoay)
{
DO.RELAY4=0; //dung keo xe ve
DO.RELAY2=1;
M[6]=0;
M[7]=1;
}
if (Timer28.TIMER_ENABLE||(M[7]&&INPUT_REGISTERS[8]==1))
{
DO.RELAY2=0; //vi tri ban dau
AO.AO4=100;
if(Timer28.TIMER_ENABLE==FALSE)Timer28.TIMER_VALUE=17;
Timer28.TIMER_ENABLE=TRUE;
if(Timer28.TIMER_ENABLE==TRUE && Timer28.TIMER_VALUE==0){
AO.AO4=0;
M[7]=0;
Khoa Điện – Điện tử
20
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
Timer28.TIMER_ENABLE=FALSE;
RFID_Flag=FALSE;
}
}
//=============================================================
======================
if (Timer29.TIMER_ENABLE||(RFID_Recv_Keytag==Keytag5 &&
INPUT_REGISTERS[6]==1 )) //gui xe the keytag5
{
AO.AO3=100;
if(Timer29.TIMER_ENABLE==FALSE)Timer29.TIMER_VALUE=15;
Timer29.TIMER_ENABLE=TRUE;
if(Timer29.TIMER_ENABLE==TRUE && Timer29.TIMER_VALUE==0){
AO.AO3=0;
M[8]=1;
// AO.AO1=50;
DO.RELAY1=1; //nang len toi tang 3 // relay1 dong co nang
Timer29.TIMER_ENABLE=FALSE;
}
}
if (Timer5.TIMER_ENABLE||(M[8]&&INPUT_REGISTERS[2]==1)) //cong tat hanh
trinh tang 3
{
DO.RELAY1=0; //dung tai tang 3
DO.RELAY5=1; //nang xe len
if(Timer5.TIMER_ENABLE==FALSE)Timer5.TIMER_VALUE=10;
Timer5.TIMER_ENABLE=TRUE;
if(Timer5.TIMER_ENABLE==TRUE && Timer5.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY5=0;
DO.RELAY3=1; //day qua trai
M[8]=0;
M[9]=1;
Timer5.TIMER_ENABLE=FALSE;
}
}
if (Timer6.TIMER_ENABLE||(M[9]&&INPUT_REGISTERS[5]==1)) //ct hsnh trinh
cuoi xe
{
DO.RELAY3=0; //dung day xe qua trai
DO.RELAY6=1; //ha xe xuong
if(Timer6.TIMER_ENABLE==FALSE)Timer6.TIMER_VALUE=10;
Timer6.TIMER_ENABLE=TRUE;
if(Timer6.TIMER_ENABLE==TRUE && Timer6.TIMER_VALUE==0){
//DelayMs(2000);
Khoa Điện – Điện tử
21
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
DO.RELAY6=0;
DO.RELAY4=1; //keo xe ve
M[9]=0;
M[10]=1;
Timer6.TIMER_ENABLE=FALSE;
}
}
if (M[10]&&INPUT_REGISTERS[4]==1) //ct hanh trinh dau xe (ben de xoay)
{
DO.RELAY4=0; //dung keo xe ve
DO.RELAY2=1;
M[10]=0;
M[11]=1;
}
if (Timer30.TIMER_ENABLE||(M[11]&&INPUT_REGISTERS[8]==1))
{
DO.RELAY2=0; //vi tri ban dau
AO.AO4=100;
if(Timer30.TIMER_ENABLE==FALSE)Timer30.TIMER_VALUE=17;
Timer30.TIMER_ENABLE=TRUE;
if(Timer30.TIMER_ENABLE==TRUE && Timer30.TIMER_VALUE==0){
AO.AO4=0;
M[11]=0;
Timer30.TIMER_ENABLE=FALSE;
RFID_Flag=FALSE;
}
}
//=============================================================
======================
if (Timer31.TIMER_ENABLE||(RFID_Recv_Keytag==Keytag2 &&
INPUT_REGISTERS[6]==1 )) //gui xe the keytag2
{
AO.AO3=100;
if(Timer31.TIMER_ENABLE==FALSE)Timer31.TIMER_VALUE=15;
Timer31.TIMER_ENABLE=TRUE;
if(Timer31.TIMER_ENABLE==TRUE && Timer31.TIMER_VALUE==0){
AO.AO3=0;
M[12]=1;
// AO.AO1=50;
AO.AO1=100; //de quay sang trai
Timer31.TIMER_ENABLE=FALSE;
}
}
if (M[12]&&INPUT_REGISTERS[9]==1)
{
Khoa Điện – Điện tử
22
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
AO.AO1=0;
DO.RELAY1=1;
M[12]=0;
M[13]=1;
}
if (Timer7.TIMER_ENABLE||(M[13]&&INPUT_REGISTERS[0]==1)) //cong tat hanh
trinh tang 1
{
DO.RELAY1=0; //dung tai tang 3
DO.RELAY5=1; //nang xe len
if(Timer7.TIMER_ENABLE==FALSE)Timer7.TIMER_VALUE=10;
Timer7.TIMER_ENABLE=TRUE;
if(Timer7.TIMER_ENABLE==TRUE && Timer7.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY5=0;
DO.RELAY3=1; //day qua trai
M[13]=0;
M[14]=1;
Timer7.TIMER_ENABLE=FALSE;
}
}
if (Timer8.TIMER_ENABLE||(M[14]&&INPUT_REGISTERS[5]==1)) //ct hsnh trinh
cuoi xe
{
DO.RELAY3=0; //dung day xe qua trai
DO.RELAY6=1; //ha xe xuong
if(Timer8.TIMER_ENABLE==FALSE)Timer8.TIMER_VALUE=10;
Timer8.TIMER_ENABLE=TRUE;
if(Timer8.TIMER_ENABLE==TRUE && Timer8.TIMER_VALUE==0){
//DelayMs(2000)8
DO.RELAY6=0;
DO.RELAY4=1; //keo xe ve
M[14]=0;
M[15]=1;
Timer8.TIMER_ENABLE=FALSE;
}
}
if (M[15]&&INPUT_REGISTERS[4]==1) //ct hanh trinh dau xe (ben de xoay)
{
DO.RELAY4=0; //dung keo xe ve
DO.RELAY2=1;
M[15]=0;
M[16]=1;
}
if (M[16]&&INPUT_REGISTERS[8]==1)
Khoa Điện – Điện tử
23
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
{
DO.RELAY2=0; //vi tri ban dau
AO.AO2=100;
M[16]=0;
M[17]=1;
}
if (Timer32.TIMER_ENABLE||(M[17]&&INPUT_REGISTERS[10]==1))
{
AO.AO2=0;
AO.AO4=100;
if(Timer32.TIMER_ENABLE==FALSE)Timer32.TIMER_VALUE=17;
Timer32.TIMER_ENABLE=TRUE;
if(Timer32.TIMER_ENABLE==TRUE && Timer32.TIMER_VALUE==0){
AO.AO4=0;
M[17]=0;
Timer32.TIMER_ENABLE=FALSE;
RFID_Flag=FALSE;
}
}
//=============================================================
=====================
if (Timer33.TIMER_ENABLE||(RFID_Recv_Keytag==Keytag4 &&
INPUT_REGISTERS[6]==1 )) //gui xe the keytag4
{
AO.AO3=100;
if(Timer33.TIMER_ENABLE==FALSE)Timer33.TIMER_VALUE=15;
Timer33.TIMER_ENABLE=TRUE;
if(Timer33.TIMER_ENABLE==TRUE && Timer33.TIMER_VALUE==0){
AO.AO3=0;
M[18]=1;
// AO.AO1=50;
AO.AO1=100; //de quay sang trai
Timer33.TIMER_ENABLE=FALSE;
}
}
if (M[18]&&INPUT_REGISTERS[9]==1)
{
AO.AO1=0;
DO.RELAY1=1;
M[18]=0;
M[19]=1;
}
if (Timer9.TIMER_ENABLE||(M[19]&&INPUT_REGISTERS[1]==1)) //cong tat hanh
trinh tang 2
{
Khoa Điện – Điện tử
24
Đồ án hệ thống giữ xe tự động
GVHD: Đỗ Văn Điện
DO.RELAY1=0; //dung tai tang 3
DO.RELAY5=1; //nang xe len
if(Timer9.TIMER_ENABLE==FALSE)Timer9.TIMER_VALUE=10;
Timer9.TIMER_ENABLE=TRUE;
if(Timer9.TIMER_ENABLE==TRUE && Timer9.TIMER_VALUE==0){
//DelayMs(2000);
DO.RELAY5=0;
DO.RELAY3=1; //day qua trai
M[19]=0;
M[20]=1;
Timer9.TIMER_ENABLE=FALSE;
}
}
if (Timer10.TIMER_ENABLE||(M[20]&&INPUT_REGISTERS[5]==1)) //ct hsnh
trinh cuoi xe
{
DO.RELAY3=0; //dung day xe qua trai
DO.RELAY6=1; //ha xe xuong
if(Timer10.TIMER_ENABLE==FALSE)Timer10.TIMER_VALUE=10;
Timer10.TIMER_ENABLE=TRUE;
if(Timer10.TIMER_ENABLE==TRUE && Timer10.TIMER_VALUE==0){
//DelayMs(2000)8
DO.RELAY6=0;
DO.RELAY4=1; //keo xe ve
M[20]=0;
M[21]=1;
Timer10.TIMER_ENABLE=FALSE;
}
}
if (M[21]&&INPUT_REGISTERS[4]==1) //ct hanh trinh dau xe (ben de xoay)
{
DO.RELAY4=0; //dung keo xe ve
DO.RELAY2=1;
M[21]=0;
M[22]=1;
}
if (M[22]&&INPUT_REGISTERS[8]==1)
{
DO.RELAY2=0; //vi tri ban dau
AO.AO2=100;
M[22]=0;
M[23]=1;
}
if (Timer34.TIMER_ENABLE||(M[23]&&INPUT_REGISTERS[10]==1))
{
Khoa Điện – Điện tử
25
