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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3718|回復: 1
打印 上一主題 下一主題
收起左側

STM32F407平衡小車源碼

[復制鏈接]
跳轉到指定樓層
樓主
ID:416356 發表于 2018-10-27 16:48 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
網上搜了很多資料最后用MPU6050陀螺儀通過角度和電機速度做成的串級PID平衡小車

實驗器材:
    探索者STM32F4開發板
   
實驗目的:
    學習MPU6050 六軸傳感器(三軸加速度+三軸陀螺儀)的使用.
   
硬件資源:
    1,DS0(連接在PF9)
    2,串口1(波特率:115200,PA9/PA10連接在板載USB轉串口芯片CH340上面)
    3,ALIENTEK 2.8/3.5/4.3/7寸TFTLCD模塊(通過FSMC驅動,FSMC_NE4接LCD片選/A6接RS)
    4,KEY0按鍵(連接在PE4)
    5,MPU6050傳感器(連接在PB8(SCL),PB9(SDA)上面,INT(PC0)未用到).

實驗現象:
    本實驗開機后，先初始化MPU6050，然后利用DMP庫，初始化MPU6050及使能DMP，最后，在死循環里面不停
    讀取：溫度傳感器、加速度傳感器、陀螺儀、DMP姿態解算后的歐拉角等數據，通過串口上報給上位機（溫
    度不上報），利用上位機軟件（ANO_Tech匿名四軸上位機_V2.6.exe），可以實時顯示MPU6050的傳感器狀
    態曲線，并顯示3D姿態，可以通過KEY0按鍵開啟/關閉數據上傳功能。同時，在LCD模塊上面顯示溫度和歐拉
    角等信息。DS0來指示程序正在運行。另外,本例程也可以通過USMART調用MPU_Read_Byte/MPU_Write_Byte
    等函數,來實現對MPU6050寄存器的讀寫操作(僅在UPLOAD OFF狀態下).
   
注意事項:
    1,4.3寸和7寸屏需要比較大電流,USB供電可能不足,請用外部電源適配器(推薦外接12V 1A電源).
    2,本例程在LCD_Init函數里面(在ILI93xx.c),用到了printf,如果不初始化串口1,將導致液晶無法顯示!!  
    3,ANO_Tech匿名四軸上位機_V2.6.exe軟件所在路徑：開發板光盤-->6，軟件資料-->軟件-->匿名四軸上位機
    4,ANO_Tech匿名四軸上位機使用方法，請看軟件文件夾下的README.txt。
    5,注意:串口波特率為500Kbps！！

    PS:ANO_Tech匿名四軸上位機 功能十分強大，學習使用需要花費一點時間（半天左右），請大家耐心看匿名提供
    的視頻/文檔教程學習，不要浮躁。

