while(1)
	{ 
	
	switch(servo_index)
	{
	case 0:act_servo_pin=PB0;act_servo_port = PORTB;next_servo_port = PORTB;next_servo_pin=PB1;break;
	case 1:act_servo_pin=PB1;act_servo_port = PORTB;next_servo_port = PORTB;next_servo_pin=PB6;break;
	..........................
	..........................
	}
	
	next_servo_port |= (1<<next_servo_pin);

	while(index < 255)
		{
		...
		}

	}