标题: 我的stm32串口控制舵机程序 [打印本页]

作者: wangyuyu    时间: 2018-9-16 15:37
标题: 我的stm32串口控制舵机程序
上位机通过串口给单片机发送角度,使得它控制舵机转对应的角度
若角度发送不正确,返回error提示信息
此程序可以用来检测舵机是否工作正常

单片机源程序如下:
  1. #include "stm32f10x.h"
  2. #include "pwm.h"
  3. #include "delay.h"
  4. #include "follower.h"

  5. unsigned char Dat_R[50];
  6. char error[] = "error";
  7. char i2 = 0;//Dat_R[]的数组下标
  8. u8 Transmit_flag_2=0;//串口2接受标志位

  9. int main(void)
  10. {
  11.         u16 pwm_value = 0;//45~215对应0~180度
  12.         u8 i = 0;
  13.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
  14.         my_FOLLOWER_Init(115200);
  15.         my_PWM_Init(1800,799);//20ms
  16.         delay_init();
  17.   TIM_SetCompare1(TIM3, 135);//初始化舵机角度为90度
  18.         while(1)
  19.         {
  20.                 USART_GetFlagStatus(USART1,USART_FLAG_TC);
  21.                 USART_GetFlagStatus(USART2,USART_FLAG_TC);
  22.                
  23.                 if(Transmit_flag_2)
  24.                 {
  25.                         i = 0;
  26.                        
  27.                         if(i2 <= 5)
  28.                         {
  29.                                 while(Dat_R[i] != '\r')
  30.                                 {
  31.                                         pwm_value = pwm_value*10 + (Dat_R[i]-'0');
  32.                                         i++;
  33.                                 }

  34.                                 if(pwm_value<=180)
  35.                                 {
  36.                                         TIM_SetCompare1(TIM3, pwm_value+45);
  37.                                         USART_SendData(USART1, 'O');
  38.                                         while(USART_GetFlagStatus(USART1,USART_FLAG_TC) == RESET);
  39.                                         USART_SendData(USART1, 'K');
  40.                                         while(USART_GetFlagStatus(USART1,USART_FLAG_TC) == RESET);
  41.                                 }
  42.                                 else
  43.                                 {
  44.                                         for(i = 0; i < 5; i++)
  45.                                         {
  46.                                                 USART_SendData(USART1, error[i]);
  47.                                                 while(USART_GetFlagStatus(USART1,USART_FLAG_TC) == RESET);
  48.                                         }
  49.                                 }
  50.                         }
  51.                         else
  52.                         {
  53.                                 for(i = 0; i < 5; i++)
  54.                                 {
  55.                                         USART_SendData(USART1, error[i]);
  56.                                         while(USART_GetFlagStatus(USART1,USART_FLAG_TC) == RESET);
  57.                                 }
  58.                         }
  59.                        
  60.                        
  61.                         for(i = 0; i < i2; i++)
  62.                         {
  63.                                 Dat_R[i] = 0;
  64.                         }
  65.                         i = 0;
  66.                         pwm_value = 0;
  67.                         i2 = 0;
  68.                         Transmit_flag_2 = 0;
  69.                 }
  70.                
  71.         }
  72. }
复制代码

所有资料51hei提供下载:
串口控制舵机.zip (300.91 KB, 下载次数: 128)



作者: bbcben    时间: 2019-7-5 19:37
写的不行
作者: aYUAB    时间: 2019-8-6 20:55
无法用串口对角度进行改变啊




欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1