Subversion Repositories svnkaklik

Rev

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
   while(true)
13
   {   
14
      While(input(SW)) 
15
      {
16
         output_high(servo1);
17
         Delay_us(1500);
18
         output_low(servo1);
19
 
20
         output_high(servo2);
21
         Delay_us(1500);
22
         output_low(servo2);
23
 
24
         output_high(servo3);
25
         Delay_us(1500);
26
         output_low(servo3); 
27
 
28
         output_high(servo4);
29
         Delay_us(1500);
30
         output_low(servo4);
31
 
32
         Delay_ms(10);
33
      }
34
 
35
      While(!input(SW))
36
      {
37
         for(i=0; i<100; ++i)
38
         {
39
            output_high(servo1);
40
            Delay_us(1000);
41
            output_low(servo1);
42
 
43
            output_high(servo2);
44
            Delay_us(1000);
45
            output_low(servo2);
46
 
47
            output_high(servo3);
48
            Delay_us(1000);
49
            output_low(servo3); 
50
 
51
            output_high(servo4);
52
            Delay_us(1000);
53
            output_low(servo4);
54
 
55
            Delay_ms(10);
56
         }
57
 
58
         for(i=0; i<100; ++i)
59
         {
60
            output_high(servo1);
61
            Delay_us(2000);
62
            output_low(servo1);
63
 
64
            output_high(servo2);
65
            Delay_us(2000);
66
            output_low(servo2);
67
 
68
            output_high(servo3);
69
            Delay_us(2000);
70
            output_low(servo3); 
71
 
72
            output_high(servo4);
73
            Delay_us(2000);
74
            output_low(servo4);
75
 
76
            Delay_ms(10);
77
         }           
78
      }
79
   }      
80
}