欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

 找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開(kāi)始

搜索
查看: 1248|回復(fù): 0
收起左側(cè)

GY-271+QMC5883L電子指南針 磁場(chǎng)檢測(cè)資料程序

[復(fù)制鏈接]
ID:1108858 發(fā)表于 2024-1-10 21:53 | 顯示全部樓層 |閱讀模式
GY-271+QMC5883L電子指南針羅盤(pán)模塊+三軸磁場(chǎng)傳感器

單片機(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)

評(píng)分

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

查看全部評(píng)分

回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

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

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

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