void elevate() { servo_2(90); cur_angle=90; _delay_ms(1000); servo_2_free(); //return; // if(cur_angle==60) // { // for(i=60;i<=90;i++) // { // servo_2(i); // _delay_ms(10); // } // } // else // { // for(i=120;i>=90;i--) // { // servo_2(i); // _delay_ms(10); // } // } // cur_angle=90; }
void reset_servo() { servo_3(150); servo_2(120); servo_1(30); _delay_ms(1000); servo_1_free(); servo_2_free(); servo_3_free(); }