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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

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

風(fēng)力擺STM32源碼 帶PID卡爾曼濾波四元素算法

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:219086 發(fā)表于 2017-7-30 22:41 | 只看該作者 |只看大圖 回帖獎勵 |倒序瀏覽 |閱讀模式
風(fēng)力擺源碼
內(nèi)帶PID算法
卡爾曼濾波
四元素算法


單片機源程序如下:
  1. /*-------------------------------------------------------------------------------------------
  2.                                                    風(fēng)力擺控制系統(tǒng)(2015-8-12)

  4. 硬件平臺:
  5.                          主控器: STM32F103VET6 64K RAM 512K ROM
  6.                         驅(qū)動器: LMD18200T
  7.                     電源:   DC +12V

  9. 軟件平臺:
  10.                          開發(fā)環(huán)境: RealView MDK-ARM uVision4.10
  11.                         C編譯器 : ARMCC
  12.                         ASM編譯器:ARMASM
  13.                         連接器:   ARMLINK
  14.                         底層驅(qū)動: 各個外設(shè)驅(qū)動程序      

  16. 時間: 2015年8月12日      

  18. 作者: BoX
  19. -------------------------------------------------------------------------------------------*/   
  20. #include "stm32f10x.h"
  21. #include "usart1.h"                                         
  22. #include "delay.h"
  23. #include "led.h"
  24. #include "timer.h"
  25. #include "motor_control.h"
  26. #include "motor_pwm.h"
  27. #include "motor_pid.h"
  28. #include "stdlib.h"
  29. #include "indkey.h"
  30. #include "mpu6050.h"
  31. #include "ahrs.h"
  32. #include "math.h"
  33. #include "usart2.h"
  34. /*------------------------------------------
  35.                                  全局變量                                
  36. ------------------------------------------*/
  37. extern uint8_t Q1_Start;
  38. extern uint8_t Q2_Start;
  39. extern uint8_t Q3_Start;
  40. extern uint8_t Q4_Start;
  41. extern uint8_t Q5_Start;
  42. extern uint8_t Q6_Start;
  43. extern uint8_t CurMode;
  44. /*-----------------------------------------
  45.                             初始化外設(shè)
  46. ------------------------------------------*/
  47. void BSP_Init(void)
  48. {
  49.         DelayInit();
  50.         LED_GPIO_Config();
  51.         Key_IO_Init();        
  52.         PID_M1_Init();
  53.         PID_M2_Init();
  54.         M1TypeDef_Init();
  55.         M2TypeDef_Init();        
  56.         PWM_Init();
  57.         TIM1_Config(10000-1,71);  /* TIM1 10ms Inturrupt  */
  58.         TIM5_Config(5000-1,71);   /* TIM5 5ms Inturrupt 采樣率200Hz 不能更改*/
  59.         USART1_Config();
  60.         USART1_printf(USART1," 系統(tǒng)啟動成功!\r\n");
  61.         USART2_Config();
  62.         Display_Title();
  63.         MPU6050_Init();                  //MPU6050                                                                           
  64.         TIM_Cmd(TIM5,ENABLE);            //電機控制都在TIM5完成
  65.         TIM_Cmd(TIM1,ENABLE);
  66. }
  67. /*-----------------------------------------
  68.                                 主 函 數(shù)
  69. ------------------------------------------*/
  70. int main(void)   
  71. {   
  72.         BSP_Init();
  73.         //角度采樣和運動控制都在TIM5_IRQHandler()中完成
  74.         while(1)  
  75.         {         
  76.                 if(Q1_Start == 1)
  77.                 {
  78.                         CurMode = 1;
  79.                 }
  80.                 else if(Q2_Start == 1)
  81.                 {
  82.                         CurMode = 2;
  83.                 }
  84.                 else if(Q3_Start == 1)
  85.                 {
  86.                          CurMode = 3;
  87.                 }
  88.                 else if(Q4_Start == 1)
  89.                 {
  90.                          CurMode = 4;
  91.                 }
  92.                 else if(Q5_Start == 1)
  93.                 {
  94.                         CurMode = 5;
  95. ……………………

  97. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復(fù)制代碼

所有資料51hei提供下載:
風(fēng)力擺源代碼.7z (190.94 KB, 下載次數(shù): 56)


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

使用道具 舉報

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

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 日本精品国产 | 在线视频 中文字幕 | 亚洲激情综合 | 亚洲中午字幕 | 日韩在线一区二区三区 | 先锋影音资源网站 | 韩日在线 | 日韩超碰在线 | 91中文在线观看 | 日本中文字幕一区 | 欧美一区免费 | 成人影院在线 | 国产一区二区在线免费 | 国产精品一二三区 | 91高清免费观看 | 国产精品一区二区三区99 | 亚洲日本中文字幕在线 | 国产精品亚洲片在线播放 | 成人免费观看视频 | 国产高清视频 | 天堂一区二区三区 | 国产一区二区精品在线 | 国产精品久久久久久久久久99 | 日本黄色大片免费看 | 久久激情av | 亚洲欧美日韩国产综合 | 精品成人 | 精品亚洲一区二区 | av网站免费看 | 国产一区欧美 | 狠狠操狠狠搞 | 亚洲精品自在在线观看 | 嫩草视频网 | 久久69精品久久久久久国产越南 | 欧美久久久 | 亚洲综合色婷婷 | 久视频在线观看 | 亚洲一区中文字幕 | 综合久久色 | 日韩高清av | 天天综合日日夜夜 |