         delay(20);
         servo_under2.write(i);
         delay(100);
+        servo_ud_now = servo_ud_fun(servo_ud_now);
+        servo_ud.write(servo_ud_now);
     }
     
     for(int i = 170;i >= 10;i--)

Servo servo_under2;
Servo servo_ud;


void setup()
{
    servo_under1.attach(9);
    servo_under2.attach(10);
    servo_ud.attach(11);


void loop()
{

    int servo_ud_now = 90;
    //*以角度控制
    for(int i = 10;i <= 170;i++)
    {
