久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開始

搜索
查看: 3723|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

STM32電機(jī)閉環(huán)控制程序Orthogonal encoder

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:453328 發(fā)表于 2019-4-17 15:26 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
單片機(jī)源程序如下:
  1. #include "stm32f10x.h"

  3. //#include"delay.h"        //延時(shí)函數(shù)
  4. #include "usart.h"
  5. #include "pid.h"
  6. #include"pwm.h"
  7. #include "enc.h"
  8. #include "DataScope_DP.h"



  12. int pwm1,pwm2,pwm3; //PID計(jì)算后輸出的PWM占空比

  14. u8 flag=0;
  15. u16 Capture=0;
  16. u16 duty_TIM2=0;
  17. u8 RX_Command[1];

  19. extern PIDtypedef PID1,PID2,PID3;



  23. void USART_Configuration(void)
  24. {
  25.                 USART_InitTypeDef USART_InitStructure;
  26.                 GPIO_InitTypeDef GPIO_InitStructure;//定義結(jié)構(gòu)體
  27.                 NVIC_InitTypeDef NVIC_InitStructure;
  28.                 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOE | RCC_APB2Periph_AFIO, ENABLE); //使能A端口、端口復(fù)用時(shí)鐘

  30.                 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3; // PA.8        PA.8,作為捕獲輸入脈沖中斷的標(biāo)志，進(jìn)入中斷點(diǎn)亮LED燈
  31.                 GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;  //速度
  32.                 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽輸出
  33.                 GPIO_Init(GPIOA, &GPIO_InitStructure); //結(jié)構(gòu)體初始化
  34.         
  35.                 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_4; // PA.4  PA.4,作為定時(shí)器中斷的標(biāo)志，20ms定時(shí)，進(jìn)入中斷點(diǎn)亮LED燈
  36.                 GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;  //速度
  37.                 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽輸出
  38.                 GPIO_Init(GPIOA, &GPIO_InitStructure); //結(jié)構(gòu)體初始化
  39.                 GPIO_SetBits(GPIOA,GPIO_Pin_4);

  41.                 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9;          //USART1 TX
  42.             GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;    //復(fù)用推挽輸出
  43.             GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;  
  44.             GPIO_Init(GPIOA, &GPIO_InitStructure);      //A端口
  45.          
  46.             GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;          //USART1 RX
  47.             GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;   //復(fù)用浮空輸入
  48.             GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  49.             GPIO_Init(GPIOA, &GPIO_InitStructure);           //A端口

  51.                 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8 |GPIO_Pin_9 | GPIO_Pin_10 | GPIO_Pin_11
  52.                          | GPIO_Pin_12 | GPIO_Pin_13; // PE.8         控制電機(jī)正反轉(zhuǎn)
  53.                 GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;  //速度
  54.                 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //推挽輸出
  55.                 GPIO_Init(GPIOE, &GPIO_InitStructure); //結(jié)構(gòu)體初始化

  57.                 GPIO_SetBits(GPIOE,GPIO_Pin_8|GPIO_Pin_10 | GPIO_Pin_12); //置1
  58.                 GPIO_ResetBits(GPIOE,GPIO_Pin_9|GPIO_Pin_11 | GPIO_Pin_13);           //置0
  59.         
  60.                 RCC_APB2PeriphClockCmd(RCC_APB2Periph_USART1, ENABLE);        //使能時(shí)鐘
  61.             USART_InitStructure.USART_BaudRate = 115200;                                //波特率設(shè)為9600
  62.                 USART_InitStructure.USART_WordLength = USART_WordLength_8b;
  63.                 USART_InitStructure.USART_StopBits = USART_StopBits_1;
  64.                 USART_InitStructure.USART_Parity = USART_Parity_No;
  65.                 USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;
  66.                 USART_InitStructure.USART_Mode = USART_Mode_Tx | USART_Mode_Rx;
  67.                 USART_ITConfig(USART1, USART_IT_RXNE, ENABLE); // 開啟串口接收中斷
  68.                 USART_Init(USART1, &USART_InitStructure);
  69.                 USART_ITConfig(USART1, USART_IT_RXNE, ENABLE); // 開啟串口接收中斷
  70.                

  72.                 NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);        //設(shè)置優(yōu)先級(jí)分組為2

  74.                 NVIC_InitStructure.NVIC_IRQChannel=USART1_IRQn;        //USART1中斷
  75.                 NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //先占優(yōu)先級(jí)
  76.                 NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //從優(yōu)先級(jí)
  77.                 NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //使能
  78.                 NVIC_Init(&NVIC_InitStructure); //初始化

  80.                 USART_Cmd(USART1,ENABLE);

  82. }





  88. void PIDperiodinit(u16 arr,u16 psc)
  89. {
  90.          TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  91.         NVIC_InitTypeDef NVIC_InitStructure;

  93.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM6, ENABLE); //時(shí)鐘使能
  94.         
  95.         //定時(shí)器TIM6初始化
  96.         TIM_TimeBaseStructure.TIM_Period = arr; //設(shè)置在下一個(gè)更新事件裝入活動(dòng)的自動(dòng)重裝載寄存器周期的值        
  97.         TIM_TimeBaseStructure.TIM_Prescaler =psc; //設(shè)置用來(lái)作為TIMx時(shí)鐘頻率除數(shù)的預(yù)分頻值
  98.         TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; //設(shè)置時(shí)鐘分割:TDTS = Tck_tim
  99.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上計(jì)數(shù)模式
  100.         TIM_TimeBaseInit(TIM6, &TIM_TimeBaseStructure); //根據(jù)指定的參數(shù)初始化TIMx的時(shí)間基數(shù)單位
  101.         TIM_ClearITPendingBit(TIM6, TIM_IT_Update); //清除中斷標(biāo)志位

  103.         TIM_ITConfig(TIM6,TIM_IT_Update,ENABLE ); //使能指定的TIM6中斷,允許更新中斷

  105.         //中斷優(yōu)先級(jí)NVIC設(shè)置
  106.         NVIC_InitStructure.NVIC_IRQChannel = TIM6_IRQn;  //TIM6中斷
  107.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;  //先占優(yōu)先級(jí)1級(jí)
  108.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;  //從優(yōu)先級(jí)1級(jí)
  109.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
  110.         NVIC_Init(&NVIC_InitStructure);  //初始化NVIC寄存器


  113.         TIM_Cmd(TIM6, ENABLE);  //放在主程序中使能


  116. }
  117.         int curcount2=0;
  118.         int curcount1=0;

  120. int main(void)
  121. {
  122.         

  124.                 int i=0;
  125.                 int j=0;
  126.                 int t[20]={0,10,20,30,40,50,60,70,80,90,100,110,120,130,140,150,160,170,180,190};
  127.                 int n[20]={0};
  128.                 u8 jishu=0;
  129.                 int pwm=0;
  130.                 int sum=0;
  131.                 int N1_avr=0;
  132.                 int curcount3=0;
  133.                 int N1=0;
  134.                 int N2=0;
  135.                 int N3=0;
  136.          
  137.                 USART_Configuration();
  138.                 ENC_Init_TIM2(); // 1號(hào)電機(jī)
  139.                 TIM3_PWM_configure(1000-1,0); //PWM輸出，1000HZ
  140. //                ENC_Init_TIM4(); // 2號(hào)電機(jī)
  141. //                ENC_Init_TIM5();  // 3號(hào)電機(jī)
  142.                
  143. //                incPIDinit();                                                //初始化，將PID參數(shù)置0
  144. //                PID_setpoint(&PID1,50);                //設(shè)定1號(hào)電機(jī)轉(zhuǎn)速
  145. //                PID_setpoint(&PID2,50);                //設(shè)定2號(hào)電機(jī)轉(zhuǎn)速
  146. //                PID_setpoint(&PID3,50);                //設(shè)定3號(hào)電機(jī)轉(zhuǎn)速
  147. //                set_speed(80);
  148. //                PID_set(&PID1,5,0,0);                //設(shè)定1號(hào)電機(jī)PID參數(shù)
  149. //                PID_set(&PID2,2,0.5,0);                //設(shè)定2號(hào)電機(jī)PID參數(shù)
  150. //                PID_set(&PID3,2,0.5,0);                //設(shè)定3號(hào)電機(jī)PID參數(shù)
  151.                 PIDperiodinit(2000-1,720-1);        //PID 采樣定時(shí)器設(shè)定，采樣周期20ms        

  153.                 while(1)
  154.                 {
  155.                          if(flag==1)
  156.                                 {
  157.                                        
  158.                                         curcount1=TIM2->CNT-32768;        
  159.                                          TIM2->CNT=32768;
  160.                                         jishu++;



  164. //                                        curcount2=TIM4->CNT-32768;        
  165. //                                         TIM4->CNT=32768;
  166. //
  167. //                                        curcount3=TIM5->CNT-32768;        
  168. //                                         TIM5->CNT=32768;
  169. //
  170.                                     N1=15*(curcount1)/44; // N=125*curcount/188;  N=125*curcount/1792;
  171.                                         Data_Send_speed(curcount1,N1);


  174. //                                        sum=sum+N1;
  175. //                                        Data_Send_speed(t,N1);
  176. //                                        printf("%d\n", sum);
  177. //                                        if(jishu==10)
  178. //                                        {
  179. //                                                if(pwm>1000) { pwm=0; }
  180. //                                                N1_avr=sum/10;
  181. //                                                sum=0;
  182. //                                                jishu=0;
  183. //                                       
  184. //                                                Data_Send_speed(pwm,N1_avr);        
  185. //                                                pwm=pwm+30;
  186. //                                                TIM_SetCompare1(TIM3,pwm);
  187. ////                                                printf("%d\n", N1_avr);
  188. //
  189. //                                        }

  191.                                     flag=0;
  192.         
  193.                                 }
  194.                 }

  196. }


  199. void TIM6_IRQHandler(void)        //        采樣時(shí)間到，中斷處理函數(shù)
  200. {         
  201.         
  202. if (TIM_GetITStatus(TIM6, TIM_IT_Update) != RESET)//更新中斷
  203.     {
  204.                 TIM_ClearITPendingBit(TIM6, TIM_IT_Update); //清除中斷標(biāo)志位
  205. //                GPIO_WriteBit(GPIOA,GPIO_Pin_4,(BitAction)(1-GPIO_ReadOutputDataBit(GPIOA,GPIO_Pin_4)));
  206.                 flag=1;

  208.         }
  209. }

  211. void USART1_IRQHandler(void)
  212. {

  214.         if(USART_GetITStatus(USART1,USART_IT_RXNE)!=RESET) //判斷是否來(lái)中斷
  215.         {
  216.                 USART_ClearITPendingBit(USART1,USART_IT_RXNE); //清除中斷標(biāo)志位
  217.                 RX_Command[0]=(USART_ReceiveData(USART1));

  219.                 if(RX_Command[0]==0x0)
  220.                 {
  221.                         AIN1=0;
  222.                         AIN2=0;
  223.                         BIN1=0;
  224.                         BIN2=0;
  225.                         CIN1=0;
  226.                         CIN2=0;
  227.                 }

  229.                 if(RX_Command[0]==0x01)
  230.                 {
  231.                         AIN1=1;
  232.                         AIN2=0;
  233.                         BIN1=1;
  234.                         BIN2=0;
  235.                         CIN1=1;
  236.                         CIN2=0;        
  237.                 }

  239.                 if(RX_Command[0]==0x02)
  240.                 {
  241.                         AIN1=0;
  242.                         AIN2=1;
  243.                         BIN1=0;
  244.                         BIN2=1;
  245.                         CIN1=0;
  246.                         CIN2=1;
  247.                 }
  248.                  if((RX_Command[0] > 0x32) && (RX_Command[0] < 0x64)) //判斷發(fā)送數(shù)據(jù)是否在0x32~0x64之間
  249.                 {        
  250.                         u16 val;
  251.                         val=10*((RX_Command[0]) & (0x00FF));                         //根據(jù)發(fā)送數(shù)據(jù)，計(jì)算占空比的實(shí)際值
  252.                         TIM_SetCompare1(TIM3,val);
  253.                         TIM_SetCompare2(TIM3,val);
  254.                         TIM_SetCompare3(TIM3,val);                                                 //設(shè)置占空比
  255. //                        USART_SendData(USART1,RX_Command[0]);
  256.                         
  257.                 }

  259.         }

  261. }
