找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 1140|回復(fù): 0
打印 上一主題 下一主題
收起左側(cè)

GY-271+QMC5883L電子指南針 磁場檢測資料程序

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:1108858 發(fā)表于 2024-1-10 21:53 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
GY-271+QMC5883L電子指南針羅盤模塊+三軸磁場傳感器

單片機(jī)源程序如下:
  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. }

  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. }

  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. }

  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. }

  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. }
復(fù)制代碼

程序.7z (3.12 MB, 下載次數(shù): 15)

評分

參與人數(shù) 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎(jiǎng)勵(lì)！

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂1 踩踩
回復(fù)

使用道具 舉報(bào)

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表