You are on page 1of 1

#define F_CPU 12000000

#include<avr/io.h>
#include<util/delay.h>
#include "lib/motor/motor.h"

void sharp_left(){
PORTB=0b00001001;
_delay_ms(100);
}
void left(){
PORTB=0b00001001;
_delay_ms(60);
}
void sharp_right(){
PORTB=0b00000110;
_delay_ms(100);
}
void right(){
PORTB=0b00000110;
_delay_ms(60);
}
main(){
DDRB=0b11111111;
DDRC=0b00000000;
MotorInit();
while(1){
if((PINC&0b00001111)==0b00001111){
PORTB=0b00001010;
}
if((PINC&0b00001111)==0b00000011){
sharp_left();
}
if((PINC&0b00001111)==0b00001011){
left();
}
if((PINC&0b00001111)==0b00001100){
sharp_right();
}
if((PINC&0b00001111)==0b00000000){
right();
}
if((PINC&0b00001111)==0b00000000){
DDRB=0b00000000;
}
}
}

You might also like