標(biāo)題: 我的stm32串口控制舵機(jī)程序 [打印本頁]
作者: wangyuyu    時(shí)間: 2018-9-16 15:37
標(biāo)題: 我的stm32串口控制舵機(jī)程序
上位機(jī)通過串口給單片機(jī)發(fā)送角度，使得它控制舵機(jī)轉(zhuǎn)對(duì)應(yīng)的角度
若角度發(fā)送不正確，返回error提示信息
此程序可以用來檢測(cè)舵機(jī)是否工作正常

單片機(jī)源程序如下:
  1. #include "stm32f10x.h"
  2. #include "pwm.h"
  3. #include "delay.h"
  4. #include "follower.h"

  6. unsigned char Dat_R[50];
  7. char error[] = "error";
  8. char i2 = 0;//Dat_R[]的數(shù)組下標(biāo)
  9. u8 Transmit_flag_2=0;//串口2接受標(biāo)志位

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

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

所有資料51hei提供下載:
串口控制舵機(jī).zip (300.91 KB, 下載次數(shù): 128)


作者: bbcben    時(shí)間: 2019-7-5 19:37
寫的不行
作者: aYUAB    時(shí)間: 2019-8-6 20:55
無法用串口對(duì)角度進(jìn)行改變啊



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1