-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathwheel_chair.c
65 lines (65 loc) · 1.13 KB
/
wheel_chair.c
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
#include<avr/io.h>
#include<util/delay.h>
#define LCD_DATA_PORT PORTB
#define LCD_CONT_PORT PORTD
#define LCD_RS PD0
#define LCD_RW PD1
#define LCD_EN PD2
#include<avr/lcd.h>
#include<avr/adc.h>
#include<avr/adxl335.h>
#define X_MIN 335
#define X_MAX 360
#define Y_MIN 335
#define Y_MAX 360
void main()
{
DDRB=0XFF;
DDRD=0X07;
DDRC=0X0F;
int x,y;
adc_init();
lcd_init();
lcd_command_write(0X80);
lcd_command_write("AUTOMATIC WHEEL CHAIR");
_delay_ms(500);
_delay_ms(500);
_delay_ms(500);
_delay_ms(500);
while(1)
{
lcd_command_write(0X01);
x=read_adxl335_x_value(0);
lcd_number_write(x,10);
lcd_string_write(" ");
y=read_adxl335_x_value(1);
lcd_number_write(y,10);
lcd_command_write("0XC0");
if(x>X_MAX)
{
lcd_string_write("FORWARD");
PORTC=0X0A;
}
else if(x<X_MIN)
{
lcd_string_write("REVERSE");
PORTC=0X05;
}
else if(y>Y_MAX)
{
lcd_string_write("RIGHT");
PORTC=0X08;
}
else if(y<Y_MIN)
{
lcd_string_write("LEFT");
PORTC=0X02;
}
else
{
lcd_string_write("STOP");
PORTC=0X00;
}
_delay_ms(200);
}
}