單片機源程序如下:
  1. #include "sys.h"
  2. #include "delay.h"  
  3. #include "usart.h"   
  4. #include "led.h"
  5. #include "key.h"  
  6. #include "usmart.h"
  7. #include "mpu6050.h"
  8. #include "inv_mpu.h"
  9. #include "inv_mpu_dmp_motion_driver.h"
  10. #include "pwmout.h"
  11. #include "control.h"       
  12. #include "oled.h"
  13. #include "exti.h"
  14. #include "algorithm_pid.h"

  16. int Encoder_Left,Encoder_Right;   
  17. int Moto1,Moto2;                            //電機PWM變量 應是Motor的 向Moto致敬       
  18. float Angle_Balance,Gyro_Balance;  
  19. extern        short s1,s2;
  20. extern  PID_Struct PID_Pitch;
  21.         float pitch,roll,yaw;                 //歐拉角
  22.         short aacx,aacy,aacz;                //加速度傳感器原始數據
  23.         short gyrox,gyroy,gyroz;        //陀螺儀原始數據
  24.         short temp;                                       
  25. float x;

  27.        
  28. int main(void)
  29. {     
  30.         u8 t=0;       
  31.         int t1=0,t2=0;

  33.         Stm32_Clock_Init(336,25,2,7);//設置時鐘,168Mhz
  34.         delay_init(168);                        //延時初始化  
  35.   TIM4_PWM_Init(7200,0);
  36.         led_init();                                        //初始化LED
  37.         key_init();                                        //初始化按鍵
  38.         MPU_Init();                                        //初始化MPU6050
  39.   mpu_dmp_init();
  40.         OLED_Init();
  41.         MiniBalance_Motor_Init();
  42.                 EXTIX_Init();
  43.        
  44. TIM3_Int_Init(50-1,8400-1);
  45.         while(1)
  46.         {
  47.                 if(mpu_dmp_get_data(&pitch,&roll,&yaw)==0)
  48.                 {
  49.                         temp=MPU_Get_Temperature();        //得到溫度值
  50.                         MPU_Get_Accelerometer(&aacx,&aacy,&aacz);        //得到加速度傳感器數據
  51.                         MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);        //得到陀螺儀數據
  52. //顯示***************************************************************************************************     
  53.       if((t%5)==0)                       
  54.                         {
  55.                                
  56.                                 temp=pitch*10;

  58.                                 if(temp<0)
  59.                                 {
  60.                                         OLED_ShowString(0,0,"-",16);                //顯示負號
  61.                                         temp=-temp;                //轉為正數
  62.                                 }else OLED_ShowString(0,0," ",16);                //去掉負號
  63.                                 OLED_ShowNum(10,0,temp/10,3,16);                //顯示整數部分            
  64.                                 OLED_ShowNum(26,0,temp%10,1,16);                //顯示小數部分
  65.                  t1=s1;
  66.                  if(t1<0)
  67.                                 {
  68.                                         OLED_ShowString(60,20,"-",16);                //顯示負號
  69.                                         t1=-t1;                //轉為正數
  70.                                 }else OLED_ShowString(60,20," ",16);                //去掉負號
  71.                                 OLED_ShowNum(70,20,t1,5,16);                //顯示整數部分          
  72.     t2=s2;
  73.                 if(t2<0)
  74.                                 {
  75.                                         OLED_ShowString(60,40,"-",16);                //顯示負號
  76.                                         t2=-t2;                //轉為正數
  77.                                 }else OLED_ShowString(60,40," ",16);                //去掉負號
  78.                                 OLED_ShowNum(70,40,t2,5,16);                //顯示整數部分  
  79.                                 OLED_ShowNum(0,30,PWM2,4,16);
  80.                                 OLED_ShowNum(0,50,PWM1,4,16);
  81.                                 OLED_Refresh_Gram();
  82.                                 t=0;
  83.                                 LED0=~LED0;//LED閃爍
  84. //*************************************************************************************************************
  85.                                
  86.                          
  87.                          }t++;               
  88.                 }
  89.         }
  90. }
復制代碼

所有資料51hei提供下載:
平衡倒立擺.rar (684.34 KB, 下載次數: 65)


評分

參與人數 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵！

查看全部評分

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

使用道具 舉報

沙發
ID:270479 發表于 2019-8-3 11:07 | 只看該作者
寫的亂七八糟的
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 伊人手机在线视频 | 亚洲精品www| 欧美 日本 国产 | 91久久久久久久久久久 | 最新国产精品视频 | 欧美一级久久 | 一区二区三区四区免费观看 | 日韩一区二区在线观看视频 | 欧美激情网站 | www国产成人免费观看视频,深夜成人网 | 亚洲综合一区二区三区 | 久久免费精品 | 亚洲精品视频在线播放 | 91在线精品秘密一区二区 | 91操操操| 色综合天天综合网国产成人网 | 精品久久中文字幕 | 一区二区三区四区不卡 | 久久久女女女女999久久 | 欧美a区| 免费黄色av网站 | 天天色av | 综合一区二区三区 | 97久久久久久 | 天天操,夜夜爽 | 日韩精品在线免费 | 午夜噜噜噜 | 在线观看黄视频 | 一区二区三区中文字幕 | 蜜桃在线播放 | 亚洲一区二区三区免费在线 | 午夜视频在线免费观看 | 中文字幕日韩一区 | 色99视频 | 久久三区 | 欧美精品啪啪 | 亚洲精品在线免费观看视频 | 91福利网| 中文字幕成人在线 | 日韩视频专区 | 亚洲成人蜜桃 |