Subversion Repositories svnkaklik

Rev

Rev 625 | Blame | Compare with Previous | Last modification | View Log | Download

#include "blikac.h"
#DEFINE  SERVO_X        PIN_A2      // piny na ktere jsou pripojena serva
#DEFINE  SERVO_Y        PIN_B0
#DEFINE  TL1        PIN_B1

void main()
{
   int i;
   while (true)
   {
     while(input(TL1))
     {
       for(i=0;i<=100;i++)
       {
        output_high(servo_y);
        output_high(servo_x);
        delay_us(1000);
        output_low(servo_y);
        output_low(servo_x);
        delay_ms(20);
       }

       for(i=0;i<=100;i++)
       {
        output_high(servo_y);
        output_high(servo_x);
        delay_us(2000);
        output_low(servo_y);
        output_low(servo_x);
        delay_ms(20);
       }
     }
     output_high(servo_y);
     output_high(servo_x);
     delay_us(1500);
     output_low(servo_y);
     output_low(servo_x);
     delay_ms(20);
   }
}