標(biāo)題: stm32風(fēng)力擺源碼 dmp解算姿態(tài) [打印本頁(yè)]
作者: passenger10    時(shí)間: 2018-11-16 15:04
標(biāo)題: stm32風(fēng)力擺源碼 dmp解算姿態(tài)
暑假做的風(fēng)力擺，有需要的拿走，基于原子的dmp解算的姿態(tài)

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

  4. //MPU IIC 延時(shí)函數(shù)
  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);//先使能外設(shè)IO PORTB時(shí)鐘
  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);                                         //根據(jù)設(shè)定參數(shù)初始化GPIO
  21.        
  22.   GPIO_SetBits(GPIOB,GPIO_Pin_10|GPIO_Pin_11);                                                 //PB10,PB11 輸出高       

  24. }
  25. //產(chǎn)生IIC起始信號(hào)
  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總線，準(zhǔn)備發(fā)送或接收數(shù)據(jù)
  35. }          
  36. //產(chǎn)生IIC停止信號(hào)
  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;//發(fā)送I2C總線結(jié)束信號(hào)
  45.         MPU_IIC_Delay();                                                                  
  46. }
  47. //等待應(yīng)答信號(hào)到來(lái)
  48. //返回值：1，接收應(yīng)答失敗
  49. //        0，接收應(yīng)答成功
  50. u8 MPU_IIC_Wait_Ack(void)
  51. {
  52.         u8 ucErrTime=0;
  53.         MPU_SDA_IN();      //SDA設(shè)置為輸入  
  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;//時(shí)鐘輸出0           
  66.         return 0;  
  67. }
  68. //產(chǎn)生ACK應(yīng)答
  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. //不產(chǎn)生ACK應(yīng)答                    
  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發(fā)送一個(gè)字節(jié)
  91. //返回從機(jī)有無(wú)應(yīng)答
  92. //1，有應(yīng)答
  93. //0，無(wú)應(yīng)答                          
  94. void MPU_IIC_Send_Byte(u8 txd)
  95. {                        
  96.     u8 t;   
  97.         MPU_SDA_OUT();             
  98.     MPU_IIC_SCL=0;//拉低時(shí)鐘開(kāi)始數(shù)據(jù)傳輸
  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個(gè)字節(jié)，ack=1時(shí)，發(fā)送ACK，ack=0，發(fā)送nACK   
  110. u8 MPU_IIC_Read_Byte(unsigned char ack)
  111. {
  112.         unsigned char i,receive=0;
  113.         MPU_SDA_IN();//SDA設(shè)置為輸入
  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();//發(fā)送nACK
  125.     else
  126.         MPU_IIC_Ack(); //發(fā)送ACK   
  127.     return receive;
  128. }
復(fù)制代碼

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


作者: admin    時(shí)間: 2018-11-16 17:27
補(bǔ)全原理圖或者詳細(xì)說(shuō)明一下電路連接即可獲得100+黑幣
作者: 小黑米    時(shí)間: 2019-7-12 19:35
可以，很好的，謝謝l



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1