Subversion Repositories svnkaklik

Rev

Rev 410 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log

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