Subversion Repositories svnkaklik

Rev

Go to most recent revision | Details | Last modification | View Log

Rev Author Line No. Line
6 kaklik 1
#include "D:\@Kaklik\programy\PIC_C\mereni\serva\main.h"
2
#DEFINE servo1 PIN_A4
3
#DEFINE servo2 PIN_A3
4
#DEFINE servo3 PIN_A2
5
#DEFINE servo4 PIN_A0
6
#DEFINE SW     PIN_A1
7
 
8
void main()
9
{
10
int i;
11
 
12
 
13
   while(true)
14
   {   
15
      While(input(SW)) 
16
      {
17
         output_high(servo1);
18
         Delay_us(1500);
19
         output_low(servo1);
20
 
21
         output_high(servo2);
22
         Delay_us(1500);
23
         output_low(servo2);
24
 
25
         output_high(servo3);
26
         Delay_us(1500);
27
         output_low(servo3); 
28
 
29
         output_high(servo4);
30
         Delay_us(1500);
31
         output_low(servo4);
32
 
33
         Delay_ms(10);
34
      }
35
 
36
      While(!input(SW))
37
      {
38
         for(i=0; i<100; ++i)
39
         {
40
            output_high(servo1);
41
            Delay_us(1000);
42
            output_low(servo1);
43
 
44
            output_high(servo2);
45
            Delay_us(1000);
46
            output_low(servo2);
47
 
48
            output_high(servo3);
49
            Delay_us(1000);
50
            output_low(servo3); 
51
 
52
            output_high(servo4);
53
            Delay_us(1000);
54
            output_low(servo4);
55
 
56
            Delay_ms(10);
57
         }
58
 
59
         for(i=0; i<100; ++i)
60
         {
61
            output_high(servo1);
62
            Delay_us(2000);
63
            output_low(servo1);
64
 
65
            output_high(servo2);
66
            Delay_us(2000);
67
            output_low(servo2);
68
 
69
            output_high(servo3);
70
            Delay_us(2000);
71
            output_low(servo3); 
72
 
73
            output_high(servo4);
74
            Delay_us(2000);
75
            output_low(servo4);
76
 
77
            Delay_ms(10);
78
         }           
79
      }
80
   }      
81
}