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\PIC16F88\tester.h"
2 
 
3 
#DEFINE servo1 PIN_A4
4 
#DEFINE servo2 PIN_A3
5 
#DEFINE servo3 PIN_A2
6 
#DEFINE servo4 PIN_A0
7 
#DEFINE SW     PIN_A1
8 
 
9 
void main()
10 
{
11 
int i;
12 
 
13 
   setup_adc_ports(NO_ANALOGS|VSS_VDD);
14 
   setup_adc(ADC_OFF);
15 
   setup_spi(FALSE);
16 
   setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
17 
   setup_timer_1(T1_DISABLED);
18 
   setup_timer_2(T2_DISABLED,0,1);
19 
   setup_comparator(NC_NC_NC_NC);
20 
   setup_vref(FALSE);
21 
 
22 
 
23 
 
24 
   while(true)
25 
   {
26 
      While(input(SW))
27 
      {
28 
         output_high(servo1);
29 
         Delay_us(1500);
30 
         output_low(servo1);
31 
 
32 
         output_high(servo2);
33 
         Delay_us(1500);
34 
         output_low(servo2);
35 
 
36 
         output_high(servo3);
37 
         Delay_us(1500);
38 
         output_low(servo3);
39 
 
40 
         output_high(servo4);
41 
         Delay_us(1500);
42 
         output_low(servo4);
43 
 
44 
         Delay_ms(10);
45 
      }
46 
 
47 
      While(!input(SW))
48 
      {
49 
         for(i=0; i<100; ++i)
50 
         {
51 
            output_high(servo1);
52 
            Delay_us(1000);
53 
            output_low(servo1);
54 
 
55 
            output_high(servo2);
56 
            Delay_us(1000);
57 
            output_low(servo2);
58 
 
59 
            output_high(servo3);
60 
            Delay_us(1000);
61 
            output_low(servo3);
62 
 
63 
            output_high(servo4);
64 
            Delay_us(1000);
65 
            output_low(servo4);
66 
 
67 
            Delay_ms(10);
68 
         }
69 
 
70 
         for(i=0; i<100; ++i)
71 
         {
72 
            output_high(servo1);
73 
            Delay_us(2000);
74 
            output_low(servo1);
75 
 
76 
            output_high(servo2);
77 
            Delay_us(2000);
78 
            output_low(servo2);
79 
 
80 
            output_high(servo3);
81 
            Delay_us(2000);
82 
            output_low(servo3);
83 
 
84 
            output_high(servo4);
85 
            Delay_us(2000);
86 
            output_low(servo4);
87 
 
88 
            Delay_ms(10);
89 
         }
90 
      }
91 
   }
92 
 
93 
}