33 lines
487 B
C
33 lines
487 B
C
|
#include <avr/io.h>
|
||
|
|
#include <util/delay.h>
|
||
|
|
#include "main.h"
|
||
|
|
#include "io.h"
|
||
|
|
|
||
|
|
#define LED_DELAY 100
|
||
|
|
|
||
|
|
void blinkLed(void)
|
||
|
|
{
|
||
|
|
DDRD |= (1 << LED_1);
|
||
|
|
while (1) {
|
||
|
|
PORTD |= (1 << LED_1);
|
||
|
|
_delay_ms(LED_DELAY);
|
||
|
|
PORTD &= ~(1 << LED_1);
|
||
|
|
_delay_ms(LED_DELAY);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void runServos(void)
|
||
|
|
{
|
||
|
|
DDRD |= (1 << SERVO_L) | (1 << SERVO_R);
|
||
|
|
while (1) {
|
||
|
|
PORTD |= (1 << SERVO_L) | (1 << SERVO_R);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int main()
|
||
|
|
{
|
||
|
|
blinkLed();
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|