標(biāo)題: 九軸飛行器STM32源碼資料 串口輸出HMC5883L+ADXL345+BMP085+L3G4200D [打印本頁(yè)]
作者: aw1287362890    時(shí)間: 2018-5-16 13:54
標(biāo)題: 九軸飛行器STM32源碼資料 串口輸出HMC5883L+ADXL345+BMP085+L3G4200D
電路原理圖如下：


串口輸出HMC5883L+ADXL345+BMP085+L3G4200D單片機(jī)源程序如下:

  2. /*******************************************************************************
  3. *  函數(shù)功能：串口發(fā)送數(shù)據(jù)  HMC5883L        + ADXL345 + BMP085+L3G4200D
  4. *  芯片：STM32F103XXXX
  5. *  波特率：115200
  6. *  編譯環(huán)境：Keil uVision4
  7. *  編寫時(shí)間：
  8. *  作    者：
  9. *******************************************************************************/

  11. #include "stm32f10x_lib.h"
  12. #include  <math.h>    //Keil library  

  14. GPIO_InitTypeDef GPIO_InitStructure;
  15. ErrorStatus HSEStartUpStatus;


  18. #define   uchar unsigned char
  19. #define   uint unsigned int        
  20. #define   OSS 0         //        BMP085使用

  22. //L3G4200D內(nèi)部寄存器
  23. #define CTRL_REG1 0x20
  24. #define CTRL_REG2 0x21
  25. #define CTRL_REG3 0x22
  26. #define CTRL_REG4 0x23
  27. #define CTRL_REG5 0x24
  28. #define OUT_X_L 0x28
  29. #define OUT_X_H 0x29
  30. #define OUT_Y_L 0x2A
  31. #define OUT_Y_H 0x2B
  32. #define OUT_Z_L 0x2C
  33. #define OUT_Z_H 0x2D

  35. //定義器件在IIC總線中的從地址,根據(jù)ALT  ADDRESS地址引腳不同修改
  36. #define        HMC5883L_Addr   0x3C        //磁場(chǎng)傳感器器件地址
  37. #define        ADXL345_Addr    0xA6        //加速度傳感器器件地址
  38. #define        BMP085_Addr     0xee        //氣壓傳感器器件地址
  39. #define        L3G4200_Addr    0xD2        //陀螺儀傳感器器件地址

  41. unsigned char BUF[8];                         //接收數(shù)據(jù)緩存區(qū)
  42. char  test=0;
  43. int   x,y;
  44. float angle;
  45. uchar ge,shi,bai,qian,wan,shiwan;           //顯示變量
  46. int A_X,A_Y,A_Z;
  47. short T_X,T_Y,T_Z;

  49. short data_xyz[3];
  50. float Roll,Pitch,Q,T,K;


  53. //***BMP085使用
  54. short ac1;
  55. short ac2;
  56. short ac3;
  57. unsigned short ac4;
  58. unsigned short ac5;
  59. unsigned short ac6;
  60. short b1;
  61. short b2;
  62. short mb;
  63. short mc;
  64. short md;

  66. long  temperature;
  67. long  pressure;
  68. //********
  69. //************************************++++++++++++++++++++++++++++++++
  70. /*模擬IIC端口輸出輸入定義*/
  71. #define SCL_H         GPIOB->BSRR = GPIO_Pin_6
  72. #define SCL_L         GPIOB->BRR  = GPIO_Pin_6
  73.    
  74. #define SDA_H         GPIOB->BSRR = GPIO_Pin_7
  75. #define SDA_L         GPIOB->BRR  = GPIO_Pin_7

  77. #define SCL_read      GPIOB->IDR  & GPIO_Pin_6
  78. #define SDA_read      GPIOB->IDR  & GPIO_Pin_7

  80. /* 函數(shù)申明 -----------------------------------------------*/
  81. void RCC_Configuration(void);
  82. void GPIO_Configuration(void);
  83. void NVIC_Configuration(void);
  84. void USART1_Configuration(void);
  85. void USART2_Configuration(void);
  86. void USART3_Configuration(void);
  87. void USART4_Configuration(void);
  88. void USART5_Configuration(void);
  89. void WWDG_Configuration(void);
  90. void Delay(u32 nTime);
  91. void Delayms(vu32 m);  
  92. void conversion(long temp_data);
  93. void adxl345_angle(void);
  94. /* 變量定義 ----------------------------------------------*/

  96. //***************************************************
  97. void conversion(long temp_data)  
  98. {     
  99.     shiwan=temp_data/100000+0x30 ;
  100.     temp_data=temp_data%100000;   //取余運(yùn)算
  101.     wan=temp_data/10000+0x30 ;
  102.     temp_data=temp_data%10000;   //取余運(yùn)算
  103.         qian=temp_data/1000+0x30 ;
  104.     temp_data=temp_data%1000;    //取余運(yùn)算
  105.     bai=temp_data/100+0x30   ;
  106.     temp_data=temp_data%100;     //取余運(yùn)算
  107.     shi=temp_data/10+0x30    ;
  108.     temp_data=temp_data%10;      //取余運(yùn)算
  109.     ge=temp_data+0x30;         
  110. }
  111. /*******************************************************************************
  112. * Function Name  : I2C_GPIO_Config
  113. * Description    : Configration Simulation IIC GPIO
  114. * Input          : None
  115. * Output         : None
  116. * Return         : None
  117. ****************************************************************************** */
  118. void I2C_GPIO_Config(void)
  119. {
  120.   GPIO_InitTypeDef  GPIO_InitStructure;

  122.   GPIO_InitStructure.GPIO_Pin =  GPIO_Pin_6;
  123.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  124.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;  
  125.   GPIO_Init(GPIOB, &GPIO_InitStructure);

  127.   GPIO_InitStructure.GPIO_Pin =  GPIO_Pin_7;
  128.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  129.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;
  130.   GPIO_Init(GPIOB, &GPIO_InitStructure);
  131. }

  133. /*******************************************************************************
  134. * Function Name  : I2C_delay
  135. * Description    : Simulation IIC Timing series delay
  136. * Input          : None
  137. * Output         : None
  138. * Return         : None
  139. ****************************************************************************** */
  140. void I2C_delay(void)
  141. {
  142.                
  143.    u8 i=30; //這里可以優(yōu)化速度        ，經(jīng)測(cè)試最低到5還能寫入
  144.    while(i)
  145.    {
  146.      i--;
  147.    }  
  148. }

  150. void delay5ms(void)
  151. {
  152.                
  153.    int i=5000;  
  154.    while(i)
  155.    {
  156.      i--;
  157.    }  
  158. }
  159. /*******************************************************************************
  160. * Function Name  : I2C_Start
  161. * Description    : Master Start Simulation IIC Communication
  162. * Input          : None
  163. * Output         : None
  164. * Return         : Wheather         Start
  165. ****************************************************************************** */
  166. bool I2C_Start(void)
  167. {
  168.         SDA_H;
  169.         SCL_H;
  170.         I2C_delay();
  171.         if(!SDA_read)return FALSE;        //SDA線為低電平則總線忙,退出
  172.         SDA_L;
  173.         I2C_delay();
  174.         if(SDA_read) return FALSE;        //SDA線為高電平則總線出錯(cuò),退出
  175.         SDA_L;
  176.         I2C_delay();
  177.         return TRUE;
  178. }
  179. /*******************************************************************************
  180. * Function Name  : I2C_Stop
  181. * Description    : Master Stop Simulation IIC Communication
  182. * Input          : None
  183. * Output         : None
  184. * Return         : None
  185. ****************************************************************************** */
  186. void I2C_Stop(void)
  187. {
  188.         SCL_L;
  189.         I2C_delay();
  190.         SDA_L;
  191.         I2C_delay();
  192.         SCL_H;
  193.         I2C_delay();
  194.         SDA_H;
  195.         I2C_delay();
  196. }
  197. /*******************************************************************************
  198. * Function Name  : I2C_Ack
  199. * Description    : Master Send Acknowledge Single
  200. * Input          : None
  201. * Output         : None
  202. * Return         : None
  203. ****************************************************************************** */
  204. void I2C_Ack(void)
  205. {        
  206.         SCL_L;
  207.         I2C_delay();
  208.         SDA_L;
  209.         I2C_delay();
  210.         SCL_H;
  211.         I2C_delay();
  212.         SCL_L;
  213.         I2C_delay();
  214. }   
  215. /*******************************************************************************
  216. * Function Name  : I2C_NoAck
  217. * Description    : Master Send No Acknowledge Single
  218. * Input          : None
  219. * Output         : None
  220. * Return         : None
  221. ****************************************************************************** */
  222. void I2C_NoAck(void)
  223. {        
  224.         SCL_L;
  225.         I2C_delay();
  226.         SDA_H;
  227.         I2C_delay();
  228.         SCL_H;
  229.         I2C_delay();
  230.         SCL_L;
  231.         I2C_delay();
  232. }
  233. /*******************************************************************************
  234. * Function Name  : I2C_WaitAck
  235. * Description    : Master Reserive Slave Acknowledge Single
  236. * Input          : None
  237. * Output         : None
  238. * Return         : Wheather         Reserive Slave Acknowledge Single
  239. ****************************************************************************** */
  240. bool I2C_WaitAck(void)          //返回為:=1有ACK,=0無(wú)ACK
  241. {
  242.         SCL_L;
  243.         I2C_delay();
  244.         SDA_H;                        
  245.         I2C_delay();
  246.         SCL_H;
  247.         I2C_delay();
  248.         if(SDA_read)
  249.         {
  250.       SCL_L;
  251.           I2C_delay();
  252.       return FALSE;
  253.         }
  254.         SCL_L;
  255.         I2C_delay();
  256.         return TRUE;
  257. }
  258. /*******************************************************************************
  259. * Function Name  : I2C_SendByte
  260. * Description    : Master Send a Byte to Slave
  261. * Input          : Will Send Date
  262. * Output         : None
  263. * Return         : None
  264. ****************************************************************************** */
  265. void I2C_SendByte(u8 SendByte) //數(shù)據(jù)從高位到低位//
  266. {
  267.     u8 i=8;
  268.     while(i--)
  269.     {
  270.         SCL_L;
  271.         I2C_delay();
  272.       if(SendByte&0x80)
  273.         SDA_H;  
  274.       else
  275.         SDA_L;   
  276.         SendByte<<=1;
  277.         I2C_delay();
  278.                 SCL_H;
  279.         I2C_delay();
  280.     }
  281.     SCL_L;
  282. }  
  283. /*******************************************************************************
  284. * Function Name  : I2C_RadeByte
  285. * Description    : Master Reserive a Byte From Slave
  286. * Input          : None
  287. * Output         : None
  288. * Return         : Date From Slave
  289. ****************************************************************************** */
  290. unsigned char I2C_RadeByte(void)  //數(shù)據(jù)從高位到低位//
  291. {
  292.     u8 i=8;
  293.     u8 ReceiveByte=0;

  295.     SDA_H;                                
  296.     while(i--)
  297.     {
  298.       ReceiveByte<<=1;      
  299.       SCL_L;
  300.       I2C_delay();
  301.           SCL_H;
  302.       I2C_delay();        
  303.       if(SDA_read)
  304.       {
  305.         ReceiveByte|=0x01;
  306.       }
  307.     }
  308.     SCL_L;
  309.     return ReceiveByte;
  310. }
  311. //ZRX         
  312. //單字節(jié)寫入*******************************************

  314. bool Single_Write(unsigned char SlaveAddress,unsigned char REG_Address,unsigned char REG_data)                     //void
  315. {
  316.           if(!I2C_Start())return FALSE;
  317.     I2C_SendByte(SlaveAddress);   //發(fā)送設(shè)備地址+寫信號(hào)//I2C_SendByte(((REG_Address & 0x0700) >>7) | SlaveAddress & 0xFFFE);//設(shè)置高起始地址+器件地址
  318.     if(!I2C_WaitAck()){I2C_Stop(); return FALSE;}
  319.     I2C_SendByte(REG_Address );   //設(shè)置低起始地址      
  320.     I2C_WaitAck();        
  321.     I2C_SendByte(REG_data);
  322.     I2C_WaitAck();   
  323.     I2C_Stop();
  324.     delay5ms();
  325.     return TRUE;
  326. }

  328. //單字節(jié)讀取*****************************************
  329. unsigned char Single_Read(unsigned char SlaveAddress,unsigned char REG_Address)
  330. {   unsigned char REG_data;            
  331.         if(!I2C_Start())return FALSE;
  332.     I2C_SendByte(SlaveAddress); //I2C_SendByte(((REG_Address & 0x0700) >>7) | REG_Address & 0xFFFE);//設(shè)置高起始地址+器件地址
  333.     if(!I2C_WaitAck()){I2C_Stop();test=1; return FALSE;}
  334.     I2C_SendByte((u8) REG_Address);   //設(shè)置低起始地址      
  335.     I2C_WaitAck();
  336.     I2C_Start();
  337.     I2C_SendByte(SlaveAddress+1);
  338.     I2C_WaitAck();

  340.         REG_data= I2C_RadeByte();
  341.     I2C_NoAck();
  342.     I2C_Stop();
  343.     //return TRUE;
  344.         return REG_data;

  346. }                                                      

  348. /*
  349. ********************************************************************************
  350. ** 函數(shù)名稱 ： RCC_Configuration(void)
  351. ** 函數(shù)功能 ： 時(shí)鐘初始化
  352. ** 輸    入        ： 無(wú)
  353. ** 輸    出        ： 無(wú)
  354. ** 返    回        ： 無(wú)
  355. ********************************************************************************
  356. */
  357. void RCC_Configuration(void)
  358. {   
  359.   /* RCC system reset(for debug purpose) */
  360.   RCC_DeInit();

  362.   /* Enable HSE */
  363.   RCC_HSEConfig(RCC_HSE_ON);

  365.   /* Wait till HSE is ready */
  366.   HSEStartUpStatus = RCC_WaitForHSEStartUp();

  368.   if(HSEStartUpStatus == SUCCESS)
  369.   {
  370.     /* HCLK = SYSCLK */
  371.     RCC_HCLKConfig(RCC_SYSCLK_Div1);
  372.   
  373.     /* PCLK2 = HCLK */
  374.     RCC_PCLK2Config(RCC_HCLK_Div1);

  376.     /* PCLK1 = HCLK/2 */
  377.     RCC_PCLK1Config(RCC_HCLK_Div2);

  379.     /* Flash 2 wait state */
  380.     FLASH_SetLatency(FLASH_Latency_2);
  381.     /* Enable Prefetch Buffer */
  382.     FLASH_PrefetchBufferCmd(FLASH_PrefetchBuffer_Enable);

  384.     /* PLLCLK = 8MHz * 9 = 72 MHz */
  385.     RCC_PLLConfig(RCC_PLLSource_HSE_Div1, RCC_PLLMul_9);

  387.     /* Enable PLL */
  388.     RCC_PLLCmd(ENABLE);

  390.     /* Wait till PLL is ready */
  391.     while(RCC_GetFlagStatus(RCC_FLAG_PLLRDY) == RESET)
  392.     {
  393.     }

  395.     /* Select PLL as system clock source */
  396.     RCC_SYSCLKConfig(RCC_SYSCLKSource_PLLCLK);

  398.     /* Wait till PLL is used as system clock source */
  399.     while(RCC_GetSYSCLKSource() != 0x08)
  400.     {
  401.     }
  402.   }
  403.    /* Enable GPIOA, GPIOB, GPIOC, GPIOD, GPIOE, GPIOF, GPIOG and AFIO clocks */
  404.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB , ENABLE);
  405.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD , ENABLE);
  406.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE | RCC_APB2Periph_GPIOF , ENABLE);
  407.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOG | RCC_APB2Periph_AFIO  , ENABLE);  
  408. }

  410. /*
  411. ********************************************************************************
  412. ** 函數(shù)名稱 ： GPIO_Configuration(void)
  413. ** 函數(shù)功能 ： 端口初始化
  414. ** 輸    入        ： 無(wú)
  415. ** 輸    出        ： 無(wú)
  416. ** 返    回        ： 無(wú)
  417. ********************************************************************************
  418. */
  419. void GPIO_Configuration(void)
  420. {
  421.   GPIO_InitTypeDef GPIO_InitStructure;
  422.   RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE  );
  423.    /* Configure USART1 Tx (PA.09) as alternate function push-pull */
  424.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9;                                 //        選中管腳9
  425.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;                 // 復(fù)用推挽輸出
  426.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 // 最高輸出速率50MHz
  427.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                 // 選擇A端口
  428.    
  429.   /* Configure USART1 Rx (PA.10) as input floating */
  430.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;                          //選中管腳10
  431.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;          //浮空輸入
  432.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                  //選擇A端口

  434.   /* Configure USART2 Tx (PA.02) as alternate function push-pull */
  435.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;                                 //        選中管腳2
  436.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;                 // 復(fù)用推挽輸出
  437.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 // 最高輸出速率50MHz
  438.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                 // 選擇A端口
  439.    
  440.   /* Configure USART2 Rx (PA.03) as input floating */
  441.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;                          //選中管腳3
  442.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;          //浮空輸入
  443.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                  //選擇A端口


  446.   /* Configure USART3 Tx (PB.10) as alternate function push-pull */
  447.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;                                 //        選中管腳10
  448.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;                 // 復(fù)用推挽輸出
  449.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 // 最高輸出速率50MHz
  450.   GPIO_Init(GPIOB, &GPIO_InitStructure);                                 // 選擇B端口
  451.    
  452.   /* Configure USART3 Rx (PB.11) as input floating */
  453.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_11;                          //選中管腳11
  454.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;          //浮空輸入
  455.   GPIO_Init(GPIOB, &GPIO_InitStructure);                                  //選擇B端口

  457.    /* Configure USART4 Tx (PC.10) as alternate function push-pull */
  458.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;                                 //        選中管腳10
  459.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;                 // 復(fù)用推挽輸出
  460.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 // 最高輸出速率50MHz
  461.   GPIO_Init(GPIOC, &GPIO_InitStructure);                                 // 選擇C端口
  462.    
  463.   /* Configure USART4 Rx (PC.11) as input floating */
  464.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_11;                          //選中管腳11
  465.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;          //浮空輸入
  466.   GPIO_Init(GPIOC, &GPIO_InitStructure);                                  //選擇C端口

  468.    /* Configure USART5 Tx (PC.12) as alternate function push-pull */
  469.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12;                                 //        選中管腳12
  470.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;                 // 復(fù)用推挽輸出
  471.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 // 最高輸出速率50MHz
  472.   GPIO_Init(GPIOC, &GPIO_InitStructure);                                 // 選擇C端口
  473.    
  474.   /* Configure USART5 Rx (PD.2) as input floating */
  475.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;                          //選中管腳2
  476.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;          //浮空輸入
  477.   GPIO_Init(GPIOD, &GPIO_InitStructure);                                  //選擇D端口


  480. }

  482. /*
  483. ********************************************************************************
  484. ** 函數(shù)名稱 ： USART1_Configuration(void)
  485. ** 函數(shù)功能 ： 串口1初始化
  486. ** 輸    入        ： 無(wú)
  487. ** 輸    出        ： 無(wú)
  488. ** 返    回        ： 無(wú)
  489. ********************************************************************************
  490. */
  491. void USART1_Configuration(void)
  492. {

  494. USART_InitTypeDef USART_InitStructure;
  495. USART_ClockInitTypeDef  USART_ClockInitStructure;

  497. RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1 |RCC_APB2Periph_USART1, ENABLE  );

  499. USART_ClockInitStructure.USART_Clock = USART_Clock_Disable;                        // 時(shí)鐘低電平活動(dòng)
  500. USART_ClockInitStructure.USART_CPOL = USART_CPOL_Low;                                // 時(shí)鐘低電平
  501. USART_ClockInitStructure.USART_CPHA = USART_CPHA_2Edge;                                // 時(shí)鐘第二個(gè)邊沿進(jìn)行數(shù)據(jù)捕獲
  502. USART_ClockInitStructure.USART_LastBit = USART_LastBit_Disable;                // 最后一位數(shù)據(jù)的時(shí)鐘脈沖不從SCLK輸出
  503. /* Configure the USART1 synchronous paramters */
  504. USART_ClockInit(USART1, &USART_ClockInitStructure);                                        // 時(shí)鐘參數(shù)初始化設(shè)置
  505.                                                                                                                                          
  506. USART_InitStructure.USART_BaudRate = 115200;                                                  // 波特率為：115200
  507. USART_InitStructure.USART_WordLength = USART_WordLength_8b;                          // 8位數(shù)據(jù)
  508. USART_InitStructure.USART_StopBits = USART_StopBits_1;                                  // 在幀結(jié)尾傳輸1個(gè)停止位
  509. USART_InitStructure.USART_Parity = USART_Parity_No ;                                  // 奇偶失能
  510. USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;        // 硬件流控制失能

  512. USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx;                  // 發(fā)送使能+接收使能
  513. /* Configure USART1 basic and asynchronous paramters */
  514. USART_Init(USART1, &USART_InitStructure);
  515.    
  516.   /* Enable USART1 */
  517. USART_ClearFlag(USART1, USART_IT_RXNE);                         //清中斷，以免一啟用中斷后立即產(chǎn)生中斷
  518. USART_ITConfig(USART1,USART_IT_RXNE, ENABLE);                //使能USART1中斷源
  519. USART_Cmd(USART1, ENABLE);                                                        //USART1總開(kāi)關(guān)：開(kāi)啟
  520. }


  523. /*
  524. ********************************************************************************
  525. ** 函數(shù)名稱 ： NVIC_Configuration(void)
  526. ** 函數(shù)功能 ： 中斷初始化
  527. ** 輸    入        ： 無(wú)
  528. ** 輸    出        ： 無(wú)
  529. ** 返    回        ： 無(wú)
  530. ********************************************************************************
  531. */
  532. void NVIC_Configuration(void)
  533. {
  534.   NVIC_InitTypeDef NVIC_InitStructure;  
  535.   NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);

  537.   NVIC_InitStructure.NVIC_IRQChannel = WWDG_IRQChannel;
  538.   NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
  539.   NVIC_Init(&NVIC_InitStructure);

  541. }

  543. /*
  544. ********************************************************************************
  545. ** 函數(shù)名稱 ： WWDG_Configuration(void)
  546. ** 函數(shù)功能 ： 看門狗初始化
  547. ** 輸    入        ： 無(wú)
  548. ** 輸    出        ： 無(wú)
  549. ** 返    回        ： 無(wú)
  550. ********************************************************************************
  551. */
  552. void WWDG_Configuration(void)
  553. {
  554.   RCC_APB1PeriphClockCmd(RCC_APB1Periph_WWDG, ENABLE);        
  555.   WWDG_SetPrescaler(WWDG_Prescaler_8);                      //  WWDG clock counter = (PCLK1/4096)/8 = 244 Hz (~4 ms)  
  556.   WWDG_SetWindowValue(0x41);                                 // Set Window value to 0x41
  557.   WWDG_Enable(0x50);                       // Enable WWDG and set counter value to 0x7F, WWDG timeout = ~4 ms * 64 = 262 ms
  558.   WWDG_ClearFlag();                               // Clear EWI flag
  559.   WWDG_EnableIT();                               // Enable EW interrupt
  560. }

  562. /*
  563. ********************************************************************************
  564. ** 函數(shù)名稱 ： Delay(vu32 nCount)
  565. ** 函數(shù)功能 ： 延時(shí)函數(shù)
  566. ** 輸    入        ： 無(wú)
  567. ** 輸    出        ： 無(wú)
  568. ** 返    回        ： 無(wú)
  569. ********************************************************************************
  570. */
  571. void Delay(vu32 nCount)
  572. {
  573.   for(; nCount != 0; nCount--);
  574. }

  576. /*
  577. ********************************************************************************
  578. ** 函數(shù)名稱 ： void Delayms(vu32 m)
  579. ** 函數(shù)功能 ： 長(zhǎng)延時(shí)函數(shù)         m=1,延時(shí)1ms
  580. ** 輸    入        ： 無(wú)
  581. ** 輸    出        ： 無(wú)
  582. ** 返    回        ： 無(wú)
  583. ********************************************************************************
  584. */
  585. void Delayms(vu32 m)
  586. {
  587.   u32 i;
  588.   
  589.   for(; m != 0; m--)        
  590.        for (i=0; i<50000; i++);
  591. }



  595. /*
  596. ********************************************************************************
  597. ** 函數(shù)名稱 ： WWDG_IRQHandler(void)
  598. ** 函數(shù)功能 ： 窗口提前喚醒中斷
  599. ** 輸    入        ： 無(wú)
  600. ** 輸    出        ： 無(wú)
  601. ** 返    回        ： 無(wú)
  602. ********************************************************************************
  603. */

  605. void WWDG_IRQHandler(void)
  606. {
  607.   /* Update WWDG counter */
  608.   WWDG_SetCounter(0x50);
  609.         
  610.   /* Clear EWI flag */
  611.   WWDG_ClearFlag();
  612.   
  613. }
  614. //************************************************
  615. void  USART1_SendData(uchar SendData)
  616. {
  617. USART_SendData(USART1, SendData);
  618. Delayms(1);
  619. }
  620.         

  622. //********************************************************************
  623. long bmp085ReadTemp(void)
  624. {   short  temp_ut;
  625.         Single_Write(BMP085_Addr,0xF4,0x2E);
  626.         Delayms(5);        // max time is 4.5ms
  627.         temp_ut = Single_Read(BMP085_Addr,0xF6);
  628.         temp_ut = (temp_ut<<8)| Single_Read(BMP085_Addr,0xF7);               
  629.         return (long) temp_ut ;
  630. }
  631. //*************************************************************

  633. long bmp085ReadPressure(void)
  634. {
  635.         long pressure = 0;
  636.         Single_Write(BMP085_Addr,0xF4,0x34);
  637.         Delayms(5);        // max time is 4.5ms
  638.         pressure = Single_Read(BMP085_Addr,0xF6);
  639.         pressure = (pressure<<8)| Single_Read(BMP085_Addr,0xF7);               
  640.         pressure &= 0x0000FFFF;        
  641.         return pressure;        
  642. }

  644. //******************
  645. Send_ADXL345_data(int dis_data)
  646.   { float temp ;
  647.         if(dis_data>0x7fff)dis_data-=0xffff;
  648.          if(dis_data<0){
  649.                dis_data=-dis_data;
  650.              USART_SendData(USART1,'-');
  651.                  Delayms(2);
  652.         }
  653.         else
  654.           {
  655.            USART_SendData(USART1,'+');
  656.            Delayms(2);
  657.            }
  658.         temp=(float)dis_data*3.9;  //計(jì)算數(shù)據(jù)和顯示,查考ADXL345快速入門第4頁(yè)
  659.         conversion(temp);          //轉(zhuǎn)換出顯示需要的數(shù)據(jù)         
  660.             USART1_SendData(qian);
  661.                 USART1_SendData('.');
  662.             USART1_SendData(bai);
  663.             USART1_SendData(shi);
  664.             USART1_SendData(ge);
  665.                 USART1_SendData('g');
  666. }
  667. //***************************************
  668. //******************
  669. Send_L3G420D_data(short dis_data)
  670.   { float temp ;
  671.          if(dis_data<0){
  672.                dis_data=-dis_data;
  673.              USART_SendData(USART1,'-');
  674.                  Delayms(2);
  675.         }
  676.         else
  677.           {
  678.            USART_SendData(USART1,'+');
  679.            Delayms(2);
  680.            }
  681.         temp=(float)dis_data*0.07;  //計(jì)算數(shù)據(jù)和顯示,查考ADXL345快速入門第4頁(yè)
  682.         conversion(temp);           //轉(zhuǎn)換出顯示需要的數(shù)據(jù)         
  683.             USART1_SendData(bai);
  684.             USART1_SendData(shi);
  685.             USART1_SendData(ge);

  687. }
  688. //***************************************


  691. void Send_HMC5883L()
  692. {
  693. USART1_SendData('H');
  694. USART1_SendData('M');
  695. USART1_SendData('C');
  696. USART1_SendData('5');
  697. USART1_SendData('8');
  698. USART1_SendData('8');
  699. USART1_SendData('3');
  700. USART1_SendData('L');
  701. USART1_SendData(':');
  702. conversion(angle);
  703. USART1_SendData(bai);
  704. USART1_SendData(shi);
  705. USART1_SendData(ge);
  706. USART1_SendData('`');  
  707. USART1_SendData(0x0d);
  708. USART1_SendData(0x0a);
  709. }
  710. //*************************************************
  711. void  Send_BMP085()
  712. {
  713. USART1_SendData('B');
  714. USART1_SendData('M');
  715. USART1_SendData('P');
  716. USART1_SendData('0');
  717. USART1_SendData('8');
  718. USART1_SendData('5');
  719. USART1_SendData(':');

  721. USART1_SendData('t');
  722. USART1_SendData('=');
  723. conversion(temperature);
  724. USART1_SendData(bai);
  725. USART1_SendData(shi);
  726. USART1_SendData('.');
  727. USART1_SendData(ge);
  728. USART1_SendData('`');
  729. USART1_SendData('C');

  731. USART1_SendData(' ');
  732. USART1_SendData('p');
  733. USART1_SendData('=');
  734. conversion(pressure);

  736. USART1_SendData(shiwan);
  737. USART1_SendData(wan);
  738. USART1_SendData(qian);
  739. USART1_SendData('.');
  740. USART1_SendData(bai);
  741. USART1_SendData(shi);
  742. USART1_SendData(ge);
  743. USART1_SendData('K');
  744. USART1_SendData('p');
  745. USART1_SendData('a');                                 
  746. USART1_SendData(0x0d);
  747. USART1_SendData(0x0a);

  749. }
  750. //*****************************************************

  752. void  Send_ADXL345()
  753. {
  754. USART1_SendData('A');
  755. USART1_SendData('D');
  756. USART1_SendData('X');
  757. USART1_SendData('L');
  758. USART1_SendData('3');
  759. USART1_SendData('4');
  760. USART1_SendData('5');
  761. USART1_SendData(':');
  762.            USART1_SendData('X');
  763.            USART1_SendData('=');
  764.            Send_ADXL345_data(A_X);

  766.            USART1_SendData('Y');
  767.            USART1_SendData('=');
  768.            Send_ADXL345_data(A_Y);

  770.            USART1_SendData('Z');
  771.            USART1_SendData('=');
  772.            Send_ADXL345_data(A_Z);

  774.            adxl345_angle();


  777. USART1_SendData(0x0d);
  778. USART1_SendData(0x0a);
  779. }
  780. //*****************************************************
  781. void Send_L3G4200D()
  782. {
  783.            USART1_SendData('L');
  784.         USART1_SendData('3');
  785.         USART1_SendData('G');
  786.         USART1_SendData('4');
  787.         USART1_SendData('2');
  788.         USART1_SendData('0');
  789.         USART1_SendData('0');
  790.         USART1_SendData('D');
  791.         USART1_SendData(':');

  793.            USART1_SendData('X');
  794.            USART1_SendData('=');
  795.            Send_L3G420D_data(T_X);

  797.            USART1_SendData('Y');
  798.            USART1_SendData('=');
  799.            Send_L3G420D_data(T_Y);

  801.            USART1_SendData('Z');
  802.            USART1_SendData('=');
  803.            Send_L3G420D_data(T_Z);

  805.           USART1_SendData(0x0d);
  806.      USART1_SendData(0x0a);
  807. }
  808. //******************************************************
  809. void read_hmc5883l(void)
  810. {
  811.        Single_Write(HMC5883L_Addr,0x00,0x14);   //
  812.        Single_Write(HMC5883L_Addr,0x02,0x00);   //
  813.              Delayms(10);

  815.        BUF[1]=Single_Read(HMC5883L_Addr,0x03);//OUT_X_L_A
  816.        BUF[2]=Single_Read(HMC5883L_Addr,0x04);//OUT_X_H_A

  818.            BUF[3]=Single_Read(HMC5883L_Addr,0x07);//OUT_Y_L_A
  819.        BUF[4]=Single_Read(HMC5883L_Addr,0x08);//OUT_Y_H_A

  821.        x=(BUF[1] << 8) | BUF[2]; //Combine MSB and LSB of X Data output register
  822.        y=(BUF[3] << 8) | BUF[4]; //Combine MSB and LSB of Z Data output register

  824.        if(x>0x7fff)x-=0xffff;         
  825.        if(y>0x7fff)y-=0xffff;         
  826.        angle= atan2(y,x) * (180 / 3.14159265) + 180; // angle in degrees
  827. }
  828. //****************************************
  829. void read_ADXL345(void)
  830. {
  831.        BUF[0]=Single_Read(ADXL345_Addr,0x32);//OUT_X_L_A
  832.        BUF[1]=Single_Read(ADXL345_Addr,0x33);//OUT_X_H_A

  834.            BUF[2]=Single_Read(ADXL345_Addr,0x34);//OUT_Y_L_A
  835.        BUF[3]=Single_Read(ADXL345_Addr,0x35);//OUT_Y_H_A

  837.            BUF[4]=Single_Read(ADXL345_Addr,0x36);//OUT_Z_L_A
  838.        BUF[5]=Single_Read(ADXL345_Addr,0x37);//OUT_Z_H_A

  840.            A_X=(BUF[1]<<8)+BUF[0];  //合成數(shù)據(jù)  
  841.            A_Y=(BUF[3]<<8)+BUF[2];  //合成數(shù)據(jù)
  842.            A_Z=(BUF[5]<<8)+BUF[4];  //合成數(shù)據(jù)
  843. }
  844. //*****************************************
  845. void read_BMP085(void)
  846. {

  848.            long ut;
  849.         long up;
  850.         long x1, x2, b5, b6, x3, b3, p;
  851.         unsigned long b4, b7;

  853.         ut = bmp085ReadTemp();           // 讀取溫度
  854. //        ut = bmp085ReadTemp();           // 讀取溫度
  855.         up = bmp085ReadPressure();  // 讀取壓強(qiáng)
  856. //        up = bmp085ReadPressure();  // 讀取壓強(qiáng)
  857.         x1 = ((long)ut - ac6) * ac5 >> 15;
  858.         x2 = ((long) mc << 11) / (x1 + md);
  859.         b5 = x1 + x2;
  860.         temperature = (b5 + 8) >> 4;
  861.         
  862.          //****************

  864.         b6 = b5 - 4000;
  865.         x1 = (b2 * (b6 * b6 >> 12)) >> 11;
  866.         x2 = ac2 * b6 >> 11;
  867.         x3 = x1 + x2;
  868.         b3 = (((long)ac1 * 4 + x3) + 2)/4;
  869.         x1 = ac3 * b6 >> 13;
  870.         x2 = (b1 * (b6 * b6 >> 12)) >> 16;
  871.         x3 = ((x1 + x2) + 2) >> 2;
  872.         b4 = (ac4 * (unsigned long) (x3 + 32768)) >> 15;
  873.         b7 = ((unsigned long) up - b3) * (50000 >> OSS);
  874.         if( b7 < 0x80000000)
  875.              p = (b7 * 2) / b4 ;
  876.            else  
  877.                     p = (b7 / b4) * 2;
  878.         x1 = (p >> 8) * (p >> 8);
  879.         x1 = (x1 * 3038) >> 16;
  880.         x2 = (-7357 * p) >> 16;
  881.          pressure = p + ((x1 + x2 + 3791) >> 4);
  882. }
  883. //***************************
  884. void  Init_ADXL345(void)
  885. {
  886.    Single_Write(ADXL345_Addr,0x31,0x0B);   //測(cè)量范圍,正負(fù)16g，13位模式
  887.   // Single_Write(ADXL345_Addr,0x2C,0x0e);   //速率設(shè)定為100hz 參考pdf13頁(yè)
  888.    Single_Write(ADXL345_Addr,0x2D,0x08);   //選擇電源模式   參考pdf24頁(yè)
  889.    Single_Write(ADXL345_Addr,0x2E,0x80);   //使能 DATA_READY 中斷
  890.   // Single_Write(ADXL345_Addr,0x1E,0x00);   //X 偏移量 根據(jù)測(cè)試傳感器的狀態(tài)寫入pdf29頁(yè)
  891.   // Single_Write(ADXL345_Addr,0x1F,0x00);   //Y 偏移量 根據(jù)測(cè)試傳感器的狀態(tài)寫入pdf29頁(yè)
  892.   // Single_Write(ADXL345_Addr,0x20,0x05);   //Z 偏移量 根據(jù)測(cè)試傳感器的狀態(tài)寫入pdf29頁(yè)
  893. }
  894. //****************************
  895. void  Init_BMP085(void)
  896. {
  897.         ac1 = Single_Read(BMP085_Addr,0xAA);
  898.         ac1 = (ac1<<8)|Single_Read(BMP085_Addr,0xAB);

  900.     ac2 = Single_Read(BMP085_Addr,0xAC);
  901.         ac2 = (ac2<<8)| Single_Read(BMP085_Addr,0xAD);

  903.         ac3 = Single_Read(BMP085_Addr,0xAE);
  904.         ac3 = (ac3<<8)| Single_Read(BMP085_Addr,0xAF);

  906.         ac4 = Single_Read(BMP085_Addr,0xB0);
  907.         ac4 = (ac4<<8)| Single_Read(BMP085_Addr,0xB1);

  909.         ac5 = Single_Read(BMP085_Addr,0xB2);
  910.         ac5 = (ac5<<8)| Single_Read(BMP085_Addr,0xB3);

  912.         ac6 = Single_Read(BMP085_Addr,0xB4);
  913.         ac6 = (ac6<<8)| Single_Read(BMP085_Addr,0xB5);

  915.         b1 = Single_Read(BMP085_Addr,0xB6);
  916.         b1 = (b1<<8)| Single_Read(BMP085_Addr,0xB7);

  918.         b2 = Single_Read(BMP085_Addr,0xB8);
  919.         b2 = (b2<<8)| Single_Read(BMP085_Addr,0xB9);

  921.         mb = Single_Read(BMP085_Addr,0xBA);
  922.         mb = (mb<<8)| Single_Read(BMP085_Addr,0xBB);

  924.         mc = Single_Read(BMP085_Addr,0xBC);
  925. ……………………

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


所有資料51hei提供下載:
九軸氣壓模塊資料.rar (15.33 MB, 下載次數(shù): 72)



作者: QEQWE123    時(shí)間: 2020-4-3 16:29
缺少 stm32f10x_lib.h" 頭文件啊，，
作者: hominidclint    時(shí)間: 2020-4-9 21:08
感謝分享，學(xué)習(xí)學(xué)習(xí)，



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