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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2231|回復: 2
收起左側

stm32風力擺源碼 dmp解算姿態

[復制鏈接]
ID:382827 發表于 2018-11-16 15:04 | 顯示全部樓層 |閱讀模式
暑假做的風力擺，有需要的拿走，基于原子的dmp解算的姿態

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

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

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

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

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


回復

使用道具 舉報

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 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 欧美精品欧美精品系列 | 欧美aⅴ在线观看 | 成人美女免费网站视频 | 精品成人69xx.xyz | 国产福利资源在线 | 午夜精品视频一区 | 日韩精品久久一区二区三区 | 午夜免费在线观看 | 99久久婷婷国产精品综合 | 伊人网综合在线观看 | 精品少妇一区二区三区日产乱码 | 日韩精品一区二 | 黄色免费网站在线看 | 综合精品在线 | 精品久久久久久久人人人人传媒 | 日韩亚洲欧美综合 | 超碰日韩 | 久久国产高清 | 精品国产一区二区国模嫣然 | 密色视频| 99精品网 | 国产精品成人一区 | 国产一区精品在线 | 欧美一级片 | 丁香五月缴情综合网 | 久久爱一区 | 99精品久久久国产一区二区三 | 欧美一级欧美一级在线播放 | 日韩www | 欧美日韩视频一区二区 | 天堂一区二区三区 | 自拍视频网 | 国产精品久久久久久久久久久久久久 | 亚洲精品免费观看 | 欧美性受 | 欧美极品少妇xxxxⅹ免费视频 | 黄色男女网站 | 91精品久久久久久久久 | 欧美日韩免费在线 | 亚洲高清视频在线观看 | 日韩一区二区av |