设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › Arduino › arduino的hmc5883L源程序
返回列表 发新帖
查看: 1604|回复: 0
打印 上一主题 下一主题
收起左侧

arduino的hmc5883L源程序

[复制链接]
跳转到指定楼层
楼主
ID:683018 发表于 2020-1-7 16:18 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
有关arduino的hmc5883L磁力计的开发程序

单片机源程序如下:
  1. #if ARDUINO >= 100
  2. #include "Arduino.h"
  3. #else
  4. #include "WProgram.h"
  5. #endif

  7. #include <Wire.h>

  9. #include "HMC5883L.h"

  11. bool HMC5883L::begin()
  12. {
  13.     Wire.begin();

  15.     if ((fastRegister8(HMC5883L_REG_IDENT_A) != 0x48)
  16.     || (fastRegister8(HMC5883L_REG_IDENT_B) != 0x34)
  17.     || (fastRegister8(HMC5883L_REG_IDENT_C) != 0x33))
  18.     {
  19.         return false;
  20.     }

  22.     setRange(HMC5883L_RANGE_1_3GA);
  23.     setMeasurementMode(HMC5883L_CONTINOUS);
  24.     setDataRate(HMC5883L_DATARATE_15HZ);
  25.     setSamples(HMC5883L_SAMPLES_1);

  27.     mgPerDigit = 0.92f;

  29.     return true;
  30. }

  32. Vector HMC5883L::readRaw(void)
  33. {
  34.     v.XAxis = readRegister16(HMC5883L_REG_OUT_X_M) - xOffset;
  35.     v.YAxis = readRegister16(HMC5883L_REG_OUT_Y_M) - yOffset;
  36.     v.ZAxis = readRegister16(HMC5883L_REG_OUT_Z_M);

  38.     return v;
  39. }

  41. Vector HMC5883L::readNormalize(void)
  42. {
  43.     v.XAxis = ((float)readRegister16(HMC5883L_REG_OUT_X_M) - xOffset) * mgPerDigit;
  44.     v.YAxis = ((float)readRegister16(HMC5883L_REG_OUT_Y_M) - yOffset) * mgPerDigit;
  45.     v.ZAxis = (float)readRegister16(HMC5883L_REG_OUT_Z_M) * mgPerDigit;

  47.     return v;
  48. }

  50. void HMC5883L::setOffset(int xo, int yo)
  51. {
  52.     xOffset = xo;
  53.     yOffset = yo;
  54. }

  56. void HMC5883L::setRange(hmc5883l_range_t range)
  57. {
  58.     switch(range)
  59.     {
  60.         case HMC5883L_RANGE_0_88GA:
  61.             mgPerDigit = 0.073f;
  62.             break;

  64.         case HMC5883L_RANGE_1_3GA:
  65.             mgPerDigit = 0.92f;
  66.             break;

  68.         case HMC5883L_RANGE_1_9GA:
  69.             mgPerDigit = 1.22f;
  70.             break;

  72.         case HMC5883L_RANGE_2_5GA:
  73.             mgPerDigit = 1.52f;
  74.             break;

  76.         case HMC5883L_RANGE_4GA:
  77.             mgPerDigit = 2.27f;
  78.             break;

  80.         case HMC5883L_RANGE_4_7GA:
  81.             mgPerDigit = 2.56f;
  82.             break;

  84.         case HMC5883L_RANGE_5_6GA:
  85.             mgPerDigit = 3.03f;
  86.             break;

  88.         case HMC5883L_RANGE_8_1GA:
  89.             mgPerDigit = 4.35f;
  90.             break;

  92.         default:
  93.             break;
  94.     }

  96.     writeRegister8(HMC5883L_REG_CONFIG_B, range << 5);
  97. }

  99. hmc5883l_range_t HMC5883L::getRange(void)
  100. {
  101.     return (hmc5883l_range_t)((readRegister8(HMC5883L_REG_CONFIG_B) >> 5));
  102. }

  104. void HMC5883L::setMeasurementMode(hmc5883l_mode_t mode)
  105. {
  106.     uint8_t value;

  108.     value = readRegister8(HMC5883L_REG_MODE);
  109.     value &= 0b11111100;
  110.     value |= mode;

  112.     writeRegister8(HMC5883L_REG_MODE, value);
  113. }

  115. hmc5883l_mode_t HMC5883L::getMeasurementMode(void)
  116. {
  117.     uint8_t value;

  119.     value = readRegister8(HMC5883L_REG_MODE);
  120.     value &= 0b00000011;

  122.     return (hmc5883l_mode_t)value;
  123. }

  125. void HMC5883L::setDataRate(hmc5883l_dataRate_t dataRate)
  126. {
  127.     uint8_t value;

  129.     value = readRegister8(HMC5883L_REG_CONFIG_A);
  130.     value &= 0b11100011;
  131.     value |= (dataRate << 2);

  133.     writeRegister8(HMC5883L_REG_CONFIG_A, value);
  134. }

  136. hmc5883l_dataRate_t HMC5883L::getDataRate(void)
  137. {
  138.     uint8_t value;

  140.     value = readRegister8(HMC5883L_REG_CONFIG_A);
  141.     value &= 0b00011100;
  142.     value >>= 2;

  144.     return (hmc5883l_dataRate_t)value;
  145. }

  147. void HMC5883L::setSamples(hmc5883l_samples_t samples)
  148. {
  149.     uint8_t value;

  151.     value = readRegister8(HMC5883L_REG_CONFIG_A);
  152.     value &= 0b10011111;
  153.     value |= (samples << 5);

  155.     writeRegister8(HMC5883L_REG_CONFIG_A, value);
  156. }

  158. hmc5883l_samples_t HMC5883L::getSamples(void)
  159. {
  160.     uint8_t value;

  162.     value = readRegister8(HMC5883L_REG_CONFIG_A);
  163.     value &= 0b01100000;
  164.     value >>= 5;

  166.     return (hmc5883l_samples_t)value;
  167. }

  169. // Write byte to register
  170. void HMC5883L::writeRegister8(uint8_t reg, uint8_t value)
  171. {
  172.     Wire.beginTransmission(HMC5883L_ADDRESS);
  173.     #if ARDUINO >= 100
  174.         Wire.write(reg);
  175.         Wire.write(value);
  176.     #else
  177.         Wire.send(reg);
  178.         Wire.send(value);
  179.     #endif
  180.     Wire.endTransmission();
  181. }

  183. // Read byte to register
  184. uint8_t HMC5883L::fastRegister8(uint8_t reg)
  185. {
  186.     uint8_t value;
  187.     Wire.beginTransmission(HMC5883L_ADDRESS);
  188.     #if ARDUINO >= 100
  189.         Wire.write(reg);
  190.     #else
  191.         Wire.send(reg);
  192.     #endif
  193.     Wire.endTransmission();

  195.     Wire.requestFrom(HMC5883L_ADDRESS, 1);
  196.     #if ARDUINO >= 100
  197.         value = Wire.read();
  198.     #else
  199.         value = Wire.receive();
  200.     #endif;
  201.     Wire.endTransmission();

  203.     return value;
  204. }

  206. // Read byte from register
  207. uint8_t HMC5883L::readRegister8(uint8_t reg)
  208. {
  209.     uint8_t value;
  210.     Wire.beginTransmission(HMC5883L_ADDRESS);
  211.     #if ARDUINO >= 100
  212.         Wire.write(reg);
  213.     #else
  214.         Wire.send(reg);
  215.     #endif
  216.     Wire.endTransmission();

  218.     Wire.beginTransmission(HMC5883L_ADDRESS);
  219.     Wire.requestFrom(HMC5883L_ADDRESS, 1);
  220.     while(!Wire.available()) {};
  221.     #if ARDUINO >= 100
  222.         value = Wire.read();
  223.     #else
  224.         value = Wire.receive();
  225.     #endif;
  226.     Wire.endTransmission();

  228.     return value;
  229. }

  231. // Read word from register
  232. int16_t HMC5883L::readRegister16(uint8_t reg)
  233. {
  234.     int16_t value;
  235.     Wire.beginTransmission(HMC5883L_ADDRESS);
  236.     #if ARDUINO >= 100
  237.         Wire.write(reg);
  238.     #else
  239.         Wire.send(reg);
  240.     #endif
  241.     Wire.endTransmission();

  243.     Wire.beginTransmission(HMC5883L_ADDRESS);
  244.     Wire.requestFrom(HMC5883L_ADDRESS, 2);
  245.     while(!Wire.available()) {};
  246.     #if ARDUINO >= 100
  247.         uint8_t vha = Wire.read();
  248.         uint8_t vla = Wire.read();
  249.     #else
  250.         uint8_t vha = Wire.receive();
  251.         uint8_t vla = Wire.receive();
  252.     #endif;
  253.     Wire.endTransmission();

  255.     value = vha << 8 | vla;

  257.     return value;
  258. }
复制代码

所有资料51hei提供下载:
Arduino-HMC5883L-master.zip (540.79 KB, 下载次数: 13)


评分

参与人数 1黑币 +40 收起 理由
admin + 40 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶顶 踩踩
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表