| /programy/C/PIC_C/mereni/tester serv/blikac.c |
|---|
| 0,0 → 1,40 |
| #include "D:\@Kaklik\programy\PIC_C\prenos\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); |
| } |
| } |