Add functions to get Mx, My and Mz.
Dependents: 9DOF-Stick aigamozu_program_ver2 aigamozu_program_ver2_yokokawa aigamozu_auto_ver1 ... more
Revision 0:ae7d06398888, committed 2010-10-17
- Comitter:
- elrafapadron
- Date:
- Sun Oct 17 22:22:39 2010 +0000
- Child:
- 1:65e41eb3c291
- Commit message:
Changed in this revision
| HMC5843.cpp | Show annotated file Show diff for this revision Revisions of this file |
| HMC5843.h | Show annotated file Show diff for this revision Revisions of this file |
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/HMC5843.cpp Sun Oct 17 22:22:39 2010 +0000
@@ -0,0 +1,151 @@
+/**
+ * @author Jose R. Padron
+ *@author Used HMCHMC6352 library developed by Aaron Berk as template
+ * @section LICENSE
+ *
+ * Copyright (c) 2010 ARM Limited
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ *
+ * @section DESCRIPTION
+ *
+ * Honeywell HMC5843digital compass.
+ *
+ * Datasheet:
+ *
+ * http://www.ssec.honeywell.com/magnetic/datasheets/HMC5843.pdf
+ */
+
+/**
+ * Includes
+ */
+#include "HMC5843.h"
+
+HMC5843::HMC5843(PinName sda, PinName scl) {
+
+ i2c_ = new I2C(sda, scl);
+ //100KHz, as specified by the datasheet.
+ i2c_->frequency(100000);
+
+
+}
+
+
+void HMC5843::write(int address, int data) {
+
+ char tx[2];
+
+ tx[0]=address;
+ tx[1]=data;
+
+ i2c_->write(HMC5843_I2C_WRITE,tx,2);
+
+ wait_ms(100);
+
+}
+
+
+void HMC5843::setSleepMode() {
+
+ write(HMC5843_MODE, HMC5843_SLEEP);
+}
+
+void HMC5843::setDefault(void) {
+
+ write(HMC5843_CONFIG_A,HMC5843_10HZ_NORMAL);
+ write(HMC5843_CONFIG_B,HMC5843_1_0GA);
+ write(HMC5843_MODE,HMC5843_CONTINUOUS);
+ wait_ms(100);
+}
+
+//void HMC5843::SelfTest() {
+
+ //Future
+
+//}
+
+
+void HMC5843::getAddress(char *buffer) {
+
+ char rx[3];
+ char tx[1];
+ tx[0]=HMC5843_IDENT_A;
+
+
+ i2c_->write(HMC5843_I2C_WRITE, tx,1);
+
+ wait_ms(1);
+
+ i2c_->read(HMC5843_I2C_READ,rx,3);
+
+ buffer[0]=rx[0];
+ buffer[1]=rx[1];
+ buffer[2]=rx[2];
+}
+
+
+
+void HMC5843::setOpMode(int mode, int ConfigA, int ConfigB) {
+
+
+ write(HMC5843_CONFIG_A,ConfigA);
+ write(HMC5843_CONFIG_B,ConfigB);
+ write(HMC5843_MODE,mode);
+
+
+}
+
+
+
+
+void HMC5843::readData(int* readings) {
+
+
+ char tx[1];
+ char rx[2];
+
+
+ tx[0]=HMC5843_X_MSB;
+ i2c_->write(HMC5843_I2C_READ,tx,1);
+ i2c_->read(HMC5843_I2C_READ,rx,2);
+ readings[0]= (int)rx[0]<<8|(int)rx[1];
+
+
+ tx[0]=HMC5843_Y_MSB;
+ i2c_->write(HMC5843_I2C_READ,tx,1);
+ i2c_->read(HMC5843_I2C_READ,rx,2);
+ readings[1]= (int)rx[0]<<8|(int)rx[1];
+
+ tx[0]=HMC5843_Z_MSB;
+ i2c_->write(HMC5843_I2C_READ,tx,1);
+ i2c_->read(HMC5843_I2C_READ,rx,2);
+ readings[2]= (int)rx[0]<<8|(int)rx[1];
+
+
+ //readings[0] = (int)buffer[0] << 8 | (int)buffer[1];
+ //readings[1] = (int)buffer[2] << 8 | (int)buffer[3];
+ //readings[2] = (int)buffer[4] << 8 | (int)buffer[5];
+
+ // readings[0]=buffer[0];
+ //readings[1]=buffer[1];
+ // readings[2]=buffer[2];
+ // readings[3]=buffer[3];
+ // readings[4]=buffer[4];
+ // readings[5]=buffer[5];
+}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/HMC5843.h Sun Oct 17 22:22:39 2010 +0000
@@ -0,0 +1,201 @@
+/**
+ * @author Jose R. Padron
+ *@author Used HMC5843 library developed by Aaron Berk as template
+ * @section LICENSE
+ *
+ * Copyright (c) 2010 ARM Limited
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ *
+ * @section DESCRIPTION
+ *
+ * Honeywell HMC5843 digital compass.
+ *
+ * Datasheet:
+ *
+ * http://www.ssec.honeywell.com/magnetic/datasheets/HMC5843.pdf
+ */
+
+#ifndef HMC5843_H
+#define HMC5843_H
+
+/**
+ * Includes
+ */
+#include "mbed.h"
+
+/**
+ * Defines
+ */
+#define HMC5843_I2C_ADDRESS 0x1E //7-bit address. 0x3C write, 0x3D read.
+#define HMC5843_I2C_WRITE 0x3C
+#define HMC5843_I2C_READ 0x3D
+
+//Values Config A
+#define HMC5843_0_5HZ_NORMAL 0x00
+#define HMC5843_0_5HZ_POSITIVE 0x01
+#define HMC5843_0_5HZ_NEGATIVE 0x02
+
+#define HMC5843_1HZ_NORMAL 0x04
+#define HMC5843_1HZ_POSITIVE 0x05
+#define HMC5843_1HZ_NEGATIVE 0x06
+
+#define HMC5843_2HZ_NORMAL 0x08
+#define HMC5843_2HZ_POSITIVE 0x09
+#define HMC5843_2HZ_NEGATIVE 0x0A
+
+#define HMC5843_5HZ_NORMAL 0x0C
+#define HMC5843_5HZ_POSITIVE 0x0D
+#define HMC5843_5HZ_NEGATIVE 0x0E
+
+#define HMC5843_10HZ_NORMAL 0x10
+#define HMC5843_10HZ_POSITIVE 0x11
+#define HMC5843_10HZ_NEGATIVE 0x12
+
+#define HMC5843_20HZ_NORMAL 0x14
+#define HMC5843_20HZ_POSITIVE 0x15
+#define HMC5843_20HZ_NEGATIVE 0x16
+
+#define HMC5843_50HZ_NORMAL 0x18
+#define HMC5843_50HZ_POSITIVE 0x19
+#define HMC5843_50HZ_NEGATIVE 0x1A
+
+//Values Config B
+#define HMC5843_0_7GA 0x00
+#define HMC5843_1_0GA 0x20
+#define HMC5843_1_5GA 0x40
+#define HMC5843_2_0GA 0x60
+#define HMC5843_3_2GA 0x80
+#define HMC5843_3_8GA 0xA0
+#define HMC5843_4_5GA 0xC0
+#define HMC5843_6_5GA 0xE0
+
+//Values MODE
+#define HMC5843_CONTINUOUS 0x00
+#define HMC5843_SINGLE 0x01
+#define HMC5843_IDLE 0x02
+#define HMC5843_SLEEP 0x03
+
+
+
+#define HMC5843_CONFIG_A 0x00
+#define HMC5843_CONFIG_B 0x01
+#define HMC5843_MODE 0x02
+#define HMC5843_X_MSB 0x03
+#define HMC5843_X_LSB 0x04
+#define HMC5843_Y_MSB 0x05
+#define HMC5843_Y_LSB 0x06
+#define HMC5843_Z_MSB 0x07
+#define HMC5843_Z_LSB 0x08
+#define HMC5843_STATUS 0x09
+#define HMC5843_IDENT_A 0x0A
+#define HMC5843_IDENT_B 0x0B
+#define HMC5843_IDENT_C 0x0C
+
+
+
+/**
+ * Honeywell HMC5843 digital compass.
+ */
+class HMC5843 {
+
+public:
+
+ /**
+ * Constructor.
+ *
+ * @param sda mbed pin to use for SDA line of I2C interface.
+ * @param scl mbed pin to use for SCL line of I2C interface.
+ */
+ HMC5843(PinName sda, PinName scl);
+
+
+ /**
+ * Enter into sleep mode.
+ *
+ */
+ void setSleepMode();
+
+
+ /**
+ * Set Device in Default Mode.
+ * HMC5843_CONTINUOUS, HMC5843_10HZ_NORMAL HMC5843_1_0GA
+ */
+ void setDefault();
+
+
+
+ /**
+ * Perform Self Test.
+ *
+ */
+ // void SelfTest();
+
+
+ /**
+ * Read the memory location on the device which contains the address.
+ *
+ * @param Pointer to a buffer to hold the address value
+ * Expected H, 4 and 3.
+ */
+ void getAddress(char * address);
+
+
+
+ /**
+ * Set the operation mode.
+ *
+ * @param mode 0x00 -> Continuous
+ * 0x01 -> Single
+ * 0x02 -> Idle
+ * @param ConfigA values
+ * @param ConfigB values
+ */
+ void setOpMode(int mode, int ConfigA, int ConfigB);
+
+ /**
+ * Write to on the device.
+ *
+ * @param address Address to write to.
+ * @param data Data to write.
+ */
+ void write(int address, int data);
+
+ /* Get the output of all three axes.
+ *
+ * @param Pointer to a buffer to hold the magnetics value for the
+ * x-axis, y-axis and z-axis [in that order].
+ */
+ void readData(int* readings);
+
+ /* Get the current operation mode.
+ *
+ * @return Staus register values
+ */
+ int getStatus(void);
+
+
+
+ I2C* i2c_;
+
+
+
+};
+
+#endif /* HMC5843_H */
HMC5843 Digital Compass