-
Notifications
You must be signed in to change notification settings - Fork 2
/
Main_EN_ONLY
70 lines (68 loc) · 1.54 KB
/
Main_EN_ONLY
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
#include<lpc214x.h>
#include"TIMER.H"
#include"ULTRASONIC.H"
#include"LCD.H"
#define EN (1<<16)|(1<<17)
int cent = 100;
#define delay for(i=0;i<65000;i++);
unsigned int range,i;
unsigned char* warn;
unsigned int value;
unsigned int buffer = 0;
unsigned int get_bufreg(unsigned int trange){
if(trange<=100&trange>=50){return 1;}
else if(range<50){return 0;}
else{return 2;}
}
int main()
{ VPBDIV=0x01; // PCLK = 60MHz
IO0DIR |= 0x00FF3400; //10 12 13 16-23
IO1DIR = EN;
ultrasonic_init();
lcd_init();
show("Distance :");
IOSET1 = EN;
while(1) {
cmd(0x8A);
range=get_range();
dat((range/100)%10+48);
dat((range/10)%10+48);
dat((range%10)+48);
show("cm");
//PWM_LOGIC(range);
if (range<50){IOCLR1 = IOCLR1|EN;
cmd(0xC0);
show("CRASH WARNING ");
}
else if (range<=100&range>=50){
if(IOSET1&&EN == EN){
cmd(0xC0);
show("CRASH WARNING ");
cent =range;
for(i=0;i<50;i++){
if(get_bufreg(buffer)==get_bufreg(range)){}
else{
while(cent!=0){
range=get_range();
if(range<=100&range>=50){
IOSET1 = IOSET1|EN;
timer1delay(cent*200);
IOCLR1 = IOCLR1|EN;
timer1delay((100-cent)*200);
cent=cent-(1);
}
else{break;}}
}}
IOCLR1 = IOCLR1|EN;
}
else{IOCLR1 = IOCLR1|EN;
cmd(0xC0);
show("CRASH WARNING ");}
buffer=range;
range=get_range();}
if (range>100){
IOSET1 = IOSET1|EN;
cmd(0xC0);
show("You are safe :) ");
} }
return 0;}