#include "suryaa.h"
int distance=0;
int duration=0;
void set_ultrasonic_sensor(void)
{
digitalWrite(7,LOW);
delay_microsec(2);
digitalWrite(7,HIGH);
delay_microsec(10);
digitalWrite(7,LOW);
duration=pulseIn(6,HIGH);
distance=duration*0.034/2;
delay_microsec(1000);
}
void setup()
{
pin_configure();
set_timer0_pwm();
set_timer2_pwm();
configure_leds();
configure_ultrasonic_pin();
Serial.begin(9600);
}
void loop()
{
set_ultrasonic_sensor();
if(distance>20)
{
move_forward();
}
else
{
stop_motor();
reverse_motor();
turn_right();
}
}
mega:SCL
mega:SDA
mega:AREF
mega:GND.1
mega:13
mega:12
mega:11
mega:10
mega:9
mega:8
mega:7
mega:6
mega:5
mega:4
mega:3
mega:2
mega:1
mega:0
mega:14
mega:15
mega:16
mega:17
mega:18
mega:19
mega:20
mega:21
mega:5V.1
mega:5V.2
mega:22
mega:23
mega:24
mega:25
mega:26
mega:27
mega:28
mega:29
mega:30
mega:31
mega:32
mega:33
mega:34
mega:35
mega:36
mega:37
mega:38
mega:39
mega:40
mega:41
mega:42
mega:43
mega:44
mega:45
mega:46
mega:47
mega:48
mega:49
mega:50
mega:51
mega:52
mega:53
mega:GND.4
mega:GND.5
mega:IOREF
mega:RESET
mega:3.3V
mega:5V
mega:GND.2
mega:GND.3
mega:VIN
mega:A0
mega:A1
mega:A2
mega:A3
mega:A4
mega:A5
mega:A6
mega:A7
mega:A8
mega:A9
mega:A10
mega:A11
mega:A12
mega:A13
mega:A14
mega:A15
ultrasonic1:VCC
ultrasonic1:TRIG
ultrasonic1:ECHO
ultrasonic1:GND
led1:A
led1:C
r1:1
r1:2
led2:A
led2:C
led3:A
led3:C
r2:1
r2:2
r3:1
r3:2
led4:A
led4:C
led5:A
led5:C
led6:A
led6:C
led7:A
led7:C
r4:1
r4:2
r5:1
r5:2
r6:1
r6:2
r7:1
r7:2
led8:A
led8:C
led9:A
led9:C
r8:1
r8:2
r9:1
r9:2