32控制舵机

2019-08-17 10:06发布

我用STM32控制8路舵机,可是程序里面出现了//#########
与舵机驱动板通讯发送数据帧格式
每帧长度 4
帧头        0XFF
第一个数据        舵机号
第二个数据        高电平时间        t x 0.01ms;        如 130 = 1.3ms
帧尾        0XFE

===================================================*/
static void SendServoAngle(int8_t *tx,u8 size)
{
        u8 i;
        for(i=0;i<size;i++)
        {
                while((USART1->SR&0X40)==0);//循环发送,直到发送完毕   
                        USART1->DR = (u8)tx[i];
        }
}


static void FrontServo(int8_t dir,int8_t adj)
{       
        switch(dir)
        {       
                case        ARM_ANGLE:                                                                                                                                        //发送的角度数据,给舵机0
                        AngleBuff[1] = 0;
                        AngleBuff[2] = SERVOCENTER+adj;
                        break;
                case        ARM_FOBA:
                        AngleBuff[1] = 1;                                                                                                                                //发送的手臂伸缩数据,给舵机1
                        AngleBuff[2] = SERVOCENTER+adj;
                        break;
        }
        SendServoAngle(AngleBuff,4);
}
这是什么意思呢



友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。