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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

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

風(fēng)力擺的程序設(shè)計+匿名四軸上位機(jī)(15年國賽)對練習(xí)PID算法很有幫助

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:227103 發(fā)表于 2017-8-11 22:20 | 只看該作者 |只看大圖 回帖獎勵 |倒序瀏覽 |閱讀模式
PID算法的極好學(xué)習(xí)資料，匿名四軸資料


stm32單片機(jī)風(fēng)力擺源程序如下:
  1. #include "sys.h"
  2. #include "delay.h"
  3. #include "usart.h"
  4. #include "led.h"
  5. #include "key.h"  
  6. #include "mpu6050.h"
  7. #include "pwmset.h"
  8. #include "niming.h"
  9. #include "pid.h"
  10. #include "usmart.h"   
  11. #include "inv_mpu.h"
  12. #include "inv_mpu_dmp_motion_driver.h"

  14. volatile float pitch,roll,yaw;                 //歐拉角
  15. volatile u8 mode = 1;                                                        //當(dāng)前工作方式
  16. volatile float step = 0;

  18. int main(void)
  19. {               
  20.          Stm32_Clock_Init(9);                //系統(tǒng)時鐘設(shè)置
  21.         uart_init(72,500000);                //串口初始化為500000
  22.         delay_init(72);                                    //延時初始化
  23.         usmart_dev.init(72);                //初始化USMART
  24.         LED_Init();                                                  //初始化與LED連接的硬件接口
  25.         KEY_Init();                                                        //初始化按鍵
  26.         MPU_Init();                                                        //初始化MPU6050
  27.         TIM3_PWM_Init(999,8);          //初始化脈寬波輸出        
  28.         TIM2_Int_Init(4999,71);        //初始化定時器2，每5ms產(chǎn)生一次中斷


  31.         while(mpu_dmp_init())
  32.         {
  33.                 delay_ms(20);        
  34.         }               

  36.          while(1)
  37.         {               
  38.                 key=KEY_Scan(0);
  39.                 if(key==KEY2_PRES)                                                //測試發(fā)送pid數(shù)據(jù)給上位機(jī)
  40.                 {
  41.                         pid_send_data(rol_p,rol_i,rol_d,pit_p,pit_i,pit_d);
  42.                 }
  43.                
  44.                 if(key==KEY0_PRES)                                                //開啟或關(guān)閉下位機(jī)數(shù)據(jù)發(fā)送開關(guān)
  45.                 {
  46.                         report=!report;
  47.                 }        

  49.                 if(key==KEY1_PRES)                                                //開啟或關(guān)閉下位機(jī)數(shù)據(jù)發(fā)送開關(guān)
  50.                 {
  51.                         Rol_SumError = 0;
  52.                 }               

  54.                 if(key == KEY8_PRES)                                        //PE8按下
  55.                 {
  56.                         rol_p += 1;
  57.                         LED0 = ~LED0;
  58.                 }
  59.                 if(key == KEY9_PRES)
  60.                 {
  61.                         rol_i += 0.1;
  62.                         LED0 = ~LED0;
  63.                 }
  64.                 if(key == KEY10_PRES)
  65.                 {
  66.                         R += 0.05;
  67.                         LED0 = ~LED0;
  68.                 }
  69.                 if(key == KEY11_PRES)                                        //模式切換
  70.                 {
  71.                         mode++;
  72.                         LED0 = ~LED0;
  73.                 }

  75.                 if(key == KEY12_PRES)
  76.                 {
  77.                         rol_p -= 1;
  78.                         LED0 = ~LED0;
  79.                 }
  80.                 if(key == KEY13_PRES)
  81.                 {
  82.                         rol_i -= 0.1;
  83.                         LED0 = ~LED0;
  84.                 }
  85.                 if(key == KEY14_PRES)
  86.                 {
  87.                         R -= 0.05;
  88.                         LED0 = ~LED0;
  89.                 }
  90.                 if(key == KEY15_PRES)
  91.                 {
  92.                         mode--;                                                                                        //模式切換
  93.                         LED0 = ~LED0;
  94.                 }
  95.                
  96.                 if(USART_RX_STA == 1)                                        //檢測是否接收到了數(shù)據(jù)。
  97.                 {
  98.                         USART_RX_STA = 0;                                                //清除接收標(biāo)志，防止多次判斷。
  99.                         LED1 = ~LED1;
  100.                         rol_p = (USART_RX_BUF[4]<<8)|USART_RX_BUF[5];
  101.                         rol_i = (USART_RX_BUF[6]<<8)|USART_RX_BUF[7];
  102.                         rol_d = (USART_RX_BUF[8]<<8)|USART_RX_BUF[9];
  103.                         pit_p = (USART_RX_BUF[10]<<8)|USART_RX_BUF[11];
  104.                         pit_i = (USART_RX_BUF[12]<<8)|USART_RX_BUF[13];
  105.                         pit_d = (USART_RX_BUF[14]<<8)|USART_RX_BUF[15];                                       
  106.                 }        
  107.                         
  108.         }         
  109. }

復(fù)制代碼

所有資料51hei提供下載:
15電賽風(fēng)力擺源碼及上位機(jī).rar (3.81 MB, 下載次數(shù): 144)


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

使用道具 舉報

沙發(fā)
ID:594095 發(fā)表于 2019-8-2 13:48 | 只看該作者
謝謝分享
回復(fù)

使用道具 舉報

板凳
ID:594095 發(fā)表于 2019-8-2 13:49 | 只看該作者
謝謝分享
回復(fù)

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 美女久久视频 | 噜久寡妇噜噜久久寡妇 | 国产亚洲网站 | 久久国产综合 | 97av在线| 亚洲一区视频 | 国产精品二区三区 | 夜夜骚 | 亚洲高清av在线 | 三级成人在线 | 国产片网站 | 国产一区在线视频 | 欧美在线视频一区二区 | 国产精品欧美一区二区 | 一区二区三区四区在线视频 | 中文二区 | 免费看国产片在线观看 | 欧美在线视频a | 国产一区二区成人 | 91视频电影 | 天天干天天爽 | 国产区精品| 国产一区二区三区久久久久久久久 | 九色视频网站 | 你懂的在线视频播放 | 九九热这里 | 精品国产一区二区三区免费 | 久久久久久国产精品 | wwwxxx日本在线观看 | 一级片av| 91在线精品秘密一区二区 | 成人在线网址 | 99在线精品视频 | 久久欧美精品 | 国产福利在线看 | 中文字幕在线第一页 | 日韩av一区二区在线观看 | 亚洲视频一 | 就操在线 | 欧美性受xxx | 99re国产视频 |