SparkFun_9DOF_SensorStick

Dependencies:   FatFileSystem mbed

Fork of 9DOF_SensorStick by hige dura

Committer:
higedura
Date:
Mon Sep 03 03:44:13 2012 +0000
Revision:
5:12e37af16f2e
Parent:
2:3ffce3e97527
update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
higedura 2:3ffce3e97527 1 /**
higedura 2:3ffce3e97527 2 * @author Jose R. Padron
higedura 2:3ffce3e97527 3 * @author Used HMC6352 library developed by Aaron Berk as template
higedura 2:3ffce3e97527 4 * @section LICENSE
higedura 2:3ffce3e97527 5 *
higedura 2:3ffce3e97527 6 * Copyright (c) 2010 ARM Limited
higedura 2:3ffce3e97527 7 *
higedura 2:3ffce3e97527 8 * Permission is hereby granted, free of charge, to any person obtaining a copy
higedura 2:3ffce3e97527 9 * of this software and associated documentation files (the "Software"), to deal
higedura 2:3ffce3e97527 10 * in the Software without restriction, including without limitation the rights
higedura 2:3ffce3e97527 11 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
higedura 2:3ffce3e97527 12 * copies of the Software, and to permit persons to whom the Software is
higedura 2:3ffce3e97527 13 * furnished to do so, subject to the following conditions:
higedura 2:3ffce3e97527 14 *
higedura 2:3ffce3e97527 15 * The above copyright notice and this permission notice shall be included in
higedura 2:3ffce3e97527 16 * all copies or substantial portions of the Software.
higedura 2:3ffce3e97527 17 *
higedura 2:3ffce3e97527 18 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
higedura 2:3ffce3e97527 19 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
higedura 2:3ffce3e97527 20 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
higedura 2:3ffce3e97527 21 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
higedura 2:3ffce3e97527 22 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
higedura 2:3ffce3e97527 23 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
higedura 2:3ffce3e97527 24 * THE SOFTWARE.
higedura 2:3ffce3e97527 25 *
higedura 2:3ffce3e97527 26 * @section DESCRIPTION
higedura 2:3ffce3e97527 27 *
higedura 2:3ffce3e97527 28 * Honeywell HMC5883Ldigital compass.
higedura 2:3ffce3e97527 29 *
higedura 2:3ffce3e97527 30 * Datasheet:
higedura 2:3ffce3e97527 31 *
higedura 2:3ffce3e97527 32 * http://www.ssec.honeywell.com/magnetic/datasheets/HMC5883L.pdf
higedura 2:3ffce3e97527 33 */
higedura 2:3ffce3e97527 34
higedura 2:3ffce3e97527 35 /**
higedura 2:3ffce3e97527 36 * Includes
higedura 2:3ffce3e97527 37 */
higedura 2:3ffce3e97527 38 #include "HMC5883L.h"
higedura 2:3ffce3e97527 39
higedura 2:3ffce3e97527 40 HMC5883L::HMC5883L(PinName sda, PinName scl) {
higedura 2:3ffce3e97527 41
higedura 2:3ffce3e97527 42 i2c_ = new I2C(sda, scl);
higedura 2:3ffce3e97527 43 //100KHz, as specified by the datasheet.
higedura 2:3ffce3e97527 44 i2c_->frequency(100000);
higedura 2:3ffce3e97527 45
higedura 2:3ffce3e97527 46
higedura 2:3ffce3e97527 47 }
higedura 2:3ffce3e97527 48
higedura 2:3ffce3e97527 49
higedura 2:3ffce3e97527 50 void HMC5883L::write(int address, int data) {
higedura 2:3ffce3e97527 51
higedura 2:3ffce3e97527 52 char tx[2];
higedura 2:3ffce3e97527 53
higedura 2:3ffce3e97527 54 tx[0]=address;
higedura 2:3ffce3e97527 55 tx[1]=data;
higedura 2:3ffce3e97527 56
higedura 2:3ffce3e97527 57 i2c_->write(HMC5883L_I2C_WRITE,tx,2);
higedura 2:3ffce3e97527 58
higedura 2:3ffce3e97527 59 wait_ms(100);
higedura 2:3ffce3e97527 60
higedura 2:3ffce3e97527 61 }
higedura 2:3ffce3e97527 62
higedura 2:3ffce3e97527 63
higedura 2:3ffce3e97527 64 void HMC5883L::setSleepMode() {
higedura 2:3ffce3e97527 65
higedura 2:3ffce3e97527 66 write(HMC5883L_MODE, HMC5883L_SLEEP);
higedura 2:3ffce3e97527 67 }
higedura 2:3ffce3e97527 68
higedura 2:3ffce3e97527 69 void HMC5883L::setDefault(void) {
higedura 2:3ffce3e97527 70
higedura 2:3ffce3e97527 71 write(HMC5883L_CONFIG_A,HMC5883L_10HZ_NORMAL);
higedura 2:3ffce3e97527 72 write(HMC5883L_CONFIG_B,HMC5883L_1_0GA);
higedura 2:3ffce3e97527 73 write(HMC5883L_MODE,HMC5883L_CONTINUOUS);
higedura 2:3ffce3e97527 74 wait_ms(100);
higedura 2:3ffce3e97527 75 }
higedura 2:3ffce3e97527 76
higedura 2:3ffce3e97527 77
higedura 2:3ffce3e97527 78 void HMC5883L::getAddress(char *buffer) {
higedura 2:3ffce3e97527 79
higedura 2:3ffce3e97527 80 char rx[3];
higedura 2:3ffce3e97527 81 char tx[1];
higedura 2:3ffce3e97527 82 tx[0]=HMC5883L_IDENT_A;
higedura 2:3ffce3e97527 83
higedura 2:3ffce3e97527 84
higedura 2:3ffce3e97527 85 i2c_->write(HMC5883L_I2C_WRITE, tx,1);
higedura 2:3ffce3e97527 86
higedura 2:3ffce3e97527 87 wait_ms(1);
higedura 2:3ffce3e97527 88
higedura 2:3ffce3e97527 89 i2c_->read(HMC5883L_I2C_READ,rx,3);
higedura 2:3ffce3e97527 90
higedura 2:3ffce3e97527 91 buffer[0]=rx[0];
higedura 2:3ffce3e97527 92 buffer[1]=rx[1];
higedura 2:3ffce3e97527 93 buffer[2]=rx[2];
higedura 2:3ffce3e97527 94 }
higedura 2:3ffce3e97527 95
higedura 2:3ffce3e97527 96
higedura 2:3ffce3e97527 97
higedura 2:3ffce3e97527 98 void HMC5883L::setOpMode(int mode, int ConfigA, int ConfigB) {
higedura 2:3ffce3e97527 99
higedura 2:3ffce3e97527 100
higedura 2:3ffce3e97527 101 write(HMC5883L_CONFIG_A,ConfigA);
higedura 2:3ffce3e97527 102 write(HMC5883L_CONFIG_B,ConfigB);
higedura 2:3ffce3e97527 103 write(HMC5883L_MODE,mode);
higedura 2:3ffce3e97527 104
higedura 2:3ffce3e97527 105
higedura 2:3ffce3e97527 106 }
higedura 2:3ffce3e97527 107
higedura 2:3ffce3e97527 108
higedura 2:3ffce3e97527 109
higedura 2:3ffce3e97527 110
higedura 2:3ffce3e97527 111 void HMC5883L::readData(int* getMag) {
higedura 2:3ffce3e97527 112
higedura 2:3ffce3e97527 113
higedura 2:3ffce3e97527 114 char tx[1];
higedura 2:3ffce3e97527 115 char rx[2];
higedura 2:3ffce3e97527 116
higedura 2:3ffce3e97527 117
higedura 2:3ffce3e97527 118 tx[0]=HMC5883L_X_MSB;
higedura 2:3ffce3e97527 119 i2c_->write(HMC5883L_I2C_READ,tx,1);
higedura 2:3ffce3e97527 120 i2c_->read(HMC5883L_I2C_READ,rx,2);
higedura 2:3ffce3e97527 121 getMag[0]= (int)rx[0]<<8|(int)rx[1];
higedura 2:3ffce3e97527 122
higedura 2:3ffce3e97527 123
higedura 2:3ffce3e97527 124 tx[0]=HMC5883L_Y_MSB;
higedura 2:3ffce3e97527 125 i2c_->write(HMC5883L_I2C_READ,tx,1);
higedura 2:3ffce3e97527 126 i2c_->read(HMC5883L_I2C_READ,rx,2);
higedura 2:3ffce3e97527 127 getMag[1]= (int)rx[0]<<8|(int)rx[1];
higedura 2:3ffce3e97527 128
higedura 2:3ffce3e97527 129 tx[0]=HMC5883L_Z_MSB;
higedura 2:3ffce3e97527 130 i2c_->write(HMC5883L_I2C_READ,tx,1);
higedura 2:3ffce3e97527 131 i2c_->read(HMC5883L_I2C_READ,rx,2);
higedura 2:3ffce3e97527 132 getMag[2]= (int)rx[0]<<8|(int)rx[1];
higedura 2:3ffce3e97527 133
higedura 2:3ffce3e97527 134 }
higedura 2:3ffce3e97527 135
higedura 2:3ffce3e97527 136 int HMC5883L::getMx() {
higedura 2:3ffce3e97527 137
higedura 2:3ffce3e97527 138 char tx[1];
higedura 2:3ffce3e97527 139 char rx[2];
higedura 2:3ffce3e97527 140
higedura 2:3ffce3e97527 141
higedura 2:3ffce3e97527 142 tx[0]=HMC5883L_X_MSB;
higedura 2:3ffce3e97527 143 i2c_->write(HMC5883L_I2C_READ,tx,1);
higedura 2:3ffce3e97527 144 i2c_->read(HMC5883L_I2C_READ,rx,2);
higedura 2:3ffce3e97527 145 return ((int)rx[0]<<8|(int)rx[1]);
higedura 2:3ffce3e97527 146
higedura 2:3ffce3e97527 147 }
higedura 2:3ffce3e97527 148
higedura 2:3ffce3e97527 149 int HMC5883L::getMy() {
higedura 2:3ffce3e97527 150
higedura 2:3ffce3e97527 151 char tx[1];
higedura 2:3ffce3e97527 152 char rx[2];
higedura 2:3ffce3e97527 153
higedura 2:3ffce3e97527 154
higedura 2:3ffce3e97527 155 tx[0]=HMC5883L_Y_MSB;
higedura 2:3ffce3e97527 156 i2c_->write(HMC5883L_I2C_READ,tx,1);
higedura 2:3ffce3e97527 157 i2c_->read(HMC5883L_I2C_READ,rx,2);
higedura 2:3ffce3e97527 158 return ((int)rx[0]<<8|(int)rx[1]);
higedura 2:3ffce3e97527 159
higedura 2:3ffce3e97527 160 }
higedura 2:3ffce3e97527 161
higedura 2:3ffce3e97527 162
higedura 2:3ffce3e97527 163 int HMC5883L::getMz(){
higedura 2:3ffce3e97527 164
higedura 2:3ffce3e97527 165 char tx[1];
higedura 2:3ffce3e97527 166 char rx[2];
higedura 2:3ffce3e97527 167
higedura 2:3ffce3e97527 168
higedura 2:3ffce3e97527 169 tx[0]=HMC5883L_Z_MSB;
higedura 2:3ffce3e97527 170 i2c_->write(HMC5883L_I2C_READ,tx,1);
higedura 2:3ffce3e97527 171 i2c_->read(HMC5883L_I2C_READ,rx,2);
higedura 2:3ffce3e97527 172 return ((int)rx[0]<<8|(int)rx[1]);
higedura 2:3ffce3e97527 173
higedura 2:3ffce3e97527 174 }