Subversion Repositories svnkaklik

Rev

Rev 6 | Blame | Last modification | View Log | Download

#include "D:\@Kaklik\programy\PIC_C\mereni\serva\main.h"
#DEFINE servo1 PIN_A4
#DEFINE servo2 PIN_A3
#DEFINE servo3 PIN_A2
#DEFINE servo4 PIN_A0
#DEFINE SW     PIN_A1

void main()
{
int i;


   while(true)
   {   
      While(input(SW)) 
      {
         output_high(servo1);
         Delay_us(1500);
         output_low(servo1);
         
         output_high(servo2);
         Delay_us(1500);
         output_low(servo2);
         
         output_high(servo3);
         Delay_us(1500);
         output_low(servo3); 
         
         output_high(servo4);
         Delay_us(1500);
         output_low(servo4);
         
         Delay_ms(10);
      }
      
      While(!input(SW))
      {
         for(i=0; i<100; ++i)
         {
            output_high(servo1);
            Delay_us(1000);
            output_low(servo1);
            
            output_high(servo2);
            Delay_us(1000);
            output_low(servo2);
            
            output_high(servo3);
            Delay_us(1000);
            output_low(servo3); 
            
            output_high(servo4);
            Delay_us(1000);
            output_low(servo4);
            
            Delay_ms(10);
         }
         
         for(i=0; i<100; ++i)
         {
            output_high(servo1);
            Delay_us(2000);
            output_low(servo1);
            
            output_high(servo2);
            Delay_us(2000);
            output_low(servo2);
            
            output_high(servo3);
            Delay_us(2000);
            output_low(servo3); 
            
            output_high(servo4);
            Delay_us(2000);
            output_low(servo4);
            
            Delay_ms(10);
         }           
      }
   }      
}