void reset_servo() { servo_3(150); servo_2(120); servo_1(30); _delay_ms(1000); servo_1_free(); servo_2_free(); servo_3_free(); }
void open(unsigned char side) { if (side == 0) for(i=40;i>0;i--) { servo_3(i); _delay_ms(10); } else if (side == 1) for(i=60;i>0;i--) { servo_1(i); _delay_ms(10); } if(side==0) servo_3_free(); else servo_1_free(); }