     return servo_ud_now;
 }
 
+int servo_fun(int servo_now, int servo_max, int servo_min, bool *servo_flag)
+{
+    if(servo_now == servo_max)
+        *servo_flag = 1;
+    if(servo_now == servo_min)
+        *servo_flag = 0;
+
+    if(*servo_flag)
+    {
+        servo_now -= 1;
+    }
+    else
+    {
+        servo_now += 1;
+    }
+    return servo_now;
+}
+
 void setup()
 {
     Serial.begin(9600);

bool servo_ud_flag = 0;
int servo_ud_max = 90, servo_ud_min = 10;
int servo_ud_now = 90;

int servo_ud_fun(int servo_ud_now)
{


void loop()
{
    servo_under1_now = servo_fun(servo_under1_now, servo_under_max, servo_under_min, &servo_under1_flag);
    servo_under1.write(servo_under1_now);

    servo_under2_now = servo_fun(servo_under2_now, servo_under_max, servo_under_min, &servo_under2_flag);
    servo_under2.write(servo_under2_now);

    servo_ud_now = servo_ud_fun(servo_ud_now);
    servo_ud.write(servo_ud_now);
}
