Subversion Repositories svnkaklik

Rev

Rev 410 | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log

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