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
}