GY-271+QMC5883L电子指南针 磁场检测资料程序

GY-271+QMC5883L电子指南针罗盘模块+三轴磁场传感器

单片机源程序如下:

1. #include "GY273.h"
   
2. #include "i2c.h"
   
3. #include "delay.h"
   
4. #include "math.h"
   
5. int16_t data[3];
   
6. double gy273_xy_angle,gy273_yz_angle,gy273_xz_angle;
   
7. double x,y,z;
   
8. void hmc_write_reg(u8 reg,u8 data)
   
9. {
   
10.         IIC_Start();
    
11.         IIC_Send_Byte(WRITE_ADDRESS);
    
12.         IIC_Wait_Ack();
    
13.         IIC_Send_Byte(reg);
    
14.         IIC_Wait_Ack();
    
15.         IIC_Send_Byte(data);
    
16.         IIC_Wait_Ack();
    
17.         IIC_Stop();
    
18.         //delay_ms(5);
    
19. }
    
20. 
    
21. u8 hmc_read_reg(u8 reg)
    
22. {
    
23.         u8 data;
    
24.         IIC_Start();
    
25.         IIC_Send_Byte(WRITE_ADDRESS);
    
26.         IIC_Wait_Ack();
    
27.         IIC_Send_Byte(reg);
    
28.         IIC_Wait_Ack();
    
29.         IIC_Stop();
    
30.         IIC_Start();
    
31.         IIC_Send_Byte(READ_ADDRESS);
    
32.         IIC_Wait_Ack();
    
33.         data=IIC_Read_Byte();
    
34.         IIC_NAck();
    
35.         IIC_Stop();
    
36.         return data;
    
37. }
    
38. 
    
39. void hmc_read_XYZ(int16_t *data)
    
40. {
    
41. //        int16_t temp;
    
42. //        temp=hmc_read_reg(DATAX_M);
    
43. //        *data++=(temp<<8)+hmc_read_reg(DATAX_L);
    
44.         *data++=(hmc_read_reg(DATAX_M)<<8)|hmc_read_reg(DATAX_L);       
    
45. //        temp=hmc_read_reg(DATAY_M);
    
46. //        *data++=(temp<<8)+hmc_read_reg(DATAY_L);
    
47.         *data++=(hmc_read_reg(DATAY_M)<<8)|hmc_read_reg(DATAY_L);       
    
48. //        temp=hmc_read_reg(DATAZ_M);
    
49. //        *data++=(temp<<8)+hmc_read_reg(DATAZ_L);
    
50.         *data++=(hmc_read_reg(DATAZ_M)<<8)|hmc_read_reg(DATAZ_L);
    
51. //        printf("%f %f %f %f\r\n",x,y,z,angle);
    
52. }
    
53. 
    
54. void hmc_init(void)
    
55. {
    
56.         hmc_write_reg(0X0B,0x01);
    
57.         hmc_write_reg(0X20,0x40);
    
58.         hmc_write_reg(0X21,0x01);
    
59.         hmc_write_reg(CONFIGA,0x1D);
    
60.         delay_ms(10);
    
61. }
    
62. 
    
63. void gy273_Work(void){
    
64.         hmc_read_XYZ(data);
    
65.         gy273_xy_angle=atan2((double)data[0],(double)data[1])*(180 / 3.14159265)+180;
    
66.         gy273_yz_angle=atan2((double)data[1],(double)data[2])*(180 / 3.14159265)+180;
    
67.         gy273_xz_angle=atan2((double)data[0],(double)data[2])*(180 / 3.14159265)+180;
    
68.         x=(double)data[0];
    
69.         y=(double)data[1];
    
70.         z=(double)data[2];
    
71.         delay_ms(100);
    
72. }
    

复制代码

程序.7z (3.12 MB, 下载次数: 8)

2024-1-11 01:51 上传

点击文件名下载附件
下载积分: 黑币 -5