Subversion Repositories svnkaklik

Rev

Rev 624 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log

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