Subversion Repositories svnkaklik

Rev

Rev 410 | Details | Compare with Previous | 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 
}