HMC5883L陀螺儀的stm32程序

陀螺儀HMC5883L

1. #include "stm32f10x.h"
   
2. #include "I2C.h"
   
3. #include "HMC5883L.h"
   
4. #include "delay.h"
   
5. #include "math.h"
   
6. #include "usart.h"
   
7. short int data[3];
   
8. double angle,m,n;
   
9. int main(void)
   
10. {        
    
11.         delay_init();
    
12.         i2c_init();
    
13.         hmc_init();
    
14.         uart_init(9600);
    
15.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
    
16.         while(1)
    
17.         {
    
18.                 hmc_read_XYZ(data);
    
19.           angle=atan2((double)data[2],(double)data[0])*(180 / 3.14159265)+180;
    
20.                 delay_ms(200);
    
21.                 m=n=angle;
    
22.                 while(-90<=m-n<=90)//90是角度，不準確可以稍微調一下
    
23.                 {
    
24.                             //這里是旋轉的函數
    
25.                         hmc_read_XYZ(data);
    
26.             angle=atan2((double)data[2],(double)data[0])*(180 / 3.14159265)+180;
    
27.                         delay_ms(200);
    
28.                         n=angle;
    
29.                 }
    
30. //                USART_SendData(USART1, angle);//向串口1發送數據
    
31. //                                while(USART_GetFlagStatus(USART1,USART_FLAG_TC)!=SET);//等待發送結束
    
32.         
    
33.         }
    
34. }
    
35. 
    

復制代碼

全部資料下載地址：
HMC5883L.rar (312.59 KB, 下載次數: 170)

2017-9-16 00:54 上傳

點擊文件名下載附件
下載積分: 黑幣 -5

厲害辛苦  辛苦

謝謝分享，感覺很有用

為什么我用這個程序在串口助手上面沒顯示數據？