L3GD20 & L3G4200D / STMicroelectronics / MEMS motion sensor, three-axis gyroscope library
Dependents: GR-PEACH_test_wo_rtos GR-PEACH_test_on_rtos_works_well
L3GD20.h@0:de66621e5370, 2014-08-29 (annotated)
- Committer:
- kenjiArai
- Date:
- Fri Aug 29 13:26:33 2014 +0000
- Revision:
- 0:de66621e5370
- Child:
- 1:9475fd0e35ff
New creation: L3GD20 & L3G4200D / STMicroelectronics / MEMS motion sensor, three-axis gyroscope library
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kenjiArai | 0:de66621e5370 | 1 | /* |
kenjiArai | 0:de66621e5370 | 2 | * mbed library program |
kenjiArai | 0:de66621e5370 | 3 | * L3GD20 MEMS motion sensor: 3-axis digital gyroscope, made by STMicroelectronics |
kenjiArai | 0:de66621e5370 | 4 | * http://www.st.com/web/catalog/sense_power/FM89/SC1288 |
kenjiArai | 0:de66621e5370 | 5 | * /PF252443?sc=internet/analog/product/252443.jsp |
kenjiArai | 0:de66621e5370 | 6 | * L3G4200D MEMS motion sensor: three-axis digital output gyroscope, made by STMicroelectronics |
kenjiArai | 0:de66621e5370 | 7 | * http://www.st.com/web/catalog/sense_power/FM89/SC1288 |
kenjiArai | 0:de66621e5370 | 8 | * /PF250373?sc=internet/analog/product/250373.jsp |
kenjiArai | 0:de66621e5370 | 9 | * |
kenjiArai | 0:de66621e5370 | 10 | * Copyright (c) 2014 Kenji Arai / JH1PJL |
kenjiArai | 0:de66621e5370 | 11 | * http://www.page.sannet.ne.jp/kenjia/index.html |
kenjiArai | 0:de66621e5370 | 12 | * http://mbed.org/users/kenjiArai/ |
kenjiArai | 0:de66621e5370 | 13 | * Created: July 13th, 2014 |
kenjiArai | 0:de66621e5370 | 14 | * Revised: August 29th, 2014 |
kenjiArai | 0:de66621e5370 | 15 | * |
kenjiArai | 0:de66621e5370 | 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, |
kenjiArai | 0:de66621e5370 | 17 | * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE |
kenjiArai | 0:de66621e5370 | 18 | * AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, |
kenjiArai | 0:de66621e5370 | 19 | * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
kenjiArai | 0:de66621e5370 | 20 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
kenjiArai | 0:de66621e5370 | 21 | */ |
kenjiArai | 0:de66621e5370 | 22 | |
kenjiArai | 0:de66621e5370 | 23 | #ifndef L3GD20_GYRO_H |
kenjiArai | 0:de66621e5370 | 24 | #define L3GD20_GYRO_H |
kenjiArai | 0:de66621e5370 | 25 | |
kenjiArai | 0:de66621e5370 | 26 | #include "mbed.h" |
kenjiArai | 0:de66621e5370 | 27 | |
kenjiArai | 0:de66621e5370 | 28 | // L3G4200DMEMS Address |
kenjiArai | 0:de66621e5370 | 29 | // 7bit address = 0b110100x(0x68 or 0x69 depends on SA0/SDO) |
kenjiArai | 0:de66621e5370 | 30 | // -> 8bit = 0b1101000x0(0xd0,0xd2) -> 0xd1,0xd3(Read) or 0xd0,0xd2(Write) |
kenjiArai | 0:de66621e5370 | 31 | #define L3G4200D_G_CHIP_ADDR 0xd0 // SA0(=SDO pin) = Ground |
kenjiArai | 0:de66621e5370 | 32 | #define L3G4200D_V_CHIP_ADDR 0xd2 // SA0(=SDO pin) = Vdd |
kenjiArai | 0:de66621e5370 | 33 | // L3GD20MEMS Address |
kenjiArai | 0:de66621e5370 | 34 | // 7bit address = 0b110101x(0x6a or 0x6b depends on SA0/SDO) |
kenjiArai | 0:de66621e5370 | 35 | // -> 8bit = 0b1101001x0(0xd4,0xd6) -> 0xd5,0xd7(Read) or 0xd4,0xd6(Write) |
kenjiArai | 0:de66621e5370 | 36 | #define L3GD20_G_CHIP_ADDR 0xd4 // SA0(=SDO pin) = Ground |
kenjiArai | 0:de66621e5370 | 37 | #define L3GD20_V_CHIP_ADDR 0xd6 // SA0(=SDO pin) = Vdd |
kenjiArai | 0:de66621e5370 | 38 | |
kenjiArai | 0:de66621e5370 | 39 | // L3G4200DMEMS ID |
kenjiArai | 0:de66621e5370 | 40 | #define I_AM_L3G4200D 0xd3 |
kenjiArai | 0:de66621e5370 | 41 | // L3GD20MEMS ID |
kenjiArai | 0:de66621e5370 | 42 | #define I_AM_L3GD20 0xd4 |
kenjiArai | 0:de66621e5370 | 43 | |
kenjiArai | 0:de66621e5370 | 44 | // Register's definition |
kenjiArai | 0:de66621e5370 | 45 | #define L3GX_WHO_AM_I 0x0f |
kenjiArai | 0:de66621e5370 | 46 | #define L3GX_CTRL_REG1 0x20 |
kenjiArai | 0:de66621e5370 | 47 | #define L3GX_CTRL_REG2 0x21 |
kenjiArai | 0:de66621e5370 | 48 | #define L3GX_CTRL_REG3 0x22 |
kenjiArai | 0:de66621e5370 | 49 | #define L3GX_CTRL_REG4 0x23 |
kenjiArai | 0:de66621e5370 | 50 | #define L3GX_CTRL_REG5 0x24 |
kenjiArai | 0:de66621e5370 | 51 | #define L3GX_REFERENCE 0x25 |
kenjiArai | 0:de66621e5370 | 52 | #define L3GX_OUT_TEMP 0x26 |
kenjiArai | 0:de66621e5370 | 53 | #define L3GX_STATUS_REG 0x27 |
kenjiArai | 0:de66621e5370 | 54 | #define L3GX_OUT_X_L 0x28 |
kenjiArai | 0:de66621e5370 | 55 | #define L3GX_OUT_X_H 0x29 |
kenjiArai | 0:de66621e5370 | 56 | #define L3GX_OUT_Y_L 0x2a |
kenjiArai | 0:de66621e5370 | 57 | #define L3GX_OUT_Y_H 0x2b |
kenjiArai | 0:de66621e5370 | 58 | #define L3GX_OUT_Z_L 0x2c |
kenjiArai | 0:de66621e5370 | 59 | #define L3GX_OUT_Z_H 0x2d |
kenjiArai | 0:de66621e5370 | 60 | #define L3GX_FIFO_CTRL_REG 0x2e |
kenjiArai | 0:de66621e5370 | 61 | #define L3GX_FIFO_SRC_REG 0x2f |
kenjiArai | 0:de66621e5370 | 62 | #define L3GX_INT1_CFG 0x30 |
kenjiArai | 0:de66621e5370 | 63 | #define L3GX_INT1_SRC 0x31 |
kenjiArai | 0:de66621e5370 | 64 | #define L3GX_INT1_TSH_XH 0x32 |
kenjiArai | 0:de66621e5370 | 65 | #define L3GX_INT1_TSH_XL 0x33 |
kenjiArai | 0:de66621e5370 | 66 | #define L3GX_INT1_TSH_YH 0x34 |
kenjiArai | 0:de66621e5370 | 67 | #define L3GX_INT1_TSH_YL 0x35 |
kenjiArai | 0:de66621e5370 | 68 | #define L3GX_INT1_TSH_ZH 0x36 |
kenjiArai | 0:de66621e5370 | 69 | #define L3GX_INT1_TSH_ZL 0x37 |
kenjiArai | 0:de66621e5370 | 70 | #define L3GX_INT1_DURATION 0x38 |
kenjiArai | 0:de66621e5370 | 71 | |
kenjiArai | 0:de66621e5370 | 72 | // Output Data Rate (ODR) |
kenjiArai | 0:de66621e5370 | 73 | // L3G4200DMEMS |
kenjiArai | 0:de66621e5370 | 74 | #define L3GX_DR_100HZ 0 |
kenjiArai | 0:de66621e5370 | 75 | #define L3GX_DR_200HZ 1 |
kenjiArai | 0:de66621e5370 | 76 | #define L3GX_DR_400HZ 2 |
kenjiArai | 0:de66621e5370 | 77 | #define L3GX_DR_800HZ 3 |
kenjiArai | 0:de66621e5370 | 78 | // L3GD20MEMS |
kenjiArai | 0:de66621e5370 | 79 | #define L3GX_DR_95HZ 0 |
kenjiArai | 0:de66621e5370 | 80 | #define L3GX_DR_190HZ 1 |
kenjiArai | 0:de66621e5370 | 81 | #define L3GX_DR_380HZ 2 |
kenjiArai | 0:de66621e5370 | 82 | #define L3GX_DR_760HZ 3 |
kenjiArai | 0:de66621e5370 | 83 | |
kenjiArai | 0:de66621e5370 | 84 | // Bandwidth (Low pass) |
kenjiArai | 0:de66621e5370 | 85 | #define L3GX_BW_LOW 0 |
kenjiArai | 0:de66621e5370 | 86 | #define L3GX_BW_M_LOW 1 |
kenjiArai | 0:de66621e5370 | 87 | #define L3GX_BW_M_HI 2 |
kenjiArai | 0:de66621e5370 | 88 | #define L3GX_BW_HI 3 |
kenjiArai | 0:de66621e5370 | 89 | |
kenjiArai | 0:de66621e5370 | 90 | // Power-down mode enable/disable |
kenjiArai | 0:de66621e5370 | 91 | #define L3GX_PD_EN 0 |
kenjiArai | 0:de66621e5370 | 92 | #define L3GX_PD_DIS 1 |
kenjiArai | 0:de66621e5370 | 93 | |
kenjiArai | 0:de66621e5370 | 94 | // Axis control |
kenjiArai | 0:de66621e5370 | 95 | #define L3GX_X_EN 1 |
kenjiArai | 0:de66621e5370 | 96 | #define L3GX_X_DIS 0 |
kenjiArai | 0:de66621e5370 | 97 | #define L3GX_Y_EN 1 |
kenjiArai | 0:de66621e5370 | 98 | #define L3GX_Y_DIS 0 |
kenjiArai | 0:de66621e5370 | 99 | #define L3GX_Z_EN 1 |
kenjiArai | 0:de66621e5370 | 100 | #define L3GX_Z_DIS 0 |
kenjiArai | 0:de66621e5370 | 101 | |
kenjiArai | 0:de66621e5370 | 102 | // Full Scale |
kenjiArai | 0:de66621e5370 | 103 | #define L3GX_FS_250DPS 0 |
kenjiArai | 0:de66621e5370 | 104 | #define L3GX_FS_500DPS 1 |
kenjiArai | 0:de66621e5370 | 105 | #define L3GX_FS_2000DPS 2 |
kenjiArai | 0:de66621e5370 | 106 | |
kenjiArai | 0:de66621e5370 | 107 | //Convert from degrees to radians. |
kenjiArai | 0:de66621e5370 | 108 | #define toRadians(x) (x * 0.01745329252) |
kenjiArai | 0:de66621e5370 | 109 | //Convert from radians to degrees. |
kenjiArai | 0:de66621e5370 | 110 | #define toDegrees(x) (x * 57.2957795) |
kenjiArai | 0:de66621e5370 | 111 | |
kenjiArai | 0:de66621e5370 | 112 | /** Interface for STMicronics MEMS motion sensor: 3-axis digital gyroscope |
kenjiArai | 0:de66621e5370 | 113 | * Chip: L3GD20 (new one) and L3G4200 (old one) |
kenjiArai | 0:de66621e5370 | 114 | * |
kenjiArai | 0:de66621e5370 | 115 | * @code |
kenjiArai | 0:de66621e5370 | 116 | * #include "mbed.h" |
kenjiArai | 0:de66621e5370 | 117 | * |
kenjiArai | 0:de66621e5370 | 118 | * // I2C Communication |
kenjiArai | 0:de66621e5370 | 119 | * L3GX_GYRO gyro(p_sda, p_scl, chip_addr, datarate, bandwidth, fullscale); |
kenjiArai | 0:de66621e5370 | 120 | * // If you connected I2C line not only this device but also other devices, |
kenjiArai | 0:de66621e5370 | 121 | * // you need to declare following method. |
kenjiArai | 0:de66621e5370 | 122 | * I2C i2c(dp5,dp27); // SDA, SCL |
kenjiArai | 0:de66621e5370 | 123 | * L3GX_GYRO gyro(i2c, chip_addr, datarate, bandwidth, fullscale); |
kenjiArai | 0:de66621e5370 | 124 | * |
kenjiArai | 0:de66621e5370 | 125 | * int main() { |
kenjiArai | 0:de66621e5370 | 126 | * float f[3]; |
kenjiArai | 0:de66621e5370 | 127 | * int8_t t; |
kenjiArai | 0:de66621e5370 | 128 | * |
kenjiArai | 0:de66621e5370 | 129 | * if (gyro.read_id() == I_AM_L3G4200D){ |
kenjiArai | 0:de66621e5370 | 130 | * t = gyro.read_temp(); |
kenjiArai | 0:de66621e5370 | 131 | * gyro.read_data(f); |
kenjiArai | 0:de66621e5370 | 132 | * } |
kenjiArai | 0:de66621e5370 | 133 | * } |
kenjiArai | 0:de66621e5370 | 134 | * @endcode |
kenjiArai | 0:de66621e5370 | 135 | */ |
kenjiArai | 0:de66621e5370 | 136 | |
kenjiArai | 0:de66621e5370 | 137 | class L3GX_GYRO{ |
kenjiArai | 0:de66621e5370 | 138 | public: |
kenjiArai | 0:de66621e5370 | 139 | /** Configure data pin |
kenjiArai | 0:de66621e5370 | 140 | * @param data SDA and SCL pins |
kenjiArai | 0:de66621e5370 | 141 | * @param device address L3G4200D(SA0=0 or 1) or L3GD20(SA0=0 or 1) |
kenjiArai | 0:de66621e5370 | 142 | * @param ->L3G4200D_G_CHIP_ADDR to L3GD20_V_CHIP_ADDR |
kenjiArai | 0:de66621e5370 | 143 | * @param output data rate selection, DR_100HZ/DR_95HZ to DR_800HZ/DR_760HZ |
kenjiArai | 0:de66621e5370 | 144 | * @param bandwidth selection, BW_LOW to BW_HI |
kenjiArai | 0:de66621e5370 | 145 | * @param full scale selection, FS_250DPS, FS_500DPS, FS_2000DPS |
kenjiArai | 0:de66621e5370 | 146 | */ |
kenjiArai | 0:de66621e5370 | 147 | L3GX_GYRO(PinName p_sda, PinName p_scl, |
kenjiArai | 0:de66621e5370 | 148 | uint8_t addr, uint8_t data_rate, uint8_t bandwidth, uint8_t fullscale); |
kenjiArai | 0:de66621e5370 | 149 | |
kenjiArai | 0:de66621e5370 | 150 | /** Configure data pin (with other devices on I2C line) |
kenjiArai | 0:de66621e5370 | 151 | * @param I2C previous definition |
kenjiArai | 0:de66621e5370 | 152 | * @param other parameters -> please see L3GX_GYRO(PinName p_sda, PinName p_scl,...) |
kenjiArai | 0:de66621e5370 | 153 | */ |
kenjiArai | 0:de66621e5370 | 154 | L3GX_GYRO(I2C& p_i2c, |
kenjiArai | 0:de66621e5370 | 155 | uint8_t addr, uint8_t data_rate, uint8_t bandwidth, uint8_t fullscale); |
kenjiArai | 0:de66621e5370 | 156 | |
kenjiArai | 0:de66621e5370 | 157 | /** Read a tow's complemet type data from Gyro |
kenjiArai | 0:de66621e5370 | 158 | * @param none |
kenjiArai | 0:de66621e5370 | 159 | * @return temperature unit:degreeC(Celsius) |
kenjiArai | 0:de66621e5370 | 160 | */ |
kenjiArai | 0:de66621e5370 | 161 | int8_t read_temp(); |
kenjiArai | 0:de66621e5370 | 162 | |
kenjiArai | 0:de66621e5370 | 163 | /** Read a float type data from Gyro |
kenjiArai | 0:de66621e5370 | 164 | * @param float type of three arry's address, e.g. float dt[3]; |
kenjiArai | 0:de66621e5370 | 165 | * @return Gyro motion data unit in param array:dps(degree per second) |
kenjiArai | 0:de66621e5370 | 166 | * @return dt[0]->x, dt[1]->y, dt[2]->z |
kenjiArai | 0:de66621e5370 | 167 | */ |
kenjiArai | 0:de66621e5370 | 168 | void read_data(float *dt); |
kenjiArai | 0:de66621e5370 | 169 | |
kenjiArai | 0:de66621e5370 | 170 | /** Read a Gyro ID number |
kenjiArai | 0:de66621e5370 | 171 | * @param none |
kenjiArai | 0:de66621e5370 | 172 | * @return if STM MEMS Gyro, it should be I_AM_L3G4200D(0xd3) or I_AM_L3GD20(0xd4) |
kenjiArai | 0:de66621e5370 | 173 | */ |
kenjiArai | 0:de66621e5370 | 174 | uint8_t read_id(); |
kenjiArai | 0:de66621e5370 | 175 | |
kenjiArai | 0:de66621e5370 | 176 | /** Read Data Ready flag |
kenjiArai | 0:de66621e5370 | 177 | * @param none |
kenjiArai | 0:de66621e5370 | 178 | * @return 1 = Ready |
kenjiArai | 0:de66621e5370 | 179 | */ |
kenjiArai | 0:de66621e5370 | 180 | uint8_t data_ready(); |
kenjiArai | 0:de66621e5370 | 181 | |
kenjiArai | 0:de66621e5370 | 182 | /** Read register (general purpose) |
kenjiArai | 0:de66621e5370 | 183 | * @param register's address |
kenjiArai | 0:de66621e5370 | 184 | * @return register data |
kenjiArai | 0:de66621e5370 | 185 | */ |
kenjiArai | 0:de66621e5370 | 186 | uint8_t read_reg(uint8_t addr); |
kenjiArai | 0:de66621e5370 | 187 | |
kenjiArai | 0:de66621e5370 | 188 | /** Write register (general purpose) |
kenjiArai | 0:de66621e5370 | 189 | * @param register's address |
kenjiArai | 0:de66621e5370 | 190 | * @param data |
kenjiArai | 0:de66621e5370 | 191 | * @return none |
kenjiArai | 0:de66621e5370 | 192 | */ |
kenjiArai | 0:de66621e5370 | 193 | void write_reg(uint8_t addr, uint8_t data); |
kenjiArai | 0:de66621e5370 | 194 | |
kenjiArai | 0:de66621e5370 | 195 | protected: |
kenjiArai | 0:de66621e5370 | 196 | void initialize(uint8_t, uint8_t, uint8_t, uint8_t); |
kenjiArai | 0:de66621e5370 | 197 | |
kenjiArai | 0:de66621e5370 | 198 | I2C i2c; |
kenjiArai | 0:de66621e5370 | 199 | |
kenjiArai | 0:de66621e5370 | 200 | private: |
kenjiArai | 0:de66621e5370 | 201 | float fs_factor; // full scale factor |
kenjiArai | 0:de66621e5370 | 202 | char dbf[2]; // working buffer |
kenjiArai | 0:de66621e5370 | 203 | uint8_t gyro_addr; // gyro sensor address |
kenjiArai | 0:de66621e5370 | 204 | uint8_t gyro_id; // gyro ID |
kenjiArai | 0:de66621e5370 | 205 | uint8_t gyro_ready; // gyro is on I2C line = 1, not = 0 |
kenjiArai | 0:de66621e5370 | 206 | }; |
kenjiArai | 0:de66621e5370 | 207 | |
kenjiArai | 0:de66621e5370 | 208 | #endif // L3GD20_GYRO_H |