Пример #1
0
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;
}
Пример #2
0
void reset_servo() {
	servo_3(150);
	servo_2(120);
	servo_1(30);
	_delay_ms(1000);
	servo_1_free();
	servo_2_free();
	servo_3_free();
}