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 
}