復(fù)制代碼

所有資料51hei提供下載:
Orthogonal encoder.7z (194.08 KB, 下載次數(shù): 29)


分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

沙發(fā)
ID:1 發(fā)表于 2019-4-17 17:59 | 只看該作者
本帖需要重新編輯補(bǔ)全電路原理圖,源碼,詳細(xì)說(shuō)明與圖片即可獲得100+黑幣(帖子下方有編輯按鈕)
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 精品国产一二三区 | 91蝌蚪少妇偷拍 | 国产精品久久久久久久久久久久午夜片 | 日韩亚洲欧美在线观看 | av网站免费在线观看 | 国产精品久久久久久久久久久久午夜片 | 国产精品天堂 | 成人毛片一区二区三区 | jlzzzjlzzz国产免费观看 | 丨国产丨调教丨91丨 | 国产在线天堂 | 国产伦精品一区二区三区88av | 国产黄色免费网站 | 久久精品在线视频 | 福利视频午夜 | av免费网站 | av福利网站| 国产一级免费视频 | 欧美视频在线播放 | 91精品久久久久久久久 | 日韩午夜精品 | 色婷婷中文字幕 | 久婷婷 | 97久久久久 | 午夜视频在线播放 | 欧美国产一区二区 | 国产一区二区中文字幕 | 少妇高潮毛片 | 老女人毛片 | 一级做a爱片性色毛片 | 欧美一级特黄视频 | 黄色一级大片在线免费看产 | 69福利视频 | 亚洲看片 | 成人免费网站在线观看 | jlzzjlzz欧美大全| 日韩精品久久久久久久酒店 | 亚洲视频不卡 | 成年人网站在线免费观看 | 特级丰满少妇一级aaaa爱毛片 | 免费理论片 |