那位大神给段c语言控制舵机从0~180持续来回转动的程序，不胜感激

180度舵机是一特殊的机器人专用舵机。你所说的0-180度，在专业玩家里不这样说的，而是说成±90度。即顺时针90度，逆时针90度。

你可以自己写一个的。这种舵机比较特殊，但是只要满足一下PWM就可以实现了：

1. 周期T=20ms（即50HZ），占空比500us-2500us。

2. 500us舵机逆时针转90度，2500us舵机顺时针转90读。 （其中0度是1500us）

3. 即： TL+TH=20ms 改变TH的值，舵机角度随之改变。参数参照以上1.2点。

TL TH

_____ ____

_________| |_________|| _________|

4. 电路原理很简单，接好电源，地，信号线。

信号线接到单片机或者其他能输出PWM的控制脚。

int readPin = 0 //用来连接电位器

int servopin = 7 //定义舵机接口数字接口7

void servopulse(int angle)//定义一个脉冲函数

{

int pulsewidth=(angle*11)+500 //将角度转化为500-2480的脉宽值

digitalWrite(servopin,HIGH) //将舵机接口电平至高

delayMicroseconds(pulsewidth) //延时脉宽值的微秒数

digitalWrite(servopin,LOW)//将舵机接口电平至低

delayMicroseconds(20000-pulsewidth)

}

voidsetup()

{

pinMode(servopin,OUTPUT)//设定舵机接口为输出接口

}

voidloop()

{

//读取电位器（传感器）的读数，接到3.3V，值范围从0到660左右

int readValue = analogRead(readPin)

//把值的范围映射到0到165左右

int angle = readValue / 4

//发送50个脉冲

for(int i=0i<50i++)

{

//引用脉冲函数

servopulse(angle)

}

}

给段伪代码吧

int main()

{

    初始化 src_angle_A, dst_angle_A

    初始化 src_angle_B, dst_angle_B

    初始化 src_angle_C, dst_angle_C

    初始化 src_angle_D, dst_angle_D

    int A_flag = 0

    int B_flag = 0

    int CD_flag = 0

    

    while (1)

    {

        if (key1_down())

        {

            if  (A_flag == 0)

            {

                set_angle_A(dst_angle_A)

            }

            else

            {

                set_angle_A(src_angle_A)

            }

            A_flag = 1-A_flag

        }

        

        if (key2_down())

        {

            if  (B_flag == 0)

            {

                set_angle_B(dst_angle_B)

            }

            else

            {

                set_angle_B(src_angle_B)

            }

            B_flag = 1-B_flag

        }

        

        if (key3_down())

        {

            if (CD_flag == 0)

            {

                set_angle_C(dst_angle_C)

                set_angle_D(dst_angle_D)

            }

            else

            {

                set_angle_C(src_angle_C)

                set_angle_D(src_angle_D)

            }

            CD_flag = 1-CD_flag

        }

        delay_ms(10)

    }

    return 0

}

---