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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

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

stm32風力擺源碼 dmp解算姿態

[復制鏈接]
跳轉到指定樓層
樓主
ID:382827 發表于 2018-11-16 15:04 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
暑假做的風力擺,有需要的拿走,基于原子的dmp解算的姿態

單片機源程序如下:
  1. #include "mpuiic.h"
  2. #include "delay.h"

  3. //MPU IIC 延時函數
  4. void MPU_IIC_Delay(void)
  5. {
  6.         delay_us(2);
  7. }

  8. //初始化IIC
  9. void MPU_IIC_Init(void)
  10. {                                             
  11.   GPIO_InitTypeDef  GPIO_InitStructure;
  12.        
  13.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);//先使能外設IO PORTB時鐘
  14.                
  15.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10|GPIO_Pin_11;         // 端口配置
  16.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;                  //推挽輸出
  17.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 //IO口速度為50MHz
  18.   GPIO_Init(GPIOB, &GPIO_InitStructure);                                         //根據設定參數初始化GPIO
  19.        
  20.   GPIO_SetBits(GPIOB,GPIO_Pin_10|GPIO_Pin_11);                                                 //PB10,PB11 輸出高       

  21. }
  22. //產生IIC起始信號
  23. void MPU_IIC_Start(void)
  24. {
  25.         MPU_SDA_OUT();     //sda線輸出
  26.         MPU_IIC_SDA=1;                    
  27.         MPU_IIC_SCL=1;
  28.         MPU_IIC_Delay();
  29.         MPU_IIC_SDA=0;//START:when CLK is high,DATA change form high to low
  30.         MPU_IIC_Delay();
  31.         MPU_IIC_SCL=0;//鉗住I2C總線,準備發送或接收數據
  32. }          
  33. //產生IIC停止信號
  34. void MPU_IIC_Stop(void)
  35. {
  36.         MPU_SDA_OUT();//sda線輸出
  37.         MPU_IIC_SCL=0;
  38.         MPU_IIC_SDA=0;//STOP:when CLK is high DATA change form low to high
  39.         MPU_IIC_Delay();
  40.         MPU_IIC_SCL=1;
  41.         MPU_IIC_SDA=1;//發送I2C總線結束信號
  42.         MPU_IIC_Delay();                                                                  
  43. }
  44. //等待應答信號到來
  45. //返回值:1,接收應答失敗
  46. //        0,接收應答成功
  47. u8 MPU_IIC_Wait_Ack(void)
  48. {
  49.         u8 ucErrTime=0;
  50.         MPU_SDA_IN();      //SDA設置為輸入  
  51.         MPU_IIC_SDA=1;MPU_IIC_Delay();          
  52.         MPU_IIC_SCL=1;MPU_IIC_Delay();         
  53.         while(MPU_READ_SDA)
  54.         {
  55.                 ucErrTime++;
  56.                 if(ucErrTime>250)
  57.                 {
  58.                         MPU_IIC_Stop();
  59.                         return 1;
  60.                 }
  61.         }
  62.         MPU_IIC_SCL=0;//時鐘輸出0           
  63.         return 0;  
  64. }
  65. //產生ACK應答
  66. void MPU_IIC_Ack(void)
  67. {
  68.         MPU_IIC_SCL=0;
  69.         MPU_SDA_OUT();
  70.         MPU_IIC_SDA=0;
  71.         MPU_IIC_Delay();
  72.         MPU_IIC_SCL=1;
  73.         MPU_IIC_Delay();
  74.         MPU_IIC_SCL=0;
  75. }
  76. //不產生ACK應答                    
  77. void MPU_IIC_NAck(void)
  78. {
  79.         MPU_IIC_SCL=0;
  80.         MPU_SDA_OUT();
  81.         MPU_IIC_SDA=1;
  82.         MPU_IIC_Delay();
  83.         MPU_IIC_SCL=1;
  84.         MPU_IIC_Delay();
  85.         MPU_IIC_SCL=0;
  86. }                                                                              
  87. //IIC發送一個字節
  88. //返回從機有無應答
  89. //1,有應答
  90. //0,無應答                          
  91. void MPU_IIC_Send_Byte(u8 txd)
  92. {                        
  93.     u8 t;   
  94.         MPU_SDA_OUT();             
  95.     MPU_IIC_SCL=0;//拉低時鐘開始數據傳輸
  96.     for(t=0;t<8;t++)
  97.     {              
  98.         MPU_IIC_SDA=(txd&0x80)>>7;
  99.         txd<<=1;           
  100.                     MPU_IIC_SCL=1;
  101.                     MPU_IIC_Delay();
  102.                     MPU_IIC_SCL=0;       
  103.                     MPU_IIC_Delay();
  104.     }         
  105. }             
  106. //讀1個字節,ack=1時,發送ACK,ack=0,發送nACK   
  107. u8 MPU_IIC_Read_Byte(unsigned char ack)
  108. {
  109.         unsigned char i,receive=0;
  110.         MPU_SDA_IN();//SDA設置為輸入
  111.     for(i=0;i<8;i++ )
  112.         {
  113.         MPU_IIC_SCL=0;
  114.         MPU_IIC_Delay();
  115.                 MPU_IIC_SCL=1;
  116.         receive<<=1;
  117.         if(MPU_READ_SDA)receive++;   
  118.                 MPU_IIC_Delay();
  119.     }                                         
  120.     if (!ack)
  121.         MPU_IIC_NAck();//發送nACK
  122.     else
  123.         MPU_IIC_Ack(); //發送ACK   
  124.     return receive;
  125. }
復制代碼

所有資料51hei提供下載:
風力擺.rar (364.67 KB, 下載次數: 23)


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

使用道具 舉報

沙發
ID:1 發表于 2018-11-16 17:27 | 只看該作者
補全原理圖或者詳細說明一下電路連接即可獲得100+黑幣
回復

使用道具 舉報

板凳
ID:259503 發表于 2019-7-12 19:35 | 只看該作者
可以,很好的,謝謝l
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板: 亚洲一区二区三区在线 | 成人日b视频 | 亚洲高清久久 | 国产精品一区二区欧美黑人喷潮水 | 亚洲精品一区中文字幕 | 国产在线精品一区二区 | 国产精品福利网 | 国产99久久久国产精品下药 | 999精品在线| 久久久精品日本 | 97超在线视频 | 中文字幕成人免费视频 | 欧美日韩中文在线观看 | 国产精品免费观看 | 青青草亚洲 | 国产高清免费 | 日韩视频精品在线 | 久久精品亚洲精品国产欧美 | 欧美一区二区三区在线观看 | 久久久久久久久99 | 国产精品久久久久久久久久久久 | 国产精品毛片一区二区三区 | 中文字幕国产精品 | 91精品国产综合久久久久 | 91精品久久久久久久久 | 色综合色综合网色综合 | 福利精品| 亚洲国产成人av | 欧美日韩在线成人 | 拍戏被cao翻了h承欢 | 99热这里有精品 | 欧美一级www片免费观看 | 成人免费影院 | 国产精品视频在线播放 | 精品欧美一区二区精品久久久 | 一级黄色在线 | 亚洲综合婷婷 | 人妖一区| 日韩精品久久久 | 欧美成人精品在线 | 综合精品|