Finished servo lib.

This commit is contained in:
Marvin Blum
2017-04-24 23:50:20 +02:00
parent 55261de66c
commit 9a62dff10f
4 changed files with 107 additions and 18 deletions

17
main.c
View File

@@ -5,7 +5,9 @@
#include "ard/util.h"
#include "servo/servo.h"
Servo servo = {7};
Servo servo1;
Servo servo2;
Servo servo3;
void prepare();
void loop();
@@ -21,9 +23,18 @@ int main(){
void prepare(){
pins_init();
serial_init(9600);
servo_init(&servo);
servo_init(7, &servo1);
servo_init(6, &servo2);
servo_init(8, &servo3);
}
void loop(){
servo_set(&servo1, 0);
servo_set(&servo2, 255);
servo_set(&servo3, 0);
_delay_ms(500);
servo_set(&servo1, 128);
servo_set(&servo2, 128);
servo_set(&servo3, 255);
_delay_ms(500);
}