Subversion Repositories svnkaklik

Rev

Details | Last modification | View Log

Rev Author Line No. Line
624 kaklik 1
#include "blikac.h"
6 kaklik 2
#DEFINE  SERVO_X        PIN_A2      // piny na ktere jsou pripojena serva
3
#DEFINE  SERVO_Y        PIN_B0
4
#DEFINE  TL1        PIN_B1
5
 
6
void main()
7
{
8
   int i;
9
   while (true)
10
   {
11
     while(input(TL1))
12
     {
13
       for(i=0;i<=100;i++)
14
       {
15
        output_high(servo_y);
16
        output_high(servo_x);
17
        delay_us(1000);
18
        output_low(servo_y);
19
        output_low(servo_x);
20
        delay_ms(20);
21
       }
22
 
23
       for(i=0;i<=100;i++)
24
       {
25
        output_high(servo_y);
26
        output_high(servo_x);
27
        delay_us(2000);
28
        output_low(servo_y);
29
        output_low(servo_x);
30
        delay_ms(20);
31
       }
32
     }
33
     output_high(servo_y);
34
     output_high(servo_x);
35
     delay_us(1500);
36
     output_low(servo_y);
37
     output_low(servo_x);
38
     delay_ms(20);
39
   }
40
}