Javascript wrappers for LSM303AGR Sensor library
Dependencies: LSM303AGR
LSM303AGR_JS.cpp@3:d076984ee23b, 2017-10-31 (annotated)
- Committer:
- akhtar.syedzeeshan@gmail.com
- Date:
- Tue Oct 31 16:23:10 2017 +0100
- Revision:
- 3:d076984ee23b
- Parent:
- 2:ddbdfca82832
- Child:
- 4:ae1fba759405
Implemented SPI support
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 1 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 2 | ****************************************************************************** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 3 | * @file LSM303AGR_JS.cpp |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 4 | * @author ST |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 5 | * @version V1.0.0 |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 6 | * @date 9 October 2017 |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 7 | * @brief Implementation of an LSM303AGR Accelerometer and Magnetometer sensor for |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 8 | * use with Javascript. |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 9 | ****************************************************************************** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 10 | * @attention |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 11 | * |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 12 | * <h2><center>© COPYRIGHT(c) 2016 STMicroelectronics</center></h2> |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 13 | * |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 14 | * Redistribution and use in source and binary forms, with or without modification, |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 15 | * are permitted provided that the following conditions are met: |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 16 | * 1. Redistributions of source code must retain the above copyright notice, |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 17 | * this list of conditions and the following disclaimer. |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 18 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 19 | * this list of conditions and the following disclaimer in the documentation |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 20 | * and/or other materials provided with the distribution. |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 21 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 22 | * may be used to endorse or promote products derived from this software |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 23 | * without specific prior written permission. |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 24 | * |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 25 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 26 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 27 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 28 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 29 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 30 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 31 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 32 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 33 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 34 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 35 | * |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 36 | ****************************************************************************** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 37 | */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 38 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 39 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 40 | /* Includes ------------------------------------------------------------------*/ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 41 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 42 | #include "LSM303AGR_JS.h" |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 43 | #include <inttypes.h> |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 44 | #include <stdlib.h> /* atoi */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 45 | #include "mbed.h" |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 46 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 47 | /* Helper function for printing floats & doubles */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 48 | static char *print_double(char* str, double v, int decimalDigits=2) |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 49 | { |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 50 | int i = 1; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 51 | int intPart, fractPart; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 52 | int len; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 53 | char *ptr; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 54 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 55 | /* prepare decimal digits multiplicator */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 56 | for (;decimalDigits!=0; i*=10, decimalDigits--); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 57 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 58 | /* calculate integer & fractinal parts */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 59 | intPart = (int)v; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 60 | fractPart = (int)((v-(double)(int)v)*i); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 61 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 62 | /* fill in integer part */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 63 | sprintf(str, "%i.", intPart); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 64 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 65 | /* prepare fill in of fractional part */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 66 | len = strlen(str); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 67 | ptr = &str[len]; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 68 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 69 | /* fill in leading fractional zeros */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 70 | for (i/=10;i>1; i/=10, ptr++) { |
akhtar.syedzeeshan@gmail.com | 1:78c55e099d6c | 71 | if (fractPart >= i) { |
akhtar.syedzeeshan@gmail.com | 1:78c55e099d6c | 72 | break; |
akhtar.syedzeeshan@gmail.com | 1:78c55e099d6c | 73 | } |
akhtar.syedzeeshan@gmail.com | 1:78c55e099d6c | 74 | *ptr = '0'; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 75 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 76 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 77 | /* fill in (rest of) fractional part */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 78 | sprintf(ptr, "%i", fractPart); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 79 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 80 | return str; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 81 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 82 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 83 | /* Helper function for creating JSON for data */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 84 | char *LSM303AGR_JS::make_json(char* str, int32_t *data, char *axes, int data_count) |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 85 | { |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 86 | char *ptr; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 87 | ptr = str; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 88 | str[0] = 0; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 89 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 90 | for(int i = 0; i < data_count; i++){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 91 | //printf("len: %i\n", strlen(str)); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 92 | if(i == 0){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 93 | sprintf(ptr, "{"); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 94 | ptr = &str[strlen(str)]; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 95 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 96 | else{ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 97 | sprintf(ptr, ","); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 98 | ptr = &str[strlen(str)]; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 99 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 100 | sprintf(ptr, "\"%c\":%i", axes[i], static_cast<int>(data[i])); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 101 | ptr = &str[strlen(str)]; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 102 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 103 | sprintf(ptr, "}"); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 104 | return str; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 105 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 106 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 107 | /* Class Implementation ------------------------------------------------------*/ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 108 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 109 | /** init_acc |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 110 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 111 | * @param SPI object of an helper class which handles the SPI peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 112 | * @param CS pin |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 113 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 114 | void LSM303AGR_JS::init_acc(SPI &spi, PinName cs_pin){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 115 | accelerometer = new LSM303AGRAccSensor (&spi, cs_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 116 | accelerometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 117 | accelerometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 118 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 119 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 120 | /** init_acc |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 121 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 122 | * @param SPI object of an helper class which handles the SPI peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 123 | * @param CS pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 124 | * @param INT1 pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 125 | * @param INT2 pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 126 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 127 | void LSM303AGR_JS::init_acc(SPI &spi, PinName cs_pin, PinName int1_pin, PinName int2_pin){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 128 | accelerometer = new LSM303AGRAccSensor (&spi, cs_pin, int1_pin, int2_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 129 | accelerometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 130 | accelerometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 131 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 132 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 133 | /** init_acc |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 134 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 135 | * @param DevI2c object of an helper class which handles the DevI2C peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 136 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 137 | void LSM303AGR_JS::init_acc(DevI2C &devI2c){ |
akhtar.syedzeeshan@gmail.com | 2:ddbdfca82832 | 138 | accelerometer = new LSM303AGRAccSensor (&devI2c); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 139 | accelerometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 140 | accelerometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 141 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 142 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 143 | /** init_acc |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 144 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 145 | * @param DevI2c object of an helper class which handles the DevI2C peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 146 | * @param INT1 pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 147 | * @param INT2 pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 148 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 149 | void LSM303AGR_JS::init_acc(DevI2C &devI2c, PinName int1_pin, PinName int2_pin){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 150 | accelerometer = new LSM303AGRAccSensor (&devI2c, LSM303AGR_ACC_I2C_ADDRESS, int1_pin, int2_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 151 | accelerometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 152 | accelerometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 153 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 154 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 155 | /** init_acc |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 156 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 157 | * @param DevI2c object of an helper class which handles the DevI2C peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 158 | * @param INT1 pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 159 | * @param INT2 pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 160 | * @param Address |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 161 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 162 | void LSM303AGR_JS::init_acc(DevI2C &devI2c, PinName int1_pin, PinName int2_pin, uint8_t address){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 163 | accelerometer = new LSM303AGRAccSensor (&devI2c, address, int1_pin, int2_pin); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 164 | accelerometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 165 | accelerometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 166 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 167 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 168 | /** init_mag |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 169 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 170 | * @param SPI object of an helper class which handles the SPI peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 171 | * @param CS pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 172 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 173 | void LSM303AGR_JS::init_mag(SPI &spi, PinName cs_pin){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 174 | magnetometer = new LSM303AGRMagSensor (&spi, cs_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 175 | magnetometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 176 | magnetometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 177 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 178 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 179 | /** init_mag |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 180 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 181 | * @param SPI object of an helper class which handles the SPI peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 182 | * @param CS pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 183 | * @param INT pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 184 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 185 | void LSM303AGR_JS::init_mag(SPI &spi, PinName cs_pin, PinName int_pin){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 186 | magnetometer = new LSM303AGRMagSensor (&spi, cs_pin, int_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 187 | magnetometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 188 | magnetometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 189 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 190 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 191 | /** init_mag |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 192 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 193 | * @param DevI2c object of an helper class which handles the DevI2C peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 194 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 195 | void LSM303AGR_JS::init_mag(DevI2C &devI2c){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 196 | magnetometer = new LSM303AGRMagSensor (&devI2c); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 197 | magnetometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 198 | magnetometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 199 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 200 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 201 | /** init_mag |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 202 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 203 | * @param DevI2c object of an helper class which handles the DevI2C peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 204 | * @param INT pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 205 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 206 | void LSM303AGR_JS::init_mag(DevI2C &devI2c, PinName int_pin){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 207 | magnetometer = new LSM303AGRMagSensor (&devI2c, LSM303AGR_MAG_I2C_ADDRESS, int_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 208 | magnetometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 209 | magnetometer->enable(); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 210 | } |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 211 | |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 212 | /** init_mag |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 213 | * @brief Initializing the component. |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 214 | * @param DevI2c object of an helper class which handles the DevI2C peripheral |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 215 | * @param INT pin |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 216 | * @param Address |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 217 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 218 | void LSM303AGR_JS::init_mag(DevI2C &devI2c, PinName int_pin, uint8_t address){ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 219 | magnetometer = new LSM303AGRMagSensor (&devI2c, address, int_pin); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 220 | magnetometer->init(NULL); |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 221 | magnetometer->enable(); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 222 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 223 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 224 | /** Destructor |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 225 | * @brief Recycle the component. |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 226 | * Deletes the Sensor Object |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 227 | */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 228 | LSM303AGR_JS::~LSM303AGR_JS(){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 229 | if(magnetometer != NULL){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 230 | delete magnetometer; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 231 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 232 | if(accelerometer != NULL){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 233 | delete accelerometer; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 234 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 235 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 236 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 237 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 238 | * @brief Read ID address of LSM303AGR Magnetometer |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 239 | * @retval The ID of the Sensor |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 240 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 241 | uint8_t LSM303AGR_JS::read_magnetometer_id(){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 242 | uint8_t result; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 243 | magnetometer->read_id(&result); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 244 | return result; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 245 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 246 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 247 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 248 | * @brief Read ID address of LSM303AGR Accelerometer |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 249 | * @retval The ID of the Sensor |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 250 | */ |
akhtar.syedzeeshan@gmail.com | 3:d076984ee23b | 251 | uint8_t LSM303AGR_JS::read_accelerometer_id(){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 252 | uint8_t result; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 253 | accelerometer->read_id(&result); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 254 | return result; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 255 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 256 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 257 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 258 | * @brief Get the accleremeter reading from LSM303AGR |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 259 | * @retval Accleremeter value |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 260 | */ |
akhtar.syedzeeshan@gmail.com | 2:ddbdfca82832 | 261 | int32_t *LSM303AGR_JS::get_accelerometer_axes(int32_t *axes){ |
akhtar.syedzeeshan@gmail.com | 2:ddbdfca82832 | 262 | accelerometer->get_x_axes(axes); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 263 | printf("LSM303AGR [acc/mg]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 264 | return axes; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 265 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 266 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 267 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 268 | * @brief Get the accleremeter reading from LSM303AGR |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 269 | * @retval Accleremeter value in JSON string form |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 270 | */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 271 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 272 | char *LSM303AGR_JS::get_accelerometer_axes_json(char *data){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 273 | int32_t axes[3]; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 274 | accelerometer->get_x_axes(axes); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 275 | //printf("LSM303AGR [acc/mg]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 276 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 277 | char axes_labels[3] = {'x', 'y', 'z'}; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 278 | make_json(data, axes, axes_labels, 3); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 279 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 280 | return data; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 281 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 282 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 283 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 284 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 285 | * @brief Get the Magnetometer reading from LSM303AGR |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 286 | * @retval Magnetometer value |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 287 | */ |
akhtar.syedzeeshan@gmail.com | 2:ddbdfca82832 | 288 | int32_t *LSM303AGR_JS::get_magnetometer_axes(int32_t *axes){ |
akhtar.syedzeeshan@gmail.com | 2:ddbdfca82832 | 289 | magnetometer->get_m_axes(axes); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 290 | printf("LSM303AGR [mag/mgauss]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 291 | return axes; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 292 | } |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 293 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 294 | /** |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 295 | * @brief Get the Magnetometer reading from LSM303AGR |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 296 | * @retval Magnetometer value |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 297 | */ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 298 | char *LSM303AGR_JS::get_magnetometer_axes_json(char * data){ |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 299 | int32_t axes[3]; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 300 | magnetometer->get_m_axes(axes); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 301 | //printf("LSM303AGR [mag/mgauss]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 302 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 303 | char axes_labels[3] = {'x', 'y', 'z'}; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 304 | make_json(data, axes, axes_labels, 3); |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 305 | |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 306 | return data; |
akhtar.syedzeeshan@gmail.com | 0:23a17bd32990 | 307 | } |