 		m[i] = m[i]<motor_pwm[1]?motor_pwm[1]:m[i];
 		myservo[i].writeMicroseconds(m[i]);
 	}
-
 }
 
 int check_init() {

		case 4:
			if (gyroCal()==0) 
				status = 5;
			p_millis = millis();
			break;

		case 5:

byte packet[4];

int yprt[4] = {0,0,0,0};

void motor_idle() {
	for (int i=0;i<4;i++)
